Print the IMU information in imu command

This commit is contained in:
Oleg Kalachev
2024-10-31 10:24:00 +03:00
parent 39d4f39932
commit ad2c64625c
2 changed files with 6 additions and 0 deletions

View File

@@ -70,6 +70,7 @@ void doCommand(String& command, String& value) {
} else if (command == "psq") {
Serial.printf("qx: %f qy: %f qz: %f qw: %f\n", attitude.x, attitude.y, attitude.z, attitude.w);
} else if (command == "imu") {
printIMUInfo();
Serial.printf("gyro: %f %f %f\n", rates.x, rates.y, rates.z);
Serial.printf("acc: %f %f %f\n", acc.x, acc.y, acc.z);
printIMUCal();