Switch to overlay parsing.
This commit is contained in:
@@ -6,11 +6,38 @@
|
|||||||
#include "common.h"
|
#include "common.h"
|
||||||
#include "airspy_adsb.h"
|
#include "airspy_adsb.h"
|
||||||
|
|
||||||
|
struct __attribute__((packed)) airspy_adsb_common_overlay {
|
||||||
|
char mlat_timestamp[8];
|
||||||
|
char semicolon1;
|
||||||
|
char mlat_precision[2];
|
||||||
|
char semicolon2;
|
||||||
|
char rssi[4];
|
||||||
|
char semicolon3;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct __attribute__((packed)) airspy_adsb_mode_s_short_overlay {
|
||||||
|
char asterisk;
|
||||||
|
char payload[14];
|
||||||
|
char semicolon;
|
||||||
|
struct airspy_adsb_common_overlay common;
|
||||||
|
char cr;
|
||||||
|
char lf;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct __attribute__((packed)) airspy_adsb_mode_s_long_overlay {
|
||||||
|
char asterisk;
|
||||||
|
char payload[28];
|
||||||
|
char semicolon;
|
||||||
|
struct airspy_adsb_common_overlay common;
|
||||||
|
char cr;
|
||||||
|
char lf;
|
||||||
|
};
|
||||||
|
|
||||||
struct airspy_adsb_parser_state {
|
struct airspy_adsb_parser_state {
|
||||||
struct mlat_state mlat_state;
|
struct mlat_state mlat_state;
|
||||||
};
|
};
|
||||||
|
|
||||||
static bool airspy_adsb_parse_common(char *, struct packet *, struct airspy_adsb_parser_state *);
|
static bool airspy_adsb_parse_common(struct airspy_adsb_common_overlay *, struct packet *, struct airspy_adsb_parser_state *);
|
||||||
|
|
||||||
|
|
||||||
void airspy_adsb_init() {
|
void airspy_adsb_init() {
|
||||||
@@ -25,41 +52,49 @@ bool airspy_adsb_parse(struct backend *backend, struct packet *packet) {
|
|||||||
buf_chr(buf, 0) != '*') {
|
buf_chr(buf, 0) != '*') {
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
if (buf->length >= 35 &&
|
|
||||||
buf_chr(buf, 33) == '\r' &&
|
{
|
||||||
buf_chr(buf, 34) == '\n' &&
|
struct airspy_adsb_mode_s_short_overlay *short_overlay = (struct airspy_adsb_mode_s_short_overlay *) buf_at(buf, 0);
|
||||||
buf_chr(buf, 15) == ';') {
|
if (short_overlay->cr == '\r' &&
|
||||||
if (!airspy_adsb_parse_common(buf_at(buf, 16), packet, state)) {
|
short_overlay->lf == '\n' &&
|
||||||
return false;
|
short_overlay->semicolon == ';') {
|
||||||
|
if (!airspy_adsb_parse_common(&short_overlay->common, packet, state)) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
packet->type = MODE_S_SHORT;
|
||||||
|
hex_to_bin(packet->payload, short_overlay->payload, sizeof(short_overlay->payload) / 2);
|
||||||
|
buf_consume(buf, sizeof(*short_overlay));
|
||||||
|
return true;
|
||||||
}
|
}
|
||||||
packet->type = MODE_S_SHORT;
|
|
||||||
hex_to_bin(packet->data, buf_at(buf, 1), 7);
|
|
||||||
buf_consume(buf, 35);
|
|
||||||
return true;
|
|
||||||
}
|
}
|
||||||
if (buf->length >= 49 &&
|
|
||||||
buf_chr(buf, 47) == '\r' &&
|
{
|
||||||
buf_chr(buf, 48) == '\n' &&
|
struct airspy_adsb_mode_s_long_overlay *long_overlay = (struct airspy_adsb_mode_s_long_overlay *) buf_at(buf, 0);
|
||||||
buf_chr(buf, 29) == ';') {
|
if (buf->length >= 49 &&
|
||||||
if (!airspy_adsb_parse_common(buf_at(buf, 30), packet, state)) {
|
long_overlay->cr == '\r' &&
|
||||||
return false;
|
long_overlay->lf == '\n' &&
|
||||||
|
long_overlay->semicolon == ';') {
|
||||||
|
if (!airspy_adsb_parse_common(&long_overlay->common, packet, state)) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
packet->type = MODE_S_LONG;
|
||||||
|
hex_to_bin(packet->payload, long_overlay->payload, sizeof(long_overlay->payload) / 2);
|
||||||
|
buf_consume(buf, sizeof(*long_overlay));
|
||||||
|
return true;
|
||||||
}
|
}
|
||||||
packet->type = MODE_S_LONG;
|
|
||||||
hex_to_bin(packet->data, buf_at(buf, 1), 14);
|
|
||||||
buf_consume(buf, 49);
|
|
||||||
return true;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
static bool airspy_adsb_parse_common(char *in, struct packet *packet, struct airspy_adsb_parser_state *state) {
|
static bool airspy_adsb_parse_common(struct airspy_adsb_common_overlay *overlay, struct packet *packet, struct airspy_adsb_parser_state *state) {
|
||||||
if (in[8] != ';' ||
|
if (overlay->semicolon1 != ';' ||
|
||||||
in[11] != ';' ||
|
overlay->semicolon2 != ';' ||
|
||||||
in[16] != ';') {
|
overlay->semicolon3 != ';') {
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
uint16_t mlat_mhz = 2 * hex_to_int(&in[9], 1);
|
uint16_t mlat_mhz = 2 * hex_to_int(overlay->mlat_precision, sizeof(overlay->mlat_precision) / 2);
|
||||||
packet->mlat_timestamp = mlat_timestamp_scale_in(hex_to_int(in, 4), UINT32_MAX, mlat_mhz, &state->mlat_state);
|
packet->mlat_timestamp = mlat_timestamp_scale_in(hex_to_int(overlay->mlat_timestamp, sizeof(overlay->mlat_timestamp) / 2), UINT32_MAX, mlat_mhz, &state->mlat_state);
|
||||||
packet->rssi = rssi_scale_in(hex_to_int(&in[12], 2), UINT16_MAX);
|
packet->rssi = rssi_scale_in(hex_to_int(overlay->rssi, sizeof(overlay->rssi) / 2), UINT16_MAX);
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|||||||
2
common.h
2
common.h
@@ -41,7 +41,7 @@ struct packet {
|
|||||||
MODE_S_SHORT,
|
MODE_S_SHORT,
|
||||||
MODE_S_LONG,
|
MODE_S_LONG,
|
||||||
} type;
|
} type;
|
||||||
char data[DATA_LEN_MAX];
|
char payload[DATA_LEN_MAX];
|
||||||
uint64_t mlat_timestamp;
|
uint64_t mlat_timestamp;
|
||||||
uint32_t rssi;
|
uint32_t rssi;
|
||||||
};
|
};
|
||||||
|
|||||||
4
json.c
4
json.c
@@ -22,7 +22,7 @@ static size_t json_hello(char *buf) {
|
|||||||
|
|
||||||
static size_t json_serialize_mode_s_short(struct packet *packet, char *buf) {
|
static size_t json_serialize_mode_s_short(struct packet *packet, char *buf) {
|
||||||
char hexbuf[14];
|
char hexbuf[14];
|
||||||
hex_from_bin(hexbuf, packet->data, 7);
|
hex_from_bin(hexbuf, packet->payload, 7);
|
||||||
int len = snprintf(buf, SERIALIZE_LEN,
|
int len = snprintf(buf, SERIALIZE_LEN,
|
||||||
"{\"payload\":\"%.14s\",\"mlat_timestamp\":%ju,\"rssi\":%ju}\n",
|
"{\"payload\":\"%.14s\",\"mlat_timestamp\":%ju,\"rssi\":%ju}\n",
|
||||||
hexbuf,
|
hexbuf,
|
||||||
@@ -34,7 +34,7 @@ static size_t json_serialize_mode_s_short(struct packet *packet, char *buf) {
|
|||||||
|
|
||||||
static size_t json_serialize_mode_s_long(struct packet *packet, char *buf) {
|
static size_t json_serialize_mode_s_long(struct packet *packet, char *buf) {
|
||||||
char hexbuf[28];
|
char hexbuf[28];
|
||||||
hex_from_bin(hexbuf, packet->data, 14);
|
hex_from_bin(hexbuf, packet->payload, 14);
|
||||||
int len = snprintf(buf, SERIALIZE_LEN,
|
int len = snprintf(buf, SERIALIZE_LEN,
|
||||||
"{\"payload\":\"%.28s\",\"mlat_timestamp\":%ju,\"rssi\":%ju}\n",
|
"{\"payload\":\"%.28s\",\"mlat_timestamp\":%ju,\"rssi\":%ju}\n",
|
||||||
hexbuf,
|
hexbuf,
|
||||||
|
|||||||
Reference in New Issue
Block a user