diff options
Diffstat (limited to 'altosdroid/src/org/altusmetrum/AltosDroid/TelemetryReader.java')
| -rw-r--r-- | altosdroid/src/org/altusmetrum/AltosDroid/TelemetryReader.java | 11 |
1 files changed, 10 insertions, 1 deletions
diff --git a/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryReader.java b/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryReader.java index 3ba5afa9..0c437f87 100644 --- a/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryReader.java +++ b/altosdroid/src/org/altusmetrum/AltosDroid/TelemetryReader.java @@ -66,7 +66,7 @@ public class TelemetryReader extends Thread { AltosState state = null; try { - for (;;) { + while (telemQueue != null) { try { state = read(); handler.obtainMessage(TelemetryService.MSG_TELEMETRY, state).sendToTarget(); @@ -91,5 +91,14 @@ public class TelemetryReader extends Thread { state = null; telemQueue = new LinkedBlockingQueue<AltosLine>(); link.add_monitor(telemQueue); + try { + link.set_radio_frequency(AltosPreferences.frequency(link.serial)); + link.set_telemetry(AltosLib.ao_telemetry_standard); + link.set_telemetry_rate(AltosPreferences.telemetry_rate(link.serial)); + } catch (InterruptedException ee) { + close(); + } catch (TimeoutException te) { + close(); + } } } |