Switch from GPLv2 to GPLv2+
[fw/altos] / src / drivers / ao_cc115l.c
index fd8bb1f02a2e9fda064307c7e4ab53ec6d7d9953..a67071d24d879c44e348bb8ecb5ff8831e624e9c 100644 (file)
@@ -3,7 +3,8 @@
  *
  * 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.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
 
 #define AO_RADIO_MAX_SEND      sizeof (struct ao_telemetry_generic)
 
-static uint8_t ao_radio_mutex;
+uint8_t ao_radio_mutex;
 
-static uint8_t ao_radio_wake;          /* radio ready. Also used as sleep address */
+static uint8_t ao_radio_fifo;          /* fifo drained interrupt received */
+static uint8_t ao_radio_done;          /* tx done interrupt received */
+static uint8_t ao_radio_wake;          /* sleep address for radio interrupts */
 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
+/* Debugging commands */
+#define CC115L_DEBUG   0
 
-extern const uint32_t  ao_radio_cal;
+/* Runtime tracing */
+#define CC115L_TRACE   0
 
 #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_select()      ao_spi_get_mask(AO_CC115L_SPI_CS_PORT,(1 << AO_CC115L_SPI_CS_PIN),AO_CC115L_SPI_BUS,AO_SPI_SPEED_6MHz)
 #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;
+struct ao_cc115l_reg {
+       uint16_t        addr;
+       char            *name;
+};
 
 #if CC115L_TRACE
-       printf("\t\tao_radio_reg_read (%04x): ", addr); flush();
+
+static const struct ao_cc115l_reg ao_cc115l_reg[];
+static const char *cc115l_state_name[];
+
+enum ao_cc115l_trace_type {
+       trace_strobe,
+       trace_read,
+       trace_write,
+       trace_dma,
+       trace_line,
+};
+
+struct ao_cc115l_trace {
+       enum ao_cc115l_trace_type       type;
+       int16_t                         addr;
+       int16_t                         value;
+       const char                      *comment;
+};
+
+#define NUM_TRACE      32
+
+static struct ao_cc115l_trace  trace[NUM_TRACE];
+static int                     trace_i;
+static int                     trace_disable;
+
+static void trace_add(enum ao_cc115l_trace_type type, int16_t addr, int16_t value, const char *comment)
+{
+       if (trace_disable)
+               return;
+       switch (type) {
+       case trace_read:
+       case trace_write:
+               comment = ao_cc115l_reg[addr].name;
+               break;
+       case trace_strobe:
+               comment = cc115l_state_name[(value >> 4) & 0x7];
+               break;
+       default:
+               break;
+       }
+       trace[trace_i].type = type;
+       trace[trace_i].addr = addr;
+       trace[trace_i].value = value;
+       trace[trace_i].comment = comment;
+       if (++trace_i == NUM_TRACE)
+               trace_i = 0;
+}
+#else
+#define trace_add(t,a,v,c)
 #endif
-       datao[0] = ((1 << CC115L_READ)  |
-                   (0 << CC115L_BURST) |
-                   addr);
+
+static uint8_t
+ao_radio_reg_read(uint8_t addr)
+{
+       uint8_t data[1];
+
+       data[0] = ((1 << CC115L_READ)  |
+                  (0 << CC115L_BURST) |
+                  addr);
        ao_radio_select();
-       ao_radio_duplex(datao, datai, 2);
+       ao_radio_spi_send(data, 1);
+       ao_radio_spi_recv(data, 1);
        ao_radio_deselect();
-#if CC115L_TRACE
-       printf (" %02x\n", datai[1]);
-#endif
-       return datai[1];
+       trace_add(trace_read, addr, data[0], NULL);
+       return data[0];
 }
 
 static void
-ao_radio_reg_write(uint16_t addr, uint8_t value)
+ao_radio_reg_write(uint8_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
+       trace_add(trace_write, addr, value, NULL);
        data[0] = ((0 << CC115L_READ)  |
                   (0 << CC115L_BURST) |
                   addr);
@@ -83,11 +134,11 @@ ao_radio_reg_write(uint16_t addr, uint8_t value)
        ao_radio_deselect();
 }
 
+#if UNUSED
 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) |
@@ -101,6 +152,7 @@ ao_radio_burst_read_stop (void)
 {
        ao_radio_deselect();
 }
+#endif
 
 
 static uint8_t
@@ -108,15 +160,10 @@ 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
+       trace_add(trace_strobe, addr, in, NULL);
        return in;
 }
 
@@ -142,131 +189,161 @@ static uint8_t
 ao_radio_fifo_write(uint8_t *data, uint8_t len)
 {
        uint8_t status = ao_radio_fifo_write_start();
+       trace_add(trace_dma, CC115L_FIFO, len, NULL);
        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);
 }
 
