JunMo Hong / stm-spirit1-rf-driver_for_cubebite

Fork of EV-COG-AD3029LZ by JunMo Hong

Committer:
Wolfgang Betz
Date:
Mon Oct 24 08:34:33 2016 +0200
Revision:
8:10967c884e38
Parent:
7:e90fa8f6bc6c
Child:
9:3db68ab23070
Disable CONTIKI related stuff & Add Channel Setting Function

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Wolfgang Betz 0:4fb29d9ee571 1 /*** Mbed Includes ***/
Wolfgang Betz 0:4fb29d9ee571 2 #include "SimpleSpirit1.h"
Wolfgang Betz 3:0df38cfb1e53 3 #include "radio_spi.h"
Wolfgang Betz 0:4fb29d9ee571 4
Wolfgang Betz 0:4fb29d9ee571 5
Wolfgang Betz 0:4fb29d9ee571 6 /*** Macros from Cube Implementation ***/
Wolfgang Betz 4:07537ca85c66 7 #define CLEAR_TXBUF() (spirit_tx_len = 0)
Wolfgang Betz 4:07537ca85c66 8 #define IS_RXBUF_EMPTY() (spirit_rx_len == 0)
Wolfgang Betz 6:f5d01793bf86 9 #define CLEAR_RXBUF() do { \
Wolfgang Betz 6:f5d01793bf86 10 spirit_rx_len = 0; \
Wolfgang Betz 6:f5d01793bf86 11 _spirit_rx_pos = 0; \
Wolfgang Betz 6:f5d01793bf86 12 } while(0)
Wolfgang Betz 0:4fb29d9ee571 13
Wolfgang Betz 7:e90fa8f6bc6c 14 #define NDEBUG
Wolfgang Betz 3:0df38cfb1e53 15 #ifndef NDEBUG
Wolfgang Betz 3:0df38cfb1e53 16 #include <stdio.h>
Wolfgang Betz 3:0df38cfb1e53 17 #define PRINTF(...) printf(__VA_ARGS__)
Wolfgang Betz 3:0df38cfb1e53 18 #else
Wolfgang Betz 3:0df38cfb1e53 19 #define PRINTF(...)
Wolfgang Betz 3:0df38cfb1e53 20 #endif
Wolfgang Betz 0:4fb29d9ee571 21
Wolfgang Betz 3:0df38cfb1e53 22 #if NULLRDC_CONF_802154_AUTOACK
Wolfgang Betz 3:0df38cfb1e53 23 #define ACK_LEN 3
Wolfgang Betz 3:0df38cfb1e53 24 static int wants_an_ack = 0; /* The packet sent expects an ack */
Wolfgang Betz 3:0df38cfb1e53 25 //#define ACKPRINTF printf
Wolfgang Betz 3:0df38cfb1e53 26 #define ACKPRINTF(...)
Wolfgang Betz 3:0df38cfb1e53 27 #endif /* NULLRDC_CONF_802154_AUTOACK */
Wolfgang Betz 3:0df38cfb1e53 28
Wolfgang Betz 4:07537ca85c66 29 #define SPIRIT_GPIO_IRQ (SPIRIT_GPIO_3)
Wolfgang Betz 3:0df38cfb1e53 30
Wolfgang Betz 4:07537ca85c66 31 #define SPIRIT1_STATUS() (arch_refresh_status() & SPIRIT1_STATE_STATEBITS)
Wolfgang Betz 3:0df38cfb1e53 32
Wolfgang Betz 4:07537ca85c66 33 #define SABORT_WAIT_US (400)
Wolfgang Betz 3:0df38cfb1e53 34
Wolfgang Betz 3:0df38cfb1e53 35 #define BUSYWAIT_UNTIL(cond, millisecs) \
Wolfgang Betz 3:0df38cfb1e53 36 do { \
Wolfgang Betz 7:e90fa8f6bc6c 37 uint32_t start = us_ticker_read(); \
Wolfgang Betz 7:e90fa8f6bc6c 38 while (!(cond) && ((us_ticker_read() - start) < ((uint32_t)millisecs)*1000U)); \
Wolfgang Betz 3:0df38cfb1e53 39 } while(0)
Wolfgang Betz 3:0df38cfb1e53 40
Wolfgang Betz 4:07537ca85c66 41 extern volatile SpiritStatus g_xStatus;
Wolfgang Betz 4:07537ca85c66 42 #define st_lib_g_x_status (g_xStatus)
Wolfgang Betz 4:07537ca85c66 43
Wolfgang Betz 4:07537ca85c66 44 #define st_lib_spirit_irqs SpiritIrqs
Wolfgang Betz 4:07537ca85c66 45
Wolfgang Betz 0:4fb29d9ee571 46
Wolfgang Betz 0:4fb29d9ee571 47 /*** Class Implementation ***/
Wolfgang Betz 3:0df38cfb1e53 48 /** Static Class Variables **/
Wolfgang Betz 3:0df38cfb1e53 49 SimpleSpirit1 *SimpleSpirit1::_singleton = NULL;
Wolfgang Betz 3:0df38cfb1e53 50
Wolfgang Betz 3:0df38cfb1e53 51 /** Constructor **/
Wolfgang Betz 0:4fb29d9ee571 52 SimpleSpirit1::SimpleSpirit1(PinName mosi, PinName miso, PinName sclk,
Wolfgang Betz 0:4fb29d9ee571 53 PinName irq, PinName cs, PinName sdn,
Wolfgang Betz 0:4fb29d9ee571 54 PinName led) :
Wolfgang Betz 0:4fb29d9ee571 55 _spi(mosi, miso, sclk),
Wolfgang Betz 0:4fb29d9ee571 56 _irq(irq),
Wolfgang Betz 0:4fb29d9ee571 57 _chip_select(cs),
Wolfgang Betz 0:4fb29d9ee571 58 _shut_down(sdn),
Wolfgang Betz 4:07537ca85c66 59 _led(led),
Wolfgang Betz 4:07537ca85c66 60 _current_irq_callback()
Wolfgang Betz 0:4fb29d9ee571 61 {
Wolfgang Betz 3:0df38cfb1e53 62 /* reset irq disable counter and irq callback & disable irq */
Wolfgang Betz 3:0df38cfb1e53 63 _nr_of_irq_disables = 0;
Wolfgang Betz 4:07537ca85c66 64 disable_spirit_irq();
Wolfgang Betz 0:4fb29d9ee571 65
Wolfgang Betz 0:4fb29d9ee571 66 /* unselect chip */
Wolfgang Betz 0:4fb29d9ee571 67 chip_unselect();
Wolfgang Betz 0:4fb29d9ee571 68
Wolfgang Betz 0:4fb29d9ee571 69 /* configure spi */
Wolfgang Betz 0:4fb29d9ee571 70 _spi.format(8, 0); /* 8-bit, mode = 0, [order = SPI_MSB] only available in mbed3 */
Wolfgang Betz 0:4fb29d9ee571 71 _spi.frequency(5000000); // 5MHz
Wolfgang Betz 3:0df38cfb1e53 72
Wolfgang Betz 5:c9c5bc673c64 73 /* install irq handler */
Wolfgang Betz 5:c9c5bc673c64 74 _irq.fall(Callback<void()>(this, &SimpleSpirit1::IrqHandler));
Wolfgang Betz 5:c9c5bc673c64 75
Wolfgang Betz 3:0df38cfb1e53 76 /* init cube vars */
Wolfgang Betz 3:0df38cfb1e53 77 spirit_on = OFF;
Wolfgang Betz 8:10967c884e38 78 #ifdef CONTIKI // betzw - TODO
Wolfgang Betz 3:0df38cfb1e53 79 packet_is_prepared = 0;
Wolfgang Betz 8:10967c884e38 80 just_got_an_ack = 0;
Wolfgang Betz 8:10967c884e38 81 #endif // CONTIKI
Wolfgang Betz 3:0df38cfb1e53 82 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 83 last_rssi = 0 ; //MGR
Wolfgang Betz 4:07537ca85c66 84 last_lqi = 0 ; //MGR
Wolfgang Betz 2:45642c5198a2 85 }
Wolfgang Betz 0:4fb29d9ee571 86
Wolfgang Betz 3:0df38cfb1e53 87 /** Init Function **/
Wolfgang Betz 2:45642c5198a2 88 void SimpleSpirit1::init() {
Wolfgang Betz 0:4fb29d9ee571 89 /* set frequencies */
Wolfgang Betz 0:4fb29d9ee571 90 radio_set_xtal_freq(XTAL_FREQUENCY);
Wolfgang Betz 2:45642c5198a2 91 mgmt_set_freq_base((uint32_t)BASE_FREQUENCY);
Wolfgang Betz 0:4fb29d9ee571 92
Wolfgang Betz 0:4fb29d9ee571 93 /* restart board */
Wolfgang Betz 0:4fb29d9ee571 94 enter_shutdown();
Wolfgang Betz 0:4fb29d9ee571 95 exit_shutdown();
Wolfgang Betz 0:4fb29d9ee571 96
Wolfgang Betz 0:4fb29d9ee571 97 /* soft core reset */
Wolfgang Betz 4:07537ca85c66 98 cmd_strobe(SPIRIT1_STROBE_SRES);
Wolfgang Betz 0:4fb29d9ee571 99
Wolfgang Betz 0:4fb29d9ee571 100 /* Configures the SPIRIT1 radio part */
Wolfgang Betz 0:4fb29d9ee571 101 SRadioInit x_radio_init = {
Wolfgang Betz 0:4fb29d9ee571 102 XTAL_OFFSET_PPM,
Wolfgang Betz 0:4fb29d9ee571 103 (uint32_t)BASE_FREQUENCY,
Wolfgang Betz 0:4fb29d9ee571 104 (uint32_t)CHANNEL_SPACE,
Wolfgang Betz 0:4fb29d9ee571 105 CHANNEL_NUMBER,
Wolfgang Betz 0:4fb29d9ee571 106 MODULATION_SELECT,
Wolfgang Betz 0:4fb29d9ee571 107 DATARATE,
Wolfgang Betz 0:4fb29d9ee571 108 (uint32_t)FREQ_DEVIATION,
Wolfgang Betz 0:4fb29d9ee571 109 (uint32_t)BANDWIDTH
Wolfgang Betz 0:4fb29d9ee571 110 };
Wolfgang Betz 0:4fb29d9ee571 111 radio_init(&x_radio_init);
Wolfgang Betz 0:4fb29d9ee571 112 radio_set_pa_level_dbm(0,POWER_DBM);
Wolfgang Betz 0:4fb29d9ee571 113 radio_set_pa_level_max_index(0);
Wolfgang Betz 0:4fb29d9ee571 114
Wolfgang Betz 0:4fb29d9ee571 115 /* Configures the SPIRIT1 packet handler part*/
Wolfgang Betz 0:4fb29d9ee571 116 PktBasicInit x_basic_init = {
Wolfgang Betz 0:4fb29d9ee571 117 PREAMBLE_LENGTH,
Wolfgang Betz 0:4fb29d9ee571 118 SYNC_LENGTH,
Wolfgang Betz 0:4fb29d9ee571 119 SYNC_WORD,
Wolfgang Betz 0:4fb29d9ee571 120 LENGTH_TYPE,
Wolfgang Betz 0:4fb29d9ee571 121 LENGTH_WIDTH,
Wolfgang Betz 0:4fb29d9ee571 122 CRC_MODE,
Wolfgang Betz 0:4fb29d9ee571 123 CONTROL_LENGTH,
Wolfgang Betz 0:4fb29d9ee571 124 EN_ADDRESS,
Wolfgang Betz 0:4fb29d9ee571 125 EN_FEC,
Wolfgang Betz 0:4fb29d9ee571 126 EN_WHITENING
Wolfgang Betz 0:4fb29d9ee571 127 };
Wolfgang Betz 0:4fb29d9ee571 128 pkt_basic_init(&x_basic_init);
Wolfgang Betz 0:4fb29d9ee571 129
Wolfgang Betz 0:4fb29d9ee571 130 /* Enable the following interrupt sources, routed to GPIO */
Wolfgang Betz 0:4fb29d9ee571 131 irq_de_init(NULL);
Wolfgang Betz 0:4fb29d9ee571 132 irq_clear_status();
Wolfgang Betz 0:4fb29d9ee571 133 irq_set_status(TX_DATA_SENT, S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 134 irq_set_status(RX_DATA_READY,S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 135 irq_set_status(VALID_SYNC,S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 136 irq_set_status(RX_DATA_DISC, S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 137 irq_set_status(TX_FIFO_ERROR, S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 138 irq_set_status(RX_FIFO_ERROR, S_ENABLE);
Wolfgang Betz 6:f5d01793bf86 139 irq_set_status(RX_FIFO_ALMOST_FULL, S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 140
Wolfgang Betz 0:4fb29d9ee571 141 /* Configure Spirit1 */
Wolfgang Betz 0:4fb29d9ee571 142 radio_persisten_rx(S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 143 qi_set_sqi_threshold(SQI_TH_0);
Wolfgang Betz 0:4fb29d9ee571 144 qi_sqi_check(S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 145 qi_set_rssi_threshold_dbm(CCA_THRESHOLD);
Wolfgang Betz 0:4fb29d9ee571 146 timer_set_rx_timeout_stop_condition(SQI_ABOVE_THRESHOLD);
Wolfgang Betz 0:4fb29d9ee571 147 timer_set_infinite_rx_timeout();
Wolfgang Betz 0:4fb29d9ee571 148 radio_afc_freeze_on_sync(S_ENABLE);
Wolfgang Betz 0:4fb29d9ee571 149
Wolfgang Betz 0:4fb29d9ee571 150 /* Puts the SPIRIT1 in STANDBY mode (125us -> rx/tx) */
Wolfgang Betz 4:07537ca85c66 151 cmd_strobe(SPIRIT1_STROBE_STANDBY);
Wolfgang Betz 0:4fb29d9ee571 152 spirit_on = OFF;
Wolfgang Betz 6:f5d01793bf86 153 CLEAR_TXBUF();
Wolfgang Betz 0:4fb29d9ee571 154 CLEAR_RXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 155 _spirit_tx_started = false;
Wolfgang Betz 6:f5d01793bf86 156 _spirit_rx_err = false;
Wolfgang Betz 0:4fb29d9ee571 157
Wolfgang Betz 0:4fb29d9ee571 158 /* Configure the radio to route the IRQ signal to its GPIO 3 */
Wolfgang Betz 0:4fb29d9ee571 159 SGpioInit x_gpio_init = {
Wolfgang Betz 0:4fb29d9ee571 160 SPIRIT_GPIO_IRQ,
Wolfgang Betz 0:4fb29d9ee571 161 SPIRIT_GPIO_MODE_DIGITAL_OUTPUT_LP,
Wolfgang Betz 0:4fb29d9ee571 162 SPIRIT_GPIO_DIG_OUT_IRQ
Wolfgang Betz 0:4fb29d9ee571 163 };
Wolfgang Betz 0:4fb29d9ee571 164 spirit_gpio_init(&x_gpio_init);
Wolfgang Betz 0:4fb29d9ee571 165 }
Wolfgang Betz 3:0df38cfb1e53 166
Wolfgang Betz 8:10967c884e38 167 #ifdef CONTIKI // betzw - TODO
Wolfgang Betz 3:0df38cfb1e53 168 /** Prepare the radio with a packet to be sent. **/
Wolfgang Betz 5:c9c5bc673c64 169 int SimpleSpirit1::prepare_contiki(const void *payload, unsigned short payload_len) {
Wolfgang Betz 3:0df38cfb1e53 170 PRINTF("Spirit1: prep %u\n", payload_len);
Wolfgang Betz 3:0df38cfb1e53 171 packet_is_prepared = 0;
Wolfgang Betz 3:0df38cfb1e53 172
Wolfgang Betz 3:0df38cfb1e53 173 /* Checks if the payload length is supported */
Wolfgang Betz 3:0df38cfb1e53 174 if(payload_len > MAX_PACKET_LEN) {
Wolfgang Betz 3:0df38cfb1e53 175 return RADIO_TX_ERR;
Wolfgang Betz 3:0df38cfb1e53 176 }
Wolfgang Betz 3:0df38cfb1e53 177
Wolfgang Betz 3:0df38cfb1e53 178 /* Should we delay for an ack? */
Wolfgang Betz 3:0df38cfb1e53 179 #if NULLRDC_CONF_802154_AUTOACK
Wolfgang Betz 3:0df38cfb1e53 180 frame802154_t info154;
Wolfgang Betz 3:0df38cfb1e53 181 wants_an_ack = 0;
Wolfgang Betz 3:0df38cfb1e53 182 if(payload_len > ACK_LEN
Wolfgang Betz 3:0df38cfb1e53 183 && frame802154_parse((char*)payload, payload_len, &info154) != 0) {
Wolfgang Betz 3:0df38cfb1e53 184 if(info154.fcf.frame_type == FRAME802154_DATAFRAME
Wolfgang Betz 3:0df38cfb1e53 185 && info154.fcf.ack_required != 0) {
Wolfgang Betz 3:0df38cfb1e53 186 wants_an_ack = 1;
Wolfgang Betz 3:0df38cfb1e53 187 }
Wolfgang Betz 3:0df38cfb1e53 188 }
Wolfgang Betz 3:0df38cfb1e53 189 #endif /* NULLRDC_CONF_802154_AUTOACK */
Wolfgang Betz 3:0df38cfb1e53 190
Wolfgang Betz 3:0df38cfb1e53 191 /* Sets the length of the packet to send */
Wolfgang Betz 4:07537ca85c66 192 disable_spirit_irq();
Wolfgang Betz 4:07537ca85c66 193 cmd_strobe(SPIRIT1_STROBE_FTX);
Wolfgang Betz 3:0df38cfb1e53 194 pkt_basic_set_payload_length(payload_len);
Wolfgang Betz 3:0df38cfb1e53 195 spi_write_linear_fifo(payload_len, (uint8_t *)payload);
Wolfgang Betz 4:07537ca85c66 196 enable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 197
Wolfgang Betz 3:0df38cfb1e53 198 PRINTF("PREPARE OUT\n");
Wolfgang Betz 3:0df38cfb1e53 199
Wolfgang Betz 3:0df38cfb1e53 200 packet_is_prepared = 1;
Wolfgang Betz 3:0df38cfb1e53 201 return RADIO_TX_OK;
Wolfgang Betz 3:0df38cfb1e53 202 }
Wolfgang Betz 3:0df38cfb1e53 203
Wolfgang Betz 3:0df38cfb1e53 204 /** Send the packet that has previously been prepared. **/
Wolfgang Betz 5:c9c5bc673c64 205 int SimpleSpirit1::transmit_contiki(unsigned short payload_len) {
Wolfgang Betz 3:0df38cfb1e53 206 /* This function blocks until the packet has been transmitted */
Wolfgang Betz 3:0df38cfb1e53 207 //rtimer_clock_t rtimer_txdone, rtimer_rxack;
Wolfgang Betz 3:0df38cfb1e53 208
Wolfgang Betz 3:0df38cfb1e53 209 PRINTF("TRANSMIT IN\n");
Wolfgang Betz 3:0df38cfb1e53 210 if(!packet_is_prepared) {
Wolfgang Betz 3:0df38cfb1e53 211 return RADIO_TX_ERR;
Wolfgang Betz 3:0df38cfb1e53 212 }
Wolfgang Betz 3:0df38cfb1e53 213
Wolfgang Betz 3:0df38cfb1e53 214 /* Stores the length of the packet to send */
Wolfgang Betz 3:0df38cfb1e53 215 /* Others spirit_radio_prepare will be in hold */
Wolfgang Betz 4:07537ca85c66 216 spirit_tx_len = payload_len;
Wolfgang Betz 3:0df38cfb1e53 217
Wolfgang Betz 3:0df38cfb1e53 218 /* Puts the SPIRIT1 in TX state */
Wolfgang Betz 3:0df38cfb1e53 219 receiving_packet = 0;
Wolfgang Betz 3:0df38cfb1e53 220 set_ready_state();
Wolfgang Betz 4:07537ca85c66 221 cmd_strobe(SPIRIT1_STROBE_TX);
Wolfgang Betz 3:0df38cfb1e53 222 just_got_an_ack = 0;
Wolfgang Betz 3:0df38cfb1e53 223 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_TX, 1);
Wolfgang Betz 3:0df38cfb1e53 224 //BUSYWAIT_UNTIL(SPIRIT1_STATUS() != SPIRIT1_STATE_TX, 4); //For GFSK with high data rate
Wolfgang Betz 3:0df38cfb1e53 225 BUSYWAIT_UNTIL(SPIRIT1_STATUS() != SPIRIT1_STATE_TX, 50); //For FSK with low data rate
Wolfgang Betz 3:0df38cfb1e53 226
Wolfgang Betz 3:0df38cfb1e53 227 /* Reset radio - needed for immediate RX of ack */
Wolfgang Betz 3:0df38cfb1e53 228 CLEAR_TXBUF();
Wolfgang Betz 3:0df38cfb1e53 229 CLEAR_RXBUF();
Wolfgang Betz 4:07537ca85c66 230 disable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 231 irq_clear_status();
Wolfgang Betz 7:e90fa8f6bc6c 232 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 233 cmd_strobe(SPIRIT1_STROBE_SABORT);
Wolfgang Betz 3:0df38cfb1e53 234 wait_us(SABORT_WAIT_US);
Wolfgang Betz 4:07537ca85c66 235 cmd_strobe(SPIRIT1_STROBE_READY);
Wolfgang Betz 3:0df38cfb1e53 236 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_READY, 1);
Wolfgang Betz 6:f5d01793bf86 237 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 4:07537ca85c66 238 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 3:0df38cfb1e53 239 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, 1);
Wolfgang Betz 4:07537ca85c66 240 enable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 241
Wolfgang Betz 3:0df38cfb1e53 242 #if XXX_ACK_WORKAROUND
Wolfgang Betz 3:0df38cfb1e53 243 just_got_an_ack = 1;
Wolfgang Betz 3:0df38cfb1e53 244 #endif /* XXX_ACK_WORKAROUND */
Wolfgang Betz 3:0df38cfb1e53 245
Wolfgang Betz 3:0df38cfb1e53 246 #if NULLRDC_CONF_802154_AUTOACK
Wolfgang Betz 3:0df38cfb1e53 247 if (wants_an_ack) {
Wolfgang Betz 7:e90fa8f6bc6c 248 rtimer_txdone = us_ticker_read();
Wolfgang Betz 3:0df38cfb1e53 249 BUSYWAIT_UNTIL(just_got_an_ack, 2);
Wolfgang Betz 7:e90fa8f6bc6c 250 rtimer_rxack = us_ticker_read();
Wolfgang Betz 3:0df38cfb1e53 251
Wolfgang Betz 3:0df38cfb1e53 252 if(just_got_an_ack) {
Wolfgang Betz 4:07537ca85c66 253 ACKPRINTF("debug_ack: ack received after %u us\n",
Wolfgang Betz 3:0df38cfb1e53 254 (uint32_t)(rtimer_rxack - rtimer_txdone));
Wolfgang Betz 3:0df38cfb1e53 255 } else {
Wolfgang Betz 3:0df38cfb1e53 256 ACKPRINTF("debug_ack: no ack received\n");
Wolfgang Betz 3:0df38cfb1e53 257 }
Wolfgang Betz 3:0df38cfb1e53 258 }
Wolfgang Betz 3:0df38cfb1e53 259 #endif /* NULLRDC_CONF_802154_AUTOACK */
Wolfgang Betz 3:0df38cfb1e53 260
Wolfgang Betz 3:0df38cfb1e53 261 PRINTF("TRANSMIT OUT\n");
Wolfgang Betz 3:0df38cfb1e53 262
Wolfgang Betz 3:0df38cfb1e53 263 CLEAR_TXBUF();
Wolfgang Betz 3:0df38cfb1e53 264
Wolfgang Betz 3:0df38cfb1e53 265 packet_is_prepared = 0;
Wolfgang Betz 3:0df38cfb1e53 266
Wolfgang Betz 3:0df38cfb1e53 267 wait_us(1);
Wolfgang Betz 3:0df38cfb1e53 268
Wolfgang Betz 3:0df38cfb1e53 269 return RADIO_TX_OK;
Wolfgang Betz 3:0df38cfb1e53 270 }
Wolfgang Betz 8:10967c884e38 271 #endif // CONTIKI
Wolfgang Betz 3:0df38cfb1e53 272
Wolfgang Betz 6:f5d01793bf86 273 int SimpleSpirit1::send(const void *payload, unsigned int payload_len) {
Wolfgang Betz 5:c9c5bc673c64 274 /* Checks if the payload length is supported */
Wolfgang Betz 5:c9c5bc673c64 275 if(payload_len > MAX_PACKET_LEN) {
Wolfgang Betz 5:c9c5bc673c64 276 return RADIO_TX_ERR;
Wolfgang Betz 5:c9c5bc673c64 277 }
Wolfgang Betz 5:c9c5bc673c64 278
Wolfgang Betz 5:c9c5bc673c64 279 disable_spirit_irq();
Wolfgang Betz 5:c9c5bc673c64 280
Wolfgang Betz 5:c9c5bc673c64 281 /* Reset State to Ready */
Wolfgang Betz 5:c9c5bc673c64 282 set_ready_state();
Wolfgang Betz 5:c9c5bc673c64 283
Wolfgang Betz 5:c9c5bc673c64 284 cmd_strobe(SPIRIT1_STROBE_FTX); // flush TX FIFO buffer
Wolfgang Betz 5:c9c5bc673c64 285 MBED_ASSERT(linear_fifo_read_num_elements_tx_fifo() == 0);
Wolfgang Betz 5:c9c5bc673c64 286
Wolfgang Betz 5:c9c5bc673c64 287 pkt_basic_set_payload_length(payload_len); // set desired payload len
Wolfgang Betz 5:c9c5bc673c64 288
Wolfgang Betz 5:c9c5bc673c64 289 int i = 0;
Wolfgang Betz 5:c9c5bc673c64 290 int remaining = payload_len;
Wolfgang Betz 5:c9c5bc673c64 291 bool trigger_tx = true;
Wolfgang Betz 5:c9c5bc673c64 292 do {
Wolfgang Betz 5:c9c5bc673c64 293 uint8_t fifo_available = SPIRIT_MAX_FIFO_LEN - linear_fifo_read_num_elements_tx_fifo();
Wolfgang Betz 5:c9c5bc673c64 294 uint8_t to_send = (remaining > fifo_available) ? fifo_available : remaining;
Wolfgang Betz 5:c9c5bc673c64 295 const uint8_t *buffer = (const uint8_t*)payload;
Wolfgang Betz 5:c9c5bc673c64 296
Wolfgang Betz 5:c9c5bc673c64 297 /* Fill FIFO Buffer */
Wolfgang Betz 5:c9c5bc673c64 298 spi_write_linear_fifo(to_send, (uint8_t*)&buffer[i]);
Wolfgang Betz 5:c9c5bc673c64 299
Wolfgang Betz 5:c9c5bc673c64 300 /* Start Transmit FIFO Buffer */
Wolfgang Betz 5:c9c5bc673c64 301 if(trigger_tx) {
Wolfgang Betz 5:c9c5bc673c64 302 MBED_ASSERT(linear_fifo_read_num_elements_tx_fifo() == to_send);
Wolfgang Betz 5:c9c5bc673c64 303 cmd_strobe(SPIRIT1_STROBE_TX);
Wolfgang Betz 5:c9c5bc673c64 304 trigger_tx = false;
Wolfgang Betz 5:c9c5bc673c64 305 }
Wolfgang Betz 5:c9c5bc673c64 306
Wolfgang Betz 5:c9c5bc673c64 307 i += to_send;
Wolfgang Betz 5:c9c5bc673c64 308 remaining -= to_send;
Wolfgang Betz 5:c9c5bc673c64 309 } while(remaining != 0);
Wolfgang Betz 5:c9c5bc673c64 310
Wolfgang Betz 7:e90fa8f6bc6c 311 _spirit_tx_started = true;
Wolfgang Betz 7:e90fa8f6bc6c 312
Wolfgang Betz 7:e90fa8f6bc6c 313 enable_spirit_irq();
Wolfgang Betz 7:e90fa8f6bc6c 314
Wolfgang Betz 5:c9c5bc673c64 315 BUSYWAIT_UNTIL(SPIRIT1_STATUS() != SPIRIT1_STATE_TX, 50);
Wolfgang Betz 5:c9c5bc673c64 316 MBED_ASSERT(linear_fifo_read_num_elements_tx_fifo() == 0);
Wolfgang Betz 5:c9c5bc673c64 317
Wolfgang Betz 5:c9c5bc673c64 318 return RADIO_TX_OK;
Wolfgang Betz 5:c9c5bc673c64 319 }
Wolfgang Betz 5:c9c5bc673c64 320
Wolfgang Betz 3:0df38cfb1e53 321 /** Set Ready State **/
Wolfgang Betz 3:0df38cfb1e53 322 void SimpleSpirit1::set_ready_state(void) {
Wolfgang Betz 3:0df38cfb1e53 323 PRINTF("READY IN\n");
Wolfgang Betz 3:0df38cfb1e53 324
Wolfgang Betz 4:07537ca85c66 325 disable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 326
Wolfgang Betz 3:0df38cfb1e53 327 if(SPIRIT1_STATUS() == SPIRIT1_STATE_STANDBY) {
Wolfgang Betz 4:07537ca85c66 328 cmd_strobe(SPIRIT1_STROBE_READY);
Wolfgang Betz 3:0df38cfb1e53 329 } else if(SPIRIT1_STATUS() == SPIRIT1_STATE_RX) {
Wolfgang Betz 7:e90fa8f6bc6c 330 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 331 cmd_strobe(SPIRIT1_STROBE_SABORT);
Wolfgang Betz 3:0df38cfb1e53 332 }
Wolfgang Betz 7:e90fa8f6bc6c 333 irq_clear_status();
Wolfgang Betz 3:0df38cfb1e53 334
Wolfgang Betz 4:07537ca85c66 335 enable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 336
Wolfgang Betz 3:0df38cfb1e53 337 PRINTF("READY OUT\n");
Wolfgang Betz 3:0df38cfb1e53 338 }
Wolfgang Betz 3:0df38cfb1e53 339
Wolfgang Betz 4:07537ca85c66 340 int SimpleSpirit1::off(void) {
Wolfgang Betz 3:0df38cfb1e53 341 PRINTF("Spirit1: ->off\n");
Wolfgang Betz 3:0df38cfb1e53 342 if(spirit_on == ON) {
Wolfgang Betz 3:0df38cfb1e53 343 /* Disables the mcu to get IRQ from the SPIRIT1 */
Wolfgang Betz 4:07537ca85c66 344 disable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 345
Wolfgang Betz 3:0df38cfb1e53 346 /* first stop rx/tx */
Wolfgang Betz 7:e90fa8f6bc6c 347 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 348 cmd_strobe(SPIRIT1_STROBE_SABORT);
Wolfgang Betz 3:0df38cfb1e53 349
Wolfgang Betz 3:0df38cfb1e53 350 /* Clear any pending irqs */
Wolfgang Betz 3:0df38cfb1e53 351 irq_clear_status();
Wolfgang Betz 3:0df38cfb1e53 352
Wolfgang Betz 3:0df38cfb1e53 353 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_READY, 5);
Wolfgang Betz 3:0df38cfb1e53 354 if(SPIRIT1_STATUS() != SPIRIT1_STATE_READY) {
Wolfgang Betz 3:0df38cfb1e53 355 PRINTF("Spirit1: failed off->ready\n");
Wolfgang Betz 3:0df38cfb1e53 356 return 1;
Wolfgang Betz 3:0df38cfb1e53 357 }
Wolfgang Betz 3:0df38cfb1e53 358
Wolfgang Betz 3:0df38cfb1e53 359 /* Puts the SPIRIT1 in STANDBY */
Wolfgang Betz 4:07537ca85c66 360 cmd_strobe(SPIRIT1_STROBE_STANDBY);
Wolfgang Betz 3:0df38cfb1e53 361 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_STANDBY, 5);
Wolfgang Betz 3:0df38cfb1e53 362 if(SPIRIT1_STATUS() != SPIRIT1_STATE_STANDBY) {
Wolfgang Betz 3:0df38cfb1e53 363 PRINTF("Spirit1: failed off->standby\n");
Wolfgang Betz 3:0df38cfb1e53 364 return 1;
Wolfgang Betz 3:0df38cfb1e53 365 }
Wolfgang Betz 3:0df38cfb1e53 366
Wolfgang Betz 3:0df38cfb1e53 367 spirit_on = OFF;
Wolfgang Betz 4:07537ca85c66 368 _nr_of_irq_disables = 1;
Wolfgang Betz 7:e90fa8f6bc6c 369 _spirit_tx_started = false;
Wolfgang Betz 3:0df38cfb1e53 370 CLEAR_TXBUF();
Wolfgang Betz 3:0df38cfb1e53 371 CLEAR_RXBUF();
Wolfgang Betz 3:0df38cfb1e53 372 }
Wolfgang Betz 3:0df38cfb1e53 373 PRINTF("Spirit1: off.\n");
Wolfgang Betz 3:0df38cfb1e53 374 return 0;
Wolfgang Betz 3:0df38cfb1e53 375 }
Wolfgang Betz 3:0df38cfb1e53 376
Wolfgang Betz 4:07537ca85c66 377 int SimpleSpirit1::on(void) {
Wolfgang Betz 3:0df38cfb1e53 378 PRINTF("Spirit1: on\n");
Wolfgang Betz 4:07537ca85c66 379 cmd_strobe(SPIRIT1_STROBE_SABORT);
Wolfgang Betz 3:0df38cfb1e53 380 wait_us(SABORT_WAIT_US);
Wolfgang Betz 3:0df38cfb1e53 381 if(spirit_on == OFF) {
Wolfgang Betz 3:0df38cfb1e53 382 /* ensure we are in READY state as we go from there to Rx */
Wolfgang Betz 4:07537ca85c66 383 cmd_strobe(SPIRIT1_STROBE_READY);
Wolfgang Betz 3:0df38cfb1e53 384 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_READY, 5);
Wolfgang Betz 3:0df38cfb1e53 385 if(SPIRIT1_STATUS() != SPIRIT1_STATE_READY) {
Wolfgang Betz 3:0df38cfb1e53 386 PRINTF("Spirit1: failed to turn on\n");
Wolfgang Betz 3:0df38cfb1e53 387 while(1);
Wolfgang Betz 3:0df38cfb1e53 388 //return 1;
Wolfgang Betz 3:0df38cfb1e53 389 }
Wolfgang Betz 3:0df38cfb1e53 390
Wolfgang Betz 3:0df38cfb1e53 391 /* now we go to Rx */
Wolfgang Betz 6:f5d01793bf86 392 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 4:07537ca85c66 393 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 3:0df38cfb1e53 394 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, 5);
Wolfgang Betz 3:0df38cfb1e53 395 if(SPIRIT1_STATUS() != SPIRIT1_STATE_RX) {
Wolfgang Betz 3:0df38cfb1e53 396 PRINTF("Spirit1: failed to enter rx\n");
Wolfgang Betz 3:0df38cfb1e53 397 while(1);
Wolfgang Betz 3:0df38cfb1e53 398 //return 1;
Wolfgang Betz 3:0df38cfb1e53 399 }
Wolfgang Betz 6:f5d01793bf86 400 CLEAR_RXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 401 receiving_packet = 0;
Wolfgang Betz 6:f5d01793bf86 402 _spirit_rx_err = false;
Wolfgang Betz 3:0df38cfb1e53 403
Wolfgang Betz 3:0df38cfb1e53 404 /* Enables the mcu to get IRQ from the SPIRIT1 */
Wolfgang Betz 3:0df38cfb1e53 405 spirit_on = ON;
Wolfgang Betz 5:c9c5bc673c64 406 MBED_ASSERT(_nr_of_irq_disables == 1);
Wolfgang Betz 5:c9c5bc673c64 407 enable_spirit_irq();
Wolfgang Betz 3:0df38cfb1e53 408 }
Wolfgang Betz 3:0df38cfb1e53 409
Wolfgang Betz 3:0df38cfb1e53 410 return 0;
Wolfgang Betz 3:0df38cfb1e53 411 }
Wolfgang Betz 3:0df38cfb1e53 412
Wolfgang Betz 3:0df38cfb1e53 413 uint16_t SimpleSpirit1::arch_refresh_status(void) {
Wolfgang Betz 3:0df38cfb1e53 414 uint16_t mcstate;
Wolfgang Betz 3:0df38cfb1e53 415 uint8_t header[2];
Wolfgang Betz 3:0df38cfb1e53 416 header[0]=READ_HEADER;
Wolfgang Betz 3:0df38cfb1e53 417 header[1]=MC_STATE1_BASE;
Wolfgang Betz 3:0df38cfb1e53 418
Wolfgang Betz 3:0df38cfb1e53 419 /* Puts the SPI chip select low to start the transaction */
Wolfgang Betz 3:0df38cfb1e53 420 chip_sync_select();
Wolfgang Betz 3:0df38cfb1e53 421
Wolfgang Betz 3:0df38cfb1e53 422 /* Write the aHeader bytes and read the SPIRIT1 status bytes */
Wolfgang Betz 3:0df38cfb1e53 423 mcstate = _spi.write(header[0]);
Wolfgang Betz 3:0df38cfb1e53 424 mcstate = mcstate<<8;
Wolfgang Betz 3:0df38cfb1e53 425
Wolfgang Betz 3:0df38cfb1e53 426 /* Write the aHeader bytes and read the SPIRIT1 status bytes */
Wolfgang Betz 3:0df38cfb1e53 427 mcstate |= _spi.write(header[1]);
Wolfgang Betz 3:0df38cfb1e53 428
Wolfgang Betz 3:0df38cfb1e53 429 /* Puts the SPI chip select high to end the transaction */
Wolfgang Betz 3:0df38cfb1e53 430 chip_sync_unselect();
Wolfgang Betz 3:0df38cfb1e53 431
Wolfgang Betz 3:0df38cfb1e53 432 return mcstate;
Wolfgang Betz 3:0df38cfb1e53 433 }
Wolfgang Betz 3:0df38cfb1e53 434
Wolfgang Betz 6:f5d01793bf86 435 int SimpleSpirit1::read(void *buf, unsigned int bufsize)
Wolfgang Betz 4:07537ca85c66 436 {
Wolfgang Betz 4:07537ca85c66 437 PRINTF("READ IN\n");
Wolfgang Betz 4:07537ca85c66 438
Wolfgang Betz 6:f5d01793bf86 439 disable_spirit_irq();
Wolfgang Betz 6:f5d01793bf86 440
Wolfgang Betz 4:07537ca85c66 441 /* Checks if the RX buffer is empty */
Wolfgang Betz 4:07537ca85c66 442 if(IS_RXBUF_EMPTY()) {
Wolfgang Betz 4:07537ca85c66 443 CLEAR_RXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 444 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 445 cmd_strobe(SPIRIT1_STROBE_SABORT);
Wolfgang Betz 4:07537ca85c66 446 wait_us(SABORT_WAIT_US);
Wolfgang Betz 4:07537ca85c66 447 cmd_strobe(SPIRIT1_STROBE_READY);
Wolfgang Betz 4:07537ca85c66 448 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_READY, 1);
Wolfgang Betz 6:f5d01793bf86 449 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 4:07537ca85c66 450 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 4:07537ca85c66 451 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, 1);
Wolfgang Betz 6:f5d01793bf86 452 _spirit_rx_err = false;
Wolfgang Betz 4:07537ca85c66 453 PRINTF("READ OUT RX BUF EMPTY\n");
Wolfgang Betz 4:07537ca85c66 454 enable_spirit_irq();
Wolfgang Betz 4:07537ca85c66 455 return 0;
Wolfgang Betz 4:07537ca85c66 456 }
Wolfgang Betz 4:07537ca85c66 457
Wolfgang Betz 4:07537ca85c66 458 if(bufsize < spirit_rx_len) {
Wolfgang Betz 6:f5d01793bf86 459 enable_spirit_irq();
Wolfgang Betz 6:f5d01793bf86 460
Wolfgang Betz 6:f5d01793bf86 461 /* If buf has the correct size */
Wolfgang Betz 4:07537ca85c66 462 PRINTF("TOO SMALL BUF\n");
Wolfgang Betz 4:07537ca85c66 463 return 0;
Wolfgang Betz 4:07537ca85c66 464 } else {
Wolfgang Betz 4:07537ca85c66 465 /* Copies the packet received */
Wolfgang Betz 4:07537ca85c66 466 memcpy(buf, spirit_rx_buf, spirit_rx_len);
Wolfgang Betz 4:07537ca85c66 467
Wolfgang Betz 4:07537ca85c66 468 #ifdef CONTIKI // betzw - TODO
Wolfgang Betz 4:07537ca85c66 469 packetbuf_set_attr(PACKETBUF_ATTR_RSSI, last_rssi); //MGR
Wolfgang Betz 4:07537ca85c66 470 packetbuf_set_attr(PACKETBUF_ATTR_LINK_QUALITY, last_lqi); //MGR
Wolfgang Betz 4:07537ca85c66 471 #endif
Wolfgang Betz 4:07537ca85c66 472
Wolfgang Betz 4:07537ca85c66 473 bufsize = spirit_rx_len;
Wolfgang Betz 4:07537ca85c66 474 CLEAR_RXBUF();
Wolfgang Betz 4:07537ca85c66 475
Wolfgang Betz 6:f5d01793bf86 476 enable_spirit_irq();
Wolfgang Betz 6:f5d01793bf86 477
Wolfgang Betz 4:07537ca85c66 478 PRINTF("READ OUT\n");
Wolfgang Betz 4:07537ca85c66 479
Wolfgang Betz 4:07537ca85c66 480 return bufsize;
Wolfgang Betz 4:07537ca85c66 481 }
Wolfgang Betz 4:07537ca85c66 482
Wolfgang Betz 4:07537ca85c66 483 }
Wolfgang Betz 4:07537ca85c66 484
Wolfgang Betz 4:07537ca85c66 485 int SimpleSpirit1::channel_clear(void)
Wolfgang Betz 4:07537ca85c66 486 {
Wolfgang Betz 4:07537ca85c66 487 float rssi_value;
Wolfgang Betz 4:07537ca85c66 488 /* Local variable used to memorize the SPIRIT1 state */
Wolfgang Betz 4:07537ca85c66 489 uint8_t spirit_state = ON;
Wolfgang Betz 4:07537ca85c66 490
Wolfgang Betz 4:07537ca85c66 491 PRINTF("CHANNEL CLEAR IN\n");
Wolfgang Betz 4:07537ca85c66 492
Wolfgang Betz 4:07537ca85c66 493 if(spirit_on == OFF) {
Wolfgang Betz 4:07537ca85c66 494 /* Wakes up the SPIRIT1 */
Wolfgang Betz 4:07537ca85c66 495 on();
Wolfgang Betz 4:07537ca85c66 496 spirit_state = OFF;
Wolfgang Betz 4:07537ca85c66 497 }
Wolfgang Betz 4:07537ca85c66 498
Wolfgang Betz 4:07537ca85c66 499 disable_spirit_irq();
Wolfgang Betz 7:e90fa8f6bc6c 500
Wolfgang Betz 7:e90fa8f6bc6c 501 /* Reset State to Ready */
Wolfgang Betz 7:e90fa8f6bc6c 502 set_ready_state();
Wolfgang Betz 4:07537ca85c66 503 {
Wolfgang Betz 7:e90fa8f6bc6c 504 uint32_t timeout = us_ticker_read() + 5000;
Wolfgang Betz 4:07537ca85c66 505 do {
Wolfgang Betz 4:07537ca85c66 506 mgmt_refresh_status();
Wolfgang Betz 7:e90fa8f6bc6c 507 } while((st_lib_g_x_status.MC_STATE != MC_STATE_READY) && (us_ticker_read() < timeout));
Wolfgang Betz 4:07537ca85c66 508 if(st_lib_g_x_status.MC_STATE != MC_STATE_READY) {
Wolfgang Betz 6:f5d01793bf86 509 enable_spirit_irq();
Wolfgang Betz 4:07537ca85c66 510 return 1;
Wolfgang Betz 4:07537ca85c66 511 }
Wolfgang Betz 4:07537ca85c66 512 }
Wolfgang Betz 4:07537ca85c66 513
Wolfgang Betz 4:07537ca85c66 514 /* Stores the RSSI value */
Wolfgang Betz 4:07537ca85c66 515 rssi_value = qi_get_rssi_dbm();
Wolfgang Betz 4:07537ca85c66 516
Wolfgang Betz 7:e90fa8f6bc6c 517 enable_spirit_irq();
Wolfgang Betz 7:e90fa8f6bc6c 518
Wolfgang Betz 4:07537ca85c66 519 /* Puts the SPIRIT1 in its previous state */
Wolfgang Betz 4:07537ca85c66 520 if(spirit_state==OFF) {
Wolfgang Betz 4:07537ca85c66 521 off();
Wolfgang Betz 4:07537ca85c66 522 } else {
Wolfgang Betz 6:f5d01793bf86 523 disable_spirit_irq();
Wolfgang Betz 6:f5d01793bf86 524 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 4:07537ca85c66 525 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 4:07537ca85c66 526 /* SpiritCmdStrobeRx();*/
Wolfgang Betz 4:07537ca85c66 527 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, 5);
Wolfgang Betz 6:f5d01793bf86 528 CLEAR_RXBUF();
Wolfgang Betz 6:f5d01793bf86 529 _spirit_rx_err = false;
Wolfgang Betz 6:f5d01793bf86 530 enable_spirit_irq();
Wolfgang Betz 4:07537ca85c66 531 }
Wolfgang Betz 4:07537ca85c66 532
Wolfgang Betz 4:07537ca85c66 533 PRINTF("CHANNEL CLEAR OUT\n");
Wolfgang Betz 4:07537ca85c66 534
Wolfgang Betz 4:07537ca85c66 535 /* Checks the RSSI value with the threshold */
Wolfgang Betz 4:07537ca85c66 536 if(rssi_value<CCA_THRESHOLD) {
Wolfgang Betz 4:07537ca85c66 537 return 0;
Wolfgang Betz 4:07537ca85c66 538 } else {
Wolfgang Betz 4:07537ca85c66 539 return 1;
Wolfgang Betz 4:07537ca85c66 540 }
Wolfgang Betz 4:07537ca85c66 541 }
Wolfgang Betz 4:07537ca85c66 542
Wolfgang Betz 7:e90fa8f6bc6c 543 int SimpleSpirit1::get_pending_packet(void)
Wolfgang Betz 4:07537ca85c66 544 {
Wolfgang Betz 4:07537ca85c66 545 PRINTF("PENDING PACKET\n");
Wolfgang Betz 4:07537ca85c66 546 return !IS_RXBUF_EMPTY();
Wolfgang Betz 4:07537ca85c66 547 }
Wolfgang Betz 4:07537ca85c66 548
Wolfgang Betz 5:c9c5bc673c64 549 /** Spirit Irq Callback **/
Wolfgang Betz 5:c9c5bc673c64 550 void SimpleSpirit1::IrqHandler() {
Wolfgang Betz 4:07537ca85c66 551 st_lib_spirit_irqs x_irq_status;
Wolfgang Betz 4:07537ca85c66 552
Wolfgang Betz 4:07537ca85c66 553 /* get interrupt source from radio */
Wolfgang Betz 4:07537ca85c66 554 irq_get_status(&x_irq_status);
Wolfgang Betz 4:07537ca85c66 555 irq_clear_status();
Wolfgang Betz 4:07537ca85c66 556
Wolfgang Betz 6:f5d01793bf86 557 /* Reception errors */
Wolfgang Betz 6:f5d01793bf86 558 if((x_irq_status.IRQ_RX_FIFO_ERROR) || (x_irq_status.IRQ_RX_DATA_DISC) || (x_irq_status.IRQ_RX_TIMEOUT)) {
Wolfgang Betz 4:07537ca85c66 559 receiving_packet = 0;
Wolfgang Betz 6:f5d01793bf86 560 _spirit_rx_err = true;
Wolfgang Betz 6:f5d01793bf86 561 CLEAR_RXBUF();
Wolfgang Betz 4:07537ca85c66 562 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 7:e90fa8f6bc6c 563 if(_spirit_tx_started) {
Wolfgang Betz 7:e90fa8f6bc6c 564 _spirit_tx_started = false;
Wolfgang Betz 7:e90fa8f6bc6c 565 CLEAR_TXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 566 /* call user callback */
Wolfgang Betz 7:e90fa8f6bc6c 567 if(_current_irq_callback) {
Wolfgang Betz 7:e90fa8f6bc6c 568 _current_irq_callback(-1); // betzw - TODO: define enums for callback values
Wolfgang Betz 7:e90fa8f6bc6c 569 }
Wolfgang Betz 7:e90fa8f6bc6c 570 }
Wolfgang Betz 4:07537ca85c66 571 }
Wolfgang Betz 4:07537ca85c66 572
Wolfgang Betz 6:f5d01793bf86 573 /* Transmission error */
Wolfgang Betz 4:07537ca85c66 574 if(x_irq_status.IRQ_TX_FIFO_ERROR) {
Wolfgang Betz 6:f5d01793bf86 575 error("IRQ_TX_FIFO_ERROR should never happen!\n");
Wolfgang Betz 4:07537ca85c66 576 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 577 cmd_strobe(SPIRIT1_STROBE_FTX);
Wolfgang Betz 7:e90fa8f6bc6c 578 if(_spirit_tx_started) {
Wolfgang Betz 7:e90fa8f6bc6c 579 _spirit_tx_started = false;
Wolfgang Betz 7:e90fa8f6bc6c 580 CLEAR_TXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 581 /* call user callback */
Wolfgang Betz 7:e90fa8f6bc6c 582 if(_current_irq_callback) {
Wolfgang Betz 7:e90fa8f6bc6c 583 _current_irq_callback(-1); // betzw - TODO: define enums for callback values
Wolfgang Betz 7:e90fa8f6bc6c 584 }
Wolfgang Betz 7:e90fa8f6bc6c 585 }
Wolfgang Betz 4:07537ca85c66 586 }
Wolfgang Betz 4:07537ca85c66 587
Wolfgang Betz 4:07537ca85c66 588 /* The IRQ_VALID_SYNC is used to notify a new packet is coming */
Wolfgang Betz 4:07537ca85c66 589 if(x_irq_status.IRQ_VALID_SYNC) {
Wolfgang Betz 4:07537ca85c66 590 receiving_packet = 1;
Wolfgang Betz 6:f5d01793bf86 591 _spirit_rx_err = false;
Wolfgang Betz 6:f5d01793bf86 592 CLEAR_RXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 593 if(_spirit_tx_started) { // betzw - TOCHECK: is this really correct to be done here?
Wolfgang Betz 7:e90fa8f6bc6c 594 _spirit_tx_started = false;
Wolfgang Betz 7:e90fa8f6bc6c 595 CLEAR_TXBUF();
Wolfgang Betz 7:e90fa8f6bc6c 596 /* call user callback */
Wolfgang Betz 7:e90fa8f6bc6c 597 if(_current_irq_callback) {
Wolfgang Betz 7:e90fa8f6bc6c 598 _current_irq_callback(-1); // betzw - TODO: define enums for callback values
Wolfgang Betz 7:e90fa8f6bc6c 599 }
Wolfgang Betz 7:e90fa8f6bc6c 600 }
Wolfgang Betz 6:f5d01793bf86 601 }
Wolfgang Betz 6:f5d01793bf86 602
Wolfgang Betz 6:f5d01793bf86 603 /* RX FIFO almost full */
Wolfgang Betz 6:f5d01793bf86 604 if(x_irq_status.IRQ_RX_FIFO_ALMOST_FULL) {
Wolfgang Betz 6:f5d01793bf86 605 if(_spirit_rx_err) {
Wolfgang Betz 6:f5d01793bf86 606 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 6:f5d01793bf86 607 } else {
Wolfgang Betz 6:f5d01793bf86 608 uint8_t fifo_available = linear_fifo_read_num_elements_rx_fifo();
Wolfgang Betz 6:f5d01793bf86 609 unsigned int remaining = MAX_PACKET_LEN - _spirit_rx_pos;
Wolfgang Betz 6:f5d01793bf86 610 if(fifo_available > remaining) {
Wolfgang Betz 6:f5d01793bf86 611 receiving_packet = 0;
Wolfgang Betz 6:f5d01793bf86 612 _spirit_rx_err = true;
Wolfgang Betz 6:f5d01793bf86 613 CLEAR_RXBUF();
Wolfgang Betz 6:f5d01793bf86 614 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 6:f5d01793bf86 615 } else {
Wolfgang Betz 6:f5d01793bf86 616 spi_read_linear_fifo(fifo_available, &spirit_rx_buf[_spirit_rx_pos]);
Wolfgang Betz 6:f5d01793bf86 617 _spirit_rx_pos += fifo_available;
Wolfgang Betz 6:f5d01793bf86 618 }
Wolfgang Betz 6:f5d01793bf86 619 }
Wolfgang Betz 4:07537ca85c66 620 }
Wolfgang Betz 4:07537ca85c66 621
Wolfgang Betz 4:07537ca85c66 622 /* The IRQ_TX_DATA_SENT notifies the packet received. Puts the SPIRIT1 in RX */
Wolfgang Betz 4:07537ca85c66 623 if(x_irq_status.IRQ_TX_DATA_SENT) {
Wolfgang Betz 7:e90fa8f6bc6c 624 MBED_ASSERT(_spirit_tx_started);
Wolfgang Betz 7:e90fa8f6bc6c 625
Wolfgang Betz 6:f5d01793bf86 626 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 4:07537ca85c66 627 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 4:07537ca85c66 628 /* SpiritCmdStrobeRx();*/
Wolfgang Betz 4:07537ca85c66 629 CLEAR_TXBUF();
Wolfgang Betz 6:f5d01793bf86 630 CLEAR_RXBUF();
Wolfgang Betz 6:f5d01793bf86 631 _spirit_rx_err = false;
Wolfgang Betz 7:e90fa8f6bc6c 632 _spirit_tx_started = false;
Wolfgang Betz 7:e90fa8f6bc6c 633
Wolfgang Betz 7:e90fa8f6bc6c 634 /* call user callback */
Wolfgang Betz 7:e90fa8f6bc6c 635 if(_current_irq_callback) {
Wolfgang Betz 7:e90fa8f6bc6c 636 _current_irq_callback(0); // betzw - TODO: define enums for callback values
Wolfgang Betz 7:e90fa8f6bc6c 637 }
Wolfgang Betz 4:07537ca85c66 638 }
Wolfgang Betz 4:07537ca85c66 639
Wolfgang Betz 4:07537ca85c66 640 /* The IRQ_RX_DATA_READY notifies a new packet arrived */
Wolfgang Betz 4:07537ca85c66 641 if(x_irq_status.IRQ_RX_DATA_READY) {
Wolfgang Betz 6:f5d01793bf86 642 if(_spirit_rx_err) {
Wolfgang Betz 6:f5d01793bf86 643 receiving_packet = 0;
Wolfgang Betz 6:f5d01793bf86 644 _spirit_rx_err = false;
Wolfgang Betz 6:f5d01793bf86 645 CLEAR_RXBUF();
Wolfgang Betz 6:f5d01793bf86 646 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 6:f5d01793bf86 647 } else {
Wolfgang Betz 6:f5d01793bf86 648 spirit_rx_len = pkt_basic_get_received_pkt_length();
Wolfgang Betz 6:f5d01793bf86 649 unsigned int remaining = 0;
Wolfgang Betz 6:f5d01793bf86 650 uint8_t fifo_available = 0;
Wolfgang Betz 6:f5d01793bf86 651 uint8_t to_receive = 0;
Wolfgang Betz 6:f5d01793bf86 652
Wolfgang Betz 6:f5d01793bf86 653 MBED_ASSERT(spirit_rx_len <= MAX_PACKET_LEN);
Wolfgang Betz 5:c9c5bc673c64 654
Wolfgang Betz 6:f5d01793bf86 655 for(; _spirit_rx_pos < spirit_rx_len;) {
Wolfgang Betz 6:f5d01793bf86 656 remaining = spirit_rx_len - _spirit_rx_pos;
Wolfgang Betz 6:f5d01793bf86 657 fifo_available = linear_fifo_read_num_elements_rx_fifo();
Wolfgang Betz 6:f5d01793bf86 658 to_receive = (remaining < fifo_available) ? remaining : fifo_available;
Wolfgang Betz 6:f5d01793bf86 659 if(to_receive > 0) {
Wolfgang Betz 6:f5d01793bf86 660 spi_read_linear_fifo(to_receive, &spirit_rx_buf[_spirit_rx_pos]);
Wolfgang Betz 6:f5d01793bf86 661 _spirit_rx_pos += to_receive;
Wolfgang Betz 6:f5d01793bf86 662 }
Wolfgang Betz 6:f5d01793bf86 663 }
Wolfgang Betz 5:c9c5bc673c64 664
Wolfgang Betz 6:f5d01793bf86 665 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 4:07537ca85c66 666
Wolfgang Betz 6:f5d01793bf86 667 last_rssi = qi_get_rssi(); //MGR
Wolfgang Betz 6:f5d01793bf86 668 last_lqi = qi_get_lqi(); //MGR
Wolfgang Betz 4:07537ca85c66 669
Wolfgang Betz 6:f5d01793bf86 670 receiving_packet = 0;
Wolfgang Betz 4:07537ca85c66 671
Wolfgang Betz 4:07537ca85c66 672 #if NULLRDC_CONF_802154_AUTOACK
Wolfgang Betz 6:f5d01793bf86 673 if (spirit_rxbuf[0] == ACK_LEN) {
Wolfgang Betz 6:f5d01793bf86 674 /* For debugging purposes we assume this is an ack for us */
Wolfgang Betz 6:f5d01793bf86 675 just_got_an_ack = 1;
Wolfgang Betz 6:f5d01793bf86 676 }
Wolfgang Betz 4:07537ca85c66 677 #endif /* NULLRDC_CONF_802154_AUTOACK */
Wolfgang Betz 4:07537ca85c66 678
Wolfgang Betz 6:f5d01793bf86 679 /* call user callback */
Wolfgang Betz 6:f5d01793bf86 680 if(_current_irq_callback) {
Wolfgang Betz 7:e90fa8f6bc6c 681 _current_irq_callback(1); // betzw - TODO: define enums for callback values
Wolfgang Betz 6:f5d01793bf86 682 }
Wolfgang Betz 6:f5d01793bf86 683 }
Wolfgang Betz 4:07537ca85c66 684 }
Wolfgang Betz 4:07537ca85c66 685 }