altos: debug invalid state for easymotor

Signed-off-by: Keith Packard <keithp@keithp.com>

diff --git a/src/kernel/ao_flight.c b/src/kernel/ao_flight.c
index f873a3c5f6a578bad796247624bf485c69590529..f778b2fbb62896dca526eeafbd83755f3def1dad 100644 (file)
--- a/src/kernel/ao_flight.c
+++ b/src/kernel/ao_flight.c
@@ -201,9 +201,16 @@ ao_flight(void)
 
                        break;
 
+               case ao_flight_invalid:
+                       printf("+g %d -g %d ga %d +g-NU %d -g+NU %d\n",
+                              ao_config.accel_plus_g,
+                              ao_config.accel_minus_g,
+                              ao_ground_accel,
+                              ao_config.accel_plus_g - ACCEL_NOSE_UP,
+                              ao_config.accel_minus_g + ACCEL_NOSE_UP);
+                       break;
 #if 0
                case ao_flight_idle:
-               case ao_flight_invalid:
                        printf("+g %d ga %d sa %d accel %ld speed %ld\n", ao_config.accel_plus_g, ao_ground_accel, ao_sample_accel, ao_accel, ao_speed);
                        break;
 #endif