ao-telem: Add companion packet telemetry data printing

[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 da873838a7f79ad4b06e45be9815510234e8ea1f..05a69542d53b7c97a436df77d85dd4f59811ef12 100644 (file)
--- a/ao-tools/ao-telem/ao-telem.c
+++ b/ao-tools/ao-telem/ao-telem.c
@@ -173,6 +173,15 @@ main (int argc, char **argv)
                                                telem.mega_sensor.mag_y,
                                                telem.mega_sensor.mag_z);
                                        break;
+                               case AO_TELEMETRY_COMPANION:
+                                       printf("board_id %3d update_period %3d channels %2d",
+                                              telem.companion.board_id,
+                                              telem.companion.update_period,
+                                              telem.companion.channels);
+                                       for (c = 0; c < telem.companion.channels; c++)
+                                               printf(" %6d", telem.companion.companion_data[c]);
+                                       printf("\n");
+                                       break;
                                case AO_TELEMETRY_MEGA_DATA:
                                        printf ("state %1d v_batt %5d v_pyro %5d ",
                                                telem.mega_data.state,
@@ -182,7 +191,7 @@ main (int argc, char **argv)
                                                printf ("s%1d %5d ", c,
                                                        telem.mega_data.sense[c] |
                                                        (telem.mega_data.sense[c] << 8));
-                                       
+
                                        printf ("ground_pres %5d ground_accel %5d accel_plus %5d accel_minus %5d ",
                                                telem.mega_data.ground_pres,
                                                telem.mega_data.ground_accel,