Drone Status Menue: Sensor-Status, Arming, Temperaturen und Steig-/Sinkrate hinzugefuegt

Neue Zeile ganz oben mit farblich kodierten Sensor-Badges (ACC/BARO/MAG/
GPS/RNG/OF/PITOT/TEMP, aus dem sensorStatus-Bitfeld von MSP2_INAV_STATUS,
zuvor schon dokumentiert aber ungenutzt), darunter ein Zeilenpaar fuer
Arming-Status und die ersten 3 Temperatursensoren (neu: MSP2_INAV_
TEMPERATURES, 0x201E). Ans Ende der Liste die Steig-/Sinkrate (vario aus
MSP_ALTITUDE, bislang nur die Hoehe selbst wurde daraus gelesen).

- msp_commands.dart: inavTemperatures-Konstante ergaenzt; die Sensor-
  Status-Bits (bisher nur als Doc-Kommentar bei MSP2_INAV_STATUS notiert)
  zu echten Konstanten (MspSensorStatusBits) promoviert, da jetzt
  tatsaechlich gebraucht.
- msp_telemetry_codec.dart: parseMspAltitudeVerticalSpeedMs,
  parseMspInavStatusSensorStatus, parseMspInavTemperaturesC ergaenzt +
  Unit-Tests.
- TelemetryFrame: sensorStatusBits (Bitmaske, protokollneutral
  durchgereicht wie navMode), temperaturesC (erste 3 Sensoren, null je
  nicht konfiguriertem Slot), verticalSpeedMs.
- msp_telemetry_poller.dart: vario kommt aus derselben MSP_ALTITUDE-
  Antwort wie die Hoehe (keine zusaetzliche Anfrage), sensorStatus aus
  derselben MSP2_INAV_STATUS-Antwort wie ARMED; MSP2_INAV_TEMPERATURES neu
  im 2-Hz-Statuszyklus abgefragt.
- MockFlightControllerLink: synthetische Sensor-/Temperatur-/Vario-Werte
  (kein Pitot/Rangefinder/Opflow am T1 Ranger vorgesehen), leicht
  schwankend, damit die neuen Felder auch ohne Hardware sichtbar auf
  Werteaenderungen reagieren.
- drone_status_messages_panel.dart: eigene Sensor-Status-Zeile (lokale
  Bit-Konstanten statt MSP-Import, analog zum bestehenden navMode-Muster
  in domain/telemetry/drone_status.dart, damit die UI protokollneutral
  bleibt), Arming+Temperaturen-Zeilenpaar, Vertical-speed-Zeile am Ende.

Auf dem Pixel_10a-Emulator verifiziert: Sensor-Badges gruen/grau je nach
Bitmaske, Arming/Temperaturen-Paar, Vertical speed am Listenende.

