Eigen Revision
Dependencies: mbed LPS25HB_I2C LSM9DS1 PIDcontroller Autopilot_Eigen LoopTicker GPSUBX_UART_Eigen SBUS_without_mainfile MedianFilter Eigen UsaPack solaESKF_Eigen Vector3 CalibrateMagneto FastPWM
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;