altoslib: Add support for TeleMega v4

[fw/altos] / altoslib / AltosTelemetryStandard.java

diff --git a/altoslib/AltosTelemetryStandard.java b/altoslib/AltosTelemetryStandard.java
index 3f585ceafb49f5721ceef61907231342fc1a4a12..bef27e670482f0f178907248632a651d5fb10450 100644 (file)
--- a/altoslib/AltosTelemetryStandard.java
+++ b/altoslib/AltosTelemetryStandard.java
@@ -75,8 +75,11 @@ public abstract class AltosTelemetryStandard extends AltosTelemetry {
                case packet_type_companion:
                        telem = new AltosTelemetryCompanion(bytes);
                        break;
-               case packet_type_mega_sensor:
-                       telem = new AltosTelemetryMegaSensor(bytes);
+               case packet_type_mega_sensor_mpu:
+                       telem = new AltosTelemetryMegaSensor(bytes, AltosIMU.imu_type_telemega_v3);
+                       break;
+               case packet_type_mega_sensor_bmx160:
+                       telem = new AltosTelemetryMegaSensor(bytes, AltosIMU.imu_type_telemega_v4);
                        break;
                case packet_type_mega_data:
                        telem = new AltosTelemetryMegaData(bytes);