altoslib: Support TeleGPS for Monitor Idle

[fw/altos] / altoslib / AltosIdleFetch.java

diff --git a/altoslib/AltosIdleFetch.java b/altoslib/AltosIdleFetch.java
index 50745d9755d9be1436932d62c848615bdb51f255..8958d80c7ae232e149d938ee7beab76368d84f55 100644 (file)
--- a/altoslib/AltosIdleFetch.java
+++ b/altoslib/AltosIdleFetch.java
@@ -38,6 +38,7 @@ class AltosIdler {
        static final int        idle_sensor_mega = 12;
        static final int        idle_sensor_emini = 13;
        static final int        idle_sensor_tmini = 14;
+       static final int        idle_sensor_tgps = 15;
 
        public void update_state(AltosState state, AltosLink link, AltosConfigData config_data) throws InterruptedException, TimeoutException {
                for (int idler : idlers) {
@@ -72,6 +73,10 @@ class AltosIdler {
                                break;
                        case idle_sensor_tmini:
                                AltosSensorTMini.update_state(state, link, config_data);
+                               break;
+                       case idle_sensor_tgps:
+                               AltosSensorTGPS.update_state(state, link, config_data);
+                               break;
                        }
                        if (idle != null)
                                idle.update_state(state);
@@ -122,6 +127,9 @@ public class AltosIdleFetch implements AltosStateUpdate {
                               AltosIdler.idle_ms5607, AltosIdler.idle_mma655x,
                               AltosIdler.idle_imu, AltosIdler.idle_mag,
                               AltosIdler.idle_sensor_mega),
+               new AltosIdler("TeleGPS",
+                              AltosIdler.idle_gps,
+                              AltosIdler.idle_sensor_tgps),
        };
 
        AltosLink               link;
@@ -131,6 +139,7 @@ public class AltosIdleFetch implements AltosStateUpdate {
 
        public void update_state(AltosState state) throws InterruptedException {
                try {
+                       /* Fetch config data from remote */
                        AltosConfigData config_data = new AltosConfigData(link);
                        state.set_state(AltosLib.ao_flight_startup);
                        state.set_serial(config_data.serial);