MAVLink ADSB_VEHICLE
Što ovaj primjer prikazuje
Prebacivanje prijamnika s CSV na MAVLink izlaz i dekodiranje poruke
ADSB_VEHICLE koju šalje za svaku praćenu letjelicu. Skica također registrira
opći callback za okvire koji ispisuje sirove bajtove korisnog sadržaja svake MAVLink
poruke koju prijamnik pošalje. CSV je zadani izlaz prijamnika prema
njegovom tehničkom listu, a prijamnik na ovoj pločici javlja
AT+ADSB_RX_PROTOCOL_DECODED=CSV s firmverom 2.89.28.0, verzijom za koju je
tehnički list napisan.
Primjer koda
Ovo je 6_MavlinkAdsbVehicle.ino iz fiksirane biblioteke, bez zaglavnog
komentara datoteke. Tijelo skice je točno onakvo kakvo se isporučuje.
#include "ADSB-Receiver-SOLDERED.h"
// Create an instance of the ADS-B object
ADSBReceiver adsb;
// Called once per decoded ADSB_VEHICLE message, one per tracked aircraft.
void onAdsbVehicle(const MavlinkAdsbVehicle &v)
{
Serial.print("ICAO ");
Serial.print(v.icaoAddress, HEX);
if (v.hasValidCallsign())
{
Serial.print(" call=");
Serial.print(v.callsign);
}
if (v.hasValidCoords())
{
Serial.print(" lat=");
Serial.print(v.latDegrees(), 5);
Serial.print(" lon=");
Serial.print(v.lonDegrees(), 5);
}
if (v.hasValidAltitude())
{
Serial.print(" alt=");
Serial.print(v.altitudeMeters());
Serial.print("m");
}
if (v.hasValidVelocity())
{
Serial.print(" vel=");
Serial.print(v.horVelocity / 100.0);
Serial.print("m/s");
}
if (v.hasValidSquawk())
{
Serial.print(" squawk=");
Serial.print(v.squawk);
}
Serial.print(" tslc=");
Serial.print(v.tslc);
Serial.println("s");
}
// Called for every MAVLink frame received, whatever its message id.
void onFrame(const MavlinkFrame &f)
{
Serial.print("[mavlink] msgid=");
Serial.print(f.msgid);
Serial.print(" sysid=");
Serial.print(f.sysid);
Serial.print(" crcValid=");
Serial.print(f.crcValid ? "yes" : "no");
Serial.print(" payload=");
for (uint8_t i = 0; i < f.payloadLen; i++)
{
if (f.payload[i] < 0x10)
Serial.print('0');
Serial.print(f.payload[i], HEX);
}
Serial.println();
}
void setup()
{
Serial.begin(115200);
adsb.begin(115200);
// Register the callbacks that will receive the decoded and raw MAVLink data.
adsb.onMavlinkAdsbVehicle(onAdsbVehicle);
adsb.onMavlinkFrame(onFrame);
// The module defaults to CSV output, so switch it to MAVLink here.
if (adsb.enterConfiguration())
{
adsb.setAdsbRxProtocolDecoded(DecodedProtocol::MAVLINK);
adsb.exitConfiguration(115200);
}
}
void loop()
{
adsb.poll();
}
Očekivani rezultat
Otvorite Tools → Serial Monitor, postavite brzinu prijenosa na 115200 i
resetirajte pločicu. Pojavljuju se dvije vrste redaka. Redak ICAO dolazi iz dekodirane
poruke ADSB_VEHICLE: adresa letjelice u heksadecimalnom zapisu, zatim pozivni znak,
položaj, visina u metrima, brzina u metrima u sekundi i squawk za
sva polja koja poruka označava kao valjana, i na kraju tslc, broj sekundi
od posljednjeg kontakta s tom letjelicom. Redak [mavlink] dolazi iz svakog
okvira koji prijamnik pošalje, s ID-jem poruke, ID-jem sustava, podatkom je li kontrolni zbroj
bio ispravan i korisnim sadržajem kao heksadecimalnim bajtovima. Biblioteka navodi da prijamnik uz podatke o letjelicama
šalje i poruku HEARTBEAT (id 0) jednom u sekundi, pa
očekujte i retke [mavlink] msgid=0.
[mavlink] msgid=0 sysid=1 crcValid=yes payload=000000001B08000403
[mavlink] msgid=246 sysid=1 crcValid=yes payload=8C1F4700E36E371B5B160C0B2015AC00983A075A0000BF01B50A00575A5A33353237000003
ICAO 471F8C call=WZZ3527 lat=45.66177 lon=18.53415 alt=11277.60m vel=230.47m/s squawk=2741 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=D2A94C00DB336F1BDB69AF0A6062B5000032DA5E0000BF012A1400525952364C4600000003
ICAO 4CA9D2 call=RYR6LF lat=46.02726 lon=17.92681 alt=11887.20m vel=242.82m/s squawk=5162 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=67AA4B006FD40B1B81CE790BC0BBB0002477AA610000BF01631800544859314A4B00000003
ICAO 4BAA67 call=THY1JK lat=45.37601 lon=19.25321 alt=11582.40m vel=250.02m/s squawk=6243 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=2D0C4400634A081BDEB4720B806EA7001437A45C0000BF011F100041554136373500000003
ICAO 440C2D call=AUA675 lat=45.35282 lon=19.20668 alt=10972.80m vel=237.16m/s squawk=4127 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=15024C00E5ADC11A9283B20B3C816F006C39944F6EFCBF0105120041534C3131330000000301
ICAO 4C0215 call=ASL113 lat=44.89006 lon=19.62485 alt=7307.58m vel=203.72m/s squawk=4613 tslc=1s
[mavlink] msgid=0 sysid=1 crcValid=yes payload=000000001B08000403
Korištene funkcije
ADSBReceiver()returns NoneStvara objekt prijamnika. Bez argumenata koristi zadane vrijednosti biblioteke za pločicu: hardverski UART 1, IO17 za TX liniju prijamnika, IO18 za njegovu RX liniju i IO21 za njegovu RESET liniju, što odgovara načinu na koji je ova pločica spojena.
ReturnsKonstruktor; nema povratne vrijednosti.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
uint8_t | uartNum | Hardverski UART ESP32 koji se koristi. Neobavezno, zadano 1. Izbjegavajte 0, koji je obično USB konzola. |
int8_t | rxPin | GPIO ESP32 spojen na TX pin modula. Neobavezno, zadano 17. |
int8_t | txPin | GPIO ESP32 spojen na RX pin modula. Neobavezno, zadano 18. |
int8_t | resetPin | GPIO ESP32 spojen na RESET pin modula. Neobavezno, zadano 21. Proslijedite -1 ako nije spojen. |
begin(uint32_t initialBaud, size_t rxBufferSize)returns voidOtvara UART vezu s prijamnikom. Pozovite je jednom u setup().
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
uint32_t | initialBaud | Brzina prijenosa na kojoj se započinje. Neobavezno, zadano 115200. |
size_t | rxBufferSize | Veličina UART prijamnog međuspremnika u bajtovima. Neobavezno, zadano 4096. |
onMavlinkAdsbVehicle(MavlinkAdsbVehicleCallback cb)returns voidRegistrira funkciju koja se poziva za svaki ADSB_VEHICLE okvir (id poruke 246) koji prođe provjeru kontrolnog zbroja.
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
void (*)(const MavlinkAdsbVehicle &vehicle) | cb | Funkcija koju treba pozvati. Polja i pomoćne funkcije objekta MavlinkAdsbVehicle pogledajte u tablici ispod funkcija. |
onMavlinkFrame(MavlinkFrameCallback cb)returns voidRegistrira funkciju koja se poziva za svaki potpuni MAVLink okvir, bez obzira na id poruke. Vrijednost crcValid okvira istinita je samo za id-jeve poruka koje biblioteka može provjeriti (HEARTBEAT, id 0, i ADSB_VEHICLE, id 246); za sve ostale poruke ostaje false čak i kad je okvir ispravan.
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
void (*)(const MavlinkFrame &frame) | cb | Funkcija koju treba pozvati. Okvir sadrži msgid, sysid, compid, seq, payload, payloadLen i crcValid. |
enterConfiguration()returns boolPrebacuje prijamnik iz stanja RUN u stanje CONFIGURATION. Šalje AT+CONFIG=1, prebacuje lokalni UART na 115200 i potvrđuje novo stanje naredbom AT+CONFIG?.
Returnstrue ako prijamnik javi da je u stanju CONFIGURATION, inače false.
setAdsbRxProtocolDecoded(DecodedProtocol p)returns boolOdabire format dekodiranih podataka o letjelici. Primjer odabire MAVLink; biblioteka prijamniku šalje naziv Mavlink.
Returnstrue ako je prijamnik odgovorio s AT+OK, inače false.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
DecodedProtocol | p | DecodedProtocol::NONE, DecodedProtocol::CSV ili DecodedProtocol::MAVLINK. |
exitConfiguration(uint32_t runBaud)returns boolPrebacuje prijamnik iz stanja CONFIGURATION natrag u stanje RUN. Šalje AT+CONFIG=0, prebacuje lokalni UART na runBaud i potvrđuje novo stanje naredbom AT+CONFIG?.
Returnstrue ako prijamnik javi da je u stanju RUN, inače false.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
uint32_t | runBaud | Brzina prijenosa za stanje RUN. Neobavezno, zadano 115200. Mora odgovarati pohranjenoj postavci BAUDRATE prijamnika. |
poll()returns voidČita svaki pristigli bajt i aktivira registrirane callbacke. Bajt po bajt razlikuje CSV retke od MAVLink okvira, pa isti poziv služi za oba formata. Ne blokira, zato ga pozovite u svakom prolasku kroz loop().
ReturnsNišta.
Što callback prima
Objekt MavlinkAdsbVehicle sadrži sirove MAVLink jedinice, a njegove pomoćne
funkcije pretvaraju ih i govore vam koja je polja prijamnik popunio.
| Polje ili funkcija | Značenje |
|---|---|
icaoAddress | 24-bitna ICAO adresa letjelice. Primjer je ispisuje u heksadecimalnom zapisu. |
hasValidCallsign() i callsign | Sadrži li poruka pozivni znak i tekst pozivnog znaka. |
hasValidCoords(), latDegrees() i lonDegrees() | Je li položaj valjan te zemljopisna širina i dužina u stupnjevima. Sirove vrijednosti lat i lon su stupnjevi puta 10^7. |
hasValidAltitude() i altitudeMeters() | Je li visina valjana i visina u metrima. Sirova vrijednost altitude je u milimetrima. |
hasValidVelocity() i horVelocity | Je li brzina valjana i horizontalna brzina u cm/s. Primjer dijeli sa 100 kako bi ispisao m/s. |
hasValidSquawk() i squawk | Sadrži li poruka squawk kôd i sam kôd. |
tslc | Sekunde od posljednjeg kontakta s ovom letjelicom. |
Sastavljanje cjeline
Najprije registrirajte oba callbacka, zatim prebacite prijamnik na MAVLink izlaz dok
je u stanju CONFIGURATION i nastavite pozivati poll(). Dekodirani callback
daje vam pregledne podatke o letjelici, a callback za okvire je mjesto na koje gledate kad
želite vidjeti sve što prijamnik šalje.
Skica mijenja izlazni protokol prijamnika. Da biste ponovno dobili CSV izlaz za skicu Read aircraft reports, pokrenite skicu sa stranice Konfiguracija protokola i postavki koja odabire CSV.