altos: Fix HAS_FLIGHT_DEBUG for easytimer

[fw/altos] / src / kernel / ao_sample.c

diff --git a/src/kernel/ao_sample.c b/src/kernel/ao_sample.c
index 391188c52974260f5933d8058bfc51de7ce4f25c..67f20aff9093b5941a3ccee9ffc5e6e752f96479 100644 (file)
--- a/src/kernel/ao_sample.c
+++ b/src/kernel/ao_sample.c
@@ -225,7 +225,10 @@ ao_sample_preflight_set(void)
        ao_quaternion_vectors_to_rotation(&ao_rotation, &up, &orient);
 #if HAS_FLIGHT_DEBUG
        if (ao_orient_test)
-               printf("\n\treset\n");
+               printf("\n\treset across %d through %d along %d\n",
+                      (ao_ground_accel_across - ao_config.accel_zero_across),
+                      (ao_ground_accel_through - ao_config.accel_zero_through),
+                      (ao_ground_accel_along - ao_config.accel_zero_along));
 #endif 
 
        ao_sample_compute_orient();