altos: Add temporary RF power settings

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

diff --git a/src/drivers/ao_cc115l.c b/src/drivers/ao_cc115l.c
index feff82afd35f2edc7122e98d095d992aee982a1e..5b0ec3d7fb8aa93d958dab7647b9048a714af398 100644 (file)
--- a/src/drivers/ao_cc115l.c
+++ b/src/drivers/ao_cc115l.c
@@ -452,6 +452,7 @@ static void
 ao_radio_get(uint8_t len)
 {
        static uint32_t last_radio_setting;
+       static uint8_t  last_power_setting;
 
        ao_mutex_get(&ao_radio_mutex);
        if (!ao_radio_configured)
@@ -462,6 +463,10 @@ ao_radio_get(uint8_t len)
                ao_radio_reg_write(CC115L_FREQ0, ao_config.radio_setting);
                last_radio_setting = ao_config.radio_setting;
        }
+       if (ao_config.radio_power != last_power_setting) {
+               ao_radio_reg_write(CC115L_PA, ao_config.radio_power);
+               last_power_setting = ao_config.radio_power;
+       }
        ao_radio_set_len(len);
 }