HAPSRG / Mbed 2 deprecated optWingforHAPS_Eigen

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@90:96c2b0ed4b96, 2021-10-26 (annotated)

Committer:
NaotoMorita
Date:
Tue Oct 26 05:36:18 2021 +0000
Revision:
90:96c2b0ed4b96
Parent:
89:c9f64bd655d9
Child:
92:00460f6df439
solaeskf compiled

Who changed what in which revision?

UserRevisionLine numberNew contents of line
osaka 87:89bbbcdb667b 1 #include "global.hpp"
osaka 87:89bbbcdb667b 2
osaka 87:89bbbcdb667b 3 void sendData2PC()
osaka 87:89bbbcdb667b 4 {
osaka 87:89bbbcdb667b 5 sp.da = da;
osaka 87:89bbbcdb667b 6 sp.de = de;
osaka 87:89bbbcdb667b 7 sp.dT = dT;
osaka 87:89bbbcdb667b 8 sp.rpy[0] = rpy.x*180.0f/M_PI;
osaka 87:89bbbcdb667b 9 sp.rpy[1] = rpy.y*180.0f/M_PI;
osaka 87:89bbbcdb667b 10 sp.rpy[2] = rpy.z*180.0f/M_PI;
osaka 87:89bbbcdb667b 11 pc.Send(0000, &(sp));
osaka 87:89bbbcdb667b 12 }
osaka 87:89bbbcdb667b 13
osaka 87:89bbbcdb667b 14 void sendTelemetry()
osaka 87:89bbbcdb667b 15 {
osaka 88:be349faa1976 16 //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);
NaotoMorita 90:96c2b0ed4b96 17 twelite.printf("%f %f %f %f %f %f %f %f %f %f %f %f\r\n",eskf.pihat(1,1),eskf.pihat(2,1),eskf.pihat(3,1),eskf.vihat(1,1), eskf.vihat(2,1), eskf.vihat(3,1),rpy.x*180.0f/M_PI,rpy.y*180.0f/M_PI,rpy.z*180.0f/M_PI,eskf.gravity(1,1),eskf.gravity(2,1),eskf.gravity(3,1));
NaotoMorita 89:c9f64bd655d9 18 //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);
osaka 87:89bbbcdb667b 19 }
osaka 87:89bbbcdb667b 20
osaka 87:89bbbcdb667b 21 void writeSDcard()
osaka 87:89bbbcdb667b 22 {
osaka 88:be349faa1976 23 //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);
osaka 87:89bbbcdb667b 24 }