UAVの姿勢推定に使用するプログラム。

Dependencies:   MPU6050_alter

Revision:
4:21a356ae0747
Parent:
3:3fa7882a5fd0
--- a/Vector/Vector_Matrix_operator.cpp	Wed Jul 24 12:00:01 2019 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,35 +0,0 @@
-#include "Vector_Matrix_operator.h"
-
-Vector operator*(const Matrix& lhm, const Vector& rhv) {
-    if (lhm.GetCol() != rhv.GetDim()) error("Irregular Dimention");
-    Vector retVec(lhm.GetRow());
-
-    for (int i = 1; i <= lhm.GetRow(); i++) {
-        float temp = 0.0f;
-        for (int j = 1; j <= rhv.GetDim(); j++) {
-            temp += lhm.GetComp(i, j)*rhv.GetComp(j);
-        }
-        retVec.SetComp(i, temp);
-    }
-
-    retVec.CleanUp();
-
-    return retVec;
-}
-
-Vector operator*(const Vector& lhv, const Matrix& rhm) {
-    if (lhv.GetDim() != rhm.GetRow()) error("Irregular Dimention");
-    Vector retVec(rhm.GetCol());
-
-    for (int i = 1; i <= rhm.GetCol(); i++) {
-        float temp = 0.0f;
-        for (int j = 1; j <= lhv.GetDim(); j++) {
-            temp += lhv.GetComp(j) * rhm.GetComp(j, i);
-        }
-        retVec.SetComp(i, temp);
-    }
-
-    retVec.CleanUp();
-
-    return retVec;
-}
\ No newline at end of file