+#if CC115L_DEBUG
 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;
 }
+#endif
 
-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;
-}
+#define ao_radio_rdf_value 0x55
 
 static void
-ao_radio_isr(void)
+ao_radio_done_isr(void)
 {
-       ao_exti_disable(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN);
-       ao_radio_wake = 1;
+       ao_exti_disable(AO_CC115L_DONE_INT_PORT, AO_CC115L_DONE_INT_PIN);
+       trace_add(trace_line, __LINE__, 0, "done_isr");
+       ao_radio_done = 1;
        ao_wakeup(&ao_radio_wake);
 }
 
 static void
-ao_radio_start_tx(void)
+ao_radio_fifo_isr(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);
+       ao_exti_disable(AO_CC115L_FIFO_INT_PORT, AO_CC115L_FIFO_INT_PIN);
+       trace_add(trace_line, __LINE__, 0, "fifo_isr");
+       ao_radio_fifo = 1;
+       ao_wakeup(&ao_radio_wake);
 }
 
 static void
 ao_radio_idle(void)
 {
+       ao_radio_pa_off();
        for (;;) {
                uint8_t state = ao_radio_strobe(CC115L_SIDLE);
                if ((state >> CC115L_STATUS_STATE) == CC115L_STATUS_STATE_IDLE)
                        break;
+               if ((state >> CC115L_STATUS_STATE) == CC115L_STATUS_STATE_TX_FIFO_UNDERFLOW)
+                       ao_radio_strobe(CC115L_SFTX);
        }
        /* Flush any pending TX bytes */
        ao_radio_strobe(CC115L_SFTX);
+       /* Make sure the RF calibration is current */
+       ao_radio_strobe(CC115L_SCAL);
 }
 
 /*
- * Packet deviation is 20.5kHz
+ * Packet deviation
  *
  *     fdev = fosc >> 17 * (8 + dev_m) << dev_e
  *
+ * For 38400 baud, use 20.5kHz:
+ *
  *             26e6 / (2 ** 17) * (8 + 5) * (2 ** 3) = 20630Hz
+ *
+ * For 9600 baud, use 5.125kHz:
+ *
+ *             26e6 / (2 ** 17) * (8 + 5) * (2 ** 1) = 5157Hz
+ *
+ * For 2400 baud, use 1.5kHz:
+ *
+ *             26e6 / (2 ** 17) * (8 + 0) * (2 ** 0) = 1587Hz
  */
 
-#define PACKET_DEV_E   3
-#define PACKET_DEV_M   5
+#define PACKET_DEV_E_384       3
+#define PACKET_DEV_M_384       5
+
+#define PACKET_DEV_E_96                1
+#define PACKET_DEV_M_96                5
+
+#define PACKET_DEV_E_24                0
+#define PACKET_DEV_M_24                0
 
 /*
- * For our packet data, set the symbol rate to 38400 Baud
+ * For our packet data:
  *
  *              (256 + DATARATE_M) * 2 ** DATARATE_E
  *     Rdata = -------------------------------------- * fosc
  *                          2 ** 28
  *
+ * For 38400 baud:
+ *
  *             (256 + 131) * (2 ** 10) / (2**28) * 26e6 = 38383
  *
  *     DATARATE_M = 131
- *     DATARATE_E = 10
+ *     DATARATE_E_384 = 10
+ *     DATARATE_E_96 = 8
+ *     DATARATE_E_24 = 6
  */
-#define PACKET_DRATE_E 10
-#define PACKET_DRATE_M 131
+#define PACKET_DRATE_M         131
+
+#define PACKET_DRATE_E_384     10
+#define PACKET_DRATE_E_96      8
+#define PACKET_DRATE_E_24      6
+
+static const struct {
+       uint8_t         mdmcfg4;
+       uint8_t         deviatn;
+} packet_rate_setup[] = {
+       [AO_RADIO_RATE_38400] = {
+               .mdmcfg4 = ((0xf << 4) |
+                           (PACKET_DRATE_E_384 << CC115L_MDMCFG4_DRATE_E)),
+               .deviatn = ((PACKET_DEV_E_384 << CC115L_DEVIATN_DEVIATION_E) |
+                           (PACKET_DEV_M_384 << CC115L_DEVIATN_DEVIATION_M)),
+       },
+
+       [AO_RADIO_RATE_9600] = {
+               .mdmcfg4 = ((0xf << 4) |
+                           (PACKET_DRATE_E_96 << CC115L_MDMCFG4_DRATE_E)),
+               .deviatn = ((PACKET_DEV_E_96 << CC115L_DEVIATN_DEVIATION_E) |
+                           (PACKET_DEV_M_96 << CC115L_DEVIATN_DEVIATION_M)),
+       },
+
+       [AO_RADIO_RATE_2400] = {
+               .mdmcfg4 = ((0xf << 4) |
+                           (PACKET_DRATE_E_24 << CC115L_MDMCFG4_DRATE_E)),
+               .deviatn = ((PACKET_DEV_E_24 << CC115L_DEVIATN_DEVIATION_E) |
+                           (PACKET_DEV_M_24 << CC115L_DEVIATN_DEVIATION_M)),
+       },
+};
 
 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),
