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
transferData.cpp
- Committer:
- osaka
- Date:
- 2021-10-21
- Revision:
- 88:be349faa1976
- Parent:
- 87:89bbbcdb667b
- Child:
- 89:c9f64bd655d9
File content as of revision 88:be349faa1976:
#include "global.hpp" void sendData2PC() { sp.da = da; sp.de = de; sp.dT = dT; sp.rpy[0] = rpy.x*180.0f/M_PI; sp.rpy[1] = rpy.y*180.0f/M_PI; sp.rpy[2] = rpy.z*180.0f/M_PI; sp.vi[0] = vi.x; sp.vi[1] = vi.y; sp.vi[2] = vi.z; sp.vihat[0] = ekf.vihat(1,1); sp.vihat[1] = ekf.vihat(2,1); sp.vihat[2] = ekf.vihat(3,1); sp.accBias[0] = ekf.accBias.x; sp.accBias[1] = ekf.accBias.y; sp.accBias[2] = ekf.accBias.z; pc.Send(0000, &(sp)); } 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)); } 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); }