X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=altoslib%2FAltosTelemetryReader.java;h=b3b97faea349f7212dd724d647fba46ff9cca142;hp=5ed501348b07174bb0debee09d499ada26bffb56;hb=c0ce45100dd205f59cd84465138c74d9b31df0bb;hpb=55e6558fa7cb23fb1363a86c83fbd6abf67ea324 diff --git a/altoslib/AltosTelemetryReader.java b/altoslib/AltosTelemetryReader.java index 5ed50134..b3b97fae 100644 --- a/altoslib/AltosTelemetryReader.java +++ b/altoslib/AltosTelemetryReader.java @@ -32,9 +32,12 @@ public class AltosTelemetryReader extends AltosFlightReader { LinkedBlockingQueue telem; public AltosState read() throws InterruptedException, ParseException, AltosCRCException, IOException { - AltosLine l = telem.take(); - if (l.line == null) - throw new IOException("IO error"); + AltosLine l; + do { + l = telem.take(); + if (l.line == null) + throw new IOException("IO error"); + } while (!link.get_monitor()); AltosTelemetry telem = AltosTelemetry.parse(l.line); if (state == null) state = new AltosState(); @@ -53,6 +56,7 @@ public class AltosTelemetryReader extends AltosFlightReader { } public void close(boolean interrupted) { + link.remove_monitor(telem); log.close(); try {