+       CC115L_MDMCFG2,         ((CC115L_MDMCFG2_MOD_FORMAT_GFSK << CC115L_MDMCFG2_MOD_FORMAT) |
+                                (0 << CC115L_MDMCFG2_MANCHESTER_EN) |
+                                (CC115L_MDMCFG2_SYNC_MODE_16BITS << CC115L_MDMCFG2_SYNC_MODE)),
 };
 
 
 /*
- * RDF deviation is 5kHz
+ * RDF deviation is 3kHz
  *
  *     fdev = fosc >> 17 * (8 + dev_m) << dev_e
  *
- *             26e6 / (2 ** 17) * (8 + 4) * (2 ** 1) = 4761Hz
+ *             26e6 / (2 ** 17) * (8 + 7) * (2 ** 0) = 2975
  */
 
-#define RDF_DEV_E      1
-#define RDF_DEV_M      4
+#define RDF_DEV_E      0
+#define RDF_DEV_M      7
 
 /*
  * For our RDF beacon, set the symbol rate to 2kBaud (for a 1kHz tone)
@@ -279,12 +356,9 @@ static const uint16_t packet_setup[] = {
  *
  *     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) |
@@ -292,14 +366,19 @@ static const uint16_t rdf_setup[] = {
        CC115L_MDMCFG4,         ((0xf << 4) |
                                 (RDF_DRATE_E << CC115L_MDMCFG4_DRATE_E)),
        CC115L_MDMCFG3,         (RDF_DRATE_M),
+       CC115L_MDMCFG2,         ((CC115L_MDMCFG2_MOD_FORMAT_GFSK << CC115L_MDMCFG2_MOD_FORMAT) |
+                                (0 << CC115L_MDMCFG2_MANCHESTER_EN) |
+                                (CC115L_MDMCFG2_SYNC_MODE_NONE << CC115L_MDMCFG2_SYNC_MODE)),
 };
 
 /*
- * APRS deviation is the same as RDF
+ * APRS deviation is 3kHz
+ *
+ * 26e6 / (2 ** 17) * (8 + 7) * (2 ** 0) = 2975
  */
 
-#define APRS_DEV_E     RDF_DEV_E
-#define APRS_DEV_M     RDF_DEV_E
+#define APRS_DEV_E     0
+#define APRS_DEV_M     7
 
 /*
  * For our APRS beacon, set the symbol rate to 9.6kBaud (8x oversampling for 1200 baud data rate)
@@ -323,6 +402,9 @@ static const uint16_t aprs_setup[] = {
        CC115L_MDMCFG4,         ((0xf << 4) |
                                 (APRS_DRATE_E << CC115L_MDMCFG4_DRATE_E)),
        CC115L_MDMCFG3,         (APRS_DRATE_M),
+       CC115L_MDMCFG2,         ((CC115L_MDMCFG2_MOD_FORMAT_GFSK << CC115L_MDMCFG2_MOD_FORMAT) |
+                                (0 << CC115L_MDMCFG2_MANCHESTER_EN) |
+                                (CC115L_MDMCFG2_SYNC_MODE_NONE << CC115L_MDMCFG2_SYNC_MODE)),
 };
 
 #define AO_PKTCTRL0_INFINITE   ((CC115L_PKTCTRL0_PKT_FORMAT_NORMAL << CC115L_PKTCTRL0_PKT_FORMAT) | \
@@ -334,41 +416,45 @@ static const uint16_t aprs_setup[] = {
 
 static uint16_t ao_radio_mode;
 
+
+/*
+ * These set the data rate and modulation parameters
+ */
 #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_BITS_RDF         2
+#define AO_RADIO_MODE_BITS_APRS                4
+
+/*
+ * Flips between infinite packet mode and fixed packet mode;
+ * we use infinite mode until the sender gives us the
+ * last chunk of data
+ */
+#define AO_RADIO_MODE_BITS_INFINITE    40
+#define AO_RADIO_MODE_BITS_FIXED       80
 
 #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)
