Diff: transferData.cpp

Revision:

88:be349faa1976

Parent:

87:89bbbcdb667b

Child:

89:c9f64bd655d9

--- a/transferData.cpp	Wed Oct 20 01:50:52 2021 +0000
+++ b/transferData.cpp	Thu Oct 21 06:41:03 2021 +0000
@@ -22,10 +22,11 @@
 
 void sendTelemetry()
 {
-    twelite.printf("%f %f %f %f %f %f\r\n",da,de,dT,rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI);
+    //twelite.printf("%f %f %f %f %f %f\r\n",da,de,dT,rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI);
+    twelite.printf("%f %f %f %f %f %f %f %f %f %f %f %f\r\n",ekf.vihat(1,1), ekf.vihat(2,1), ekf.vihat(3,1),ekf.accBias.x,ekf.accBias.y,ekf.accBias.z,ekf.errState(7,1),ekf.errState(8,1),ekf.errState(9,1),ekf.errState(10,1),ekf.errState(11,1),ekf.errState(12,1));
 }
 
 void writeSDcard()
 {
-    sd.printf("%f %f %f %f %f %f\r\n",da,de,dT,rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI);
+    //sd.printf("%f %f %f %f %f %f\r\n",da,de,dT,rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI);
 }