Added attitude determination

include/sta/math/quaternion.hpp

@@ -0,0 +1,35 @@
+/*
+ * quaternion.hpp
+ *
+ *  Created on: Jun 17, 2024
+ *      Author: Dario
+ */
+
+#ifndef STA_PEAK_QUATERNION_HPP
+#define STA_PEAK_QUATERNION_HPP
+
+namespace sta
+{
+	namespace math {
+		class Quaternion
+		{
+		public:
+			Quaternion(float w, float x, float y, float z);
+
+			Quaternion();
+
+			static Quaternion unit();
+
+			float norm();
+
+			Quaternion normalized();
+
+			Quaternion operator+(const Quaternion& quat);
+			Quaternion operator*(float scalar);
+		public:
+			float x, y, z, w;
+		};
+	}  // namespace math
+}  // namespace sta
+
+#endif /* STA_PEAK_QUATERNION_HPP */