Clean up commands a bit

[fw/altos] / ao_radio.c

diff --git a/ao_radio.c b/ao_radio.c
index 1b943ea88b1099a64043a15e9bf791ed1372df32..dbef6a188a60957bff523b6bc2c399d04167182a 100644 (file)
--- a/ao_radio.c
+++ b/ao_radio.c
@@ -275,8 +275,10 @@ ao_radio_idle(void)
 void
 ao_radio_send(__xdata struct ao_telemetry *telemetry) __reentrant
 {
+       ao_config_get();
        ao_mutex_get(&ao_radio_mutex);
        ao_radio_idle();
+       RF_CHANNR = ao_config.radio_channel;
        ao_dma_set_transfer(ao_radio_dma,
                            telemetry,
                            &RFDXADDR,
@@ -297,8 +299,10 @@ ao_radio_send(__xdata struct ao_telemetry *telemetry) __reentrant
 void
 ao_radio_recv(__xdata struct ao_radio_recv *radio) __reentrant
 {
+       ao_config_get();
        ao_mutex_get(&ao_radio_mutex);
        ao_radio_idle();
+       RF_CHANNR = ao_config.radio_channel;
        ao_dma_set_transfer(ao_radio_dma,
                            &RFDXADDR,
                            radio,