Some radio init stuff, untested

2 files changed, 80 insertions, 4 deletions

diff --git a/laser-tag software/main.c b/laser-tag software/main.c
index 8eee6c5..4007f2d 100644
--- a/laser-tag software/main.c
+++ b/laser-tag software/main.c
@@ -290,7 +290,6 @@ void led(uint8_t red, uint8_t green, uint8_t blue)
 
 /*!
  * @brief LPTMR interrupt call back function.
- * The function is used to toggle LED1.
  */
 static void lptmr_call_back(void)
 {
diff --git a/laser-tag software/radio.c b/laser-tag software/radio.c
index 0915a29..348de3d 100644
--- a/laser-tag software/radio.c
+++ b/laser-tag software/radio.c
@@ -1,6 +1,7 @@
 #include "radio.h"
 #include "fsl_gpio_driver.h"
 #include "fsl_spi_master_driver.h"
+#include "RFM69registers.h"
 
 static const gpio_output_pin_user_config_t pinReset = {
     .pinName = GPIO_MAKE_PIN(GPIOC_IDX, 8),
@@ -15,6 +16,75 @@ static const spi_master_user_config_t spiConfig = {
     .bitCount = kSpi16BitMode,
 };
 
+static const struct {
+    uint8_t reg;
+    uint8_t val;
+} config[] = {
+    { REG_OPMODE, RF_OPMODE_SEQUENCER_ON | RF_OPMODE_LISTEN_OFF
+        | RF_OPMODE_STANDBY },
+    { REG_DATAMODUL, RF_DATAMODUL_DATAMODE_PACKET
+        | RF_DATAMODUL_MODULATIONTYPE_FSK
+        | RF_DATAMODUL_MODULATIONSHAPING_00 }, // no shaping
+    { REG_BITRATEMSB, RF_BITRATEMSB_55555 }, // default: 4.8 KBPS
+    { REG_BITRATELSB, RF_BITRATELSB_55555 },
+    { REG_FDEVMSB, RF_FDEVMSB_50000 }, // default: 5KHz,
+                                       // (FDEV + BitRate / 2 <= 500KHz)
+    { REG_FDEVLSB, RF_FDEVLSB_50000 },
+    { REG_FRFMSB, RF_FRFMSB_915 },
+    { REG_FRFMID, RF_FRFMID_915 },
+    { REG_FRFLSB, RF_FRFLSB_915 },
+    // looks like PA1 and PA2 are not implemented on RFM69W,
+    // hence the max output power is 13dBm
+    // +17dBm and +20dBm are possible on RFM69HW
+    // +13dBm formula: Pout = -18 + OutputPower (with PA0 or PA1**)
+    // +17dBm formula: Pout = -14 + OutputPower (with PA1 and PA2)**
+    // +20dBm formula: Pout = -11 + OutputPower (with PA1 and PA2)** and high
+    // power PA settings (section 3.3.7 in datasheet)
+    //{ REG_PALEVEL, RF_PALEVEL_PA0_ON | RF_PALEVEL_PA1_OFF
+    //| RF_PALEVEL_PA2_OFF | RF_PALEVEL_OUTPUTPOWER_11111 },
+    //{ REG_OCP, RF_OCP_ON | RF_OCP_TRIM_95 }, // over current protection
+    //(default is 95mA)
+
+    // RXBW defaults are RF_RXBW_DCCFREQ_010 | RF_RXBW_MANT_24 | RF_RXBW_EXP_5
+    // (RxBw: 10.4KHz)
+    //for BR-19200: RF_RXBW_DCCFREQ_010 | RF_RXBW_MANT_24 | RF_RXBW_EXP_3
+    // (BitRate < 2 * RxBw)
+    { REG_RXBW, RF_RXBW_DCCFREQ_010 | RF_RXBW_MANT_16 | RF_RXBW_EXP_2 },
+    // DIO0 is the only IRQ we're using
+    { REG_DIOMAPPING1, RF_DIOMAPPING1_DIO0_01 },
+    // DIO5 ClkOut disable for power saving
+    { REG_DIOMAPPING2, RF_DIOMAPPING2_CLKOUT_OFF },
+    // writing to this bit ensures that the FIFO & status flags are reset
+    { REG_IRQFLAGS2, RF_IRQFLAGS2_FIFOOVERRUN },
+    // must be set to dBm = (-Sensitivity / 2), default is 0xE4 = 228 so -114dBm
+    { REG_RSSITHRESH, 220 },
+    // default 3 preamble bytes 0xAAAAAA
+    //{ REG_PREAMBLELSB, RF_PREAMBLESIZE_LSB_VALUE }
+    { REG_SYNCCONFIG, RF_SYNC_ON | RF_SYNC_FIFOFILL_AUTO | RF_SYNC_SIZE_2
+        | RF_SYNC_TOL_0 },
+    // attempt to make this compatible with sync1 byte of RFM12B lib
+    { REG_SYNCVALUE1, 0x2D },
+    { REG_SYNCVALUE2, 42 }, // NETWORK ID
+    { REG_PACKETCONFIG1, RF_PACKET1_FORMAT_VARIABLE | RF_PACKET1_DCFREE_OFF
+        | RF_PACKET1_CRC_ON | RF_PACKET1_CRCAUTOCLEAR_ON
+        | RF_PACKET1_ADRSFILTERING_OFF },
+    // in variable length mode: the max frame size, not used in TX
+    { REG_PAYLOADLENGTH, 66 },
+    // turned off because we're not using address filtering
+    //{ REG_NODEADRS, nodeID },
+    { REG_FIFOTHRESH, RF_FIFOTHRESH_TXSTART_FIFONOTEMPTY
+        | RF_FIFOTHRESH_VALUE }, // TX on FIFO not empty
+    // RXRESTARTDELAY must match transmitter PA ramp-down time
+    // (bitrate dependent)
+    //for BR-19200: RF_PACKET2_RXRESTARTDELAY_NONE | RF_PACKET2_AUTORXRESTART_ON
+    //| RF_PACKET2_AES_OFF
+    { REG_PACKETCONFIG2, RF_PACKET2_RXRESTARTDELAY_2BITS
+        | RF_PACKET2_AUTORXRESTART_ON | RF_PACKET2_AES_OFF },
+    // run DAGC continuously in RX mode for Fading Margin Improvement,
+    // recommended default for AfcLowBetaOn=0
+    { REG_TESTDAGC, RF_DAGC_IMPROVED_LOWBETA0 },
+};
+
 static spi_master_state_t spiState;
 
 static spi_status_t SPI_Transfer(const uint8_t *tx, uint8_t *rx, size_t count)
@@ -77,11 +147,18 @@ int radio_init()
     uint32_t calculatedBaudRate;
     SPI_DRV_MasterConfigureBus(0, &spiConfig, &calculatedBaudRate);
 
-	write_reg(0x2f, 0xaa);
-	uint32_t reg = read_reg(0x2f);
-	if (reg != 0xaa) {
+    /* Use REG_SYNCVALUE1 to test that the radio is there */
+	write_reg(REG_SYNCVALUE1, 0x55);
+	uint32_t reg = read_reg(REG_SYNCVALUE1);
+	if (reg != 0x55) {
 		return -1;
 	}
+
+    /* Setup a bunch of config registers */
+    uint32_t i;
+    for (i = 0; i < sizeof config / sizeof *config; ++i) {
+        write_reg(config[i].reg, config[i].val);
+    }
 	return 0;
 }