misc/adsb-tools
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Beast send support.

Browse Source
This commit is contained in:
Ian Gulliver
2016-02-17 18:01:39 -08:00
parent 5671f37f8a
commit 44cb3fb122
6 changed files with 106 additions and 12 deletions
Download Patch File Download Diff File Expand all files Collapse all files

81
beast.c
View File

@@ -40,6 +40,15 @@ static uint64_t beast_parse_mlat(uint8_t *mlat_timestamp) {
((uint64_t) mlat_timestamp[5]));
}
static void beast_write_mlat(uint64_t timestamp, uint8_t *mlat_timestamp) {
mlat_timestamp[0] = (timestamp >> 40) & 0xff;
mlat_timestamp[1] = (timestamp >> 32) & 0xff;
mlat_timestamp[2] = (timestamp >> 24) & 0xff;
mlat_timestamp[3] = (timestamp >> 16) & 0xff;
mlat_timestamp[4] = (timestamp >> 8) & 0xff;
mlat_timestamp[5] = (timestamp) & 0xff;
}
static ssize_t beast_unescape(struct buf *out, const struct buf *in, size_t out_bytes) {
int o = 0, i = 0;
for (; i < in->length && o < out_bytes; i++, o++) {
@@ -58,8 +67,13 @@ static ssize_t beast_unescape(struct buf *out, const struct buf *in, size_t out_
}
}
static bool beast_parse_mode_ac(struct buf *buf, struct packet *packet, struct beast_parser_state *state) {
return false;
static void beast_escape(struct buf *out, const struct buf *in) {
for (int i = 0; i < in->length; i++, out->length++) {
buf_chr(out, out->length) = buf_chr(in, i);
if (i > 0 && buf_chr(in, i) == 0x1a) {
buf_chr(out, ++(out->length)) = 0x1a;
}
}
}
static bool beast_parse_mode_s_short(struct buf *buf, struct packet *packet, struct beast_parser_state *state) {
@@ -110,14 +124,71 @@ bool beast_parse(struct buf *buf, struct packet *packet, void *state_in) {
struct beast_common_overlay *overlay = (struct beast_common_overlay *) buf_at(buf, 0);
switch (overlay->type) {
case 0x31:
return beast_parse_mode_ac(buf, packet, state);
case 0x32:
return beast_parse_mode_s_short(buf, packet, state);
case 0x33:
return beast_parse_mode_s_long(buf, packet, state);
default:
fprintf(stderr, "unknown beast type %x\n", overlay->type);
return false;
}
return false;
}
void beast_serialize_mode_s_short(struct packet *packet, struct buf *buf) {
struct buf buf2 = BUF_INIT;
struct beast_mode_s_short_overlay *overlay = (struct beast_mode_s_short_overlay *) buf_at(&buf2, 0);
overlay->common.one_a = 0x1a;
overlay->common.type = 0x32;
memcpy(overlay->payload, packet->payload, sizeof(overlay->payload));
beast_write_mlat(
mlat_timestamp_scale_out(packet->mlat_timestamp, UINT64_C(0xffffffffffff), 12),
overlay->mlat_timestamp);
if (packet->rssi) {
overlay->rssi = rssi_scale_out(packet->rssi, UINT8_MAX);
} else {
overlay->rssi = UINT8_MAX;
}
buf2.length = sizeof(*overlay);
beast_escape(buf, &buf2);
}
void beast_serialize_mode_s_long(struct packet *packet, struct buf *buf) {
struct buf buf2 = BUF_INIT;
struct beast_mode_s_long_overlay *overlay = (struct beast_mode_s_long_overlay *) buf_at(&buf2, 0);
overlay->common.one_a = 0x1a;
overlay->common.type = 0x33;
memcpy(overlay->payload, packet->payload, sizeof(overlay->payload));
beast_write_mlat(
mlat_timestamp_scale_out(packet->mlat_timestamp, UINT64_C(0xffffffffffff), 12),
overlay->mlat_timestamp);
if (packet->rssi) {
overlay->rssi = rssi_scale_out(packet->rssi, UINT8_MAX);
} else {
overlay->rssi = UINT8_MAX;
}
buf2.length = sizeof(*overlay);
beast_escape(buf, &buf2);
}
void beast_serialize(struct packet *packet, struct buf *buf) {
if (!packet) {
return;
}
switch (packet->type) {
case MODE_S_SHORT:
beast_serialize_mode_s_short(packet, buf);
break;
case MODE_S_LONG:
beast_serialize_mode_s_long(packet, buf);
break;
}
}