mirror of
https://github.com/okalachev/flix.git
synced 2025-07-27 17:49:33 +00:00
Print the IMU information in imu command
This commit is contained in:
parent
39d4f39932
commit
ad2c64625c
@ -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();
|
||||
|
@ -122,3 +122,8 @@ void printIMUCal() {
|
||||
Serial.printf("accel bias: %f %f %f\n", accBias.x, accBias.y, accBias.z);
|
||||
Serial.printf("accel scale: %f %f %f\n", accScale.x, accScale.y, accScale.z);
|
||||
}
|
||||
|
||||
void printIMUInfo() {
|
||||
Serial.printf("type: %s\n", IMU.getType());
|
||||
Serial.printf("who am I: 0x%02X\n", IMU.whoAmI());
|
||||
}
|
||||
|
Loading…
x
Reference in New Issue
Block a user