+
+#define AO_RADIO_MODE_RDF              AO_RADIO_MODE_BITS_RDF
+#define AO_RADIO_MODE_PACKET_TX                AO_RADIO_MODE_BITS_PACKET_TX
+#define AO_RADIO_MODE_APRS             AO_RADIO_MODE_BITS_APRS
 
 static void
 ao_radio_set_mode(uint16_t new_mode)
 {
        uint16_t changes;
-       int i;
+       unsigned int i;
 
        if (new_mode == ao_radio_mode)
                return;
 
        changes = new_mode & (~ao_radio_mode);
-       if (changes & AO_RADIO_MODE_BITS_PACKET_TX)
+       if (changes & AO_RADIO_MODE_BITS_PACKET_TX) {
+               ao_radio_reg_write(CC115L_MDMCFG4, packet_rate_setup[ao_config.radio_rate].mdmcfg4);
+               ao_radio_reg_write(CC115L_DEVIATN, packet_rate_setup[ao_config.radio_rate].deviatn);
+
                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)
@@ -387,18 +473,65 @@ ao_radio_set_mode(uint16_t new_mode)
        ao_radio_mode = new_mode;
 }
 
+/***************************************************************
+ *  SmartRF Studio(tm) Export
+ *
+ *  Radio register settings specifed with address, value
+ *
+ *  RF device: CC115L
+ *
+ ***************************************************************/
+
 static const uint16_t radio_setup[] = {
-#include "ao_rf_cc115l.h"
+
+       /* High when FIFO is above threshold, low when fifo is below threshold */
+       AO_CC115L_FIFO_INT_GPIO_IOCFG,      CC115L_IOCFG_GPIO_CFG_TXFIFO_THR,
+
+       /* High when transmitter is running, low when off */
+       AO_CC115L_DONE_INT_GPIO_IOCFG,      CC115L_IOCFG_GPIO_CFG_PA_PD | (1 << CC115L_IOCFG_GPIO_INV),
+
+        CC115L_FIFOTHR,                     0x47,       /* TX FIFO Thresholds */
+       CC115L_MDMCFG1,                                 /* Modem Configuration */
+               ((CC115L_MDMCFG1_NUM_PREAMBLE_4 << CC115L_MDMCFG1_NUM_PREAMBLE) |
+                (1 << CC115L_MDMCFG1_CHANSPC_E)),
+       CC115L_MDMCFG0,                     248,        /* Channel spacing M value (100kHz channels) */
+       CC115L_MCSM1,                       0x30,       /* Main Radio Control State Machine Configuration */
+        CC115L_MCSM0,                       0x38,       /* Main Radio Control State Machine Configuration */
+        CC115L_RESERVED_0X20,               0xfb,       /* Use setting from SmartRF Studio */
+       CC115L_FREND0,                      0x10,       /* Front End TX Configuration */
+        CC115L_FSCAL3,                      0xe9,       /* Frequency Synthesizer Calibration */
+        CC115L_FSCAL2,                      0x2a,       /* Frequency Synthesizer Calibration */
+        CC115L_FSCAL1,                      0x00,       /* Frequency Synthesizer Calibration */
+        CC115L_FSCAL0,                      0x1f,       /* Frequency Synthesizer Calibration */
+       CC115L_RESERVED_0X29,               0x59,       /* RESERVED */
+       CC115L_RESERVED_0X2A,               0x7f,       /* RESERVED */
+       CC115L_RESERVED_0X2B,               0x3f,       /* RESERVED */
+        CC115L_TEST2,                       0x81,       /* Various Test Settings */
+        CC115L_TEST1,                       0x35,       /* Various Test Settings */
+        CC115L_TEST0,                       0x09,       /* Various Test Settings */
 };
 
 static uint8_t ao_radio_configured = 0;
 
+#if HAS_RADIO_POWER
+#define RADIO_POWER    ao_config.radio_power
+#else
+
+#if 0
+#define RADIO_POWER    0x03    /* -31.75dBm on the test board */
+#endif
+
+#define RADIO_POWER    0xc0    /* full power */
+
+#endif
+
 static void
 ao_radio_setup(void)
 {
-       int     i;
+       unsigned int    i;
 
        ao_radio_strobe(CC115L_SRES);
+       ao_delay(AO_MS_TO_TICKS(10));
 
        for (i = 0; i < sizeof (radio_setup) / sizeof (radio_setup[0]); i += 2)
                ao_radio_reg_write(radio_setup[i], radio_setup[i+1]);
@@ -407,6 +540,10 @@ ao_radio_setup(void)
 
        ao_config_get();
 
+       ao_radio_reg_write(CC115L_PA, RADIO_POWER);
+
+       ao_radio_strobe(CC115L_SCAL);
+
        ao_radio_configured = 1;
 }
 
