Merge remote-tracking branch 'origin/micropeak-logging'
[fw/altos] / src / drivers / ao_cc1120.c
index 9470fa878ea74c01978f6cee1bd7e382546e8ac6..8068740f91782483e6f83329a4f439d2c778b5a5 100644 (file)
  */
 
 #include <ao.h>
+#include <ao_cc1120.h>
+#include <ao_exti.h>
+#include <ao_fec.h>
+#include <ao_packet.h>
 
-uint32_t       ao_radio_cal = 1186611;
+#define AO_RADIO_MAX_RECV      sizeof(struct ao_packet)
+#define AO_RADIO_MAX_SEND      sizeof(struct ao_packet)
+
+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_marc_status;   /* Last read MARC status value */
+
+#define CC1120_DEBUG   AO_FEC_DEBUG
+#define CC1120_TRACE   0
+
+extern const uint32_t  ao_radio_cal;
+
+#define FOSC   32000000
+
+#define ao_radio_select()      ao_spi_get_mask(AO_CC1120_SPI_CS_PORT,(1 << AO_CC1120_SPI_CS_PIN),AO_CC1120_SPI_BUS,AO_SPI_SPEED_1MHz)
+#define ao_radio_deselect()    ao_spi_put_mask(AO_CC1120_SPI_CS_PORT,(1 << AO_CC1120_SPI_CS_PIN),AO_CC1120_SPI_BUS)
+#define ao_radio_spi_send(d,l) ao_spi_send((d), (l), AO_CC1120_SPI_BUS)
+#define ao_radio_spi_send_fixed(d,l) ao_spi_send_fixed((d), (l), AO_CC1120_SPI_BUS)
+#define ao_radio_spi_recv(d,l) ao_spi_recv((d), (l), AO_CC1120_SPI_BUS)
+#define ao_radio_duplex(o,i,l) ao_spi_duplex((o), (i), (l), AO_CC1120_SPI_BUS)
+
+static uint8_t
+ao_radio_reg_read(uint16_t addr)
+{
+       uint8_t data[2];
+       uint8_t d;
+
+#if CC1120_TRACE
+       printf("\t\tao_radio_reg_read (%04x): ", addr); flush();
+#endif
+       if (CC1120_IS_EXTENDED(addr)) {
+               data[0] = ((1 << CC1120_READ)  |
+                          (0 << CC1120_BURST) |
+                          CC1120_EXTENDED);
+               data[1] = addr;
+               d = 2;
+       } else {
+               data[0] = ((1 << CC1120_READ)  |
+                          (0 << CC1120_BURST) |
+                          addr);
+               d = 1;
+       }
+       ao_radio_select();
+       ao_radio_spi_send(data, d);
+       ao_radio_spi_recv(data, 1);
+       ao_radio_deselect();
+#if CC1120_TRACE
+       printf (" %02x\n", data[0]);
+#endif
+       return data[0];
+}
+
+static void
+ao_radio_reg_write(uint16_t addr, uint8_t value)
+{
+       uint8_t data[3];
+       uint8_t d;
+
+#if CC1120_TRACE
+       printf("\t\tao_radio_reg_write (%04x): %02x\n", addr, value);
+#endif
+       if (CC1120_IS_EXTENDED(addr)) {
+               data[0] = ((0 << CC1120_READ)  |
+                          (0 << CC1120_BURST) |
+                          CC1120_EXTENDED);
+               data[1] = addr;
+               d = 2;
+       } else {
+               data[0] = ((0 << CC1120_READ)  |
+                          (0 << CC1120_BURST) |
+                          addr);
+               d = 1;
+       }
+       data[d] = value;
+       ao_radio_select();
+       ao_radio_spi_send(data, d+1);
+       ao_radio_deselect();
+}
+
+static void
+ao_radio_burst_read_start (uint16_t addr)
+{
+       uint8_t data[2];
+       uint8_t d;
+
+       if (CC1120_IS_EXTENDED(addr)) {
+               data[0] = ((1 << CC1120_READ)  |
+                          (1 << CC1120_BURST) |
+                          CC1120_EXTENDED);
+               data[1] = addr;
+               d = 2;
+       } else {
+               data[0] = ((1 << CC1120_READ)  |
+                          (1 << CC1120_BURST) |
+                          addr);
+               d = 1;
+       }
+       ao_radio_select();
+       ao_radio_spi_send(data, d);
+}
+
+static void
+ao_radio_burst_read_stop (void)
+{
+       ao_radio_deselect();
+}
+
+
+static uint8_t
+ao_radio_strobe(uint8_t addr)
+{
+       uint8_t in;
+
+#if CC1120_TRACE
+       printf("\t\tao_radio_strobe (%02x): ", addr); flush();
+#endif
+       ao_radio_select();
+       ao_radio_duplex(&addr, &in, 1);
+       ao_radio_deselect();
+#if CC1120_TRACE
+       printf("%02x\n", in); flush();
+#endif
+       return in;
+}
+
+static uint8_t
+ao_radio_fifo_read(uint8_t *data, uint8_t len)
+{
+       uint8_t addr = ((1 << CC1120_READ)  |
+                       (1 << CC1120_BURST) |
+                       CC1120_FIFO);
+       uint8_t status;
+
+       ao_radio_select();
+       ao_radio_duplex(&addr, &status, 1);
+       ao_radio_spi_recv(data, len);
+       ao_radio_deselect();
+       return status;
+}
+
+static uint8_t
+ao_radio_fifo_write_start(void)
+{
+       uint8_t addr = ((0 << CC1120_READ)  |
+                       (1 << CC1120_BURST) |
+                       CC1120_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 CC1120_FIFO_SIZE - ao_radio_reg_read(CC1120_NUM_TXBYTES);
+}
+
+static uint8_t
+ao_radio_status(void)
+{
+       return ao_radio_strobe (CC1120_SNOP);
+}
 
 void
 ao_radio_recv_abort(void)
 {
+       ao_radio_abort = 1;
+       ao_wakeup(&ao_radio_wake);
+}
+
+#define ao_radio_rdf_value 0x55
+
+static uint8_t
+ao_radio_get_marc_status(void)
+{
+       return ao_radio_reg_read(CC1120_MARC_STATUS1);
+}
+
+static void
+ao_radio_mcu_wakeup_isr(void)
+{
+       ao_radio_mcu_wake = 1;
+       ao_wakeup(&ao_radio_wake);
+}
+
+
+static void
+ao_radio_check_marc_status(void)
+{
+       ao_radio_mcu_wake = 0;
+       ao_radio_marc_status = ao_radio_get_marc_status();
+       
+       /* Anyt other than 'tx/rx finished' means an error occurred */
+       if (ao_radio_marc_status & ~(CC1120_MARC_STATUS1_TX_FINISHED|CC1120_MARC_STATUS1_RX_FINISHED))
+               ao_radio_abort = 1;
+}
+
+static void
+ao_radio_isr(void)
+{
+       ao_exti_disable(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN);
+       ao_radio_wake = 1;
+       ao_wakeup(&ao_radio_wake);
+}
+
+static void
+ao_radio_start_tx(void)
+{
+       ao_exti_set_callback(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN, ao_radio_isr);
+       ao_exti_enable(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN);
+       ao_exti_enable(AO_CC1120_MCU_WAKEUP_PORT, AO_CC1120_MCU_WAKEUP_PIN);
+       ao_radio_strobe(CC1120_STX);
+}
+
+static void
+ao_radio_idle(void)
+{
+       for (;;) {
+               uint8_t state = ao_radio_strobe(CC1120_SIDLE);
+               if ((state >> CC1120_STATUS_STATE) == CC1120_STATUS_STATE_IDLE)
+                       break;
+       }
+       /* Flush any pending TX bytes */
+       ao_radio_strobe(CC1120_SFTX);
+}
+
+/*
+ * Packet deviation is 20.5kHz
+ *
+ *     fdev = fosc >> 24 * (256 + dev_m) << dev_e
+ *
+ *             32e6Hz / (2 ** 24) * (256 + 80) * (2 ** 5) = 20508Hz
+ */
+
+#define PACKET_DEV_E   5
+#define PACKET_DEV_M   80
+
+/*
+ * For our packet data, set the symbol rate to 38400 Baud
+ *
+ *              (2**20 + DATARATE_M) * 2 ** DATARATE_E
+ *     Rdata = -------------------------------------- * fosc
+ *                          2 ** 39
+ *
+ *
+ *     DATARATE_M = 239914
+ *     DATARATE_E = 9
+ */
+#define PACKET_DRATE_E 9
+#define PACKET_DRATE_M 239914
+
+static const uint16_t packet_setup[] = {
+       CC1120_DEVIATION_M,     PACKET_DEV_M,
+       CC1120_MODCFG_DEV_E,    ((CC1120_MODCFG_DEV_E_MODEM_MODE_NORMAL << CC1120_MODCFG_DEV_E_MODEM_MODE) |
+                                (CC1120_MODCFG_DEV_E_MOD_FORMAT_2_GFSK << CC1120_MODCFG_DEV_E_MOD_FORMAT) |
+                                (PACKET_DEV_E << CC1120_MODCFG_DEV_E_DEV_E)),
+       CC1120_DRATE2,          ((PACKET_DRATE_E << CC1120_DRATE2_DATARATE_E) |
+                                (((PACKET_DRATE_M >> 16) & CC1120_DRATE2_DATARATE_M_19_16_MASK) << CC1120_DRATE2_DATARATE_M_19_16)),
+       CC1120_DRATE1,          ((PACKET_DRATE_M >> 8) & 0xff),
+       CC1120_DRATE0,          ((PACKET_DRATE_M >> 0) & 0xff),
+       CC1120_PKT_CFG2,        ((CC1120_PKT_CFG2_CCA_MODE_ALWAYS_CLEAR << CC1120_PKT_CFG2_CCA_MODE) |
+                                (CC1120_PKT_CFG2_PKT_FORMAT_NORMAL << CC1120_PKT_CFG2_PKT_FORMAT)),
+       CC1120_PKT_CFG1,        ((0 << CC1120_PKT_CFG1_WHITE_DATA) |
+                                (CC1120_PKT_CFG1_ADDR_CHECK_CFG_NONE << CC1120_PKT_CFG1_ADDR_CHECK_CFG) |
+                                (CC1120_PKT_CFG1_CRC_CFG_DISABLED << CC1120_PKT_CFG1_CRC_CFG) |
+                                (0 << CC1120_PKT_CFG1_APPEND_STATUS)),
+       CC1120_PKT_CFG0,        ((0 << CC1120_PKT_CFG0_RESERVED7) |
+                                (CC1120_PKT_CFG0_LENGTH_CONFIG_FIXED << CC1120_PKT_CFG0_LENGTH_CONFIG) |
+                                (0 << CC1120_PKT_CFG0_PKG_BIT_LEN) |
+                                (0 << CC1120_PKT_CFG0_UART_MODE_EN) |
+                                (0 << CC1120_PKT_CFG0_UART_SWAP_EN)),
+       AO_CC1120_MARC_GPIO_IOCFG,              CC1120_IOCFG_GPIO_CFG_MARC_MCU_WAKEUP,
+};
+
+static const uint16_t packet_tx_setup[] = {
+       CC1120_PKT_CFG2,        ((CC1120_PKT_CFG2_CCA_MODE_ALWAYS_CLEAR << CC1120_PKT_CFG2_CCA_MODE) |
+                                (CC1120_PKT_CFG2_PKT_FORMAT_NORMAL << CC1120_PKT_CFG2_PKT_FORMAT)),
+       AO_CC1120_INT_GPIO_IOCFG,               CC1120_IOCFG_GPIO_CFG_RX0TX1_CFG,
+};
+
+static const uint16_t packet_rx_setup[] = {
+       CC1120_PKT_CFG2,        ((CC1120_PKT_CFG2_CCA_MODE_ALWAYS_CLEAR << CC1120_PKT_CFG2_CCA_MODE) |
+                                (CC1120_PKT_CFG2_PKT_FORMAT_SYNCHRONOUS_SERIAL << CC1120_PKT_CFG2_PKT_FORMAT)),
+       AO_CC1120_INT_GPIO_IOCFG,               CC1120_IOCFG_GPIO_CFG_CLKEN_SOFT,
+};
+
+/*
+ * RDF deviation is 5kHz
+ *
+ *     fdev = fosc >> 24 * (256 + dev_m) << dev_e
+ *
+ *             32e6Hz / (2 ** 24) * (256 + 71) * (2 ** 3) = 4989
+ */
+
+#define RDF_DEV_E      3
+#define RDF_DEV_M      71
+#define RDF_PACKET_LEN 50
+
+/*
+ * For our RDF beacon, set the symbol rate to 2kBaud (for a 1kHz tone)
+ *
+ *              (2**20 + DATARATE_M) * 2 ** DATARATE_E
+ *     Rdata = -------------------------------------- * fosc
+ *                          2 ** 39
+ *
+ *     DATARATE_M = 25166
+ *     DATARATE_E = 5
+ *
+ * To make the tone last for 200ms, we need 2000 * .2 = 400 bits or 50 bytes
+ */
+#define RDF_DRATE_E    5
+#define RDF_DRATE_M    25166
+#define RDF_PACKET_LEN 50
+
+static const uint16_t rdf_setup[] = {
+       CC1120_DEVIATION_M,     RDF_DEV_M,
+       CC1120_MODCFG_DEV_E,    ((CC1120_MODCFG_DEV_E_MODEM_MODE_NORMAL << CC1120_MODCFG_DEV_E_MODEM_MODE) |
+                                (CC1120_MODCFG_DEV_E_MOD_FORMAT_2_GFSK << CC1120_MODCFG_DEV_E_MOD_FORMAT) |
+                                (RDF_DEV_E << CC1120_MODCFG_DEV_E_DEV_E)),
+       CC1120_DRATE2,          ((RDF_DRATE_E << CC1120_DRATE2_DATARATE_E) |
+                                (((RDF_DRATE_M >> 16) & CC1120_DRATE2_DATARATE_M_19_16_MASK) << CC1120_DRATE2_DATARATE_M_19_16)),
+       CC1120_DRATE1,          ((RDF_DRATE_M >> 8) & 0xff),
+       CC1120_DRATE0,          ((RDF_DRATE_M >> 0) & 0xff),
+       CC1120_PKT_CFG2,        ((CC1120_PKT_CFG2_CCA_MODE_ALWAYS_CLEAR << CC1120_PKT_CFG2_CCA_MODE) |
+                                (CC1120_PKT_CFG2_PKT_FORMAT_NORMAL << CC1120_PKT_CFG2_PKT_FORMAT)),
+       CC1120_PKT_CFG1,        ((0 << CC1120_PKT_CFG1_WHITE_DATA) |
+                                (CC1120_PKT_CFG1_ADDR_CHECK_CFG_NONE << CC1120_PKT_CFG1_ADDR_CHECK_CFG) |
+                                (CC1120_PKT_CFG1_CRC_CFG_DISABLED << CC1120_PKT_CFG1_CRC_CFG) |
+                                (0 << CC1120_PKT_CFG1_APPEND_STATUS)),
+       CC1120_PKT_CFG0,        ((0 << CC1120_PKT_CFG0_RESERVED7) |
+                                (CC1120_PKT_CFG0_LENGTH_CONFIG_FIXED << CC1120_PKT_CFG0_LENGTH_CONFIG) |
+                                (0 << CC1120_PKT_CFG0_PKG_BIT_LEN) |
+                                (0 << CC1120_PKT_CFG0_UART_MODE_EN) |
+                                (0 << CC1120_PKT_CFG0_UART_SWAP_EN)),
+};
+
+/*
+ * APRS deviation is 5kHz
+ *
+ *     fdev = fosc >> 24 * (256 + dev_m) << dev_e
+ *
+ *             32e6Hz / (2 ** 24) * (256 + 71) * (2 ** 3) = 4989
+ */
+
+#define APRS_DEV_E     3
+#define APRS_DEV_M     71
+#define APRS_PACKET_LEN        50
+
+/*
+ * For our APRS beacon, set the symbol rate to 9.6kBaud (8x oversampling for 1200 baud data rate)
+ *
+ *              (2**20 + DATARATE_M) * 2 ** DATARATE_E
+ *     Rdata = -------------------------------------- * fosc
+ *                          2 ** 39
+ *
+ *     DATARATE_M = 239914
+ *     DATARATE_E = 7
+ *
+ *     Rdata = 9599.998593330383301
+ *
+ */
+#define APRS_DRATE_E   7
+#define APRS_DRATE_M   239914
+
+static const uint16_t aprs_setup[] = {
+       CC1120_DEVIATION_M,     APRS_DEV_M,
+       CC1120_MODCFG_DEV_E,    ((CC1120_MODCFG_DEV_E_MODEM_MODE_NORMAL << CC1120_MODCFG_DEV_E_MODEM_MODE) |
+                                (CC1120_MODCFG_DEV_E_MOD_FORMAT_2_GFSK << CC1120_MODCFG_DEV_E_MOD_FORMAT) |
+                                (APRS_DEV_E << CC1120_MODCFG_DEV_E_DEV_E)),
+       CC1120_DRATE2,          ((APRS_DRATE_E << CC1120_DRATE2_DATARATE_E) |
+                                (((APRS_DRATE_M >> 16) & CC1120_DRATE2_DATARATE_M_19_16_MASK) << CC1120_DRATE2_DATARATE_M_19_16)),
+       CC1120_DRATE1,          ((APRS_DRATE_M >> 8) & 0xff),
+       CC1120_DRATE0,          ((APRS_DRATE_M >> 0) & 0xff),
+       CC1120_PKT_CFG2,        ((CC1120_PKT_CFG2_CCA_MODE_ALWAYS_CLEAR << CC1120_PKT_CFG2_CCA_MODE) |
+                                (CC1120_PKT_CFG2_PKT_FORMAT_NORMAL << CC1120_PKT_CFG2_PKT_FORMAT)),
+       CC1120_PKT_CFG1,        ((0 << CC1120_PKT_CFG1_WHITE_DATA) |
+                                (CC1120_PKT_CFG1_ADDR_CHECK_CFG_NONE << CC1120_PKT_CFG1_ADDR_CHECK_CFG) |
+                                (CC1120_PKT_CFG1_CRC_CFG_DISABLED << CC1120_PKT_CFG1_CRC_CFG) |
+                                (0 << CC1120_PKT_CFG1_APPEND_STATUS)),
+};
+
+#define AO_PKT_CFG0_INFINITE ((0 << CC1120_PKT_CFG0_RESERVED7) |       \
+                             (CC1120_PKT_CFG0_LENGTH_CONFIG_INFINITE << CC1120_PKT_CFG0_LENGTH_CONFIG) | \
+                             (0 << CC1120_PKT_CFG0_PKG_BIT_LEN) |      \
+                             (0 << CC1120_PKT_CFG0_UART_MODE_EN) |     \
+                             (0 << CC1120_PKT_CFG0_UART_SWAP_EN))
+
+#define AO_PKT_CFG0_FIXED ((0 << CC1120_PKT_CFG0_RESERVED7) |          \
+                          (CC1120_PKT_CFG0_LENGTH_CONFIG_FIXED << CC1120_PKT_CFG0_LENGTH_CONFIG) | \
+                          (0 << CC1120_PKT_CFG0_PKG_BIT_LEN) |         \
+                          (0 << CC1120_PKT_CFG0_UART_MODE_EN) |        \
+                          (0 << CC1120_PKT_CFG0_UART_SWAP_EN))
+
+static uint16_t ao_radio_mode;
+
+#define AO_RADIO_MODE_BITS_PACKET      1
+#define AO_RADIO_MODE_BITS_PACKET_TX   2
+#define AO_RADIO_MODE_BITS_TX_BUF      4
+#define AO_RADIO_MODE_BITS_TX_FINISH   8
+#define AO_RADIO_MODE_BITS_PACKET_RX   16
+#define AO_RADIO_MODE_BITS_RDF         32
+#define AO_RADIO_MODE_BITS_APRS                64
+#define AO_RADIO_MODE_BITS_INFINITE    128
+#define AO_RADIO_MODE_BITS_FIXED       256
+
+#define AO_RADIO_MODE_NONE             0
+#define AO_RADIO_MODE_PACKET_TX_BUF    (AO_RADIO_MODE_BITS_PACKET | AO_RADIO_MODE_BITS_PACKET_TX | AO_RADIO_MODE_BITS_TX_BUF)
+#define AO_RADIO_MODE_PACKET_TX_FINISH (AO_RADIO_MODE_BITS_PACKET | AO_RADIO_MODE_BITS_PACKET_TX | AO_RADIO_MODE_BITS_TX_FINISH)
+#define AO_RADIO_MODE_PACKET_RX                (AO_RADIO_MODE_BITS_PACKET | AO_RADIO_MODE_BITS_PACKET_RX)
+#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)
+               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_PACKET_TX)
+               for (i = 0; i < sizeof (packet_tx_setup) / sizeof (packet_tx_setup[0]); i += 2)
+                       ao_radio_reg_write(packet_tx_setup[i], packet_tx_setup[i+1]);
+               
+       if (changes & AO_RADIO_MODE_BITS_TX_BUF)
+               ao_radio_reg_write(AO_CC1120_INT_GPIO_IOCFG, CC1120_IOCFG_GPIO_CFG_TXFIFO_THR);
+
+       if (changes & AO_RADIO_MODE_BITS_TX_FINISH)
+               ao_radio_reg_write(AO_CC1120_INT_GPIO_IOCFG, CC1120_IOCFG_GPIO_CFG_RX0TX1_CFG);
+
+       if (changes & AO_RADIO_MODE_BITS_PACKET_RX)
+               for (i = 0; i < sizeof (packet_rx_setup) / sizeof (packet_rx_setup[0]); i += 2)
+                       ao_radio_reg_write(packet_rx_setup[i], packet_rx_setup[i+1]);
+               
+       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(CC1120_PKT_CFG0, AO_PKT_CFG0_INFINITE);
+
+       if (changes & AO_RADIO_MODE_BITS_FIXED)
+               ao_radio_reg_write(CC1120_PKT_CFG0, AO_PKT_CFG0_FIXED);
+
+       ao_radio_mode = new_mode;
+}
+
+static const uint16_t radio_setup[] = {
+#include "ao_cc1120_CC1120.h"
+};
+
+static uint8_t ao_radio_configured = 0;
+
+static void
+ao_radio_setup(void)
+{
+       int     i;
+
+       ao_radio_strobe(CC1120_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(CC1120_PKT_LEN, 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(CC1120_FREQ2, ao_config.radio_setting >> 16);
+               ao_radio_reg_write(CC1120_FREQ1, ao_config.radio_setting >> 8);
+               ao_radio_reg_write(CC1120_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_marc_status();
+       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(CC1120_STX);
+#if CC1120_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_marc_status();
+}
+
+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 = CC1120_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_CC1120_INT_PORT, AO_CC1120_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 = CC1120_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_CC1120_INT_PORT, AO_CC1120_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 uint8_t rx_data[(AO_RADIO_MAX_RECV + 4) * 2 * 8];
+static uint16_t        rx_data_count;
+static uint16_t        rx_data_consumed;
+static uint16_t rx_data_cur;
+static uint8_t rx_ignore;
+static uint8_t rx_waiting;
+
+#if AO_PROFILE
+static uint32_t        rx_start_tick, rx_packet_tick, rx_done_tick, rx_last_done_tick;
+
+uint32_t       ao_rx_start_tick, ao_rx_packet_tick, ao_rx_done_tick, ao_rx_last_done_tick;
+
+#include <ao_profile.h>
+#endif
+
+static void
+ao_radio_rx_isr(void)
+{
+       uint8_t d;
+
+       d = AO_CC1120_SPI.dr;
+       AO_CC1120_SPI.dr = 0;
+       if (rx_ignore == 0) {
+               if (rx_data_cur >= rx_data_count)
+                       ao_exti_disable(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN);
+               else
+                       rx_data[rx_data_cur++] = d;
+               if (rx_waiting && rx_data_cur - rx_data_consumed >= AO_FEC_DECODE_BLOCK) {
+#if AO_PROFILE
+                       if (!rx_packet_tick)
+                               rx_packet_tick = ao_profile_tick();
+                       if (rx_data_cur < rx_data_count)
+                               return;
+#endif
+                       rx_waiting = 0;
+                       ao_wakeup(&ao_radio_wake);
+               }
+       } else {
+               --rx_ignore;
+       }
+}
+
+static uint16_t
+ao_radio_rx_wait(void)
+{
+       do {
+               if (ao_radio_mcu_wake)
+                       ao_radio_check_marc_status();
+               ao_alarm(AO_MS_TO_TICKS(100));
+               ao_arch_block_interrupts();
+               rx_waiting = 1;
+               while (rx_data_cur - rx_data_consumed < AO_FEC_DECODE_BLOCK &&
+                      !ao_radio_abort &&
+                      !ao_radio_mcu_wake)
+               {
+                       if (ao_sleep(&ao_radio_wake))
+                               ao_radio_abort = 1;
+               }
+               rx_waiting = 0;
+               ao_arch_release_interrupts();
+               ao_clear_alarm();
+       } while (ao_radio_mcu_wake);
+       if (ao_radio_abort)
+               return 0;
+       rx_data_consumed += AO_FEC_DECODE_BLOCK;
+#if AO_PROFILE
+       return rx_data_cur - rx_data_consumed;
+#endif
+       return AO_FEC_DECODE_BLOCK;
+}
+
+uint8_t
+ao_radio_recv(__xdata void *d, uint8_t size)
+{
+       uint8_t         len;
+       uint16_t        i;
+       uint8_t         rssi;
+       uint8_t         ret;
+       static int been_here = 0;
+
+       size -= 2;                      /* status bytes */
+       if (size > AO_RADIO_MAX_RECV) {
+               ao_delay(AO_SEC_TO_TICKS(1));
+               return 0;
+       }
+#if AO_PROFILE
+       rx_start_tick = ao_profile_tick();
+       rx_packet_tick = 0;
+#endif
+       len = size + 2;                 /* CRC bytes */
+       len += 1 + ~(len & 1);          /* 1 or two pad bytes */
+       len *= 2;                       /* 1/2 rate convolution */
+       rx_data_count = len * 8;        /* bytes to bits */
+       rx_data_cur = 0;
+       rx_data_consumed = 0;
+       rx_ignore = 2;
+
+       /* Must be set before changing the frequency; any abort
+        * after the frequency is set needs to terminate the read
+        * so that the registers can be reprogrammed
+        */
+       ao_radio_abort = 0;
+
+       /* configure interrupt pin */
+       ao_radio_get(len);
+       ao_radio_set_mode(AO_RADIO_MODE_PACKET_RX);
+
+       ao_radio_wake = 0;
+       ao_radio_mcu_wake = 0;
+
+       AO_CC1120_SPI.cr2 = 0;
+
+       /* clear any RXNE */
+       (void) AO_CC1120_SPI.dr;
+
+       /* Have the radio signal when the preamble quality goes high */
+       ao_radio_reg_write(AO_CC1120_INT_GPIO_IOCFG, CC1120_IOCFG_GPIO_CFG_PQT_REACHED);
+       ao_exti_set_mode(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN,
+                        AO_EXTI_MODE_RISING|AO_EXTI_PRIORITY_HIGH);
+       ao_exti_set_callback(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN, ao_radio_isr);
+       ao_exti_enable(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN);
+       ao_exti_enable(AO_CC1120_MCU_WAKEUP_PORT, AO_CC1120_MCU_WAKEUP_PIN);
+
+       ao_radio_strobe(CC1120_SRX);
+
+       /* Wait for the preamble to appear */
+       ao_radio_wait_isr();
+       if (ao_radio_abort)
+               goto abort;
+
+       ao_radio_reg_write(AO_CC1120_INT_GPIO_IOCFG, CC1120_IOCFG_GPIO_CFG_CLKEN_SOFT);
+       ao_exti_set_mode(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN,
+                        AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_HIGH);
+
+       ao_exti_set_callback(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN, ao_radio_rx_isr);
+       ao_exti_enable(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN);
+
+       ao_radio_burst_read_start(CC1120_SOFT_RX_DATA_OUT);
+
+       ret = ao_fec_decode(rx_data, rx_data_count, d, size + 2, ao_radio_rx_wait);
+
+       ao_radio_burst_read_stop();
+
+abort:
+       ao_radio_strobe(CC1120_SIDLE);
+
+       /* Convert from 'real' rssi to cc1111-style values */
+
+       rssi = AO_RADIO_FROM_RSSI(ao_radio_reg_read(CC1120_RSSI1));
+
+       ao_radio_put();
+
+       /* Store the received RSSI value; the crc-OK byte is already done */
+
+       ((uint8_t *) d)[size] = (uint8_t) rssi;
+
+#if AO_PROFILE
+       rx_last_done_tick = rx_done_tick;
+       rx_done_tick = ao_profile_tick();
+
+       ao_rx_start_tick = rx_start_tick;
+       ao_rx_packet_tick = rx_packet_tick;
+       ao_rx_done_tick = rx_done_tick;
+       ao_rx_last_done_tick = rx_last_done_tick;
+#endif
+
+       return ret;
+}
+
+
+#if CC1120_DEBUG
+static char *cc1120_state_name[] = {
+       [CC1120_STATUS_STATE_IDLE] = "IDLE",
+       [CC1120_STATUS_STATE_RX] = "RX",
+       [CC1120_STATUS_STATE_TX] = "TX",
+       [CC1120_STATUS_STATE_FSTXON] = "FSTXON",
+       [CC1120_STATUS_STATE_CALIBRATE] = "CALIBRATE",
+       [CC1120_STATUS_STATE_SETTLING] = "SETTLING",
+       [CC1120_STATUS_STATE_RX_FIFO_ERROR] = "RX_FIFO_ERROR",
+       [CC1120_STATUS_STATE_TX_FIFO_ERROR] = "TX_FIFO_ERROR",
+};
+
+struct ao_cc1120_reg {
+       uint16_t        addr;
+       char            *name;
+};
+
+const static struct ao_cc1120_reg ao_cc1120_reg[] = {
+       { .addr = CC1120_IOCFG3,        .name = "IOCFG3" },
+       { .addr = CC1120_IOCFG2,        .name = "IOCFG2" },
+       { .addr = CC1120_IOCFG1,        .name = "IOCFG1" },
+       { .addr = CC1120_IOCFG0,        .name = "IOCFG0" },
+       { .addr = CC1120_SYNC3, .name = "SYNC3" },
+       { .addr = CC1120_SYNC2, .name = "SYNC2" },
+       { .addr = CC1120_SYNC1, .name = "SYNC1" },
+       { .addr = CC1120_SYNC0, .name = "SYNC0" },
+       { .addr = CC1120_SYNC_CFG1,     .name = "SYNC_CFG1" },
+       { .addr = CC1120_SYNC_CFG0,     .name = "SYNC_CFG0" },
+       { .addr = CC1120_DEVIATION_M,   .name = "DEVIATION_M" },
+       { .addr = CC1120_MODCFG_DEV_E,  .name = "MODCFG_DEV_E" },
+       { .addr = CC1120_DCFILT_CFG,    .name = "DCFILT_CFG" },
+       { .addr = CC1120_PREAMBLE_CFG1, .name = "PREAMBLE_CFG1" },
+       { .addr = CC1120_PREAMBLE_CFG0, .name = "PREAMBLE_CFG0" },
+       { .addr = CC1120_FREQ_IF_CFG,   .name = "FREQ_IF_CFG" },
+       { .addr = CC1120_IQIC,  .name = "IQIC" },
+       { .addr = CC1120_CHAN_BW,       .name = "CHAN_BW" },
+       { .addr = CC1120_MDMCFG1,       .name = "MDMCFG1" },
+       { .addr = CC1120_MDMCFG0,       .name = "MDMCFG0" },
+       { .addr = CC1120_DRATE2,        .name = "DRATE2" },
+       { .addr = CC1120_DRATE1,        .name = "DRATE1" },
+       { .addr = CC1120_DRATE0,        .name = "DRATE0" },
+       { .addr = CC1120_AGC_REF,       .name = "AGC_REF" },
+       { .addr = CC1120_AGC_CS_THR,    .name = "AGC_CS_THR" },
+       { .addr = CC1120_AGC_GAIN_ADJUST,       .name = "AGC_GAIN_ADJUST" },
+       { .addr = CC1120_AGC_CFG3,      .name = "AGC_CFG3" },
+       { .addr = CC1120_AGC_CFG2,      .name = "AGC_CFG2" },
+       { .addr = CC1120_AGC_CFG1,      .name = "AGC_CFG1" },
+       { .addr = CC1120_AGC_CFG0,      .name = "AGC_CFG0" },
+       { .addr = CC1120_FIFO_CFG,      .name = "FIFO_CFG" },
+       { .addr = CC1120_DEV_ADDR,      .name = "DEV_ADDR" },
+       { .addr = CC1120_SETTLING_CFG,  .name = "SETTLING_CFG" },
+       { .addr = CC1120_FS_CFG,        .name = "FS_CFG" },
+       { .addr = CC1120_WOR_CFG1,      .name = "WOR_CFG1" },
+       { .addr = CC1120_WOR_CFG0,      .name = "WOR_CFG0" },
+       { .addr = CC1120_WOR_EVENT0_MSB,        .name = "WOR_EVENT0_MSB" },
+       { .addr = CC1120_WOR_EVENT0_LSB,        .name = "WOR_EVENT0_LSB" },
+       { .addr = CC1120_PKT_CFG2,      .name = "PKT_CFG2" },
+       { .addr = CC1120_PKT_CFG1,      .name = "PKT_CFG1" },
+       { .addr = CC1120_PKT_CFG0,      .name = "PKT_CFG0" },
+       { .addr = CC1120_RFEND_CFG1,    .name = "RFEND_CFG1" },
+       { .addr = CC1120_RFEND_CFG0,    .name = "RFEND_CFG0" },
+       { .addr = CC1120_PA_CFG2,       .name = "PA_CFG2" },
+       { .addr = CC1120_PA_CFG1,       .name = "PA_CFG1" },
+       { .addr = CC1120_PA_CFG0,       .name = "PA_CFG0" },
+       { .addr = CC1120_PKT_LEN,       .name = "PKT_LEN" },
+       { .addr = CC1120_IF_MIX_CFG,    .name = "IF_MIX_CFG" },
+       { .addr = CC1120_FREQOFF_CFG,   .name = "FREQOFF_CFG" },
+       { .addr = CC1120_TOC_CFG,       .name = "TOC_CFG" },
+       { .addr = CC1120_MARC_SPARE,    .name = "MARC_SPARE" },
+       { .addr = CC1120_ECG_CFG,       .name = "ECG_CFG" },
+       { .addr = CC1120_SOFT_TX_DATA_CFG,      .name = "SOFT_TX_DATA_CFG" },
+       { .addr = CC1120_EXT_CTRL,      .name = "EXT_CTRL" },
+       { .addr = CC1120_RCCAL_FINE,    .name = "RCCAL_FINE" },
+       { .addr = CC1120_RCCAL_COARSE,  .name = "RCCAL_COARSE" },
+       { .addr = CC1120_RCCAL_OFFSET,  .name = "RCCAL_OFFSET" },
+       { .addr = CC1120_FREQOFF1,      .name = "FREQOFF1" },
+       { .addr = CC1120_FREQOFF0,      .name = "FREQOFF0" },
+       { .addr = CC1120_FREQ2, .name = "FREQ2" },
+       { .addr = CC1120_FREQ1, .name = "FREQ1" },
+       { .addr = CC1120_FREQ0, .name = "FREQ0" },
+       { .addr = CC1120_IF_ADC2,       .name = "IF_ADC2" },
+       { .addr = CC1120_IF_ADC1,       .name = "IF_ADC1" },
+       { .addr = CC1120_IF_ADC0,       .name = "IF_ADC0" },
+       { .addr = CC1120_FS_DIG1,       .name = "FS_DIG1" },
+       { .addr = CC1120_FS_DIG0,       .name = "FS_DIG0" },
+       { .addr = CC1120_FS_CAL3,       .name = "FS_CAL3" },
+       { .addr = CC1120_FS_CAL2,       .name = "FS_CAL2" },
+       { .addr = CC1120_FS_CAL1,       .name = "FS_CAL1" },
+       { .addr = CC1120_FS_CAL0,       .name = "FS_CAL0" },
+       { .addr = CC1120_FS_CHP,        .name = "FS_CHP" },
+       { .addr = CC1120_FS_DIVTWO,     .name = "FS_DIVTWO" },
+       { .addr = CC1120_FS_DSM1,       .name = "FS_DSM1" },
+       { .addr = CC1120_FS_DSM0,       .name = "FS_DSM0" },
+       { .addr = CC1120_FS_DVC1,       .name = "FS_DVC1" },
+       { .addr = CC1120_FS_DVC0,       .name = "FS_DVC0" },
+       { .addr = CC1120_FS_LBI,        .name = "FS_LBI" },
+       { .addr = CC1120_FS_PFD,        .name = "FS_PFD" },
+       { .addr = CC1120_FS_PRE,        .name = "FS_PRE" },
+       { .addr = CC1120_FS_REG_DIV_CML,        .name = "FS_REG_DIV_CML" },
+       { .addr = CC1120_FS_SPARE,      .name = "FS_SPARE" },
+       { .addr = CC1120_FS_VCO4,       .name = "FS_VCO4" },
+       { .addr = CC1120_FS_VCO3,       .name = "FS_VCO3" },
+       { .addr = CC1120_FS_VCO2,       .name = "FS_VCO2" },
+       { .addr = CC1120_FS_VCO1,       .name = "FS_VCO1" },
+       { .addr = CC1120_FS_VCO0,       .name = "FS_VCO0" },
+       { .addr = CC1120_GBIAS6,        .name = "GBIAS6" },
+       { .addr = CC1120_GBIAS5,        .name = "GBIAS5" },
+       { .addr = CC1120_GBIAS4,        .name = "GBIAS4" },
+       { .addr = CC1120_GBIAS3,        .name = "GBIAS3" },
+       { .addr = CC1120_GBIAS2,        .name = "GBIAS2" },
+       { .addr = CC1120_GBIAS1,        .name = "GBIAS1" },
+       { .addr = CC1120_GBIAS0,        .name = "GBIAS0" },
+       { .addr = CC1120_IFAMP, .name = "IFAMP" },
+       { .addr = CC1120_LNA,   .name = "LNA" },
+       { .addr = CC1120_RXMIX, .name = "RXMIX" },
+       { .addr = CC1120_XOSC5, .name = "XOSC5" },
+       { .addr = CC1120_XOSC4, .name = "XOSC4" },
+       { .addr = CC1120_XOSC3, .name = "XOSC3" },
+       { .addr = CC1120_XOSC2, .name = "XOSC2" },
+       { .addr = CC1120_XOSC1, .name = "XOSC1" },
+       { .addr = CC1120_XOSC0, .name = "XOSC0" },
+       { .addr = CC1120_ANALOG_SPARE,  .name = "ANALOG_SPARE" },
+       { .addr = CC1120_PA_CFG3,       .name = "PA_CFG3" },
+       { .addr = CC1120_WOR_TIME1,     .name = "WOR_TIME1" },
+       { .addr = CC1120_WOR_TIME0,     .name = "WOR_TIME0" },
+       { .addr = CC1120_WOR_CAPTURE1,  .name = "WOR_CAPTURE1" },
+       { .addr = CC1120_WOR_CAPTURE0,  .name = "WOR_CAPTURE0" },
+       { .addr = CC1120_BIST,  .name = "BIST" },
+       { .addr = CC1120_DCFILTOFFSET_I1,       .name = "DCFILTOFFSET_I1" },
+       { .addr = CC1120_DCFILTOFFSET_I0,       .name = "DCFILTOFFSET_I0" },
+       { .addr = CC1120_DCFILTOFFSET_Q1,       .name = "DCFILTOFFSET_Q1" },
+       { .addr = CC1120_DCFILTOFFSET_Q0,       .name = "DCFILTOFFSET_Q0" },
+       { .addr = CC1120_IQIE_I1,       .name = "IQIE_I1" },
+       { .addr = CC1120_IQIE_I0,       .name = "IQIE_I0" },
+       { .addr = CC1120_IQIE_Q1,       .name = "IQIE_Q1" },
+       { .addr = CC1120_IQIE_Q0,       .name = "IQIE_Q0" },
+       { .addr = CC1120_RSSI1, .name = "RSSI1" },
+       { .addr = CC1120_RSSI0, .name = "RSSI0" },
+       { .addr = CC1120_MARCSTATE,     .name = "MARCSTATE" },
+       { .addr = CC1120_LQI_VAL,       .name = "LQI_VAL" },
+       { .addr = CC1120_PQT_SYNC_ERR,  .name = "PQT_SYNC_ERR" },
+       { .addr = CC1120_DEM_STATUS,    .name = "DEM_STATUS" },
+       { .addr = CC1120_FREQOFF_EST1,  .name = "FREQOFF_EST1" },
+       { .addr = CC1120_FREQOFF_EST0,  .name = "FREQOFF_EST0" },
+       { .addr = CC1120_AGC_GAIN3,     .name = "AGC_GAIN3" },
+       { .addr = CC1120_AGC_GAIN2,     .name = "AGC_GAIN2" },
+       { .addr = CC1120_AGC_GAIN1,     .name = "AGC_GAIN1" },
+       { .addr = CC1120_AGC_GAIN0,     .name = "AGC_GAIN0" },
+       { .addr = CC1120_SOFT_RX_DATA_OUT,      .name = "SOFT_RX_DATA_OUT" },
+       { .addr = CC1120_SOFT_TX_DATA_IN,       .name = "SOFT_TX_DATA_IN" },
+       { .addr = CC1120_ASK_SOFT_RX_DATA,      .name = "ASK_SOFT_RX_DATA" },
+       { .addr = CC1120_RNDGEN,        .name = "RNDGEN" },
+       { .addr = CC1120_MAGN2, .name = "MAGN2" },
+       { .addr = CC1120_MAGN1, .name = "MAGN1" },
+       { .addr = CC1120_MAGN0, .name = "MAGN0" },
+       { .addr = CC1120_ANG1,  .name = "ANG1" },
+       { .addr = CC1120_ANG0,  .name = "ANG0" },
+       { .addr = CC1120_CHFILT_I2,     .name = "CHFILT_I2" },
+       { .addr = CC1120_CHFILT_I1,     .name = "CHFILT_I1" },
+       { .addr = CC1120_CHFILT_I0,     .name = "CHFILT_I0" },
+       { .addr = CC1120_CHFILT_Q2,     .name = "CHFILT_Q2" },
+       { .addr = CC1120_CHFILT_Q1,     .name = "CHFILT_Q1" },
+       { .addr = CC1120_CHFILT_Q0,     .name = "CHFILT_Q0" },
+       { .addr = CC1120_GPIO_STATUS,   .name = "GPIO_STATUS" },
+       { .addr = CC1120_FSCAL_CTRL,    .name = "FSCAL_CTRL" },
+       { .addr = CC1120_PHASE_ADJUST,  .name = "PHASE_ADJUST" },
+       { .addr = CC1120_PARTNUMBER,    .name = "PARTNUMBER" },
+       { .addr = CC1120_PARTVERSION,   .name = "PARTVERSION" },
+       { .addr = CC1120_SERIAL_STATUS, .name = "SERIAL_STATUS" },
+       { .addr = CC1120_RX_STATUS,     .name = "RX_STATUS" },
+       { .addr = CC1120_TX_STATUS,     .name = "TX_STATUS" },
+       { .addr = CC1120_MARC_STATUS1,  .name = "MARC_STATUS1" },
+       { .addr = CC1120_MARC_STATUS0,  .name = "MARC_STATUS0" },
+       { .addr = CC1120_PA_IFAMP_TEST, .name = "PA_IFAMP_TEST" },
+       { .addr = CC1120_FSRF_TEST,     .name = "FSRF_TEST" },
+       { .addr = CC1120_PRE_TEST,      .name = "PRE_TEST" },
+       { .addr = CC1120_PRE_OVR,       .name = "PRE_OVR" },
+       { .addr = CC1120_ADC_TEST,      .name = "ADC_TEST" },
+       { .addr = CC1120_DVC_TEST,      .name = "DVC_TEST" },
+       { .addr = CC1120_ATEST, .name = "ATEST" },
+       { .addr = CC1120_ATEST_LVDS,    .name = "ATEST_LVDS" },
+       { .addr = CC1120_ATEST_MODE,    .name = "ATEST_MODE" },
+       { .addr = CC1120_XOSC_TEST1,    .name = "XOSC_TEST1" },
+       { .addr = CC1120_XOSC_TEST0,    .name = "XOSC_TEST0" },
+       { .addr = CC1120_RXFIRST,       .name = "RXFIRST" },
+       { .addr = CC1120_TXFIRST,       .name = "TXFIRST" },
+       { .addr = CC1120_RXLAST,        .name = "RXLAST" },
+       { .addr = CC1120_TXLAST,        .name = "TXLAST" },
+       { .addr = CC1120_NUM_TXBYTES,   .name = "NUM_TXBYTES" },
+       { .addr = CC1120_NUM_RXBYTES,   .name = "NUM_RXBYTES" },
+       { .addr = CC1120_FIFO_NUM_TXBYTES,      .name = "FIFO_NUM_TXBYTES" },
+       { .addr = CC1120_FIFO_NUM_RXBYTES,      .name = "FIFO_NUM_RXBYTES" },
+};
+
+#define AO_NUM_CC1120_REG      (sizeof ao_cc1120_reg / sizeof ao_cc1120_reg[0])
+
+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 >> CC1120_STATUS_CHIP_RDY) & 1);
+       printf ("STATE:    %s\n", cc1120_state_name[(status >> CC1120_STATUS_STATE) & CC1120_STATUS_STATE_MASK]);
+       printf ("MARC:     %02x\n", ao_radio_get_marc_status());
+
+       for (i = 0; i < AO_NUM_CC1120_REG; i++)
+               printf ("\t%02x %-20.20s\n", ao_radio_reg_read(ao_cc1120_reg[i].addr), ao_cc1120_reg[i].name);
+       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));
+}
+
+void
+ao_radio_test_recv()
+{
+       uint8_t bytes[34];
+       uint8_t b;
+
+       if (ao_radio_recv(bytes, 34)) {
+               if (bytes[33] & 0x80)
+                       printf ("CRC OK");
+               else
+                       printf ("CRC BAD");
+               printf (" RSSI %d", AO_RSSI_FROM_RADIO(bytes[32]));
+               for (b = 0; b < 32; b++)
+                       printf (" %02x", bytes[b]);
+               printf ("\n");
+       }
+}
+
+#if HAS_APRS
+#include <ao_aprs.h>
+
+static void
+ao_radio_aprs()
+{
+       ao_packet_slave_stop();
+       ao_aprs_send();
+}
+#endif
+
+#endif
+
+static const struct ao_cmds ao_radio_cmds[] = {
+       { ao_radio_test_cmd,    "C <1 start, 0 stop, none both>\0Radio carrier test" },
+#if CC1120_DEBUG
+#if HAS_APRS
+       { ao_radio_aprs,        "G\0Send APRS packet" },
+#endif
+       { ao_radio_show,        "R\0Show CC1120 status" },
+       { ao_radio_beep,        "b\0Emit an RDF beacon" },
+       { ao_radio_packet,      "p\0Send a test packet" },
+       { ao_radio_test_recv,   "q\0Recv a test packet" },
+#endif
+       { 0, NULL }
+};
+
+void
+ao_radio_init(void)
+{
+       int     i;
+
+       ao_radio_configured = 0;
+       ao_spi_init_cs (AO_CC1120_SPI_CS_PORT, (1 << AO_CC1120_SPI_CS_PIN));
+
+#if 0
+       AO_CC1120_SPI_CS_PORT->bsrr = ((uint32_t) (1 << AO_CC1120_SPI_CS_PIN));
+       for (i = 0; i < 10000; i++) {
+               if ((SPI_2_PORT->idr & (1 << SPI_2_MISO_PIN)) == 0)
+                       break;
+       }
+       AO_CC1120_SPI_CS_PORT->bsrr = (1 << AO_CC1120_SPI_CS_PIN);
+       if (i == 10000)
+               ao_panic(AO_PANIC_SELF_TEST_CC1120);
+#endif
+
+       /* Enable the EXTI interrupt for the appropriate pin */
+       ao_enable_port(AO_CC1120_INT_PORT);
+       ao_exti_setup(AO_CC1120_INT_PORT, AO_CC1120_INT_PIN,
+                     AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_HIGH,
+                     ao_radio_isr);
+
+       /* Enable the hacked up GPIO3 pin */
+       ao_enable_port(AO_CC1120_MCU_WAKEUP_PORT);
+       ao_exti_setup(AO_CC1120_MCU_WAKEUP_PORT, AO_CC1120_MCU_WAKEUP_PIN,
+                     AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_MED,
+                     ao_radio_mcu_wakeup_isr);
+
+       ao_cmd_register(&ao_radio_cmds[0]);
 }