altos: Actually write cc1120 register values

[fw/altos] / src / drivers / ao_cc1120.c

diff --git a/src/drivers/ao_cc1120.c b/src/drivers/ao_cc1120.c
index 95b21170f597e0b1c468cef9e1d3f97a13c5b014..d2820e5145bda40dddb5fc7100e0f2ae80e7429c 100644 (file)
--- a/src/drivers/ao_cc1120.c
+++ b/src/drivers/ao_cc1120.c
@@ -25,7 +25,7 @@ uint8_t ao_radio_abort;
 
 #define CC1120_DEBUG   1
 
-uint32_t       ao_radio_cal = 1186611;
+uint32_t       ao_radio_cal = 0x6ca333;
 
 #define FOSC   32000000
 
@@ -77,13 +77,13 @@ ao_radio_reg_write(uint16_t addr, uint8_t value)
        printf("\t\tao_radio_reg_write (%04x): %02x\n", addr, value);
 #endif
        if (CC1120_IS_EXTENDED(addr)) {
-               data[0] = ((1 << CC1120_READ)  |
+               data[0] = ((0 << CC1120_READ)  |
                           (0 << CC1120_BURST) |
                           CC1120_EXTENDED);
                data[1] = addr;
                d = 2;
        } else {
-               data[0] = ((1 << CC1120_READ)  |
+               data[0] = ((0 << CC1120_READ)  |
                           (0 << CC1120_BURST) |
                           addr);
                d = 1;
@@ -492,6 +492,9 @@ ao_radio_get(uint8_t len)
        ao_mutex_get(&ao_radio_mutex);
        if (!ao_radio_configured)
                ao_radio_setup();
+       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);
        ao_radio_reg_write(CC1120_PKT_LEN, len);
 }