@@ -422,9 +559,10 @@ ao_radio_set_len(uint8_t len)
 }
 
 static void
-ao_radio_get(uint8_t len)
+ao_radio_get(void)
 {
        static uint32_t last_radio_setting;
+       static uint8_t  last_radio_rate;
 
        ao_mutex_get(&ao_radio_mutex);
        if (!ao_radio_configured)
@@ -434,69 +572,110 @@ ao_radio_get(uint8_t len)
                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;
+               /* Make sure the RF calibration is current */
+               ao_radio_strobe(CC115L_SCAL);
+       }
+       if (ao_config.radio_rate != last_radio_rate) {
+               ao_radio_mode &= ~AO_RADIO_MODE_BITS_PACKET_TX;
+               last_radio_rate = ao_config.radio_rate;
        }
-       ao_radio_set_len(len);
 }
 
+static void
+_ao_radio_send_lots(ao_radio_fill_func fill, uint8_t mode);
+
 #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);
+struct ao_radio_tone {
+       uint8_t value;
+       uint8_t len;
+};
 
-       ao_radio_set_mode(AO_RADIO_MODE_RDF);
-       ao_radio_wake = 0;
+struct ao_radio_tone *ao_radio_tone;
+uint8_t ao_radio_tone_count;
+uint8_t ao_radio_tone_current;
+uint8_t ao_radio_tone_offset;
 
+int16_t
+ao_radio_tone_fill(uint8_t *buf, int16_t len)
+{
+       int16_t ret = 0;
+
+       while (len) {
+               int16_t                 this_time;
+               struct ao_radio_tone    *t;
+
+               /* Figure out how many to send of the current value */
+               t = &ao_radio_tone[ao_radio_tone_current];
+               this_time = t->len - ao_radio_tone_offset;
+               if (this_time > len)
+                       this_time = len;
+
+               /* queue the data */
+               memset(buf, t->value, this_time);
+
+               /* mark as sent */
+               len -= this_time;
+               ao_radio_tone_offset += this_time;
+               ret += this_time;
+
+               if (ao_radio_tone_offset >= t->len) {
+                       ao_radio_tone_offset = 0;
+                       ao_radio_tone_current++;
+                       if (ao_radio_tone_current >= ao_radio_tone_count) {
+                               trace_add(trace_line, __LINE__, ret, "done with tone");
+                               return -ret;
+                       }
+               }
+       }
+       trace_add(trace_line, __LINE__, ret, "got some tone");
+       return ret;
 }
 
 static void
-ao_rdf_run(void)
+ao_radio_tone_run(struct ao_radio_tone *tones, int ntones)
 {
-       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_get();
+       ao_radio_tone = tones;
+       ao_radio_tone_current = 0;
+       ao_radio_tone_offset = 0;
+       ao_radio_tone_count = ntones;
+       _ao_radio_send_lots(ao_radio_tone_fill, AO_RADIO_MODE_RDF);
        ao_radio_put();
 }
 
 void
 ao_radio_rdf(void)
 {
-       ao_rdf_start(AO_RADIO_RDF_LEN);
+       struct ao_radio_tone    tone;
 
-       ao_radio_fifo_write_fixed(ao_radio_rdf_value, AO_RADIO_RDF_LEN);
-
-       ao_rdf_run();
+       tone.value = ao_radio_rdf_value;
+       tone.len = AO_RADIO_RDF_LEN;
+       ao_radio_tone_run(&tone, 1);
 }
 
 void
 ao_radio_continuity(uint8_t c)
 {
-       uint8_t i;
-       uint8_t status;
-
-       ao_rdf_start(AO_RADIO_CONT_TOTAL_LEN);
+       struct ao_radio_tone    tones[7];
+       uint8_t count = 0;
+       uint8_t i;
 
-       status = ao_radio_fifo_write_start();
        for (i = 0; i < 3; i++) {
-               ao_radio_spi_send_fixed(0x00, AO_RADIO_CONT_PAUSE_LEN);
+               tones[count].value = 0x00;
+               tones[count].len = AO_RADIO_CONT_PAUSE_LEN;
+               count++;
                if (i < c)
-                       ao_radio_spi_send_fixed(ao_radio_rdf_value, AO_RADIO_CONT_TONE_LEN);
+                       tones[count].value = ao_radio_rdf_value;
                else
-                       ao_radio_spi_send_fixed(0x00, AO_RADIO_CONT_TONE_LEN);
+                       tones[count].value = 0x00;
+               tones[count].len = AO_RADIO_CONT_TONE_LEN;
+               count++;
        }
-       ao_radio_spi_send_fixed(0x00, AO_RADIO_CONT_PAUSE_LEN);
-       status = ao_radio_fifo_write_stop(status);
-       (void) status;
-       ao_rdf_run();
+       tones[count].value = 0x00;
+       tones[count].len = AO_RADIO_CONT_PAUSE_LEN;
+       count++;
+       ao_radio_tone_run(tones, count);
 }
 
 void
