git.gag.com Git - fw/altos/blob - src/ao_radio.c

   1 /*
   2  * Copyright © 2009 Keith Packard <keithp@keithp.com>
   3  *
   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.
   7  *
   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.
  12  *
  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.
  16  */
  17
  18 #include "ao.h"
  19
  20 /* Values from SmartRF® Studio for:
  21  *
  22  * Deviation:   20.507812 kHz
  23  * Datarate:    38.360596 kBaud
  24  * Modulation:  GFSK
  25  * RF Freq:     434.549927 MHz
  26  * Channel:     99.975586 kHz
  27  * Channel:     0
  28  * RX filter:   93.75 kHz
  29  */
  30
  31 /*
  32  * For IF freq of 140.62kHz, the IF value is:
  33  *
  34  * 140.62e3 / (24e6 / 2**10) = 6
  35  */
  36
  37 #define IF_FREQ_CONTROL 6
  38
  39 /*
  40  * For channel bandwidth of 93.75 kHz, the CHANBW_E and CHANBW_M values are
  41  *
  42  * BW = 24e6 / (8 * (4 + M) * 2 ** E)
  43  *
  44  * So, M = 0 and E = 3
  45  */
  46
  47 #define CHANBW_M        0
  48 #define CHANBW_E        3
  49
  50 /*
  51  * For a symbol rate of 38360kBaud, the DRATE_E and DRATE_M values are:
  52  *
  53  * R = (256 + M) * 2** E * 24e6 / 2**28
  54  *
  55  * So M is 163 and E is 10
  56  */
  57
  58 #define DRATE_E         10
  59 #define DRATE_M         163
  60
  61 /*
  62  * For a channel deviation of 20.5kHz, the DEVIATION_E and DEVIATION_M values are:
  63  *
  64  * F = 24e6/2**17 * (8 + DEVIATION_M) * 2**DEVIATION_E
  65  *
  66  * So M is 6 and E is 3
  67  */
  68
  69 #define DEVIATION_M     6
  70 #define DEVIATION_E     3
  71
  72 /*
  73  * For our RDF beacon, set the symbol rate to 2kBaud (for a 1kHz tone),
  74  * so the DRATE_E and DRATE_M values are:
  75  *
  76  * M is 94 and E is 6
  77  *
  78  * To make the tone last for 200ms, we need 2000 * .2 = 400 bits or 50 bytes
  79  */
  80
  81 #define RDF_DRATE_E     6
  82 #define RDF_DRATE_M     94
  83 #define RDF_PACKET_LEN  50
  84
  85 /*
  86  * RDF deviation should match the normal NFM value of 5kHz
  87  *
  88  * M is 6 and E is 1
  89  *
  90  */
  91
  92 #define RDF_DEVIATION_M 6
  93 #define RDF_DEVIATION_E 1
  94
  95 /* This are from the table for 433MHz */
  96
  97 #define RF_POWER_M30_DBM        0x12
  98 #define RF_POWER_M20_DBM        0x0e
  99 #define RF_POWER_M15_DBM        0x1d
 100 #define RF_POWER_M10_DBM        0x34
 101 #define RF_POWER_M5_DBM         0x2c
 102 #define RF_POWER_0_DBM          0x60
 103 #define RF_POWER_5_DBM          0x84
 104 #define RF_POWER_7_DBM          0xc8
 105 #define RF_POWER_10_DBM         0xc0
 106
 107 #define RF_POWER                RF_POWER_10_DBM
 108
 109 static __code uint8_t radio_setup[] = {
 110         RF_PA_TABLE7_OFF,       RF_POWER,
 111         RF_PA_TABLE6_OFF,       RF_POWER,
 112         RF_PA_TABLE5_OFF,       RF_POWER,
 113         RF_PA_TABLE4_OFF,       RF_POWER,
 114         RF_PA_TABLE3_OFF,       RF_POWER,
 115         RF_PA_TABLE2_OFF,       RF_POWER,
 116         RF_PA_TABLE1_OFF,       RF_POWER,
 117         RF_PA_TABLE0_OFF,       RF_POWER,
 118
 119         RF_FSCTRL1_OFF,         (IF_FREQ_CONTROL << RF_FSCTRL1_FREQ_IF_SHIFT),
 120         RF_FSCTRL0_OFF,         (0 << RF_FSCTRL0_FREQOFF_SHIFT),
 121
 122         RF_MDMCFG4_OFF,         ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
 123                                  (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
 124                                  (DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
 125         RF_MDMCFG3_OFF,         (DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
 126         RF_MDMCFG2_OFF,         (RF_MDMCFG2_DEM_DCFILT_OFF |
 127                                  RF_MDMCFG2_MOD_FORMAT_GFSK |
 128                                  RF_MDMCFG2_SYNC_MODE_15_16_THRES),
 129         RF_MDMCFG1_OFF,         (RF_MDMCFG1_FEC_EN |
 130                                  RF_MDMCFG1_NUM_PREAMBLE_4 |
 131                                  (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
 132         RF_MDMCFG0_OFF,         (17 << RF_MDMCFG0_CHANSPC_M_SHIFT),
 133
 134         RF_CHANNR_OFF,          0,
 135
 136         RF_DEVIATN_OFF,         ((DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
 137                                  (DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
 138
 139         /* SmartRF says set LODIV_BUF_CURRENT_TX to 0
 140          * And, we're not using power ramping, so use PA_POWER 0
 141          */
 142         RF_FREND0_OFF,          ((1 << RF_FREND0_LODIV_BUF_CURRENT_TX_SHIFT) |
 143                                  (0 << RF_FREND0_PA_POWER_SHIFT)),
 144
 145         RF_FREND1_OFF,          ((1 << RF_FREND1_LNA_CURRENT_SHIFT) |
 146                                  (1 << RF_FREND1_LNA2MIX_CURRENT_SHIFT) |
 147                                  (1 << RF_FREND1_LODIV_BUF_CURRENT_RX_SHIFT) |
 148                                  (2 << RF_FREND1_MIX_CURRENT_SHIFT)),
 149
 150         RF_FSCAL3_OFF,          0xE9,
 151         RF_FSCAL2_OFF,          0x0A,
 152         RF_FSCAL1_OFF,          0x00,
 153         RF_FSCAL0_OFF,          0x1F,
 154
 155         RF_TEST2_OFF,           0x88,
 156         RF_TEST1_OFF,           0x31,
 157         RF_TEST0_OFF,           0x09,
 158
 159         /* default sync values */
 160         RF_SYNC1_OFF,           0xD3,
 161         RF_SYNC0_OFF,           0x91,
 162
 163         /* max packet length */
 164         RF_PKTLEN_OFF,          sizeof (struct ao_telemetry),
 165
 166         RF_PKTCTRL1_OFF,        ((1 << PKTCTRL1_PQT_SHIFT)|
 167                                  PKTCTRL1_APPEND_STATUS|
 168                                  PKTCTRL1_ADR_CHK_NONE),
 169         RF_PKTCTRL0_OFF,        (RF_PKTCTRL0_WHITE_DATA|
 170                                  RF_PKTCTRL0_PKT_FORMAT_NORMAL|
 171                                  RF_PKTCTRL0_CRC_EN|
 172                                  RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
 173         RF_ADDR_OFF,            0x00,
 174         RF_MCSM2_OFF,           (RF_MCSM2_RX_TIME_END_OF_PACKET),
 175         RF_MCSM1_OFF,           (RF_MCSM1_CCA_MODE_RSSI_BELOW_UNLESS_RECEIVING|
 176                                  RF_MCSM1_RXOFF_MODE_IDLE|
 177                                  RF_MCSM1_TXOFF_MODE_IDLE),
 178         RF_MCSM0_OFF,           (RF_MCSM0_FS_AUTOCAL_FROM_IDLE|
 179                                  RF_MCSM0_MAGIC_3|
 180                                  RF_MCSM0_CLOSE_IN_RX_0DB),
 181         RF_FOCCFG_OFF,          (RF_FOCCFG_FOC_PRE_K_3K,
 182                                  RF_FOCCFG_FOC_POST_K_PRE_K,
 183                                  RF_FOCCFG_FOC_LIMIT_BW_OVER_4),
 184         RF_BSCFG_OFF,           (RF_BSCFG_BS_PRE_K_2K|
 185                                  RF_BSCFG_BS_PRE_KP_3KP|
 186                                  RF_BSCFG_BS_POST_KI_PRE_KI|
 187                                  RF_BSCFG_BS_POST_KP_PRE_KP|
 188                                  RF_BSCFG_BS_LIMIT_0),
 189         RF_AGCCTRL2_OFF,        0x43,
 190         RF_AGCCTRL1_OFF,        0x40,
 191         RF_AGCCTRL0_OFF,        0x91,
 192
 193         RF_IOCFG2_OFF,          0x00,
 194         RF_IOCFG1_OFF,          0x00,
 195         RF_IOCFG0_OFF,          0x00,
 196 };
 197
 198 static __code uint8_t rdf_setup[] = {
 199         RF_MDMCFG4_OFF,         ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
 200                                  (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
 201                                  (RDF_DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
 202         RF_MDMCFG3_OFF,         (RDF_DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
 203         RF_MDMCFG2_OFF,         (RF_MDMCFG2_DEM_DCFILT_OFF |
 204                                  RF_MDMCFG2_MOD_FORMAT_GFSK |
 205                                  RF_MDMCFG2_SYNC_MODE_15_16_THRES),
 206         RF_MDMCFG1_OFF,         (RF_MDMCFG1_FEC_DIS |
 207                                  RF_MDMCFG1_NUM_PREAMBLE_2 |
 208                                  (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
 209
 210         RF_DEVIATN_OFF,         ((RDF_DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
 211                                  (RDF_DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
 212
 213         /* packet length is set in-line */
 214         RF_PKTCTRL1_OFF,        ((1 << PKTCTRL1_PQT_SHIFT)|
 215                                  PKTCTRL1_ADR_CHK_NONE),
 216         RF_PKTCTRL0_OFF,        (RF_PKTCTRL0_PKT_FORMAT_NORMAL|
 217                                  RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
 218 };
 219
 220 static __code uint8_t telemetry_setup[] = {
 221         RF_MDMCFG4_OFF,         ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
 222                                  (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
 223                                  (DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
 224         RF_MDMCFG3_OFF,         (DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
 225         RF_MDMCFG2_OFF,         (RF_MDMCFG2_DEM_DCFILT_OFF |
 226                                  RF_MDMCFG2_MOD_FORMAT_GFSK |
 227                                  RF_MDMCFG2_SYNC_MODE_15_16_THRES),
 228         RF_MDMCFG1_OFF,         (RF_MDMCFG1_FEC_EN |
 229                                  RF_MDMCFG1_NUM_PREAMBLE_4 |
 230                                  (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
 231
 232         RF_DEVIATN_OFF,         ((DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
 233                                  (DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
 234
 235         /* max packet length */
 236         RF_PKTLEN_OFF,          sizeof (struct ao_telemetry),
 237         RF_PKTCTRL1_OFF,        ((1 << PKTCTRL1_PQT_SHIFT)|
 238                                  PKTCTRL1_APPEND_STATUS|
 239                                  PKTCTRL1_ADR_CHK_NONE),
 240         RF_PKTCTRL0_OFF,        (RF_PKTCTRL0_WHITE_DATA|
 241                                  RF_PKTCTRL0_PKT_FORMAT_NORMAL|
 242                                  RF_PKTCTRL0_CRC_EN|
 243                                  RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
 244 };
 245
 246 static __code uint8_t packet_setup[] = {
 247         RF_MDMCFG4_OFF,         ((CHANBW_E << RF_MDMCFG4_CHANBW_E_SHIFT) |
 248                                  (CHANBW_M << RF_MDMCFG4_CHANBW_M_SHIFT) |
 249                                  (DRATE_E << RF_MDMCFG4_DRATE_E_SHIFT)),
 250         RF_MDMCFG3_OFF,         (DRATE_M << RF_MDMCFG3_DRATE_M_SHIFT),
 251         RF_MDMCFG2_OFF,         (RF_MDMCFG2_DEM_DCFILT_OFF |
 252                                  RF_MDMCFG2_MOD_FORMAT_GFSK |
 253                                  RF_MDMCFG2_SYNC_MODE_15_16_THRES),
 254         RF_MDMCFG1_OFF,         (RF_MDMCFG1_FEC_EN |
 255                                  RF_MDMCFG1_NUM_PREAMBLE_4 |
 256                                  (2 << RF_MDMCFG1_CHANSPC_E_SHIFT)),
 257
 258         RF_DEVIATN_OFF,         ((DEVIATION_E << RF_DEVIATN_DEVIATION_E_SHIFT) |
 259                                  (DEVIATION_M << RF_DEVIATN_DEVIATION_M_SHIFT)),
 260
 261         /* max packet length */
 262         RF_PKTLEN_OFF,          sizeof (struct ao_packet),
 263         RF_PKTCTRL1_OFF,        ((1 << PKTCTRL1_PQT_SHIFT)|
 264                                  PKTCTRL1_APPEND_STATUS|
 265                                  PKTCTRL1_ADR_CHK_NONE),
 266         RF_PKTCTRL0_OFF,        (RF_PKTCTRL0_WHITE_DATA|
 267                                  RF_PKTCTRL0_PKT_FORMAT_NORMAL|
 268                                  RF_PKTCTRL0_CRC_EN|
 269                                  RF_PKTCTRL0_LENGTH_CONFIG_FIXED),
 270 };
 271
 272 __xdata uint8_t ao_radio_dma;
 273 __xdata uint8_t ao_radio_dma_done;
 274 __xdata uint8_t ao_radio_done;
 275 __xdata uint8_t ao_radio_abort;
 276 __xdata uint8_t ao_radio_mutex;
 277
 278 void
 279 ao_radio_general_isr(void) __interrupt 16
 280 {
 281         S1CON &= ~0x03;
 282         if (RFIF & RFIF_IM_TIMEOUT) {
 283                 ao_radio_recv_abort();
 284                 RFIF &= ~ RFIF_IM_TIMEOUT;
 285         } else if (RFIF & RFIF_IM_DONE) {
 286                 ao_radio_done = 1;
 287                 ao_wakeup(&ao_radio_done);
 288                 RFIF &= ~RFIF_IM_DONE;
 289         }
 290 }
 291
 292 void
 293 ao_radio_set_telemetry(void)
 294 {
 295         uint8_t i;
 296         for (i = 0; i < sizeof (telemetry_setup); i += 2)
 297                 RF[telemetry_setup[i]] = telemetry_setup[i+1];
 298 }
 299
 300 void
 301 ao_radio_set_packet(void)
 302 {
 303         uint8_t i;
 304         for (i = 0; i < sizeof (packet_setup); i += 2)
 305                 RF[packet_setup[i]] = packet_setup[i+1];
 306 }
 307
 308 void
 309 ao_radio_set_rdf(void)
 310 {
 311         uint8_t i;
 312         for (i = 0; i < sizeof (rdf_setup); i += 2)
 313                 RF[rdf_setup[i]] = rdf_setup[i+1];
 314 }
 315
 316 void
 317 ao_radio_idle(void)
 318 {
 319         if (RF_MARCSTATE != RF_MARCSTATE_IDLE)
 320         {
 321                 do {
 322                         RFST = RFST_SIDLE;
 323                         ao_yield();
 324                 } while (RF_MARCSTATE != RF_MARCSTATE_IDLE);
 325         }
 326 }
 327
 328 void
 329 ao_radio_get(void)
 330 {
 331         ao_config_get();
 332         ao_mutex_get(&ao_radio_mutex);
 333         ao_radio_idle();
 334         RF_CHANNR = ao_config.radio_channel;
 335         RF_FREQ2 = (uint8_t) (ao_config.radio_cal >> 16);
 336         RF_FREQ1 = (uint8_t) (ao_config.radio_cal >> 8);
 337         RF_FREQ0 = (uint8_t) (ao_config.radio_cal);
 338 }
 339
 340
 341 void
 342 ao_radio_send(__xdata void *packet, uint8_t size) __reentrant
 343 {
 344         ao_radio_get();
 345         ao_radio_done = 0;
 346         ao_dma_set_transfer(ao_radio_dma,
 347                             packet,
 348                             &RFDXADDR,
 349                             size,
 350                             DMA_CFG0_WORDSIZE_8 |
 351                             DMA_CFG0_TMODE_SINGLE |
 352                             DMA_CFG0_TRIGGER_RADIO,
 353                             DMA_CFG1_SRCINC_1 |
 354                             DMA_CFG1_DESTINC_0 |
 355                             DMA_CFG1_PRIORITY_HIGH);
 356         ao_dma_start(ao_radio_dma);
 357         RFST = RFST_STX;
 358         __critical while (!ao_radio_done)
 359                 ao_sleep(&ao_radio_done);
 360         ao_radio_put();
 361 }
 362
 363 uint8_t
 364 ao_radio_recv(__xdata void *packet, uint8_t size) __reentrant
 365 {
 366         ao_radio_abort = 0;
 367         ao_radio_get();
 368         ao_dma_set_transfer(ao_radio_dma,
 369                             &RFDXADDR,
 370                             packet,
 371                             size,
 372                             DMA_CFG0_WORDSIZE_8 |
 373                             DMA_CFG0_TMODE_SINGLE |
 374                             DMA_CFG0_TRIGGER_RADIO,
 375                             DMA_CFG1_SRCINC_0 |
 376                             DMA_CFG1_DESTINC_1 |
 377                             DMA_CFG1_PRIORITY_HIGH);
 378         ao_dma_start(ao_radio_dma);
 379         RFST = RFST_SRX;
 380
 381         /* Wait for DMA to be done, for the radio receive process to
 382          * get aborted or for a receive timeout to fire
 383          */
 384         __critical while (!ao_radio_dma_done && !ao_radio_abort)
 385                            if (ao_sleep(&ao_radio_dma_done))
 386                                    break;
 387
 388         /* If recv was aborted, clean up by stopping the DMA engine
 389          * and idling the radio
 390          */
 391         if (!ao_radio_dma_done) {
 392                 ao_dma_abort(ao_radio_dma);
 393                 ao_radio_idle();
 394         }
 395         ao_radio_put();
 396         return ao_radio_dma_done;
 397 }
 398
 399 /*
 400  * Wake up a task waiting to receive a radio packet
 401  * and tell them to abort the transfer
 402  */
 403
 404 void
 405 ao_radio_recv_abort(void)
 406 {
 407         ao_radio_abort = 1;
 408         ao_wakeup(&ao_radio_dma_done);
 409 }
 410
 411 __xdata ao_radio_rdf_value = 0x55;
 412
 413 void
 414 ao_radio_rdf(int ms)
 415 {
 416         uint8_t i;
 417         uint8_t pkt_len;
 418
 419         ao_radio_abort = 0;
 420         ao_radio_get();
 421         ao_radio_done = 0;
 422         for (i = 0; i < sizeof (rdf_setup); i += 2)
 423                 RF[rdf_setup[i]] = rdf_setup[i+1];
 424
 425         /*
 426          * Compute the packet length as follows:
 427          *
 428          * 2000 bps (for a 1kHz tone)
 429          * so, for 'ms' milliseconds, we need
 430          * 2 * ms bits, or ms / 4 bytes
 431          */
 432         if (ms > (255 * 4))
 433                 ms = 255 * 4;
 434         pkt_len = ms >> 2;
 435         RF[RF_PKTLEN_OFF] = pkt_len;
 436
 437         ao_dma_set_transfer(ao_radio_dma,
 438                             &ao_radio_rdf_value,
 439                             &RFDXADDR,
 440                             pkt_len,
 441                             DMA_CFG0_WORDSIZE_8 |
 442                             DMA_CFG0_TMODE_SINGLE |
 443                             DMA_CFG0_TRIGGER_RADIO,
 444                             DMA_CFG1_SRCINC_0 |
 445                             DMA_CFG1_DESTINC_0 |
 446                             DMA_CFG1_PRIORITY_HIGH);
 447         ao_dma_start(ao_radio_dma);
 448         RFST = RFST_STX;
 449         __critical while (!ao_radio_done && !ao_radio_abort)
 450                            ao_sleep(&ao_radio_done);
 451         if (!ao_radio_done) {
 452                 ao_dma_abort(ao_radio_dma);
 453                 ao_radio_idle();
 454         }
 455         for (i = 0; i < sizeof (telemetry_setup); i += 2)
 456                 RF[telemetry_setup[i]] = telemetry_setup[i+1];
 457         ao_radio_put();
 458 }
 459
 460 void
 461 ao_radio_rdf_abort(void)
 462 {
 463         ao_radio_abort = 1;
 464         ao_wakeup(&ao_radio_done);
 465 }
 466
 467
 468 /* Output carrier */
 469 void
 470 ao_radio_test(void)
 471 {
 472         uint8_t mode = 2;
 473         static __xdata radio_on;
 474         ao_cmd_white();
 475         if (ao_cmd_lex_c != '\n') {
 476                 ao_cmd_decimal();
 477                 mode = (uint8_t) ao_cmd_lex_u32;
 478         }
 479         mode++;
 480         if ((mode & 2) && !radio_on) {
 481                 ao_set_monitor(0);
 482                 ao_packet_slave_stop();
 483                 ao_radio_get();
 484                 RFST = RFST_STX;
 485                 radio_on = 1;
 486         }
 487         if (mode == 3) {
 488                 printf ("Hit a character to stop..."); flush();
 489                 getchar();
 490                 putchar('\n');
 491         }
 492         if ((mode & 1) && radio_on) {
 493                 ao_radio_idle();
 494                 ao_radio_put();
 495                 radio_on = 0;
 496         }
 497 }
 498
 499 __code struct ao_cmds ao_radio_cmds[] = {
 500         { 'C',  ao_radio_test,  "C <1 start, 0 stop, none both>     Radio carrier test" },
 501         { 0,    ao_radio_test,  NULL },
 502 };
 503
 504 void
 505 ao_radio_init(void)
 506 {
 507         uint8_t i;
 508         for (i = 0; i < sizeof (radio_setup); i += 2)
 509                 RF[radio_setup[i]] = radio_setup[i+1];
 510         ao_radio_set_telemetry();
 511         ao_radio_dma_done = 1;
 512         ao_radio_dma = ao_dma_alloc(&ao_radio_dma_done);
 513         RFIF = 0;
 514         RFIM = RFIM_IM_TIMEOUT|RFIM_IM_DONE;
 515         IEN2 |= IEN2_RFIE;
 516         ao_cmd_register(&ao_radio_cmds[0]);
 517 }