HAPSRG / Mbed 2 deprecated HAPStail

Dependencies:   mbed MatrixMath LPS25HB_I2C LSM9DS1 Matrix2 PIDcontroller LoopTicker SBUS_without_mainfile UsaPack solaESKF_wind Vector3 CalibrateMagneto FastPWM

Revision:
80:31e0ffc82931
Parent:
75:7fa924da9d32
Child:
81:b1526a4eec17
--- a/datatransfer.cpp	Wed Sep 29 06:32:46 2021 +0000
+++ b/datatransfer.cpp	Wed Sep 29 06:41:22 2021 +0000
@@ -28,6 +28,7 @@
     ekf.updateCenteredGyroBiasCorrection(updateValues.gyroBias);
     //ekf.updateCenteredAccBiasCorrection(updateValues.accBias);
     //pc.printf("%f %f\n\r",rpy.x*180.0f/M_PI,updateValues.gyroBias[0]);
+    pc.printf("%f %f \r\n",rpy.x/M_PI*180.0f,rpy.y/M_PI*180.0f);
 }
 
 // eeprom書き込み・読み込みに必要な関数