altos: Add cc115l driver (untested)

Includes support for sending telemetry, RDF and APRS tones

Signed-off-by: Keith Packard <keithp@keithp.com>

1 files changed, 796 insertions, 0 deletions

diff --git a/src/drivers/ao_cc115l.c b/src/drivers/ao_cc115l.c
new file mode 100644
index 00000000..fd8bb1f0
--- /dev/null
+++ b/src/drivers/ao_cc115l.c
@@ -0,0 +1,796 @@
+/*
+ * Copyright © 2013 Keith Packard <keithp@keithp.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+ */
+
+#include <ao.h>
+#include <ao_cc115l.h>
+#include <ao_exti.h>
+#include <ao_telemetry.h>
+#include <ao_fec.h>
+
+#define AO_RADIO_MAX_SEND	sizeof (struct ao_telemetry_generic)
+
+static uint8_t ao_radio_mutex;
+
+static uint8_t ao_radio_wake;		/* radio ready. Also used as sleep address */
+static uint8_t ao_radio_abort;		/* radio operation should abort */
+static uint8_t ao_radio_mcu_wake;	/* MARC status change */
+static uint8_t ao_radio_marcstate;	/* Last read MARC state value */
+
+#define CC115L_DEBUG	AO_FEC_DEBUG
+#define CC115L_TRACE	1
+
+extern const uint32_t	ao_radio_cal;
+
+#define FOSC	26000000
+
+#define ao_radio_select()	ao_spi_get_mask(AO_CC115L_SPI_CS_PORT,(1 << AO_CC115L_SPI_CS_PIN),AO_CC115L_SPI_BUS,AO_SPI_SPEED_4MHz)
+#define ao_radio_deselect()	ao_spi_put_mask(AO_CC115L_SPI_CS_PORT,(1 << AO_CC115L_SPI_CS_PIN),AO_CC115L_SPI_BUS)
+#define ao_radio_spi_send(d,l)	ao_spi_send((d), (l), AO_CC115L_SPI_BUS)
+#define ao_radio_spi_send_fixed(d,l) ao_spi_send_fixed((d), (l), AO_CC115L_SPI_BUS)
+#define ao_radio_spi_recv(d,l)	ao_spi_recv((d), (l), AO_CC115L_SPI_BUS)
+#define ao_radio_duplex(o,i,l)	ao_spi_duplex((o), (i), (l), AO_CC115L_SPI_BUS)
+
+static uint8_t
+ao_radio_reg_read(uint16_t addr)
+{
+	uint8_t	datao[2], datai[2];
+	uint8_t	d;
+
+#if CC115L_TRACE
+	printf("\t\tao_radio_reg_read (%04x): ", addr); flush();
+#endif
+	datao[0] = ((1 << CC115L_READ)  |
+		    (0 << CC115L_BURST) |
+		    addr);
+	ao_radio_select();
+	ao_radio_duplex(datao, datai, 2);
+	ao_radio_deselect();
+#if CC115L_TRACE
+	printf (" %02x\n", datai[1]);
+#endif
+	return datai[1];
+}
+
+static void
+ao_radio_reg_write(uint16_t addr, uint8_t value)
+{
+	uint8_t	data[2];
+	uint8_t	d;
+
+#if CC115L_TRACE
+	printf("\t\tao_radio_reg_write (%04x): %02x\n", addr, value);
+#endif
+	data[0] = ((0 << CC115L_READ)  |
+		   (0 << CC115L_BURST) |
+		   addr);
+	data[1] = value;
+	ao_radio_select();
+	ao_radio_spi_send(data, 2);
+	ao_radio_deselect();
+}
+
+static void
+ao_radio_burst_read_start (uint16_t addr)
+{
+	uint8_t data[1];
+	uint8_t d;
+
+	data[0] = ((1 << CC115L_READ)  |
+		   (1 << CC115L_BURST) |
+		   addr);
+	ao_radio_select();
+	ao_radio_spi_send(data, 1);
+}
+
+static void
+ao_radio_burst_read_stop (void)
+{
+	ao_radio_deselect();
+}
+
+
+static uint8_t
+ao_radio_strobe(uint8_t addr)
+{
+	uint8_t	in;
+
+#if CC115L_TRACE
+	printf("\t\tao_radio_strobe (%02x): ", addr); flush();
+#endif
+	ao_radio_select();
+	ao_radio_duplex(&addr, &in, 1);
+	ao_radio_deselect();
+#if CC115L_TRACE
+	printf("%02x\n", in); flush();
+#endif
+	return in;
+}
+
+static uint8_t
+ao_radio_fifo_write_start(void)
+{
+	uint8_t	addr = ((0 << CC115L_READ)  |
+			(1 << CC115L_BURST) |
+			CC115L_FIFO);
+	uint8_t status;
+
+	ao_radio_select();
+	ao_radio_duplex(&addr, &status, 1);
+	return status;
+}
+
+static inline uint8_t ao_radio_fifo_write_stop(uint8_t status) {
+	ao_radio_deselect();
+	return status;
+}
+
+static uint8_t
+ao_radio_fifo_write(uint8_t *data, uint8_t len)
+{
+	uint8_t	status = ao_radio_fifo_write_start();
+	ao_radio_spi_send(data, len);
+	return ao_radio_fifo_write_stop(status);
+}
+
+static uint8_t
+ao_radio_fifo_write_fixed(uint8_t data, uint8_t len)
+{
+	uint8_t status = ao_radio_fifo_write_start();
+	ao_radio_spi_send_fixed(data, len);
+	return ao_radio_fifo_write_stop(status);
+}
+
+static uint8_t
+ao_radio_tx_fifo_space(void)
+{
+	return CC115L_FIFO_SIZE - (ao_radio_reg_read(CC115L_TXBYTES) & CC115L_TXBYTES_NUM_TX_BYTES_MASK);
+}
+
+static uint8_t
+ao_radio_status(void)
+{
+	return ao_radio_strobe (CC115L_SNOP);
+}
+
+#define ao_radio_rdf_value 0x55
+
+static uint8_t
+ao_radio_get_marcstate(void)
+{
+	return ao_radio_reg_read(CC115L_MARCSTATE) & CC115L_MARCSTATE_MASK;
+}
+
+static void
+ao_radio_mcu_wakeup_isr(void)
+{
+	ao_radio_mcu_wake = 1;
+	ao_wakeup(&ao_radio_wake);
+}
+
+
+static void
+ao_radio_check_marcstate(void)
+{
+	ao_radio_mcu_wake = 0;
+	ao_radio_marcstate = ao_radio_get_marcstate();
+	
+	/* Anyt other than 'tx finished' means an error occurred */
+	if (ao_radio_marcstate != CC115L_MARCSTATE_TX_END)
+		ao_radio_abort = 1;
+}
+
+static void
+ao_radio_isr(void)
+{
+	ao_exti_disable(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN);
+	ao_radio_wake = 1;
+	ao_wakeup(&ao_radio_wake);
+}
+
+static void
+ao_radio_start_tx(void)
+{
+	ao_exti_set_callback(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN, ao_radio_isr);
+	ao_exti_enable(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN);
+	ao_exti_enable(AO_CC115L_MCU_WAKEUP_PORT, AO_CC115L_MCU_WAKEUP_PIN);
+	ao_radio_strobe(CC115L_STX);
+}
+
+static void
+ao_radio_idle(void)
+{
+	for (;;) {
+		uint8_t	state = ao_radio_strobe(CC115L_SIDLE);
+		if ((state >> CC115L_STATUS_STATE) == CC115L_STATUS_STATE_IDLE)
+			break;
+	}
+	/* Flush any pending TX bytes */
+	ao_radio_strobe(CC115L_SFTX);
+}
+
+/*
+ * Packet deviation is 20.5kHz
+ *
+ *	fdev = fosc >> 17 * (8 + dev_m) << dev_e
+ *
+ *     	26e6 / (2 ** 17) * (8 + 5) * (2 ** 3) = 20630Hz
+ */
+
+#define PACKET_DEV_E	3
+#define PACKET_DEV_M	5
+
+/*
+ * For our packet data, set the symbol rate to 38400 Baud
+ *
+ *              (256 + DATARATE_M) * 2 ** DATARATE_E
+ *	Rdata = -------------------------------------- * fosc
+ *		             2 ** 28
+ *
+ *		(256 + 131) * (2 ** 10) / (2**28) * 26e6 = 38383
+ *
+ *	DATARATE_M = 131
+ *	DATARATE_E = 10
+ */
+#define PACKET_DRATE_E	10
+#define PACKET_DRATE_M	131
+
+static const uint16_t packet_setup[] = {
+	CC115L_DEVIATN,		((PACKET_DEV_E << CC115L_DEVIATN_DEVIATION_E) |
+				 (PACKET_DEV_M << CC115L_DEVIATN_DEVIATION_M)),
+	CC115L_MDMCFG4,		((0xf << 4) |
+				 (PACKET_DRATE_E << CC115L_MDMCFG4_DRATE_E)),
+	CC115L_MDMCFG3,		(PACKET_DRATE_M),
+};
+
+
+/*
+ * RDF deviation is 5kHz
+ *
+ *	fdev = fosc >> 17 * (8 + dev_m) << dev_e
+ *
+ *     	26e6 / (2 ** 17) * (8 + 4) * (2 ** 1) = 4761Hz
+ */
+
+#define RDF_DEV_E	1
+#define RDF_DEV_M	4
+
+/*
+ * For our RDF beacon, set the symbol rate to 2kBaud (for a 1kHz tone)
+ *
+ *              (256 + DATARATE_M) * 2 ** DATARATE_E
+ *	Rdata = -------------------------------------- * fosc
+ *		             2 ** 28
+ *
+ *		(256 + 67) * (2 ** 6) / (2**28) * 26e6 = 2002
+ *
+ *	DATARATE_M = 67
+ *	DATARATE_E = 6
+ *
+ * To make the tone last for 200ms, we need 2000 * .2 = 400 bits or 50 bytes
+ */
+#define RDF_DRATE_E	6
+#define RDF_DRATE_M	67
+#define RDF_PACKET_LEN	50
+
+static const uint16_t rdf_setup[] = {
+	CC115L_DEVIATN,		((RDF_DEV_E << CC115L_DEVIATN_DEVIATION_E) |
+				 (RDF_DEV_M << CC115L_DEVIATN_DEVIATION_M)),
+	CC115L_MDMCFG4,		((0xf << 4) |
+				 (RDF_DRATE_E << CC115L_MDMCFG4_DRATE_E)),
+	CC115L_MDMCFG3,		(RDF_DRATE_M),
+};
+
+/*
+ * APRS deviation is the same as RDF
+ */
+
+#define APRS_DEV_E	RDF_DEV_E
+#define APRS_DEV_M	RDF_DEV_E
+
+/*
+ * For our APRS beacon, set the symbol rate to 9.6kBaud (8x oversampling for 1200 baud data rate)
+ *
+ *              (256 + DATARATE_M) * 2 ** DATARATE_E
+ *	Rdata = -------------------------------------- * fosc
+ *		             2 ** 28
+ *
+ *		(256 + 131) * (2 ** 8) / (2**28) * 26e6 = 9596
+ *
+ *	DATARATE_M = 131
+ *	DATARATE_E = 8
+ *
+ */
+#define APRS_DRATE_E	8
+#define APRS_DRATE_M	131
+
+static const uint16_t aprs_setup[] = {
+	CC115L_DEVIATN,		((APRS_DEV_E << CC115L_DEVIATN_DEVIATION_E) |
+				 (APRS_DEV_M << CC115L_DEVIATN_DEVIATION_M)),
+	CC115L_MDMCFG4,		((0xf << 4) |
+				 (APRS_DRATE_E << CC115L_MDMCFG4_DRATE_E)),
+	CC115L_MDMCFG3,		(APRS_DRATE_M),
+};
+
+#define AO_PKTCTRL0_INFINITE	((CC115L_PKTCTRL0_PKT_FORMAT_NORMAL << CC115L_PKTCTRL0_PKT_FORMAT) | \
+				 (0 << CC115L_PKTCTRL0_PKT_CRC_EN) |					\
+				 (CC115L_PKTCTRL0_PKT_LENGTH_CONFIG_INFINITE << CC115L_PKTCTRL0_PKT_LENGTH_CONFIG))
+#define AO_PKTCTRL0_FIXED	((CC115L_PKTCTRL0_PKT_FORMAT_NORMAL << CC115L_PKTCTRL0_PKT_FORMAT) | \
+				 (0 << CC115L_PKTCTRL0_PKT_CRC_EN) |					\
+				 (CC115L_PKTCTRL0_PKT_LENGTH_CONFIG_FIXED << CC115L_PKTCTRL0_PKT_LENGTH_CONFIG))
+
+static uint16_t ao_radio_mode;
+
+#define AO_RADIO_MODE_BITS_PACKET_TX	1
+#define AO_RADIO_MODE_BITS_TX_BUF	2
+#define AO_RADIO_MODE_BITS_TX_FINISH	4
+#define AO_RADIO_MODE_BITS_RDF		8
+#define AO_RADIO_MODE_BITS_APRS		16
+#define AO_RADIO_MODE_BITS_INFINITE	32
+#define AO_RADIO_MODE_BITS_FIXED	64
+
+#define AO_RADIO_MODE_NONE		0
+#define AO_RADIO_MODE_PACKET_TX_BUF	(AO_RADIO_MODE_BITS_PACKET_TX | AO_RADIO_MODE_BITS_TX_BUF)
+#define AO_RADIO_MODE_PACKET_TX_FINISH	(AO_RADIO_MODE_BITS_PACKET_TX | AO_RADIO_MODE_BITS_TX_FINISH)
+#define AO_RADIO_MODE_RDF		(AO_RADIO_MODE_BITS_RDF | AO_RADIO_MODE_BITS_TX_FINISH)
+#define AO_RADIO_MODE_APRS_BUF		(AO_RADIO_MODE_BITS_APRS | AO_RADIO_MODE_BITS_INFINITE | AO_RADIO_MODE_BITS_TX_BUF)
+#define AO_RADIO_MODE_APRS_LAST_BUF	(AO_RADIO_MODE_BITS_APRS | AO_RADIO_MODE_BITS_FIXED | AO_RADIO_MODE_BITS_TX_BUF)
+#define AO_RADIO_MODE_APRS_FINISH	(AO_RADIO_MODE_BITS_APRS | AO_RADIO_MODE_BITS_FIXED | AO_RADIO_MODE_BITS_TX_FINISH)
+
+static void
+ao_radio_set_mode(uint16_t new_mode)
+{
+	uint16_t changes;
+	int i;
+
+	if (new_mode == ao_radio_mode)
+		return;
+
+	changes = new_mode & (~ao_radio_mode);
+	if (changes & AO_RADIO_MODE_BITS_PACKET_TX)
+		for (i = 0; i < sizeof (packet_setup) / sizeof (packet_setup[0]); i += 2)
+			ao_radio_reg_write(packet_setup[i], packet_setup[i+1]);
+
+	if (changes & AO_RADIO_MODE_BITS_TX_BUF)
+		ao_radio_reg_write(AO_CC115L_INT_GPIO_IOCFG, CC115L_IOCFG_GPIO_CFG_TXFIFO_THR);
+
+	if (changes & AO_RADIO_MODE_BITS_TX_FINISH)
+		ao_radio_reg_write(AO_CC115L_INT_GPIO_IOCFG, CC115L_IOCFG_GPIO_CFG_PKT_SYNC_TX | (1 << CC115L_IOCFG_GPIO_INV));
+
+	if (changes & AO_RADIO_MODE_BITS_RDF)
+		for (i = 0; i < sizeof (rdf_setup) / sizeof (rdf_setup[0]); i += 2)
+			ao_radio_reg_write(rdf_setup[i], rdf_setup[i+1]);
+
+	if (changes & AO_RADIO_MODE_BITS_APRS)
+		for (i = 0; i < sizeof (aprs_setup) / sizeof (aprs_setup[0]); i += 2)
+			ao_radio_reg_write(aprs_setup[i], aprs_setup[i+1]);
+
+	if (changes & AO_RADIO_MODE_BITS_INFINITE)
+		ao_radio_reg_write(CC115L_PKTCTRL0, AO_PKTCTRL0_INFINITE);
+
+	if (changes & AO_RADIO_MODE_BITS_FIXED)
+		ao_radio_reg_write(CC115L_PKTCTRL0, AO_PKTCTRL0_FIXED);
+
+	ao_radio_mode = new_mode;
+}
+
+static const uint16_t radio_setup[] = {
+#include "ao_rf_cc115l.h"
+};
+
+static uint8_t	ao_radio_configured = 0;
+
+static void
+ao_radio_setup(void)
+{
+	int	i;
+
+	ao_radio_strobe(CC115L_SRES);
+
+	for (i = 0; i < sizeof (radio_setup) / sizeof (radio_setup[0]); i += 2)
+		ao_radio_reg_write(radio_setup[i], radio_setup[i+1]);
+
+	ao_radio_mode = 0;
+
+	ao_config_get();
+
+	ao_radio_configured = 1;
+}
+
+static void
+ao_radio_set_len(uint8_t len)
+{
+	static uint8_t	last_len;
+
+	if (len != last_len) {
+		ao_radio_reg_write(CC115L_PKTLEN, len);
+		last_len = len;
+	}
+}
+
+static void
+ao_radio_get(uint8_t len)
+{
+	static uint32_t	last_radio_setting;
+
+	ao_mutex_get(&ao_radio_mutex);
+	if (!ao_radio_configured)
+		ao_radio_setup();
+	if (ao_config.radio_setting != last_radio_setting) {
+		ao_radio_reg_write(CC115L_FREQ2, ao_config.radio_setting >> 16);
+		ao_radio_reg_write(CC115L_FREQ1, ao_config.radio_setting >> 8);
+		ao_radio_reg_write(CC115L_FREQ0, ao_config.radio_setting);
+		last_radio_setting = ao_config.radio_setting;
+	}
+	ao_radio_set_len(len);
+}
+
+#define ao_radio_put()	ao_mutex_put(&ao_radio_mutex)
+
+static void
+ao_rdf_start(uint8_t len)
+{
+	ao_radio_abort = 0;
+	ao_radio_get(len);
+
+	ao_radio_set_mode(AO_RADIO_MODE_RDF);
+	ao_radio_wake = 0;
+
+}
+
+static void
+ao_rdf_run(void)
+{
+	ao_radio_start_tx();
+
+	ao_arch_block_interrupts();
+	while (!ao_radio_wake && !ao_radio_abort && !ao_radio_mcu_wake)
+		ao_sleep(&ao_radio_wake);
+	ao_arch_release_interrupts();
+	if (ao_radio_mcu_wake)
+		ao_radio_check_marcstate();
+	if (!ao_radio_wake)
+		ao_radio_idle();
+	ao_radio_put();
+}
+
+void
+ao_radio_rdf(void)
+{
+	ao_rdf_start(AO_RADIO_RDF_LEN);
+
+	ao_radio_fifo_write_fixed(ao_radio_rdf_value, AO_RADIO_RDF_LEN);
+
+	ao_rdf_run();
+}
+
+void
+ao_radio_continuity(uint8_t c)
+{
+	uint8_t	i;
+	uint8_t status;
+
+	ao_rdf_start(AO_RADIO_CONT_TOTAL_LEN);
+
+	status = ao_radio_fifo_write_start();
+	for (i = 0; i < 3; i++) {
+		ao_radio_spi_send_fixed(0x00, AO_RADIO_CONT_PAUSE_LEN);
+		if (i < c)
+			ao_radio_spi_send_fixed(ao_radio_rdf_value, AO_RADIO_CONT_TONE_LEN);
+		else
+			ao_radio_spi_send_fixed(0x00, AO_RADIO_CONT_TONE_LEN);
+	}
+	ao_radio_spi_send_fixed(0x00, AO_RADIO_CONT_PAUSE_LEN);
+	status = ao_radio_fifo_write_stop(status);
+	(void) status;
+	ao_rdf_run();
+}
+
+void
+ao_radio_rdf_abort(void)
+{
+	ao_radio_abort = 1;
+	ao_wakeup(&ao_radio_wake);
+}
+
+static void
+ao_radio_test_cmd(void)
+{
+	uint8_t	mode = 2;
+	static uint8_t radio_on;
+	ao_cmd_white();
+	if (ao_cmd_lex_c != '\n') {
+		ao_cmd_decimal();
+		mode = (uint8_t) ao_cmd_lex_u32;
+	}
+	mode++;
+	if ((mode & 2) && !radio_on) {
+#if HAS_MONITOR
+		ao_monitor_disable();
+#endif
+#if PACKET_HAS_SLAVE
+		ao_packet_slave_stop();
+#endif
+		ao_radio_get(0xff);
+		ao_radio_strobe(CC115L_STX);
+#if CC115L_TRACE
+		{ int t; 
+			for (t = 0; t < 10; t++) {
+				printf ("status: %02x\n", ao_radio_status());
+				ao_delay(AO_MS_TO_TICKS(100));
+			}
+		}
+#endif
+		radio_on = 1;
+	}
+	if (mode == 3) {
+		printf ("Hit a character to stop..."); flush();
+		getchar();
+		putchar('\n');
+	}
+	if ((mode & 1) && radio_on) {
+		ao_radio_idle();
+		ao_radio_put();
+		radio_on = 0;
+#if HAS_MONITOR
+		ao_monitor_enable();
+#endif
+	}
+}
+
+static void
+ao_radio_wait_isr(void)
+{
+	ao_arch_block_interrupts();
+	while (!ao_radio_wake && !ao_radio_mcu_wake && !ao_radio_abort)
+		ao_sleep(&ao_radio_wake);
+	ao_arch_release_interrupts();
+	if (ao_radio_mcu_wake)
+		ao_radio_check_marcstate();
+}
+
+static uint8_t
+ao_radio_wait_tx(uint8_t wait_fifo)
+{
+	uint8_t	fifo_space = 0;
+
+	do {
+		ao_radio_wait_isr();
+		if (!wait_fifo)
+			return 0;
+		fifo_space = ao_radio_tx_fifo_space();
+	} while (!fifo_space && !ao_radio_abort);
+	return fifo_space;
+}
+
+static uint8_t	tx_data[(AO_RADIO_MAX_SEND + 4) * 2];
+
+void
+ao_radio_send(const void *d, uint8_t size)
+{
+	uint8_t		marc_status;
+	uint8_t		*e = tx_data;
+	uint8_t		encode_len;
+	uint8_t		this_len;
+	uint8_t		started = 0;
+	uint8_t		fifo_space;
+
+	encode_len = ao_fec_encode(d, size, tx_data);
+
+	ao_radio_get(encode_len);
+
+	started = 0;
+	fifo_space = CC115L_FIFO_SIZE;
+	while (encode_len) {
+		this_len = encode_len;
+
+		ao_radio_wake = 0;
+		if (this_len > fifo_space) {
+			this_len = fifo_space;
+			ao_radio_set_mode(AO_RADIO_MODE_PACKET_TX_BUF);
+		} else {
+			ao_radio_set_mode(AO_RADIO_MODE_PACKET_TX_FINISH);
+		}
+
+		ao_radio_fifo_write(e, this_len);
+		e += this_len;
+		encode_len -= this_len;
+
+		if (!started) {
+			ao_radio_start_tx();
+			started = 1;
+		} else {
+			ao_exti_enable(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN);
+		}
+			
+		fifo_space = ao_radio_wait_tx(encode_len != 0);
+		if (ao_radio_abort) {
+			ao_radio_idle();
+			break;
+		}
+	}
+	ao_radio_put();
+}
+
+#define AO_RADIO_LOTS	64
+
+void
+ao_radio_send_lots(ao_radio_fill_func fill)
+{
+	uint8_t	buf[AO_RADIO_LOTS], *b;
+	int	cnt;
+	int	total = 0;
+	uint8_t	done = 0;
+	uint8_t	started = 0;
+	uint8_t	fifo_space;
+
+	ao_radio_get(0xff);
+	fifo_space = CC115L_FIFO_SIZE;
+	while (!done) {
+		cnt = (*fill)(buf, sizeof(buf));
+		if (cnt < 0) {
+			done = 1;
+			cnt = -cnt;
+		}
+		total += cnt;
+
+		/* At the last buffer, set the total length */
+		if (done)
+			ao_radio_set_len(total & 0xff);
+
+		b = buf;
+		while (cnt) {
+			uint8_t	this_len = cnt;
+
+			/* Wait for some space in the fifo */
+			while (!ao_radio_abort && (fifo_space = ao_radio_tx_fifo_space()) == 0) {
+				ao_radio_wake = 0;
+				ao_radio_wait_isr();
+			}
+			if (ao_radio_abort)
+				break;
+			if (this_len > fifo_space)
+				this_len = fifo_space;
+
+			cnt -= this_len;
+
+			if (done) {
+				if (cnt)
+					ao_radio_set_mode(AO_RADIO_MODE_APRS_LAST_BUF);
+				else
+					ao_radio_set_mode(AO_RADIO_MODE_APRS_FINISH);
+			} else
+				ao_radio_set_mode(AO_RADIO_MODE_APRS_BUF);
+
+			ao_radio_fifo_write(b, this_len);
+			b += this_len;
+
+			if (!started) {
+				ao_radio_start_tx();
+				started = 1;
+			} else
+				ao_exti_enable(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN);
+		}
+		if (ao_radio_abort) {
+			ao_radio_idle();
+			break;
+		}
+		/* Wait for the transmitter to go idle */
+		ao_radio_wake = 0;
+		ao_radio_wait_isr();
+	}
+	ao_radio_put();
+}
+
+static char *cc115l_state_name[] = {
+	[CC115L_STATUS_STATE_IDLE] = "IDLE",
+	[CC115L_STATUS_STATE_TX] = "TX",
+	[CC115L_STATUS_STATE_FSTXON] = "FSTXON",
+	[CC115L_STATUS_STATE_CALIBRATE] = "CALIBRATE",
+	[CC115L_STATUS_STATE_SETTLING] = "SETTLING",
+	[CC115L_STATUS_STATE_TX_FIFO_UNDERFLOW] = "TX_FIFO_UNDERFLOW",
+};
+
+static void ao_radio_show(void) {
+	uint8_t	status = ao_radio_status();
+	int	i;
+
+	ao_radio_get(0xff);
+	status = ao_radio_status();
+	printf ("Status:   %02x\n", status);
+	printf ("CHIP_RDY: %d\n", (status >> CC115L_STATUS_CHIP_RDY) & 1);
+	printf ("STATE:    %s\n", cc115l_state_name[(status >> CC115L_STATUS_STATE) & CC115L_STATUS_STATE_MASK]);
+	printf ("MARC:     %02x\n", ao_radio_get_marcstate());
+
+	ao_radio_put();
+}
+
+static void ao_radio_beep(void) {
+	ao_radio_rdf();
+}
+
+static void ao_radio_packet(void) {
+	static const uint8_t packet[] = {
+#if 1
+		0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
+		0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
+		0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
+		0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
+#else
+		3, 1, 2, 3
+#endif
+	};
+
+	ao_radio_send(packet, sizeof (packet));
+}
+
+#if HAS_APRS
+#include <ao_aprs.h>
+
+static void
+ao_radio_aprs()
+{
+	ao_packet_slave_stop();
+	ao_aprs_send();
+}
+#endif
+
+static const struct ao_cmds ao_radio_cmds[] = {
+	{ ao_radio_test_cmd,	"C <1 start, 0 stop, none both>\0Radio carrier test" },
+#if CC115L_DEBUG
+#if HAS_APRS
+	{ ao_radio_aprs,	"G\0Send APRS packet" },
+#endif
+	{ ao_radio_show,	"R\0Show CC115L status" },
+	{ ao_radio_beep,	"b\0Emit an RDF beacon" },
+	{ ao_radio_packet,	"p\0Send a test packet" },
+#endif
+	{ 0, NULL }
+};
+
+void
+ao_radio_init(void)
+{
+	int	i;
+
+	ao_radio_configured = 0;
+	ao_spi_init_cs (AO_CC115L_SPI_CS_PORT, (1 << AO_CC115L_SPI_CS_PIN));
+
+#if 0
+	AO_CC115L_SPI_CS_PORT->bsrr = ((uint32_t) (1 << AO_CC115L_SPI_CS_PIN));
+	for (i = 0; i < 10000; i++) {
+		if ((SPI_2_PORT->idr & (1 << SPI_2_MISO_PIN)) == 0)
+			break;
+	}
+	AO_CC115L_SPI_CS_PORT->bsrr = (1 << AO_CC115L_SPI_CS_PIN);
+	if (i == 10000)
+		ao_panic(AO_PANIC_SELF_TEST_CC115L);
+#endif
+
+	/* Enable the EXTI interrupt for the appropriate pin */
+	ao_enable_port(AO_CC115L_INT_PORT);
+	ao_exti_setup(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN,
+		      AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_HIGH,
+		      ao_radio_isr);
+
+	/* Enable the hacked up GPIO3 pin */
+	ao_enable_port(AO_CC115L_MCU_WAKEUP_PORT);
+	ao_exti_setup(AO_CC115L_MCU_WAKEUP_PORT, AO_CC115L_MCU_WAKEUP_PIN,
+		      AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_MED,
+		      ao_radio_mcu_wakeup_isr);
+
+	ao_cmd_register(&ao_radio_cmds[0]);
+}