@@ -506,6 +685,15 @@ ao_radio_rdf_abort(void)
        ao_wakeup(&ao_radio_wake);
 }
 
+#define POWER_STEP     0x08
+
+static void
+ao_radio_stx(void)
+{
+       ao_radio_pa_on();
+       ao_radio_strobe(CC115L_STX);
+}
+
 static void
 ao_radio_test_cmd(void)
 {
@@ -524,16 +712,11 @@ ao_radio_test_cmd(void)
 #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
+               ao_radio_get();
+               ao_radio_strobe(CC115L_SFTX);
+               ao_radio_set_len(0xff);
+               ao_radio_set_mode(AO_RADIO_MODE_RDF);
+               ao_radio_stx();
                radio_on = 1;
        }
        if (mode == 3) {
@@ -551,84 +734,80 @@ ao_radio_test_cmd(void)
        }
 }
 
+#if CC115L_TRACE
+static inline int16_t
+ao_radio_gpio_bits(void)
+{
+       return ((ao_gpio_get(AO_CC115L_DONE_INT_PORT, AO_CC115L_DONE_INT_PIN, AO_CC115L_DONE_INT) << 1) |
+               ao_gpio_get(AO_CC115L_FIFO_INT_PORT, AO_CC115L_FIFO_INT_PIN, AO_CC115L_FIFO_INT));
+}
+#endif
+
 static void
-ao_radio_wait_isr(void)
+ao_radio_wait_fifo(void)
 {
        ao_arch_block_interrupts();
-       while (!ao_radio_wake && !ao_radio_mcu_wake && !ao_radio_abort)
+       while (!ao_radio_fifo && !ao_radio_done && !ao_radio_abort) {
+               trace_add(trace_line, __LINE__, ao_radio_gpio_bits(), "wait_fifo");
                ao_sleep(&ao_radio_wake);
+       }
        ao_arch_release_interrupts();
-       if (ao_radio_mcu_wake)
-               ao_radio_check_marcstate();
+       trace_add(trace_line, __LINE__, ao_radio_gpio_bits(), "wake bits");
+       trace_add(trace_line, __LINE__, ao_radio_fifo, "wake fifo");
+       trace_add(trace_line, __LINE__, ao_radio_done, "wake done");
+       trace_add(trace_line, __LINE__, ao_radio_abort, "wake abort");
 }
 
-static uint8_t
-ao_radio_wait_tx(uint8_t wait_fifo)
+static void
+ao_radio_wait_done(void)
 {
-       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;
+       ao_arch_block_interrupts();
+       while (!ao_radio_done && !ao_radio_abort) {
+               trace_add(trace_line, __LINE__, ao_radio_gpio_bits(), "wait_done");
+               ao_sleep(&ao_radio_wake);
+       }
+       ao_arch_release_interrupts();
+       trace_add(trace_line, __LINE__, ao_radio_gpio_bits(), "wake bits");
+       trace_add(trace_line, __LINE__, ao_radio_fifo, "wake fifo");
+       trace_add(trace_line, __LINE__, ao_radio_done, "wake done");
+       trace_add(trace_line, __LINE__, ao_radio_abort, "wake abort");
 }
 
 static uint8_t tx_data[(AO_RADIO_MAX_SEND + 4) * 2];
 
+static uint8_t *ao_radio_send_buf;
+static int16_t ao_radio_send_len;
+
+static int16_t
+ao_radio_send_fill(uint8_t *buf, int16_t len)
+{
+       int16_t this_time;
+
+       this_time = ao_radio_send_len;
+       if (this_time > len)
+               this_time = len;
+       memcpy(buf, ao_radio_send_buf, this_time);
+       ao_radio_send_buf += this_time;
+       ao_radio_send_len -= this_time;
+       if (ao_radio_send_len == 0)
+               return -this_time;
+       return this_time;
+}
+
 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_get();
+       ao_radio_send_len = ao_fec_encode(d, size, tx_data);
+       ao_radio_send_buf = tx_data;
+       _ao_radio_send_lots(ao_radio_send_fill, AO_RADIO_MODE_PACKET_TX);
        ao_radio_put();
 }
 
 #define AO_RADIO_LOTS  64
 
