HAPSRG / Mbed 2 deprecated HAPStail

Dependencies:   mbed MatrixMath LPS25HB_I2C LSM9DS1 Matrix2 PIDcontroller LoopTicker SBUS_without_mainfile UsaPack solaESKF_wind Vector3 CalibrateMagneto FastPWM

Revision:
97:2a65f22488e4
Parent:
93:b0f7a1e91476
Parent:
96:0be0d80d5299
Child:
99:37cfd8633c9b
diff -r 98dbbcc6b39d -r 2a65f22488e4 datatransfer.cpp
--- a/datatransfer.cpp	Wed Feb 02 07:59:58 2022 +0000
+++ b/datatransfer.cpp	Wed Feb 02 08:37:33 2022 +0000
@@ -18,6 +18,14 @@
     vp.altitude = -palt;
     vp.de = de;
     vp.deobj = deobj;
+    Matrix pihat = eskf.getPihat();
+    vp.pi[0] = pihat(1, 1);
+    vp.pi[1] = pihat(2, 1);
+    vp.pi[2] = pihat(3, 1);
+    Matrix vihat = eskf.getVihat();
+    vp.vi[0] = vihat(1, 1);
+    vp.vi[1] = vihat(2, 1);
+    vp.vi[2] = vihat(3, 1);
     if (prefligt_finished)
     {
         vp.readyFlag = 1;