|
|
|
@ -456,7 +456,6 @@ test_ins(uint8_t argc, const Menu::arg *argv)
@@ -456,7 +456,6 @@ test_ins(uint8_t argc, const Menu::arg *argv)
|
|
|
|
|
return (0); |
|
|
|
|
#else |
|
|
|
|
Vector3f gyro, accel; |
|
|
|
|
float temp; |
|
|
|
|
print_hit_enter(); |
|
|
|
|
cliSerial->printf_P(PSTR("INS\n")); |
|
|
|
|
delay(1000); |
|
|
|
@ -472,14 +471,13 @@ test_ins(uint8_t argc, const Menu::arg *argv)
@@ -472,14 +471,13 @@ test_ins(uint8_t argc, const Menu::arg *argv)
|
|
|
|
|
ins.update(); |
|
|
|
|
gyro = ins.get_gyro(); |
|
|
|
|
accel = ins.get_accel(); |
|
|
|
|
temp = ins.temperature(); |
|
|
|
|
|
|
|
|
|
float test = accel.length() / GRAVITY_MSS; |
|
|
|
|
|
|
|
|
|
cliSerial->printf_P(PSTR("a %7.4f %7.4f %7.4f g %7.4f %7.4f %7.4f t %74f | %7.4f\n"), |
|
|
|
|
accel.x, accel.y, accel.z, |
|
|
|
|
gyro.x, gyro.y, gyro.z, |
|
|
|
|
temp, test); |
|
|
|
|
test); |
|
|
|
|
|
|
|
|
|
delay(40); |
|
|
|
|
if(cliSerial->available() > 0) { |
|
|
|
|