Diff: transferData.cpp

Revision:

141:725321fe2949

Parent:

140:53dbdb207542

Child:

143:53808e4e684c

--- a/transferData.cpp	Mon Dec 06 11:37:55 2021 +0000
+++ b/transferData.cpp	Fri Dec 10 10:43:50 2021 +0000
@@ -17,19 +17,19 @@
 
 void sendTelemetry()
 {
-    Vector3f pihat = eskf.getPihat();
-    Vector3f vihat = eskf.getVihat();
-    tp.time=_t.read();
-    tp.hertz = 1.0f/att_dt;
-    tp.gpsFix = float(gps.gpsFix);
-    for(int i = 0;i<3;i++){
-        tp.rpy[i] = euler(i*180.0f/M_PI_F);
-        tp.pihat[i] = pihat(i);
-        tp.vihat[i] = vihat(i);
-    }
-    tp.dynaccNorm = std::sqrt(dynaccnorm2);
-    
-    twelite.Send(0000, &(tp));
+//    Vector3f pihat = eskf.getPihat();
+//    Vector3f vihat = eskf.getVihat();
+//    tp.time=_t.read();
+//    tp.hertz = 1.0f/att_dt;
+//    tp.gpsFix = float(gps.gpsFix);
+//    for(int i = 0;i<3;i++){
+//        tp.rpy[i] = euler(i*180.0f/M_PI_F);
+//        tp.pihat[i] = pihat(i);
+//        tp.vihat[i] = vihat(i);
+//    }
+//    tp.dynaccNorm = std::sqrt(dynaccnorm2);
+//    
+//    twelite.Send(0000, &(tp));
         
 }
 
@@ -40,7 +40,7 @@
 
     lp.time = _t.read();
     lp.hertz = 1.0f/att_dt;
-    lp.gpsFix = float(gps.gpsFix);
+//    lp.gpsFix = float(gps.gpsFix);
     lp.da = da;
     lp.de = de;
     lp.dT = dT;