-void
-ao_radio_send_lots(ao_radio_fill_func fill)
+static void
+_ao_radio_send_lots(ao_radio_fill_func fill, uint8_t mode)
 {
        uint8_t buf[AO_RADIO_LOTS], *b;
        int     cnt;
@@ -637,10 +816,16 @@ ao_radio_send_lots(ao_radio_fill_func fill)
        uint8_t started = 0;
        uint8_t fifo_space;
 
-       ao_radio_get(0xff);
        fifo_space = CC115L_FIFO_SIZE;
+       ao_radio_abort = 0;
+
+       ao_radio_strobe(CC115L_SFTX);
+
+       ao_radio_done = 0;
+       ao_radio_fifo = 0;
        while (!done) {
                cnt = (*fill)(buf, sizeof(buf));
+               trace_add(trace_line, __LINE__, cnt, "send data count");
                if (cnt < 0) {
                        done = 1;
                        cnt = -cnt;
@@ -648,8 +833,13 @@ ao_radio_send_lots(ao_radio_fill_func fill)
                total += cnt;
 
                /* At the last buffer, set the total length */
-               if (done)
+               if (done) {
                        ao_radio_set_len(total & 0xff);
+                       ao_radio_set_mode(mode | AO_RADIO_MODE_BITS_FIXED);
+               } else {
+                       ao_radio_set_len(0xff);
+                       ao_radio_set_mode(mode | AO_RADIO_MODE_BITS_INFINITE);
+               }
 
                b = buf;
                while (cnt) {
@@ -657,45 +847,49 @@ ao_radio_send_lots(ao_radio_fill_func fill)
 
                        /* 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();
+                               trace_add(trace_line, __LINE__, this_len, "wait for space");
+                               ao_radio_wait_fifo();
                        }
-                       if (ao_radio_abort)
+                       if (ao_radio_abort || ao_radio_done)
                                break;
+                       trace_add(trace_line, __LINE__, fifo_space, "got space");
                        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_done = 0;
+                       ao_radio_fifo = 0;
                        ao_radio_fifo_write(b, this_len);
                        b += this_len;
 
+                       ao_exti_enable(AO_CC115L_FIFO_INT_PORT, AO_CC115L_FIFO_INT_PIN);
+                       ao_exti_enable(AO_CC115L_DONE_INT_PORT, AO_CC115L_DONE_INT_PIN);
+
                        if (!started) {
-                               ao_radio_start_tx();
+                               ao_radio_stx();
                                started = 1;
-                       } else
-                               ao_exti_enable(AO_CC115L_INT_PORT, AO_CC115L_INT_PIN);
+                       }
                }
-               if (ao_radio_abort) {
-                       ao_radio_idle();
+               if (ao_radio_abort || ao_radio_done)
                        break;
-               }
-               /* Wait for the transmitter to go idle */
-               ao_radio_wake = 0;
-               ao_radio_wait_isr();
        }
+       if (ao_radio_abort)
+               ao_radio_idle();
+       ao_radio_wait_done();
+       ao_radio_pa_off();
+}
+
+void
+ao_radio_send_aprs(ao_radio_fill_func fill)
+{
+       ao_radio_get();
+       _ao_radio_send_lots(fill, AO_RADIO_MODE_APRS);
        ao_radio_put();
 }
 
-static char *cc115l_state_name[] = {
+#if CC115L_DEBUG
+static const char *cc115l_state_name[] = {
        [CC115L_STATUS_STATE_IDLE] = "IDLE",
        [CC115L_STATUS_STATE_TX] = "TX",
        [CC115L_STATUS_STATE_FSTXON] = "FSTXON",
@@ -704,17 +898,63 @@ static char *cc115l_state_name[] = {
        [CC115L_STATUS_STATE_TX_FIFO_UNDERFLOW] = "TX_FIFO_UNDERFLOW",
 };
 
+static const struct ao_cc115l_reg ao_cc115l_reg[] = {
+       { .addr = CC115L_IOCFG2, .name = "IOCFG2" },
+       { .addr = CC115L_IOCFG1, .name = "IOCFG1" },
+       { .addr = CC115L_IOCFG0, .name = "IOCFG0" },
+       { .addr = CC115L_FIFOTHR, .name = "FIFOTHR" },
+       { .addr = CC115L_SYNC1, .name = "SYNC1" },
+       { .addr = CC115L_SYNC0, .name = "SYNC0" },
+       { .addr = CC115L_PKTLEN, .name = "PKTLEN" },
+       { .addr = CC115L_PKTCTRL0, .name = "PKTCTRL0" },
+       { .addr = CC115L_CHANNR, .name = "CHANNR" },
+       { .addr = CC115L_FSCTRL0, .name = "FSCTRL0" },
+       { .addr = CC115L_FREQ2, .name = "FREQ2" },
+       { .addr = CC115L_FREQ1, .name = "FREQ1" },
+       { .addr = CC115L_FREQ0, .name = "FREQ0" },
+       { .addr = CC115L_MDMCFG4, .name = "MDMCFG4" },
+       { .addr = CC115L_MDMCFG3, .name = "MDMCFG3" },
+       { .addr = CC115L_MDMCFG2, .name = "MDMCFG2" },
+       { .addr = CC115L_MDMCFG1, .name = "MDMCFG1" },
+       { .addr = CC115L_MDMCFG0, .name = "MDMCFG0" },
+       { .addr = CC115L_DEVIATN, .name = "DEVIATN" },
+       { .addr = CC115L_MCSM1, .name = "MCSM1" },
+       { .addr = CC115L_MCSM0, .name = "MCSM0" },
+       { .addr = CC115L_RESERVED_0X20, .name = "RESERVED_0X20" },
+       { .addr = CC115L_FREND0, .name = "FREND0" },
+       { .addr = CC115L_FSCAL3, .name = "FSCAL3" },
+       { .addr = CC115L_FSCAL2, .name = "FSCAL2" },
+       { .addr = CC115L_FSCAL1, .name = "FSCAL1" },
+       { .addr = CC115L_FSCAL0, .name = "FSCAL0" },
+       { .addr = CC115L_RESERVED_0X29, .name = "RESERVED_0X29" },
+       { .addr = CC115L_RESERVED_0X2A, .name = "RESERVED_0X2A" },
+       { .addr = CC115L_RESERVED_0X2B, .name = "RESERVED_0X2B" },
+       { .addr = CC115L_TEST2, .name = "TEST2" },
+       { .addr = CC115L_TEST1, .name = "TEST1" },
+       { .addr = CC115L_TEST0, .name = "TEST0" },
+       { .addr = CC115L_PARTNUM, .name = "PARTNUM" },
+       { .addr = CC115L_VERSION, .name = "VERSION" },
+       { .addr = CC115L_MARCSTATE, .name = "MARCSTATE" },
+       { .addr = CC115L_PKTSTATUS, .name = "PKTSTATUS" },
+       { .addr = CC115L_TXBYTES, .name = "TXBYTES" },
+       { .addr = CC115L_PA, .name = "PA" },
+};
+
+#define AO_NUM_CC115L_REG      (sizeof ao_cc115l_reg / sizeof ao_cc115l_reg[0])
+
 static void ao_radio_show(void) {
        uint8_t status = ao_radio_status();
-       int     i;
+       unsigned int    i;
 
-       ao_radio_get(0xff);
+       ao_radio_get();
        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());
 
+       for (i = 0; i < AO_NUM_CC115L_REG; i++)
+               printf ("\t%02x %-20.20s\n", ao_radio_reg_read(ao_cc115l_reg[i].addr), ao_cc115l_reg[i].name);
        ao_radio_put();
 }
 
@@ -737,16 +977,20 @@ static void ao_radio_packet(void) {
        ao_radio_send(packet, sizeof (packet));
 }
 
+
 #if HAS_APRS
 #include <ao_aprs.h>
 
 static void
 ao_radio_aprs()
 {
+#if PACKET_HAS_SLAVE
        ao_packet_slave_stop();
+#endif
        ao_aprs_send();
 }
 #endif
+#endif /* CC115L_DEBUG */
 
 static const struct ao_cmds ao_radio_cmds[] = {
        { ao_radio_test_cmd,    "C <1 start, 0 stop, none both>\0Radio carrier test" },
@@ -764,7 +1008,9 @@ static const struct ao_cmds ao_radio_cmds[] = {
 void
 ao_radio_init(void)
 {
+#if 0
        int     i;
+#endif
 
        ao_radio_configured = 0;
        ao_spi_init_cs (AO_CC115L_SPI_CS_PORT, (1 << AO_CC115L_SPI_CS_PIN));
@@ -780,17 +1026,19 @@ ao_radio_init(void)
                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,
+       /* Enable the fifo threhold interrupt pin */
+       ao_enable_port(AO_CC115L_FIFO_INT_PORT);
+       ao_exti_setup(AO_CC115L_FIFO_INT_PORT, AO_CC115L_FIFO_INT_PIN,
                      AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_HIGH,
-                     ao_radio_isr);
+                     ao_radio_fifo_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,
+       /* Enable the tx done interrupt pin */
+       ao_enable_port(AO_CC115L_DONE_INT_PORT);
+       ao_exti_setup(AO_CC115L_DONE_INT_PORT, AO_CC115L_DONE_INT_PIN,
                      AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_MED,
-                     ao_radio_mcu_wakeup_isr);
+                     ao_radio_done_isr);
+
+       ao_radio_pa_init();
 
        ao_cmd_register(&ao_radio_cmds[0]);
 }