1 files changed, 27 insertions, 0 deletions
diff --git a/altosui/AltosTelemetryReader.java b/altosui/AltosTelemetryReader.java
index 1f327a67..85dc9cbc 100644
--- a/altosui/AltosTelemetryReader.java
+++ b/altosui/AltosTelemetryReader.java
@@ -56,6 +56,33 @@ class AltosTelemetryReader extends AltosFlightReader {
 		serial.set_radio_frequency(frequency);
 	}
 
+	public boolean supports_telemetry(int telemetry) {
+
+		try {
+			/* Version 1.0 or later firmware supports all telemetry formats */
+			if (serial.config_data().compare_version("1.0") >= 0)
+				return true;
+
+			/* Version 0.9 firmware only supports 0.9 telemetry */
+			if (serial.config_data().compare_version("0.9") >= 0) {
+				if (telemetry == Altos.ao_telemetry_0_9)
+					return true;
+				else
+					return false;
+			}
+
+			/* Version 0.8 firmware only supports 0.8 telemetry */
+			if (telemetry == Altos.ao_telemetry_0_8)
+				return true;
+			else
+				return false;
+		} catch (InterruptedException ie) {
+			return true;
+		} catch (TimeoutException te) {
+			return true;
+		}
+	}
+
 	void save_frequency() {
 		AltosPreferences.set_frequency(device.getSerial(), frequency);
 	}