JunMo Hong / stm-spirit1-rf-driver_for_cubebite

Fork of EV-COG-AD3029LZ by JunMo Hong

Committer:
Wolfgang Betz
Date:
Tue Nov 08 11:04:30 2016 +0100
Revision:
21:d5c10e5742f6
Parent:
19:42df12d5f750
Child:
22:9165bd73c61e
First version running 'mbed-os-example-client' & 'k64f-border-router with Spirit1'

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