JunMo Hong / stm-spirit1-rf-driver_for_cubebite

Fork of EV-COG-AD3029LZ by JunMo Hong

Committer:
Wolfgang Betz
Date:
Wed Oct 19 10:04:00 2016 +0200
Revision:
6:f5d01793bf86
Parent:
5:c9c5bc673c64
Child:
7:e90fa8f6bc6c
First simple Sender->Receiver example

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