Skip to main content

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.

ShellMicroPython
[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 ADSBReceiver

Stvara 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

TipNazivOpis
machine.UARTuartOtvoreni 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 Nonereset_pinGPIO spojen na RESET pin prijamnika. Neobavezno, zadano None, čime se onemogućuje hardwareReset(). Ova pločica koristi 21.
onMavlinkAdsbVehicle(cb)returns None

Registrira funkciju koja se poziva za svaku MAVLink poruku ADSB_VEHICLE (id poruke 246) čiji je kontrolni zbroj valjan.

ReturnsNišta.

Parametri

TipNazivOpis
function ili NonecbFunkcija koja se poziva, a prima objekt MavlinkAdsbVehicle.

Objekt MavlinkAdsbVehicle koji primjer čita ima sljedeće atribute i funkcije:

NazivOpis
icaoAddressICAO adresa letjelice kao cijeli broj.
callsignPozivni 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.
horVelocityHorizontalna brzina u centimetrima u sekundi, zbog čega je primjer dijeli sa 100.
squawkSquawk kod kao cijeli broj.
tslcSekunde 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 None

Registrira 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

TipNazivOpis
function ili NonecbFunkcija koja se poziva, a prima objekt MavlinkFrame s atributima, među ostalima, msgid, sysid, crcValid i payload (bajtovi).
enterConfiguration()returns bool

Prebacuje 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 bool

Bira 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

TipNazivOpis
intprotocolJedna od vrijednosti DECODED_PROTOCOL_NONE (0), DECODED_PROTOCOL_CSV (1) ili DECODED_PROTOCOL_MAVLINK (2).
exitConfiguration(run_baud=115200)returns bool

Vrać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

TipNazivOpis
intrun_baudBrzina 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.