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. Skripta također registrira
opću funkciju povratnog poziva za okvire (frame callback) koja ispisuje sirove bajtove korisnog sadržaja svake MAVLink poruke
koju prijamnik pošalje. CSV je prema tehničkom listu zadani izlaz prijamnika, a
prijamnik na ovoj pločici javlja
AT+ADSB_RX_PROTOCOL_DECODED=CSV s firmwareom 2.89.28.0, verzijom za koju je
tehnički list napisan.
Kod primjera
Ovo je Examples/ADSBReceiver-mavlinkAdsbVehicle.py iz fiksirane verzije modula,
bez uvodnog komentara datoteke. Tijelo skripte je točno onakvo kako se isporučuje. Spoj
UART1 na IO17 i IO18 te reset na IO21 vlastito su ožičenje pločice.
from machine import UART
from ADSBReceiver import ADSBReceiver, DECODED_PROTOCOL_MAVLINK
uart = UART(1, baudrate=115200, rx=17, tx=18, rxbuf=4096)
adsb = ADSBReceiver(uart, reset_pin=21)
# Called once per decoded ADSB_VEHICLE message, one per tracked aircraft.
def onAdsbVehicle(v):
line = "ICAO {:X}".format(v.icaoAddress)
if v.hasValidCallsign():
line += " call={}".format(v.callsign)
if v.hasValidCoords():
line += " lat={:.5f} lon={:.5f}".format(v.latDegrees(), v.lonDegrees())
if v.hasValidAltitude():
line += " alt={}m".format(v.altitudeMeters())
if v.hasValidVelocity():
line += " vel={}m/s".format(v.horVelocity / 100.0)
if v.hasValidSquawk():
line += " squawk={}".format(v.squawk)
line += " tslc={}s".format(v.tslc)
print(line)
# Called for every MAVLink frame received, whatever its message id.
def onFrame(f):
payload_hex = "".join("{:02X}".format(b) for b in f.payload)
print(
"[mavlink] msgid={} sysid={} crcValid={} payload={}".format(
f.msgid, f.sysid, "yes" if f.crcValid else "no", payload_hex
)
)
# 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(DECODED_PROTOCOL_MAVLINK)
adsb.exitConfiguration(115200)
while True:
adsb.poll()
Spremite ga u datoteku na računalu, a zatim ga pokrenite na pločici naredbom
mpremote run <file.py>, pri čemu umjesto <file.py> upišite naziv svoje datoteke. Potrebno je
da je modul instaliran kako je prikazano na stranici
MicroPython biblioteka.
Očekivani rezultat
Kad je prijamnik u MAVLink načinu rada, skripta ispisuje dvije vrste redaka. Redak
koji počinje s ICAO i adresom letjelice u heksadecimalnom zapisu dolazi iz poruke
ADSB_VEHICLE, a iza njega slijede samo polja koja poruka označava kao valjana:
pozivni znak, geografska širina i dužina, visina u metrima, brzina u metrima u sekundi
i squawk kod, te uvijek tslc, sekunde od trenutka kad je prijamnik zadnji put čuo
tu letjelicu. Redak koji počinje s [mavlink] prikazuje id poruke, id sustava,
je li kontrolni zbroj bio valjan i korisni sadržaj kao heksadecimalne bajtove. Komentar
samog modula navodi da prijamnik uz poruke o letjelicama šalje i poruku heartbeat (id 0)
jednom u sekundi, a funkcija povratnog poziva za okvire prima i nju.
[mavlink] msgid=0 sysid=1 crcValid=yes payload=000000001B08000403
[mavlink] msgid=246 sysid=1 crcValid=yes payload=8C1F47000AFD261BEFBC190B2015AC00983A075A0000BF01B50A00575A5A33353237000003
ICAO 471F8C call=WZZ3527 lat=45.55400 lon=18.62361 alt=11277.6m vel=230.47m/s squawk=2741 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=D2A94C0068E9621B7327C60A6062B5000032DA5E0000BF012A1400525952364C4600000003
ICAO 4CA9D2 call=RYR6LF lat=45.94671 lon=18.07584 alt=11887.2m vel=242.82m/s squawk=5162 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=67AA4B0027A5171BEEDD610BC0BBB0002477AA610000BF01631800544859314A4B00000003
ICAO 4BAA67 call=THY1JK lat=45.45345 lon=19.09632 alt=11582.4m vel=250.02m/s squawk=6243 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=2D0C44008A12F91A1552840B806EA7001437A45C0000BF011F100041554136373500000003
ICAO 440C2D call=AUA675 lat=45.25308 lon=19.32211 alt=10972.8m vel=237.16m/s squawk=4127 tslc=0s
[mavlink] msgid=246 sysid=1 crcValid=yes payload=15024C003B9AB31A3178BF0B1C2267006C39944F6EFCBF0105120041534C3131330000000301
ICAO 4C0215 call=ASL113 lat=44.79781 lon=19.70975 alt=6758.94m vel=203.72m/s squawk=4613 tslc=1s
[mavlink] msgid=0 sysid=1 crcValid=yes payload=000000001B08000403
Korištene funkcije
ADSBReceiver(uart, reset_pin=None)returns ADSBReceiverStvara objekt prijamnika na UART-u koji ste već otvorili. Ako zadate reset pin, modul ga postavlja kao ulaz visoke impedancije, pa se pin pokreće samo tijekom hardwareReset().
ReturnsObjekt prijamnika spreman za ostale funkcije.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
machine.UART | uart | Otvoreni UART spojen na prijamnik. Veličinu njegova prijamnog međuspremnika odredite pri stvaranju, kao što primjer radi s rxbuf=4096: gust promet može preplaviti zadani međuspremnik i oštetiti retke. |
int ili None | reset_pin | GPIO spojen na RESET pin prijamnika. Neobavezno, zadano None, čime se onemogućuje hardwareReset(). Ova pločica koristi 21. |
onMavlinkAdsbVehicle(cb)returns NoneRegistrira funkciju koja se poziva za svaku MAVLink poruku ADSB_VEHICLE (id poruke 246) čiji je kontrolni zbroj valjan.
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
function ili None | cb | Funkcija koja se poziva, a prima objekt MavlinkAdsbVehicle. |
Objekt MavlinkAdsbVehicle koji primjer čita ima sljedeće atribute i
funkcije:
| Naziv | Opis |
|---|---|
icaoAddress | ICAO adresa letjelice kao cijeli broj. |
callsign | Pozivni znak kao niz znakova. |
latDegrees(), lonDegrees() | Geografska širina i dužina u stupnjevima. Poruka ih nosi kao stupnjeve puta 10 milijuna. |
altitudeMeters() | Visina u metrima. Poruka je nosi u milimetrima. |
horVelocity | Horizontalna brzina u centimetrima u sekundi, zbog čega je primjer dijeli sa 100. |
squawk | Squawk kod kao cijeli broj. |
tslc | Sekunde od posljednjeg kontakta s ovom letjelicom. |
hasValidCallsign(), hasValidCoords(), hasValidAltitude(), hasValidVelocity(), hasValidSquawk() | True kada zastavice poruke označavaju to polje kao valjano. Provjerite ih prije nego upotrijebite polje. |
onMavlinkFrame(cb)returns NoneRegistrira funkciju koja se poziva za svaki primljeni potpuni MAVLink okvir, bez obzira na id poruke. Vrijednost crcValid okvira ima značenje samo za id-ove poruka koje modul može provjeriti, trenutačno heartbeat (id 0) i ADSB_VEHICLE (id 246).
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
function ili None | cb | Funkcija koja se poziva, a prima objekt MavlinkFrame s atributima, među ostalima, msgid, sysid, crcValid i payload (bajtovi). |
enterConfiguration()returns boolPrebacuje prijamnik iz stanja RUN u stanje CONFIGURATION. Šalje AT+CONFIG=1, prebacuje UART na 115200 (fiksna brzina prijenosa prijamnika u stanju CONFIGURATION) i potvrđuje novo stanje naredbom AT+CONFIG?. Postavke se mogu zapisivati samo u ovom stanju.
ReturnsTrue ako prijamnik javi da je u stanju CONFIGURATION, inače False.
setAdsbRxProtocolDecoded(protocol)returns boolBira format dekodiranih podataka o letjelicama koje prijamnik šalje. Prijamnik ovu postavku prima kao naziv, pa modul šalje CSV, Mavlink ili None.
ReturnsTrue u slučaju uspjeha, inače False.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
int | protocol | Jedna od vrijednosti DECODED_PROTOCOL_NONE (0), DECODED_PROTOCOL_CSV (1) ili DECODED_PROTOCOL_MAVLINK (2). |
exitConfiguration(run_baud=115200)returns boolVraća prijamnik iz stanja CONFIGURATION natrag u stanje RUN. Šalje AT+CONFIG=0, prebacuje UART na run_baud i potvrđuje novo stanje naredbom AT+CONFIG?.
ReturnsTrue ako prijamnik javi da je u stanju RUN, inače False.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
int | run_baud | Brzina prijenosa (baud rate) pod kojom je spremljena postavka BAUDRATE prijamnika, na primjer 115200. Neobavezno, zadano 115200. |
poll()returns NoneČita sve pristigle bajtove, obrađuje potpune retke i MAVLink okvire (razlikuje ih bajt po bajt) te poziva registrirane funkcije. Ne blokira izvođenje, zato je pozovite u svakom prolazu petlje.
ReturnsNišta.
Sastavljanje u cjelinu
Registrirajte obje funkcije povratnog poziva, prebacite dekodirani protokol na MAVLink dok je prijamnik
u stanju CONFIGURATION, vratite se u stanje RUN i nastavite pozivati poll(). Funkcija
povratnog poziva za okvire prva vidi svaki okvir, a zatim slijedi funkcija za letjelice za svaki
ADSB_VEHICLE okvir koji je prošao provjeru kontrolnog zbroja.