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:
- 89:c9f64bd655d9
- Parent:
- 88:be349faa1976
- Child:
- 90:96c2b0ed4b96
--- a/transferData.cpp Thu Oct 21 06:41:03 2021 +0000 +++ b/transferData.cpp Mon Oct 25 05:39:34 2021 +0000 @@ -23,7 +23,8 @@ 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 %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)); + twelite.printf("%f %f %f %f %f %f %f %f %f %f %f %f\r\n",ekf.accned(1,1),ekf.accned(2,1),ekf.accned(3,1),ekf.vihat(1,1), ekf.vihat(2,1), ekf.vihat(3,1),ekf.errState(10,1),ekf.errState(11,1),ekf.errState(12,1),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\r\n", lsm.ax, lsm.ay, lsm.az, lsm.gx, lsm.gy, lsm.gz, lsm.mx, lsm.my, lsm.mz); } void writeSDcard()