HAPSRG / solaESKF_Eigen

Eigen

Dependencies:   Eigen

Dependents:   optWingforHAPS_Eigen hexaTest_Eigen

Diff: solaESKF.cpp

Revision:
81:230a3d2b0493
Parent:
80:b241c058df83
Child:
82:662b810155e9
--- a/solaESKF.cpp	Fri Jun 24 05:43:46 2022 +0000
+++ b/solaESKF.cpp	Fri Jun 24 09:10:18 2022 +0000
@@ -754,11 +754,11 @@
     }
 }
 
-void solaESKF::setPihat(float pi_x, float pi_y)
+void solaESKF::setPihat(float pi_x, float pi_y, float pi_z)
 {
     pihat(0) = pi_x;
     pihat(1) = pi_y;
-    //pihat(3,1) = pi_z;
+    pihat(3,1) = pi_z;
 }
 
 Matrix3f solaESKF::Matrixcross(Vector3f v)