ao-telem: Dump orientation field from TeleMega sensor telemetry packet

[fw/altos] / ao-tools / ao-telem / ao-telem.c

diff --git a/ao-tools/ao-telem/ao-telem.c b/ao-tools/ao-telem/ao-telem.c
index d2dae5a7a14068cbdcc5e21552bc64e61f79b31e..da873838a7f79ad4b06e45be9815510234e8ea1f 100644 (file)
--- a/ao-tools/ao-telem/ao-telem.c
+++ b/ao-tools/ao-telem/ao-telem.c
@@ -158,7 +158,8 @@ main (int argc, char **argv)
                                        printf ("\n");
                                        break;
                                case AO_TELEMETRY_MEGA_SENSOR:
-                                       printf ("accel %5d pres %9d temp %5d accel_x %5d accel_y %5d accel_z %5d gyro_x %5d gyro_y %5d gyro_z %5d mag_x %5d mag_y %5d mag_z %5d\n",
+                                       printf ("orient %3d accel %5d pres %9d temp %5d accel_x %5d accel_y %5d accel_z %5d gyro_x %5d gyro_y %5d gyro_z %5d mag_x %5d mag_y %5d mag_z %5d\n",
+                                               telem.mega_sensor.orient,
                                                telem.mega_sensor.accel,
                                                telem.mega_sensor.pres,
                                                telem.mega_sensor.temp,
@@ -194,6 +195,39 @@ main (int argc, char **argv)
                                                telem.mega_data.height);
 
                                        break;
+                               case AO_TELEMETRY_METRUM_SENSOR:
+                                       printf ("state %1d accel %5d pres %9d temp %6.2f acceleration %6.2f speed %6.2f height %5d v_batt %5d sense_a %5d sense_m %5d\n",
+                                               telem.metrum_sensor.state,
+                                               telem.metrum_sensor.accel,
+                                               telem.metrum_sensor.pres,
+                                               telem.metrum_sensor.temp / 100.0,
+                                               telem.metrum_sensor.acceleration / 16.0,
+                                               telem.metrum_sensor.speed / 16.0,
+                                               telem.metrum_sensor.height,
+                                               telem.metrum_sensor.v_batt,
+                                               telem.metrum_sensor.sense_a,
+                                               telem.metrum_sensor.sense_m);
+                                       break;
+                               case AO_TELEMETRY_METRUM_DATA:
+                                       printf ("ground_pres %9d ground_accel %5d accel_plus %5d accel_minus %5d\n",
+                                               telem.metrum_data.ground_pres,
+                                               telem.metrum_data.ground_accel,
+                                               telem.metrum_data.accel_plus_g,
+                                               telem.metrum_data.accel_minus_g);
+                                       break;
+                               case AO_TELEMETRY_MINI:
+                                       printf ("state %1d v_batt %5d sense_a %5d sense_m %5d pres %9d temp %6.2f acceleration %6.2f speed %6.2f height %5d ground_pres %9d\n",
+                                               telem.mini.state,
+                                               telem.mini.v_batt,
+                                               telem.mini.sense_a,
+                                               telem.mini.sense_m,
+                                               telem.mini.pres,
+                                               telem.mini.temp / 100.0,
+                                               telem.mini.acceleration / 16.0,
+                                               telem.mini.speed / 16.0,
+                                               telem.mini.height,
+                                               telem.mini.ground_pres);
+                                       break;
                                default:
                                        printf("\n");
                                }