RF_DEVIATN_OFF, ((RDF_DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
(RDF_DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
- /* packet length */
- RF_PKTLEN_OFF, RDF_PACKET_LEN,
+ /* packet length is set in-line */
RF_PKTCTRL1_OFF, ((1 << PKTCTRL1_PQT_SHIFT)|
PKTCTRL1_ADR_CHK_NONE),
RF_PKTCTRL0_OFF, (RF_PKTCTRL0_PKT_FORMAT_NORMAL|
RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
};
+static __code uint8_t packet_setup[] = {
+ RF_MDMCFG4_OFF, ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
+ (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
+ (DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
+ RF_MDMCFG3_OFF, (DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
+ RF_MDMCFG2_OFF, (RF_MDMCFG2_DEM_DCFILT_OFF |
+ RF_MDMCFG2_MOD_FORMAT_GFSK |
+ RF_MDMCFG2_SYNC_MODE_15_16_THRES),
+ RF_MDMCFG1_OFF, (RF_MDMCFG1_FEC_EN |
+ RF_MDMCFG1_NUM_PREAMBLE_4 |
+ (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
+
+ RF_DEVIATN_OFF, ((DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
+ (DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
+
+ /* max packet length */
+ RF_PKTLEN_OFF, sizeof (struct ao_packet),
+ RF_PKTCTRL1_OFF, ((1 << PKTCTRL1_PQT_SHIFT)|
+ PKTCTRL1_APPEND_STATUS|
+ PKTCTRL1_ADR_CHK_NONE),
+ RF_PKTCTRL0_OFF, (RF_PKTCTRL0_WHITE_DATA|
+ RF_PKTCTRL0_PKT_FORMAT_NORMAL|
+ RF_PKTCTRL0_CRC_EN|
+ RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
+};
+
__xdata uint8_t ao_radio_dma;
__xdata uint8_t ao_radio_dma_done;
+__xdata uint8_t ao_radio_done;
__xdata uint8_t ao_radio_mutex;
-static void
+void
+ao_radio_general_isr(void) interrupt 16
+{
+ S1CON &= ~0x03;
+ if (RFIF & RFIF_IM_TIMEOUT) {
+ ao_dma_abort(ao_radio_dma);
+ RFIF &= ~ RFIF_IM_TIMEOUT;
+ } else if (RFIF & RFIF_IM_DONE) {
+ ao_radio_done = 1;
+ ao_wakeup(&ao_radio_done);
+ RFIF &= ~RFIF_IM_DONE;
+ }
+}
+
+void
+ao_radio_set_telemetry(void)
+{
+ uint8_t i;
+ for (i = 0; i < sizeof (telemetry_setup); i += 2)
+ RF[telemetry_setup[i]] = telemetry_setup[i+1];
+}
+
+void
+ao_radio_set_packet(void)
+{
+ uint8_t i;
+ for (i = 0; i < sizeof (packet_setup); i += 2)
+ RF[packet_setup[i]] = packet_setup[i+1];
+}
+
+void
+ao_radio_set_rdf(void)
+{
+ uint8_t i;
+ for (i = 0; i < sizeof (rdf_setup); i += 2)
+ RF[rdf_setup[i]] = rdf_setup[i+1];
+}
+
+void
ao_radio_idle(void)
{
if (RF_MARCSTATE != RF_MARCSTATE_IDLE)
ao_config_get();
ao_mutex_get(&ao_radio_mutex);
ao_radio_idle();
+ ao_radio_done = 0;
RF_CHANNR = ao_config.radio_channel;
ao_dma_set_transfer(ao_radio_dma,
telemetry,
DMA_CFG1_PRIORITY_HIGH);
ao_dma_start(ao_radio_dma);
RFST = RFST_STX;
- __critical while (!ao_radio_dma_done)
- ao_sleep(&ao_radio_dma_done);
+ __critical while (!ao_radio_done)
+ ao_sleep(&ao_radio_done);
ao_mutex_put(&ao_radio_mutex);
}
-void
+uint8_t
ao_radio_recv(__xdata struct ao_radio_recv *radio) __reentrant
{
ao_config_get();
__critical while (!ao_radio_dma_done)
ao_sleep(&ao_radio_dma_done);
ao_mutex_put(&ao_radio_mutex);
+ return (ao_radio_dma_done & AO_DMA_DONE);
}
__xdata ao_radio_rdf_running;
__xdata ao_radio_rdf_value = 0x55;
void
-ao_radio_rdf(void)
+ao_radio_rdf(int ms)
{
uint8_t i;
+ uint8_t pkt_len;
ao_mutex_get(&ao_radio_mutex);
ao_radio_idle();
ao_radio_rdf_running = 1;
for (i = 0; i < sizeof (rdf_setup); i += 2)
RF[rdf_setup[i]] = rdf_setup[i+1];
+ /*
+ * Compute the packet length as follows:
+ *
+ * 2000 bps (for a 1kHz tone)
+ * so, for 'ms' milliseconds, we need
+ * 2 * ms bits, or ms / 4 bytes
+ */
+ if (ms > (255 * 4))
+ ms = 255 * 4;
+ pkt_len = ms >> 2;
+ RF[RF_PKTLEN_OFF] = pkt_len;
+
ao_dma_set_transfer(ao_radio_dma,
&ao_radio_rdf_value,
&RFDXADDR,
- RDF_PACKET_LEN,
+ pkt_len,
DMA_CFG0_WORDSIZE_8 |
DMA_CFG0_TMODE_SINGLE |
DMA_CFG0_TRIGGER_RADIO,
ao_sleep(&ao_radio_dma_done);
ao_radio_rdf_running = 0;
ao_radio_idle();
- for (i = 0; i < sizeof (rdf_setup); i += 2)
+ for (i = 0; i < sizeof (telemetry_setup); i += 2)
RF[telemetry_setup[i]] = telemetry_setup[i+1];
ao_mutex_put(&ao_radio_mutex);
}
+void
+ao_radio_abort(void)
+{
+ ao_dma_abort(ao_radio_dma);
+ ao_radio_idle();
+}
+
void
ao_radio_rdf_abort(void)
{
- if (ao_radio_rdf_running) {
- ao_dma_abort(ao_radio_dma);
- ao_radio_idle();
- }
+ if (ao_radio_rdf_running)
+ ao_radio_abort();
+}
+
+/* Output carrier */
+void
+ao_radio_test(void)
+{
+ ao_config_get();
+ ao_mutex_get(&ao_radio_mutex);
+ ao_radio_idle();
+ printf ("Hit a character to stop..."); flush();
+ RFST = RFST_STX;
+ getchar();
+ ao_radio_idle();
+ ao_mutex_put(&ao_radio_mutex);
+ putchar('\n');
}
+__code struct ao_cmds ao_radio_cmds[] = {
+ { 'C', ao_radio_test, "C Radio carrier test" },
+ { 0, ao_radio_test, NULL },
+};
+
void
ao_radio_init(void)
{
uint8_t i;
for (i = 0; i < sizeof (radio_setup); i += 2)
RF[radio_setup[i]] = radio_setup[i+1];
+ ao_radio_set_telemetry();
ao_radio_dma_done = 1;
ao_radio_dma = ao_dma_alloc(&ao_radio_dma_done);
+ RFIF = 0;
+ RFIM = RFIM_IM_TIMEOUT|RFIM_IM_DONE;
+ IEN2 |= IEN2_RFIE;
+ ao_cmd_register(&ao_radio_cmds[0]);
}