Show imu data in cli

This commit is contained in:
Oleg Kalachev 2023-05-24 11:05:11 +03:00
parent 34fd303027
commit 17edd0ee00
2 changed files with 3 additions and 1 deletions

View File

@ -66,6 +66,8 @@ static void doCommand()
} 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") {
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();
} else if (command == "rc") {
Serial.printf("RAW throttle %d yaw %d pitch %d roll %d aux %d mode %d\n",

View File

@ -45,4 +45,4 @@ void setLED(bool on) {};
void calibrateGyro() {};
void fullMotorTest(int n) {};
void sendMotors() {};
void printIMUCal() { Serial.print("N/A"); };
void printIMUCal() { Serial.print("cal: N/A\n"); };