Co-Authored-By: Claude Sonnet 5 <noreply@anthropic.com>
This commit is contained in:
Constantin Leue
2026-08-06 15:32:56 +02:00
co-authored by Claude Sonnet 5
parent 08791cac0c
commit 9cece7dbb6
9 changed files with 324 additions and 21 deletions
+37 -4
View File
@@ -31,6 +31,10 @@ abstract final class MspCommands {
static const int setWp = 209;
/// Response: i32 estAlt(cm), i16 vario(cm/s), i32 baroAlt(cm).
/// `vario` ist `getEstimatedActualVelocity(Z)` - dieselbe Achse/dasselbe
/// Vorzeichen wie `estAlt` (`getEstimatedActualPosition(Z)`, beide aus
/// `navGetCurrentActualPositionAndVelocity()`, `navigation.c`), also
/// positiv = Steigen, negativ = Sinken.
/// (`fc_msp.c`, `case MSP_ALTITUDE`)
static const int altitude = 109;
@@ -44,10 +48,8 @@ abstract final class MspCommands {
/// (`fc_msp.c`, `case MSP2_INAV_STATUS`; ID aus
/// `msp_protocol_v2_inav.h`: `#define MSP2_INAV_STATUS 0x2000`)
///
/// Bit-Layout `sensorStatus` (`packSensorStatus()` in `fc_msp_box.c`):
/// Bit 0 ACC, 1 BARO, 2 MAG, 3 GPS, 4 RANGEFINDER, 5 OPFLOW, 6 PITOT,
/// 7 TEMP (je 1 = Sensor vorhanden/aktiviert); Bits 8-14 unbenutzt;
/// Bit 15 = Hardware-Defekt (`!isHardwareHealthy()`).
/// Bit-Layout `sensorStatus` (`packSensorStatus()` in `fc_msp_box.c`) -
/// siehe [MspSensorStatusBits].
///
/// Bit-Layout `armingFlags` (`armingFlag_e` in `fc/runtime_config.h`) -
/// siehe [MspArmingFlags].
@@ -88,6 +90,16 @@ abstract final class MspCommands {
/// i8 uplinkSnr. (`fc_msp.c`, `case MSP2_INAV_GET_LINK_STATS`; ID aus
/// `msp_protocol_v2_inav.h`: `#define MSP2_INAV_GET_LINK_STATS 0x2103`)
static const int inavLinkStats = 0x2103;
/// Response (`MAX_TEMP_SENSORS` = 8 Slots, je i16, 0.1°C-Schritte,
/// `sensors/temperature.h`: "Temperature is returned in degC*10"):
/// ungueltiger/nicht konfigurierter Sensor liefert `-1000`
/// (`fc_msp.c`, `case MSP2_INAV_TEMPERATURES`: `sbufWriteU16(dst, valid
/// ? temperature : -1000)`, braucht `USE_TEMPERATURE_SENSOR` +
/// konfigurierte Sensoren, sonst dauerhaft `-1000` fuer alle 8 Slots).
/// ID aus `msp_protocol_v2_inav.h`:
/// `#define MSP2_INAV_TEMPERATURES 0x201E`.
static const int inavTemperatures = 0x201E;
}
/// Bits von `armingFlags` (`armingFlag_e` in `fc/runtime_config.h`, iNAV
@@ -110,3 +122,24 @@ abstract final class MspCommands {
abstract final class MspArmingFlags {
static const int armed = 1 << 2;
}
/// Bits von `sensorStatus` (`packSensorStatus()` in `fc_msp_box.c`, Teil
/// der `MSP2_INAV_STATUS`-Antwort, siehe [MspCommands.inavStatus]) - Bits
/// 0-7 melden je, ob der Sensor als vorhanden/aktiviert erkannt wurde
/// (`sensors(SENSOR_*)`), unabhaengig von einer eigenen Kalibrierung/einem
/// gueltigen Messwert. Bits 8-14 unbenutzt.
abstract final class MspSensorStatusBits {
static const int acc = 1 << 0;
static const int baro = 1 << 1;
static const int mag = 1 << 2;
static const int gps = 1 << 3;
static const int rangefinder = 1 << 4;
static const int opflow = 1 << 5;
static const int pitot = 1 << 6;
static const int temp = 1 << 7;
/// `!isHardwareHealthy()` - mind. ein Sensor meldet einen Hardware-Defekt
/// (I2C-Fehler etc.), unabhaengig davon, welcher der Bits 0-7 betroffen
/// ist.
static const int hardwareFailure = 1 << 15;
}
@@ -56,6 +56,14 @@ double parseMspAltitudeMeters(Uint8List payload) {
return data.getInt32(0, Endian.little) / 100.0;
}
/// Parst die `MSP_ALTITUDE`-Antwort und liefert die vertikale Geschwindigkeit
/// (Steig-/Sinkrate) in m/s, positiv = Steigen (Offset 4, i16, siehe
/// [MspCommands.altitude]).
double parseMspAltitudeVerticalSpeedMs(Uint8List payload) {
final data = ByteData.sublistView(payload);
return data.getInt16(4, Endian.little) / 100.0;
}
/// Parst die `MSP2_INAV_STATUS`-Antwort und liefert, ob der ARMED-Bit in
/// `armingFlags` gesetzt ist (siehe [MspCommands.inavStatus]).
bool parseMspInavStatusArmed(Uint8List payload) {
@@ -66,6 +74,14 @@ bool parseMspInavStatusArmed(Uint8List payload) {
return (armingFlags & MspArmingFlags.armed) != 0;
}
/// Parst die `MSP2_INAV_STATUS`-Antwort und liefert das rohe `sensorStatus`-
/// Bitfeld (Offset 4, siehe [MspSensorStatusBits] fuer die Bit-Bedeutung
/// und [MspCommands.inavStatus]).
int parseMspInavStatusSensorStatus(Uint8List payload) {
final data = ByteData.sublistView(payload);
return data.getUint16(4, Endian.little);
}
/// Parst die `MSP_NAV_STATUS`-Antwort und liefert den aktiven Wegpunkt als
/// 0-basierten Index in die App-eigene Wegpunktliste, oder null, wenn keine
/// Mission aktiv ist (`activeWpNumber == 0`, siehe [MspCommands.navStatus]).
@@ -164,3 +180,17 @@ int parseMspLinkQuality(Uint8List payload) => payload[1];
/// behaftet zurueckgelesen werden, siehe [MspCommands.inavLinkStats]).
int parseMspLinkStatsSnr(Uint8List payload) =>
ByteData.sublistView(payload).getInt8(2);
/// Parst die `MSP2_INAV_TEMPERATURES`-Antwort und liefert die Werte der
/// ersten 3 Temperatursensoren in °C, `null` je Slot ohne konfigurierten/
/// gueltigen Sensor (Rohwert `-1000`, siehe [MspCommands.inavTemperatures]).
/// Absichtlich nur die ersten 3 von bis zu 8 moeglichen Slots (Doku Drone
/// Status Menue: "die ersten 3 temperaturen") - fuer mehr besteht kein
/// UI-Bedarf.
List<double?> parseMspInavTemperaturesC(Uint8List payload) {
final data = ByteData.sublistView(payload);
return List.generate(3, (i) {
final raw = data.getInt16(i * 2, Endian.little);
return raw <= -1000 ? null : raw / 10.0;
});
}
@@ -14,11 +14,13 @@ import 'msp_telemetry_codec.dart';
///
/// - Position/Lage/Hoehe (5-10 Hz): jeden Zyklus (`MSP_RAW_GPS` +
/// `MSP_ALTITUDE`).
/// - Status/Flugmodus/Akku/Link (2 Hz): jeden [_statusEveryNCycles]-ten
/// Zyklus (`MSP2_INAV_STATUS`, `MSP_NAV_STATUS`, `MSP2_INAV_ANALOG`,
/// `MSP2_INAV_GET_LINK_STATS`) - Flugmodus wird aus derselben
/// - Status/Flugmodus/Akku/Link/Temperaturen (2 Hz): jeden
/// [_statusEveryNCycles]-ten Zyklus (`MSP2_INAV_STATUS`, `MSP_NAV_STATUS`,
/// `MSP2_INAV_ANALOG`, `MSP2_INAV_GET_LINK_STATS`,
/// `MSP2_INAV_TEMPERATURES`) - Flugmodus wird aus derselben
/// `MSP_NAV_STATUS`-Antwort gelesen wie der aktive Wegpunkt, keine
/// zusaetzliche Anfrage noetig.
/// zusaetzliche Anfrage noetig. `sensorStatus` ebenso aus derselben
/// `MSP2_INAV_STATUS`-Antwort wie der ARMED-Status.
///
/// Der Strom wird NICHT auf einen gueltigen GPS-Fix gegated - jeder Zyklus
/// emittiert ein [TelemetryFrame], auch ohne Fix (dann mit `hasFix: false`
@@ -45,6 +47,8 @@ class MspTelemetryPoller {
int _snrDb = 0;
int _navMode = 0;
String _flightMode = 'Idle';
int _sensorStatusBits = 0;
List<double?> _temperaturesC = const [null, null, null];
Stream<TelemetryFrame> get frames => _framesController.stream;
@@ -75,14 +79,15 @@ class MspTelemetryPoller {
Future<void> _runCycle() async {
final gps = parseMspRawGps(await _client.request(MspCommands.rawGps));
final altitudeM =
parseMspAltitudeMeters(await _client.request(MspCommands.altitude));
final altitudePayload = await _client.request(MspCommands.altitude);
final altitudeM = parseMspAltitudeMeters(altitudePayload);
final verticalSpeedMs = parseMspAltitudeVerticalSpeedMs(altitudePayload);
_cycle++;
if (_cycle % _statusEveryNCycles == 0) {
_armed = parseMspInavStatusArmed(
await _client.request(MspCommands.inavStatus),
);
final statusPayload = await _client.request(MspCommands.inavStatus);
_armed = parseMspInavStatusArmed(statusPayload);
_sensorStatusBits = parseMspInavStatusSensorStatus(statusPayload);
final navStatusPayload = await _client.request(MspCommands.navStatus);
_activeWaypointIndex = parseMspNavStatusActiveWaypoint(navStatusPayload);
final navMode = parseMspNavMode(navStatusPayload);
@@ -95,6 +100,9 @@ class MspTelemetryPoller {
final linkStatsPayload = await _client.request(MspCommands.inavLinkStats);
_linkQuality = parseMspLinkQuality(linkStatsPayload);
_snrDb = parseMspLinkStatsSnr(linkStatsPayload);
final temperaturesPayload =
await _client.request(MspCommands.inavTemperatures);
_temperaturesC = parseMspInavTemperaturesC(temperaturesPayload);
}
if (!_framesController.isClosed) {
@@ -115,6 +123,9 @@ class MspTelemetryPoller {
hdop: gps.hdop,
navMode: _navMode,
flightMode: _flightMode,
sensorStatusBits: _sensorStatusBits,
temperaturesC: _temperaturesC,
verticalSpeedMs: verticalSpeedMs,
activeWaypointIndex: _activeWaypointIndex,
));
}