#include <stdbool.h>
#include <stdio.h>
#include <string.h>

#include "common.h"
#include "airspy_adsb.h"

static bool airspy_adsb_parse_common(char *, struct packet *);


bool airspy_adsb_parse(struct buf *buf, struct packet *packet) {
	if (buf->length < 35 ||
	    buf_chr(buf, 0) != '*') {
		return false;
	}
	if (buf->length >= 35 &&
	    buf_chr(buf, 33) == '\r' &&
	    buf_chr(buf, 34) == '\n' &&
			buf_chr(buf, 15) == ';') {
		if (!airspy_adsb_parse_common(buf_at(buf, 16), packet)) {
			return false;
		}
		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' &&
			buf_chr(buf, 29) == ';') {
		if (!airspy_adsb_parse_common(buf_at(buf, 30), packet)) {
			return false;
		}
		packet->type = MODE_S_LONG;
		hex_to_bin(packet->data, buf_at(buf, 1), 14);
		buf_consume(buf, 49);
		return true;
	}
	return false;
}

static bool airspy_adsb_parse_common(char *in, struct packet *packet) {
	if (in[8] != ';' ||
	    in[11] != ';' ||
			in[16] != ';') {
		return false;
	}
	uint16_t mlat_mhz = 2 * hex_to_int(&in[9], 1);
	packet->mlat_timestamp = hex_to_int(in, 4) * (MLAT_MHZ / mlat_mhz);
	packet->rssi = hex_to_int(&in[12], 2) * (RSSI_MAX / (1 << 16));
	return true;
}