2 * Copyright © 2009 Keith Packard <keithp@keithp.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; version 2 of the License.
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
13 * You should have received a copy of the GNU General Public License along
14 * with this program; if not, write to the Free Software Foundation, Inc.,
15 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
20 /* Values from SmartRF® Studio for:
22 * Deviation: 20.507812 kHz
23 * Datarate: 38.360596 kBaud
25 * RF Freq: 434.549927 MHz
26 * Channel: 99.975586 kHz
28 * RX filter: 93.75 kHz
32 * For 434.550MHz, the frequency value is:
34 * 434.550e6 / (24e6 / 2**16) = 1186611.2
37 #define FREQ_CONTROL 1186611
40 * For IF freq of 140.62kHz, the IF value is:
42 * 140.62e3 / (24e6 / 2**10) = 6
45 #define IF_FREQ_CONTROL 6
48 * For channel bandwidth of 93.75 kHz, the CHANBW_E and CHANBW_M values are
50 * BW = 24e6 / (8 * (4 + M) * 2 ** E)
59 * For a symbol rate of 38360kBaud, the DRATE_E and DRATE_M values are:
61 * R = (256 + M) * 2** E * 24e6 / 2**28
63 * So M is 163 and E is 10
70 * For a channel deviation of 20.5kHz, the DEVIATION_E and DEVIATION_M values are:
72 * F = 24e6/2**17 * (8 + DEVIATION_M) * 2**DEVIATION_E
74 * So M is 6 and E is 3
81 * For our RDF beacon, set the symbol rate to 2kBaud (for a 1kHz tone),
82 * so the DRATE_E and DRATE_M values are:
86 * To make the tone last for 200ms, we need 2000 * .2 = 400 bits or 50 bytes
90 #define RDF_DRATE_M 94
91 #define RDF_PACKET_LEN 50
94 * RDF deviation should match the normal NFM value of 5kHz
100 #define RDF_DEVIATION_M 6
101 #define RDF_DEVIATION_E 1
103 /* This are from the table for 433MHz */
105 #define RF_POWER_M30_DBM 0x12
106 #define RF_POWER_M20_DBM 0x0e
107 #define RF_POWER_M15_DBM 0x1d
108 #define RF_POWER_M10_DBM 0x34
109 #define RF_POWER_M5_DBM 0x2c
110 #define RF_POWER_0_DBM 0x60
111 #define RF_POWER_5_DBM 0x84
112 #define RF_POWER_7_DBM 0xc8
113 #define RF_POWER_10_DBM 0xc0
115 #define RF_POWER RF_POWER_10_DBM
117 static __code uint8_t radio_setup[] = {
118 RF_PA_TABLE7_OFF, RF_POWER,
119 RF_PA_TABLE6_OFF, RF_POWER,
120 RF_PA_TABLE5_OFF, RF_POWER,
121 RF_PA_TABLE4_OFF, RF_POWER,
122 RF_PA_TABLE3_OFF, RF_POWER,
123 RF_PA_TABLE2_OFF, RF_POWER,
124 RF_PA_TABLE1_OFF, RF_POWER,
125 RF_PA_TABLE0_OFF, RF_POWER,
127 RF_FREQ2_OFF, (FREQ_CONTROL >> 16) & 0xff,
128 RF_FREQ1_OFF, (FREQ_CONTROL >> 8) & 0xff,
129 RF_FREQ0_OFF, (FREQ_CONTROL >> 0) & 0xff,
131 RF_FSCTRL1_OFF, (IF_FREQ_CONTROL << RF_FSCTRL1_FREQ_IF_SHIFT),
132 RF_FSCTRL0_OFF, (0 << RF_FSCTRL0_FREQOFF_SHIFT),
134 RF_MDMCFG4_OFF, ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
135 (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
136 (DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
137 RF_MDMCFG3_OFF, (DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
138 RF_MDMCFG2_OFF, (RF_MDMCFG2_DEM_DCFILT_OFF |
139 RF_MDMCFG2_MOD_FORMAT_GFSK |
140 RF_MDMCFG2_SYNC_MODE_15_16_THRES),
141 RF_MDMCFG1_OFF, (RF_MDMCFG1_FEC_EN |
142 RF_MDMCFG1_NUM_PREAMBLE_4 |
143 (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
144 RF_MDMCFG0_OFF, (17 << RF_MDMCFG0_CHANSPC_M_SHIFT),
148 RF_DEVIATN_OFF, ((DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
149 (DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
151 /* SmartRF says set LODIV_BUF_CURRENT_TX to 0
152 * And, we're not using power ramping, so use PA_POWER 0
154 RF_FREND0_OFF, ((1 << RF_FREND0_LODIV_BUF_CURRENT_TX_SHIFT) |
155 (0 << RF_FREND0_PA_POWER_SHIFT)),
157 RF_FREND1_OFF, ((1 << RF_FREND1_LNA_CURRENT_SHIFT) |
158 (1 << RF_FREND1_LNA2MIX_CURRENT_SHIFT) |
159 (1 << RF_FREND1_LODIV_BUF_CURRENT_RX_SHIFT) |
160 (2 << RF_FREND1_MIX_CURRENT_SHIFT)),
171 /* default sync values */
175 /* max packet length */
176 RF_PKTLEN_OFF, sizeof (struct ao_telemetry),
178 RF_PKTCTRL1_OFF, ((1 << PKTCTRL1_PQT_SHIFT)|
179 PKTCTRL1_APPEND_STATUS|
180 PKTCTRL1_ADR_CHK_NONE),
181 RF_PKTCTRL0_OFF, (RF_PKTCTRL0_WHITE_DATA|
182 RF_PKTCTRL0_PKT_FORMAT_NORMAL|
184 RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
186 RF_MCSM2_OFF, (RF_MCSM2_RX_TIME_END_OF_PACKET),
187 RF_MCSM1_OFF, (RF_MCSM1_CCA_MODE_RSSI_BELOW_UNLESS_RECEIVING|
188 RF_MCSM1_RXOFF_MODE_IDLE|
189 RF_MCSM1_TXOFF_MODE_IDLE),
190 RF_MCSM0_OFF, (RF_MCSM0_FS_AUTOCAL_FROM_IDLE|
192 RF_MCSM0_CLOSE_IN_RX_0DB),
193 RF_FOCCFG_OFF, (RF_FOCCFG_FOC_PRE_K_3K,
194 RF_FOCCFG_FOC_POST_K_PRE_K,
195 RF_FOCCFG_FOC_LIMIT_BW_OVER_4),
196 RF_BSCFG_OFF, (RF_BSCFG_BS_PRE_K_2K|
197 RF_BSCFG_BS_PRE_KP_3KP|
198 RF_BSCFG_BS_POST_KI_PRE_KI|
199 RF_BSCFG_BS_POST_KP_PRE_KP|
200 RF_BSCFG_BS_LIMIT_0),
201 RF_AGCCTRL2_OFF, 0x43,
202 RF_AGCCTRL1_OFF, 0x40,
203 RF_AGCCTRL0_OFF, 0x91,
210 static __code uint8_t rdf_setup[] = {
211 RF_MDMCFG4_OFF, ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
212 (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
213 (RDF_DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
214 RF_MDMCFG3_OFF, (RDF_DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
215 RF_MDMCFG2_OFF, (RF_MDMCFG2_DEM_DCFILT_OFF |
216 RF_MDMCFG2_MOD_FORMAT_GFSK |
217 RF_MDMCFG2_SYNC_MODE_15_16_THRES),
218 RF_MDMCFG1_OFF, (RF_MDMCFG1_FEC_DIS |
219 RF_MDMCFG1_NUM_PREAMBLE_2 |
220 (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
222 RF_DEVIATN_OFF, ((RDF_DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
223 (RDF_DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
226 RF_PKTLEN_OFF, RDF_PACKET_LEN,
227 RF_PKTCTRL1_OFF, ((1 << PKTCTRL1_PQT_SHIFT)|
228 PKTCTRL1_ADR_CHK_NONE),
229 RF_PKTCTRL0_OFF, (RF_PKTCTRL0_PKT_FORMAT_NORMAL|
230 RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
233 static __code uint8_t telemetry_setup[] = {
234 RF_MDMCFG4_OFF, ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
235 (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
236 (DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
237 RF_MDMCFG3_OFF, (DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
238 RF_MDMCFG2_OFF, (RF_MDMCFG2_DEM_DCFILT_OFF |
239 RF_MDMCFG2_MOD_FORMAT_GFSK |
240 RF_MDMCFG2_SYNC_MODE_15_16_THRES),
241 RF_MDMCFG1_OFF, (RF_MDMCFG1_FEC_EN |
242 RF_MDMCFG1_NUM_PREAMBLE_4 |
243 (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
245 RF_DEVIATN_OFF, ((DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
246 (DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
248 /* max packet length */
249 RF_PKTLEN_OFF, sizeof (struct ao_telemetry),
250 RF_PKTCTRL1_OFF, ((1 << PKTCTRL1_PQT_SHIFT)|
251 PKTCTRL1_APPEND_STATUS|
252 PKTCTRL1_ADR_CHK_NONE),
253 RF_PKTCTRL0_OFF, (RF_PKTCTRL0_WHITE_DATA|
254 RF_PKTCTRL0_PKT_FORMAT_NORMAL|
256 RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
259 __xdata uint8_t ao_radio_dma;
260 __xdata uint8_t ao_radio_dma_done;
261 __xdata uint8_t ao_radio_mutex;
266 if (RF_MARCSTATE != RF_MARCSTATE_IDLE)
271 } while (RF_MARCSTATE != RF_MARCSTATE_IDLE);
276 ao_radio_send(__xdata struct ao_telemetry *telemetry) __reentrant
279 ao_mutex_get(&ao_radio_mutex);
281 RF_CHANNR = ao_config.radio_channel;
282 ao_dma_set_transfer(ao_radio_dma,
285 sizeof (struct ao_telemetry),
286 DMA_CFG0_WORDSIZE_8 |
287 DMA_CFG0_TMODE_SINGLE |
288 DMA_CFG0_TRIGGER_RADIO,
291 DMA_CFG1_PRIORITY_HIGH);
292 ao_dma_start(ao_radio_dma);
294 __critical while (!ao_radio_dma_done)
295 ao_sleep(&ao_radio_dma_done);
296 ao_mutex_put(&ao_radio_mutex);
300 ao_radio_recv(__xdata struct ao_radio_recv *radio) __reentrant
303 ao_mutex_get(&ao_radio_mutex);
305 RF_CHANNR = ao_config.radio_channel;
306 ao_dma_set_transfer(ao_radio_dma,
309 sizeof (struct ao_radio_recv),
310 DMA_CFG0_WORDSIZE_8 |
311 DMA_CFG0_TMODE_SINGLE |
312 DMA_CFG0_TRIGGER_RADIO,
315 DMA_CFG1_PRIORITY_HIGH);
316 ao_dma_start(ao_radio_dma);
318 __critical while (!ao_radio_dma_done)
319 ao_sleep(&ao_radio_dma_done);
320 ao_mutex_put(&ao_radio_mutex);
323 __xdata ao_radio_rdf_running;
324 __xdata ao_radio_rdf_value = 0x55;
330 ao_mutex_get(&ao_radio_mutex);
332 ao_radio_rdf_running = 1;
333 for (i = 0; i < sizeof (rdf_setup); i += 2)
334 RF[rdf_setup[i]] = rdf_setup[i+1];
336 ao_dma_set_transfer(ao_radio_dma,
340 DMA_CFG0_WORDSIZE_8 |
341 DMA_CFG0_TMODE_SINGLE |
342 DMA_CFG0_TRIGGER_RADIO,
345 DMA_CFG1_PRIORITY_HIGH);
346 ao_dma_start(ao_radio_dma);
349 __critical while (!ao_radio_dma_done)
350 ao_sleep(&ao_radio_dma_done);
351 ao_radio_rdf_running = 0;
353 for (i = 0; i < sizeof (rdf_setup); i += 2)
354 RF[telemetry_setup[i]] = telemetry_setup[i+1];
355 ao_mutex_put(&ao_radio_mutex);
359 ao_radio_rdf_abort(void)
361 if (ao_radio_rdf_running) {
362 ao_dma_abort(ao_radio_dma);
371 for (i = 0; i < sizeof (radio_setup); i += 2)
372 RF[radio_setup[i]] = radio_setup[i+1];
373 ao_radio_dma_done = 1;
374 ao_radio_dma = ao_dma_alloc(&ao_radio_dma_done);