GNSS und Navigation
WAM-V- und BlueROV2-Sitzungen aktivieren POSIMs simulierten Satelliten-GNSS-Empfänger standardmäßig. Bei BlueROV2 kann er ausdrücklich deaktiviert werden. Sensorvertrag, Antennenlink und Topics sind gemeinsam. GNSS-Messzustand und FCU-Positionsschätzung bleiben getrennt.
Implementierung
| Stufe | Verfahren | Parameter und Ausgabe |
|---|---|---|
| Antennenkinematik | Natives Gazebo-Plugin posim::Gnss beobachtet den tatsächlichen Link einschließlich Rotation und Hebelarm. |
link_name, pose; geografische Position und Geschwindigkeit aus finiten Differenzen. |
| Messfehler | Unabhängige gaußverteilte Positions-/Geschwindigkeitsstörungen mit Startwert. | horizontal_stddev, vertical_stddev, velocity_stddev, seed; diagonale Kovarianz. |
| Verfügbarkeit | Wellenbasierter Nass-/Trockentest, Hysterese, kontinuierliche Wiedererfassung und explizite Abschattung. | water_level, wave_topic, dry_margin, reacquire_seconds, enabled; Fix, Erfassung, untergetaucht, blockiert oder unverfügbar. |
| Zeit | Simulationszeitbasierte Messrate und Verzögerungswarteschlange. | update_rate, latency; ursprünglicher Erfassungsstempel bleibt erhalten. |
| ROS und FCU | Prüft Epoche, Zeit und endliche Werte, publiziert Fix/Status und wandelt akzeptierte Messungen in MAVLink GPS_INPUT. |
Sensoralias, rohes FCU-GPS und fusionierte Schätzung bleiben unterscheidbar. |
| Anzeige und Mission | Aktualität und EKF-Zustand bestimmen Bereitschaft und Missionsschutz. | Fusionsanzeige ist eine Statusinterpretation, kein vollständiger Zugriff auf Filterinnovationen. |
Die Empfängerimplementierung und Profile definieren den Sensor. WWW-POSIM ergänzt ROS-Konvertierung, Quellenauswahl und Missionsintegration. Siehe Sensormodelle und Parameter.
Messungen und Schätzungen
| Ausgabe | Bedeutung |
|---|---|
/model/{robot}/gnss/fix |
Sensor-NavSatFix: Antennenposition mit eingestelltem Messrauschen. |
/model/{robot}/gnss/status |
Empfängerzustand und ursprüngliche Messzeit; JSON in std_msgs/String. |
/vehicle/gnss/fix, /vehicle/gnss/status |
Alias derselben Nachrichten für das aktive Fahrzeug, kein zweiter GPS-Einspeiser. |
/mavros/global_position/raw/fix |
Von ArduPilot empfangenes GPS nach MAVROS-Konvertierung. |
/mavros/global_position/global |
Fusionierte FCU-Position. |
/mavros/local_position/pose |
Fusionierte lokale FCU-Pose, ENU. |
/model/{robot}/odometry |
Simulatorreferenz für 3D-Darstellung, Geländesicherheit und Validierung; keine Quelle der Kartenkoordinaten |
Gazebo erzeugt die Messungen. Der Adapter wandelt akzeptierte Werte in GPS_INPUT mit Empfänger-ID 0. Das ArduPilot-Profil wählt diesen MAV-Empfänger, deaktiviert den zweiten und synthetisches SITL-GPS und nutzt GPS-Horizontalposition/-geschwindigkeit mit Kompasskurs. Auch bei deaktiviertem GNSS werden keine Vision-Pose oder -Geschwindigkeit aus Simulatorwahrheit in die FCU eingespeist. Eine einzelne Antenne liefert keinen stationären Kurs; auch GPS-Bewegungsrichtung ist nicht gleich Körperausrichtung.
Das GNSS-Profil setzt die Untergrenze des horizontalen Geschwindigkeitsrauschens EK3_VELNE_M_NSE aus receiver.velocity_stddev, begrenzt auf den dokumentierten Bereich 0.05–5 m/s (Standard: 0.1 m/s). Die vom Empfänger gemeldete Geschwindigkeitsgenauigkeit kann die wirksame Untergrenze erhöhen. Dies bestimmt die EKF-Gewichtung; das simulierte Messrauschen bleibt unverändert.
Die Gazebo-IMU des WAM-V liefert Beschleunigung und Winkelgeschwindigkeit über ArduPilots JSON-Schnittstelle. Der Kompass nutzt das SITL-Magnetfeldmodell. Das ist eine idealisierte Simulationsabhängigkeit, keine stationäre Kursschätzung aus der GNSS-Antenne.
Wegpunktziele verwenden den geografischen EKF-Ursprung der FCU. Ankunftsentscheidungen beruhen auf geschätzter Position. Simulatorwahrheit bleibt für Trajektorienbewertung und Geländesicherheit verfügbar, ohne den horizontalen GNSS-Fehler durch Ausrichtung zu entfernen. Ein frischer Fix allein belegt keinen gesunden Filter. Die Oberfläche zeigt EKF-Gültigkeit getrennt; Fusion kombiniert Quelle, frischen Sensorzustand und EKF-Flags, nicht Innovationen einzelner Messungen.
Bei Missionen mit konfiguriertem GNSS gilt: Nach dem Scharfschalten verlangt die Mission 2 durchgehende reale Sekunden mit aktueller lokaler Pose und beobachteter Fusion von GNSS oder akzeptierter externer Navigation vor GUIDED. Verlust startet das Intervall neu; ohne Stabilisierung nach 35 Sekunden stoppt die Mission. Wiedererfassung nutzt einen separaten Simulationszeitzähler.
Web und installierte App fordern EKF-/Systemstatus und FCU-Heartbeat mit 5 Hz Simulationszeit an. Status älter als 3 Echtzeitsekunden wird verworfen. Bei uhrvalidiertem Fix wiederholt der Adapter den Gültigkeitsstatus alle 0,2 Echtzeitsekunden, mit ursprünglichem Messstempel. Jede GPS-Eingabe und jeder Sensorfix stammt aus einer neuen akzeptierten Messung. Stehende Uhr oder veraltete Messung machen den Empfänger ungültig.
Konfiguration und Koordinatenrahmen
posim_gz_gnss/config/profiles.json definiert Empfänger und Montage. Die SDF enthält base_link → gnss_link → gnss; der Pose-Publisher stellt die tatsächliche Hierarchie über TF bereit. WAM-V montiert die Antenne 1,8 m über base_link, BlueROV2 0,3 m. Der Link trägt 0,001 kg bei.
Simulatorwahrheit nutzt map und Modelllinks. Die Schätzung nutzt fcu_map und TF map → fcu_map → fcu_base_link. Die erste Transformation projiziert den gemeldeten geografischen EKF-Ursprung in das Geländedatum und wird niemals an Wahrheit angepasst. Vertikale Translation wird null angenommen: lokaler barometrischer Nullpunkt, keine Vermessungshöhe. Sensor-TF gehört zur Wahrheitshierarchie. Vermessungsanwendungen müssen dieselben Montageextrinsiken auf die geschätzte Körperpose anwenden und Messzeiten erhalten.
| Größe | Standardwert |
|---|---|
| Koordinaten | WGS-84-Breite/-Länge in Grad; sphärische Weltkoordinaten definieren das Datum. |
| Lokal | ENU: Ost, Nord, Oben; Weltausrichtung 0°. |
| Körper | FLU; Antennenversatz nach FRD: x, −y, −z. |
| Geschwindigkeit | Antennenverschiebung über das Messintervall, nach ENU gedreht; GPS_INPUT nutzt Nord, Ost, Unten. |
| Hebelarm | Vor der Messung geometrisch angewendet und ArduPilot als identischer Körperversatz übergeben. |
| Positionsstandardabweichung | Ost/Nord je 0,7 m; vertikal 1,2 m. |
| Geschwindigkeitsstandardabweichung | 0,1 m/s je Achse. |
| Kovarianz | Bekannte ENU-Diagonale: 0,49; 0,49; 1,44 m². |
| Rate / Latenz | 5 Hz / 0,2 s Simulationszeit. |
| Gültigkeit | Verwirft doppelte, rückwärts laufende, nicht endliche, zukünftige oder über 0,6 s alte Messungen; 0,8 s Echtzeit-Watchdog für Uhrfortschritt. |
| Zeit | Erfassungsstempel bleibt über Verzögerung erhalten; deterministische GPS-Woche 2296 plus Simulationszeit. |
| Qualitätsplatzhalter | 12 Satelliten, HDOP 1,0, VDOP 1,5; keine Konstellationsberechnung. |
| Zufall | Seed 42; unabhängige gaußverteilte Positions-/Geschwindigkeitsfehler. |
Die Standardwelt setzt Meereshöhe und synthetische Geoidundulation auf 0 m. Damit stimmen Sensorhöhe und GPS_INPUT-MSL-Höhe überein. MAVROS verwendet seine installierte EGM96-Umrechnung für ellipsoidische Höhe; diese kann vom Sensortopic abweichen. Absolute vertikale Geodäsie ist nicht vermessungsqualifiziert. Tiefe bezieht sich weiter auf das lokale Wasser. Eine GNSS-/IMU-/Tiefen-Multibeamkette muss Rahmen, Erfassungszeit und vertikales Datum bewahren.
Wasser, Ausfall und Wiedererfassung
Der Empfänger vergleicht die Antennenwelthöhe einschließlich Rotation mit der lokalen Oberfläche. App-Welten verwenden das lokale Höhenfeld des physikalischen Wellensolvers mit bilinearer Interpolation. Oberflächendaten älter als 0,6 Simulationssekunden machen ihn unverfügbar. Eigenständige POSIM-Modelle verwenden die mittlere Wasserebene, sofern kein Wellentopic vorliegt.
Die App leitet gemessene lokale Wellenzellen mit ihrem ursprünglichen Zeitstempel weiter, im Alter von 0,2–0,5 Simulationssekunden. Fehlende Zellen bleiben ungültig; endliche lokale Werte und die Antenneneintauchung werden weiterhin geprüft.
An oder unter der Oberfläche wird der Fix sofort ungültig und die Verzögerungswarteschlange geleert. Erfassung beginnt oberhalb 0,05 m Trockenabstand und dauert 3 durchgehende Simulationssekunden. Ein bestehender Fix bleibt innerhalb dieses Abstands bis zur Nassgrenze gültig. Hysterese und Timer vermeiden rasches Umschalten im Wellengang.
Ohne Fix enthalten Koordinaten NaN. Der Adapter sendet explizit ungültiges GPS_INPUT ohne Position und versieht niemals alte Koordinaten mit neuer Messzeit. Reset leert die Warteschlange, setzt Erfassung zurück, erhöht die Empfängerepoche und startet die Uhrprüfung neu.
Bei Fixverlust unter Wasser bleiben manuelle Lage-, Tiefen- und Schubsteuerung zum Auftauchen verfügbar. Absolute Missionen benötigen eine aktuelle, gültige sensorbasierte FCU-Schätzung. WAM-V verlangt einen aktuellen GNSS-Fix oder eine qualifizierte, akzeptierte externe Quelle sowie die übrigen Scharfschaltprüfungen.
Das Gazebo-Boolean /model/{robot}/gnss/blocked setzt eine erzwungene Abschattung. Wind schaltet GNSS nicht direkt ab; er kann Fahrzeug und Lage verändern und die Antenne durch Wellen eintauchen lassen. Satellitengeometrie, Gebäude, Mehrwegeausbreitung, Atmosphäre, RF-Störungen und Antennencharakteristik werden nicht physikalisch simuliert. Gaußfehler, Blockierschalter und Eintauchregel sind vereinfachte Testmodelle, keine gemessene Funkleistung.
BlueROV2-Ausstattung
Der wählbare Empfänger ist eine Simulationsnutzlast. Er behauptet weder einen Satelliten-GNSS-Empfänger im serienmäßigen BlueROV2 noch ein solches Hersteller-Integrationskit.
Die Water-Linked-Integration verbindet geografische Oberflächenreferenz und akustische Unterwasserortung. Auch DVL mit UGPS ist dokumentiert. Das sind getrennte Geräte und Messwege; dieser Satellitenempfänger implementiert kein akustisches UGPS.
GPS.gov erläutert reale Genauigkeitseinflüsse. Simulierte Standardabweichungen sind Einstellungen, keine GPS-Dienstgarantie. Externe Seiten dienen als Referenz; Produktbilder, Handbücher und Herstellercode sind nicht Teil dieses Empfängers.
Sensorbasierte Kartenposition
Ground Control nutzt eine aktuelle GNSS-Messung oder eine gültige, vom FCU-Gateway akzeptierte externe Schätzung, niemals Ersatzkoordinaten aus dem Simulator. GPS fixed ist grün, GPS lost rot; unbekannt, veraltet und ungültig sind getrennte Zustände. Fix und Navigationsbereitschaft sind unabhängig.
Bei GPS fixed erscheint nur die GPS-Anzeige. Bei GPS lost und einer aktuellen, validierten Schätzung erscheint auch Positionsschätzung ON. Ist eine Unterwasserschätzung erforderlich, aber nicht verfügbar, erscheint Schätzung nicht verfügbar. Die Info-Taste neben ON öffnet Methode und Dokumentationslink per Klick, Berührung oder Tastatur; Escape schließt die Hilfe. Zahlenkoordinaten bleiben verborgen. Öffnen Sie Navigationsdetails unter der Karte für Stütze, Startreferenz und Sensorinitialisierung.
Der IMU/DVL-Schätzer verarbeitet Winkelgeschwindigkeit, spezifische Kraft und gültige bodenrelative Geschwindigkeit mit Sensorzeit, Einbaugeometrie und Kovarianz. Gazebo-Orientierung wird nicht verwendet. Lokale Odometrie allein bestimmt weder geografische Position noch Kurs.
Die BlueROV2 · KMOU nutzt eine im Szenario deklarierte Startkoordinate und gemessenen Magnetometerkurs mit konfigurierter Deklination. Die Referenz wird vom GPS getrennt angezeigt. Eine temporäre Stütze hält das Fahrzeug während Kameravorbereitung und stationärer Initialisierung. Nach normalem Scharfschalten in ALT_HOLD und akzeptierter Navigation wird die Stütze gelöst und die tatsächliche Gelenkentfernung bestätigt. Die Referenz wird nicht fortlaufend auf Simulatorwahrheit gesetzt.
Dieses Profil gilt nur für diese integrierte Demo, nicht automatisch für gespeicherte Fahrzeuge oder beliebige Welten. Allgemeiner Abgleich durch GNSS-Bewegung ist für geografische Ausgabe nicht qualifiziert. Lokale Diagnosen behalten navigation_ready=false; das Gateway prüft separat aktuelle Daten, gültigen Ursprung/Kovarianz, bestätigte Quellenauswahl und EKF/globale FCU-Telemetrie.
DVL-Verlust, veraltete Eingaben, Reset oder neues Segment machen die Schätzung ungültig. Die Karte entfernt geschätzte Koordinaten und zeigt den Fehler. Wiederkehrende DVL-Daten verwenden den Startanker nicht erneut: Simulation neu starten. Ein neuer Fix an der Oberfläche kann GNSS-Kartenposition liefern, ohne den Unterwasserschätzer neu zu initialisieren.
ArduPilot, QGC und austauschbare Anbieter
GNSS speist GPS_INPUT und EKF-Quelle 1. Akzeptierte externe Position/Geschwindigkeit nutzt MAVROS vision pose/speed und Quelle 2. WAM-V mit Standard-GNSS aktiviert keinen ungenutzten visuellen Odometrieeingang. Ein ausdrücklich ausgewählter externer Anbieter aktiviert denselben geprüften Pfad für beide Fahrzeuge.
QGC empfängt GPS-Gültigkeit über GPS_RAW_INT und fusionierte Position über GLOBAL_POSITION_INT. Ohne GPS-Fix kann eine gültige FCU-Schätzung vorliegen. Die Schätzung ändert den Fix nicht. Die Mit QGC steuern verlangt vor Kontrollübergabe das Entschärfen; Auftrieb kann das Unterwasserfahrzeug steigen lassen.
Erweiterungen der installierten App wählen genehmigte, hashgebundene, in SDF deklarierte ROS-Anbieter. /vehicle/navigation/estimate enthält ENU-Pose und FLU-Körpergeschwindigkeit in nav_msgs/Odometry; /vehicle/navigation/status enthält passende Sitzung, Zeit, Ursprung, Bereitschaftsmetadaten und Quelle. Das Gateway lehnt alte, widersprüchliche oder doppelt veröffentlichte Daten ab. GNSS bleibt beim Empfänger. Siehe Einen lokalen Arbeitsbereich steuern. Laden allein qualifiziert weder geografische Genauigkeit noch Missionsbereitschaft.