JunMo Hong / stm-spirit1-rf-driver_for_cubebite2

180718 HJM : 8 Count sensing data RF send, certTest, temp(cold)Test

Fork of EV-COG-AD3029LZ by JunMo Hong

source/SimpleSpirit1.cpp@83:54b207156a91, 2018-03-21 (annotated)

Committer:
jmhong
Date:
Wed Mar 21 05:06:08 2018 +0000
Revision:
83:54b207156a91
Parent:
82:a18c22d2b83a
Child:
84:45b9ff78a066
HJM : EV COG AD3029LZ test;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Wolfgang Betz 34:edda6a7238ec 1 /*** Mbed Includes ***/
Wolfgang Betz 34:edda6a7238ec 2 #include "SimpleSpirit1.h"
Wolfgang Betz 34:edda6a7238ec 3 #include "radio_spi.h"
jmhong 83:54b207156a91 4 //#include "main.h"
Wolfgang Betz 34:edda6a7238ec 5
jmhong 83:54b207156a91 6 //#define SPIRIT_GPIO_IRQ (SPIRIT_GPIO_0)
jmhong 83:54b207156a91 7 #define SPIRIT_GPIO_IRQ (SPIRIT_GPIO_2)
Wolfgang Betz 34:edda6a7238ec 8
Wolfgang Betz 34:edda6a7238ec 9 static uint16_t last_state;
Wolfgang Betz 34:edda6a7238ec 10 #define SPIRIT1_STATUS() ((last_state = (uint16_t)refresh_state()) & SPIRIT1_STATE_STATEBITS)
Wolfgang Betz 34:edda6a7238ec 11
Wolfgang Betz 34:edda6a7238ec 12 #define XO_ON (0x1)
Wolfgang Betz 34:edda6a7238ec 13
Wolfgang Betz 70:19b5f9b9ba80 14 #define BUSYWAIT_UNTIL(cond, millisecs) \
Wolfgang Betz 70:19b5f9b9ba80 15 do { \
Wolfgang Betz 70:19b5f9b9ba80 16 uint32_t start = us_ticker_read(); \
Wolfgang Betz 70:19b5f9b9ba80 17 uint32_t limit = (uint32_t)millisecs*1000U; \
Wolfgang Betz 70:19b5f9b9ba80 18 while (!(cond)) { \
Wolfgang Betz 70:19b5f9b9ba80 19 uint32_t now = us_ticker_read(); \
Wolfgang Betz 71:4a7772415d9c 20 if((now - start) > limit) break; \
Wolfgang Betz 70:19b5f9b9ba80 21 } \
Wolfgang Betz 69:22e9b407effa 22 } while(0)
Wolfgang Betz 34:edda6a7238ec 23
Wolfgang Betz 34:edda6a7238ec 24 #define st_lib_spirit_irqs SpiritIrqs
Wolfgang Betz 34:edda6a7238ec 25
Wolfgang Betz 37:bc043030b55a 26 #define STATE_TIMEOUT (100)
Wolfgang Betz 34:edda6a7238ec 27
Wolfgang Betz 34:edda6a7238ec 28 // betzw: switching force & back from standby is on some devices quite unstable
Wolfgang Betz 34:edda6a7238ec 29 #define USE_STANDBY_STATE
Wolfgang Betz 34:edda6a7238ec 30
Wolfgang Betz 34:edda6a7238ec 31 /*** Class Implementation ***/
Wolfgang Betz 34:edda6a7238ec 32 /** Static Class Variables **/
Wolfgang Betz 34:edda6a7238ec 33 SimpleSpirit1 *SimpleSpirit1::_singleton = NULL;
Wolfgang Betz 34:edda6a7238ec 34
Wolfgang Betz 34:edda6a7238ec 35 /** Constructor **/
Wolfgang Betz 34:edda6a7238ec 36 SimpleSpirit1::SimpleSpirit1(PinName mosi, PinName miso, PinName sclk,
Wolfgang Betz 69:22e9b407effa 37 PinName irq, PinName cs, PinName sdn,
Wolfgang Betz 69:22e9b407effa 38 PinName led) :
Wolfgang Betz 69:22e9b407effa 39 _spi(mosi, miso, sclk),
Wolfgang Betz 69:22e9b407effa 40 _irq(irq),
Wolfgang Betz 69:22e9b407effa 41 _chip_select(cs),
Wolfgang Betz 69:22e9b407effa 42 _shut_down(sdn),
Wolfgang Betz 69:22e9b407effa 43 _led(led),
Wolfgang Betz 69:22e9b407effa 44 _current_irq_callback(),
Wolfgang Betz 69:22e9b407effa 45 _rx_receiving_timeout()
Wolfgang Betz 34:edda6a7238ec 46 {
Wolfgang Betz 34:edda6a7238ec 47 }
Wolfgang Betz 34:edda6a7238ec 48
Wolfgang Betz 34:edda6a7238ec 49 /** Init Function **/
Wolfgang Betz 34:edda6a7238ec 50 void SimpleSpirit1::init() {
jmhong 83:54b207156a91 51 /*cubebite HJM, reset irq disable counter and irq callback & disable irq */
jmhong 83:54b207156a91 52 _nr_of_irq_disables = 0; // @@
Wolfgang Betz 69:22e9b407effa 53 disable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 54
jmhong 83:54b207156a91 55 /*cubebite HJM, unselect chip */
Wolfgang Betz 69:22e9b407effa 56 chip_unselect();
Wolfgang Betz 34:edda6a7238ec 57
jmhong 83:54b207156a91 58 /*cubebite HJM, configure spi */
Wolfgang Betz 69:22e9b407effa 59 _spi.format(8, 0); /* 8-bit, mode = 0, [order = SPI_MSB] only available in mbed3 */
jmhong 83:54b207156a91 60
Wolfgang Betz 34:edda6a7238ec 61
jmhong 83:54b207156a91 62 // _spi.frequency(13000000); // 13MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 63 // _spi.frequency(6500000); // 6.5MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 64 // _spi.frequency(4333333); // 4.3333...MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 65 // _spi.frequency(2600000); // 4.3333...MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 66 // _spi.frequency(1444444); // 4.3333...MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 67 // _spi.frequency(764705); // 4.3333...MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 68 _spi.frequency(393939); // 4.3333...MHz (i.e. max speed allowed for Spirit1)
jmhong 83:54b207156a91 69
jmhong 83:54b207156a91 70
jmhong 83:54b207156a91 71
jmhong 83:54b207156a91 72 /*cubebite HJM, install irq handler */
Wolfgang Betz 69:22e9b407effa 73 _irq.mode(PullUp);
Wolfgang Betz 69:22e9b407effa 74 _irq.fall(Callback<void()>(this, &SimpleSpirit1::IrqHandler));
Wolfgang Betz 34:edda6a7238ec 75
jmhong 83:54b207156a91 76 printf("test 4 \n");
jmhong 83:54b207156a91 77 /*cubebite HJM, init cube vars */
Wolfgang Betz 69:22e9b407effa 78 spirit_on = OFF;
Wolfgang Betz 69:22e9b407effa 79 last_rssi = 0 ; //MGR
Wolfgang Betz 69:22e9b407effa 80 last_sqi = 0 ; //MGR
Wolfgang Betz 34:edda6a7238ec 81
jmhong 83:54b207156a91 82 printf("test 5 \n");
jmhong 83:54b207156a91 83 /*cubebite HJM, set frequencies */
jmhong 83:54b207156a91 84 radio_set_xtal_freq(XTAL_FREQUENCY); //cubebite HJM, 50MHz
jmhong 83:54b207156a91 85 mgmt_set_freq_base((uint32_t)BASE_FREQUENCY); // @@
Wolfgang Betz 34:edda6a7238ec 86
jmhong 83:54b207156a91 87 printf("test 6 \n");
jmhong 83:54b207156a91 88 /*cubebite HJM , restart board */
jmhong 83:54b207156a91 89 enter_shutdown();
jmhong 83:54b207156a91 90 exit_shutdown();
Wolfgang Betz 34:edda6a7238ec 91
jmhong 83:54b207156a91 92 printf("test 7 \n");
jmhong 83:54b207156a91 93 /*cubebite HJM, soft core reset */
Wolfgang Betz 69:22e9b407effa 94 cmd_strobe(SPIRIT1_STROBE_SRES);
Wolfgang Betz 34:edda6a7238ec 95
jmhong 83:54b207156a91 96 printf("test 8 \n");
jmhong 83:54b207156a91 97 /*cubebite HJM, Configures the SPIRIT1 radio part */
jmhong 83:54b207156a91 98 //180119 HJM : 433MHz 설정으로 변경 후 테스트.
jmhong 83:54b207156a91 99 SRadioInit x_radio_init = {
jmhong 83:54b207156a91 100 XTAL_OFFSET_PPM, // Xtal offset in ppm
jmhong 83:54b207156a91 101 (uint32_t)BASE_FREQUENCY, // HJM 수정 후 테스트 중 base frequency
jmhong 83:54b207156a91 102 (uint32_t)CHANNEL_SPACE, // channel space
jmhong 83:54b207156a91 103 CHANNEL_NUMBER, // channel number, HJM : 뭐지 0 인줄 알았더니 1로 셋팅되어있네/
jmhong 83:54b207156a91 104 MODULATION_SELECT, // modulation select
jmhong 83:54b207156a91 105 DATARATE, // HJM 수정 후 테스트 중
jmhong 83:54b207156a91 106 (uint32_t)FREQ_DEVIATION, // frequency deviation
jmhong 83:54b207156a91 107 (uint32_t)BANDWIDTH // channel filter bandwidth
jmhong 83:54b207156a91 108 };
jmhong 83:54b207156a91 109
jmhong 83:54b207156a91 110 printf("test 9 \n");
jmhong 83:54b207156a91 111 uint8_t ui8Return;
jmhong 83:54b207156a91 112 ui8Return = radio_init(&x_radio_init);
jmhong 83:54b207156a91 113 printf("test 9, ui8Return : [%d]\n", ui8Return);
jmhong 83:54b207156a91 114 /*180117 HJM : 송신 신호 세기 */
jmhong 83:54b207156a91 115 radio_set_pa_level_dbm(0,POWER_DBM); //hjm test
jmhong 83:54b207156a91 116 // radio_set_pa_level_dbm(0,10.0);
jmhong 83:54b207156a91 117 // radio_set_pa_level_dbm(0,CUBEBITE_OUTPUT_POWER_DBM_TEST);
Wolfgang Betz 69:22e9b407effa 118 radio_set_pa_level_max_index(0);
Wolfgang Betz 34:edda6a7238ec 119
jmhong 83:54b207156a91 120 printf("test 10 \n");
Wolfgang Betz 69:22e9b407effa 121 /* Configures the SPIRIT1 packet handler part*/
Wolfgang Betz 69:22e9b407effa 122 PktBasicInit x_basic_init = {
Wolfgang Betz 69:22e9b407effa 123 PREAMBLE_LENGTH,
Wolfgang Betz 69:22e9b407effa 124 SYNC_LENGTH,
Wolfgang Betz 69:22e9b407effa 125 SYNC_WORD,
Wolfgang Betz 69:22e9b407effa 126 LENGTH_TYPE,
Wolfgang Betz 69:22e9b407effa 127 LENGTH_WIDTH,
Wolfgang Betz 69:22e9b407effa 128 CRC_MODE,
Wolfgang Betz 69:22e9b407effa 129 CONTROL_LENGTH,
Wolfgang Betz 69:22e9b407effa 130 EN_ADDRESS,
Wolfgang Betz 69:22e9b407effa 131 EN_FEC,
Wolfgang Betz 69:22e9b407effa 132 EN_WHITENING
Wolfgang Betz 69:22e9b407effa 133 };
Wolfgang Betz 69:22e9b407effa 134 pkt_basic_init(&x_basic_init);
Wolfgang Betz 34:edda6a7238ec 135
jmhong 83:54b207156a91 136 printf("test 11 \n");
Wolfgang Betz 69:22e9b407effa 137 /* Enable the following interrupt sources, routed to GPIO */
Wolfgang Betz 69:22e9b407effa 138 irq_de_init(NULL);
Wolfgang Betz 69:22e9b407effa 139 irq_clear_status();
Wolfgang Betz 69:22e9b407effa 140 irq_set_status(TX_DATA_SENT, S_ENABLE);
Wolfgang Betz 69:22e9b407effa 141 irq_set_status(RX_DATA_READY,S_ENABLE);
Wolfgang Betz 69:22e9b407effa 142 irq_set_status(RX_DATA_DISC, S_ENABLE);
Wolfgang Betz 69:22e9b407effa 143 irq_set_status(VALID_SYNC, S_ENABLE);
Wolfgang Betz 69:22e9b407effa 144 irq_set_status(TX_FIFO_ERROR, S_ENABLE);
Wolfgang Betz 69:22e9b407effa 145 irq_set_status(RX_FIFO_ERROR, S_ENABLE);
Wolfgang Betz 47:3a30b960a8c2 146 #ifndef RX_FIFO_THR_WA
Wolfgang Betz 69:22e9b407effa 147 irq_set_status(TX_FIFO_ALMOST_EMPTY, S_ENABLE);
Wolfgang Betz 69:22e9b407effa 148 irq_set_status(RX_FIFO_ALMOST_FULL, S_ENABLE);
Wolfgang Betz 47:3a30b960a8c2 149 #endif // !RX_FIFO_THR_WA
Wolfgang Betz 34:edda6a7238ec 150
jmhong 83:54b207156a91 151 printf("test 12 \n");
Wolfgang Betz 69:22e9b407effa 152 /* Configure Spirit1 */
Wolfgang Betz 69:22e9b407effa 153 radio_persistent_rx(S_ENABLE);
Wolfgang Betz 69:22e9b407effa 154 qi_set_sqi_threshold(SQI_TH_0);
Wolfgang Betz 69:22e9b407effa 155 qi_sqi_check(S_ENABLE);
jmhong 83:54b207156a91 156 qi_set_rssi_threshold_dbm(CCA_THRESHOLD); //180205 HJM : RRSI 셋팅 값 수정 테스트
Wolfgang Betz 69:22e9b407effa 157 timer_set_rx_timeout_stop_condition(SQI_ABOVE_THRESHOLD);
Wolfgang Betz 69:22e9b407effa 158 timer_set_infinite_rx_timeout();
Wolfgang Betz 69:22e9b407effa 159 radio_afc_freeze_on_sync(S_ENABLE);
Wolfgang Betz 69:22e9b407effa 160 calibration_rco(S_ENABLE);
Wolfgang Betz 34:edda6a7238ec 161
jmhong 83:54b207156a91 162 spirit_on = OFF;
Wolfgang Betz 69:22e9b407effa 163 CLEAR_TXBUF();
Wolfgang Betz 69:22e9b407effa 164 CLEAR_RXBUF();
Wolfgang Betz 69:22e9b407effa 165 _spirit_tx_started = false;
Wolfgang Betz 69:22e9b407effa 166 _is_receiving = false;
Wolfgang Betz 34:edda6a7238ec 167
jmhong 83:54b207156a91 168 printf("test 13 \n");
Wolfgang Betz 69:22e9b407effa 169 /* Configure the radio to route the IRQ signal to its GPIO 3 */
Wolfgang Betz 69:22e9b407effa 170 SGpioInit x_gpio_init = {
Wolfgang Betz 69:22e9b407effa 171 SPIRIT_GPIO_IRQ,
Wolfgang Betz 69:22e9b407effa 172 SPIRIT_GPIO_MODE_DIGITAL_OUTPUT_LP,
Wolfgang Betz 69:22e9b407effa 173 SPIRIT_GPIO_DIG_OUT_IRQ
Wolfgang Betz 69:22e9b407effa 174 };
Wolfgang Betz 69:22e9b407effa 175 spirit_gpio_init(&x_gpio_init);
Wolfgang Betz 34:edda6a7238ec 176
jmhong 83:54b207156a91 177 printf("test 14 \n");
Wolfgang Betz 69:22e9b407effa 178 /* Setup CSMA/CA */
Wolfgang Betz 69:22e9b407effa 179 CsmaInit x_csma_init = {
Wolfgang Betz 69:22e9b407effa 180 S_ENABLE, // enable persistent mode
Wolfgang Betz 69:22e9b407effa 181 TBIT_TIME_64, // Tcca time
Wolfgang Betz 69:22e9b407effa 182 TCCA_TIME_3, // Lcca length
Wolfgang Betz 69:22e9b407effa 183 5, // max nr of backoffs (<8)
Wolfgang Betz 69:22e9b407effa 184 1, // BU counter seed
Wolfgang Betz 69:22e9b407effa 185 8 // BU prescaler
Wolfgang Betz 69:22e9b407effa 186 };
Wolfgang Betz 69:22e9b407effa 187 csma_ca_init(&x_csma_init);
Wolfgang Betz 34:edda6a7238ec 188
jmhong 83:54b207156a91 189 printf("test 15 \n");
Wolfgang Betz 34:edda6a7238ec 190 #ifdef USE_STANDBY_STATE
Wolfgang Betz 69:22e9b407effa 191 /* Puts the SPIRIT1 in STANDBY mode (125us -> rx/tx) */
Wolfgang Betz 69:22e9b407effa 192 cmd_strobe(SPIRIT1_STROBE_STANDBY);
Wolfgang Betz 34:edda6a7238ec 193 #endif // USE_STANDBY_STATE
Wolfgang Betz 34:edda6a7238ec 194 }
Wolfgang Betz 34:edda6a7238ec 195
jmhong 83:54b207156a91 196
jmhong 83:54b207156a91 197
jmhong 83:54b207156a91 198
jmhong 83:54b207156a91 199
Wolfgang Betz 69:22e9b407effa 200 static volatile int tx_fifo_remaining = 0; // to be used in irq handler
Wolfgang Betz 69:22e9b407effa 201 static volatile int tx_buffer_pos = 0; // to be used in irq handler
Wolfgang Betz 69:22e9b407effa 202 static const volatile uint8_t *tx_fifo_buffer = NULL; // to be used in irq handler
jmhong 83:54b207156a91 203 int SimpleSpirit1::send(const void *payload, unsigned int payload_len, bool use_csma_ca)
jmhong 83:54b207156a91 204 {
Wolfgang Betz 69:22e9b407effa 205 /* Checks if the payload length is supported */
jmhong 83:54b207156a91 206 printf("\r\n[SEND] 1, MAX_PACKET_LEN : [%d]\n", MAX_PACKET_LEN);
jmhong 83:54b207156a91 207 printf("[SEND] 2, payload_len : [%d]\n", payload_len);
jmhong 83:54b207156a91 208
jmhong 83:54b207156a91 209 if(payload_len > MAX_PACKET_LEN)
jmhong 83:54b207156a91 210 {
jmhong 83:54b207156a91 211 // printf("[SEND] \n");
Wolfgang Betz 69:22e9b407effa 212 return RADIO_TX_ERR;
Wolfgang Betz 69:22e9b407effa 213 }
jmhong 83:54b207156a91 214
Wolfgang Betz 69:22e9b407effa 215 disable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 216
Wolfgang Betz 69:22e9b407effa 217 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, STATE_TIMEOUT);
Wolfgang Betz 34:edda6a7238ec 218 #ifndef NDEBUG
jmhong 83:54b207156a91 219 if((last_state & SPIRIT1_STATE_STATEBITS) != SPIRIT1_STATE_RX)
jmhong 83:54b207156a91 220 {
Wolfgang Betz 69:22e9b407effa 221 debug("\r\nAssert failed in: %s (%d): state=%x\r\n", __func__, __LINE__, last_state>>1);
Wolfgang Betz 69:22e9b407effa 222 }
Wolfgang Betz 34:edda6a7238ec 223 #endif
Wolfgang Betz 34:edda6a7238ec 224
jmhong 83:54b207156a91 225
jmhong 83:54b207156a91 226
jmhong 83:54b207156a91 227
jmhong 83:54b207156a91 228
Wolfgang Betz 69:22e9b407effa 229 /* Reset State to Ready */
jmhong 83:54b207156a91 230 printf("[SEND] 3, set_ready_state() call, \n");
Wolfgang Betz 69:22e9b407effa 231 set_ready_state();
jmhong 83:54b207156a91 232
Wolfgang Betz 34:edda6a7238ec 233
jmhong 83:54b207156a91 234 printf("[SEND] 4, cmd_strobe() call, SPIRIT1_STROBE_FTX \n");
jmhong 83:54b207156a91 235 cmd_strobe(SPIRIT1_STROBE_FTX); // flush TX FIFO buffer
Wolfgang Betz 34:edda6a7238ec 236
Wolfgang Betz 34:edda6a7238ec 237 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 238 debug_if(!(linear_fifo_read_num_elements_tx_fifo() == 0), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
Wolfgang Betz 34:edda6a7238ec 239 #endif
Wolfgang Betz 34:edda6a7238ec 240
jmhong 83:54b207156a91 241 printf("[SEND] 5, pkt_basic_set_payload_length() call, \n");
jmhong 83:54b207156a91 242 pkt_basic_set_payload_length(payload_len); // set desired payload len
Wolfgang Betz 34:edda6a7238ec 243
jmhong 83:54b207156a91 244 if(use_csma_ca)
jmhong 83:54b207156a91 245 {
jmhong 83:54b207156a91 246 printf("[SEND] 6, csma_ca_state() call, \n");
Wolfgang Betz 69:22e9b407effa 247 csma_ca_state(S_ENABLE); // enable CSMA/CA
Wolfgang Betz 69:22e9b407effa 248 }
Wolfgang Betz 34:edda6a7238ec 249
Wolfgang Betz 69:22e9b407effa 250 /* Init buffer & number of bytes to be send */
jmhong 83:54b207156a91 251 printf("[SEND] 7, csma_ca_state() call, \n");
Wolfgang Betz 69:22e9b407effa 252 tx_fifo_remaining = payload_len;
Wolfgang Betz 69:22e9b407effa 253 tx_fifo_buffer = (const uint8_t*)payload;
Wolfgang Betz 45:2d01cc9bc761 254
Wolfgang Betz 69:22e9b407effa 255 int8_t fifo_available = SPIRIT_MAX_FIFO_LEN; // fill-up whole fifo
Wolfgang Betz 69:22e9b407effa 256 int8_t to_send = (tx_fifo_remaining > fifo_available) ? fifo_available : tx_fifo_remaining;
Wolfgang Betz 34:edda6a7238ec 257
Wolfgang Betz 69:22e9b407effa 258 tx_fifo_remaining -= to_send;
Wolfgang Betz 34:edda6a7238ec 259
jmhong 83:54b207156a91 260 /* Fill FIFO Buffer */
jmhong 83:54b207156a91 261 if(to_send > 0)
jmhong 83:54b207156a91 262 {
jmhong 83:54b207156a91 263 printf("[SEND] 8, if(to_send > 0), if(to_send > 0) \n");
jmhong 83:54b207156a91 264 spi_write_linear_fifo(to_send, (uint8_t*)&tx_fifo_buffer[0]);
Wolfgang Betz 69:22e9b407effa 265 }
Wolfgang Betz 34:edda6a7238ec 266
Wolfgang Betz 69:22e9b407effa 267 tx_buffer_pos = to_send;
Wolfgang Betz 69:22e9b407effa 268 _spirit_tx_started = true;
Wolfgang Betz 34:edda6a7238ec 269
Wolfgang Betz 69:22e9b407effa 270 enable_spirit_irq();
jmhong 83:54b207156a91 271 printf(" 6");
Wolfgang Betz 34:edda6a7238ec 272
Wolfgang Betz 69:22e9b407effa 273 /* Start transmitting */
jmhong 83:54b207156a91 274 cmd_strobe(SPIRIT1_STROBE_TX);
Wolfgang Betz 45:2d01cc9bc761 275
Wolfgang Betz 69:22e9b407effa 276 while(tx_fifo_remaining != 0); // wait until not everything is yet send (evtl. by irq handler)
Wolfgang Betz 45:2d01cc9bc761 277
Wolfgang Betz 69:22e9b407effa 278 BUSYWAIT_UNTIL(!_spirit_tx_started, STATE_TIMEOUT);
Wolfgang Betz 34:edda6a7238ec 279 #ifdef HEAVY_DEBUG
Wolfgang Betz 69:22e9b407effa 280 debug("\r\n%s (%d): state=%x, _spirit_tx_started=%d\r\n", __func__, __LINE__, SPIRIT1_STATUS()>>1, _spirit_tx_started);
Wolfgang Betz 34:edda6a7238ec 281 #endif
Wolfgang Betz 34:edda6a7238ec 282
jmhong 83:54b207156a91 283 if(use_csma_ca)
jmhong 83:54b207156a91 284 {
Wolfgang Betz 64:28ef790e4ef7 285 csma_ca_state(S_DISABLE); // disable CSMA/CA
Wolfgang Betz 64:28ef790e4ef7 286 }
Wolfgang Betz 43:a512f909514a 287
jmhong 83:54b207156a91 288 cmd_strobe(SPIRIT1_STROBE_RX); // Return to RX state
jmhong 83:54b207156a91 289
Wolfgang Betz 34:edda6a7238ec 290
jmhong 83:54b207156a91 291 disable_spirit_irq();
jmhong 83:54b207156a91 292 if(_spirit_tx_started)
jmhong 83:54b207156a91 293 { // in case of state timeout
Wolfgang Betz 69:22e9b407effa 294 _spirit_tx_started = false;
jmhong 83:54b207156a91 295 enable_spirit_irq();
jmhong 83:54b207156a91 296 printf("[SEND] 8, if(_spirit_tx_started), in case of state timeout, return RADIO_TX_ERR \n");
jmhong 83:54b207156a91 297
Wolfgang Betz 69:22e9b407effa 298 return RADIO_TX_ERR;
jmhong 83:54b207156a91 299 }
jmhong 83:54b207156a91 300 else
jmhong 83:54b207156a91 301 {
jmhong 83:54b207156a91 302 enable_spirit_irq();
jmhong 83:54b207156a91 303 printf("[SEND] 8, else, in case of state timeout, return RADIO_TX_OK \n");
jmhong 83:54b207156a91 304
Wolfgang Betz 69:22e9b407effa 305 return RADIO_TX_OK;
Wolfgang Betz 69:22e9b407effa 306 }
Wolfgang Betz 34:edda6a7238ec 307 }
Wolfgang Betz 34:edda6a7238ec 308
Wolfgang Betz 34:edda6a7238ec 309 /** Set Ready State **/
jmhong 83:54b207156a91 310 void SimpleSpirit1::set_ready_state(void)
jmhong 83:54b207156a91 311 {
Wolfgang Betz 69:22e9b407effa 312 uint16_t state;
Wolfgang Betz 34:edda6a7238ec 313
Wolfgang Betz 69:22e9b407effa 314 disable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 315
Wolfgang Betz 69:22e9b407effa 316 _spirit_tx_started = false;
Wolfgang Betz 69:22e9b407effa 317 _is_receiving = false;
Wolfgang Betz 69:22e9b407effa 318 stop_rx_timeout();
Wolfgang Betz 34:edda6a7238ec 319
Wolfgang Betz 69:22e9b407effa 320 cmd_strobe(SPIRIT1_STROBE_FRX);
Wolfgang Betz 69:22e9b407effa 321 CLEAR_RXBUF();
Wolfgang Betz 69:22e9b407effa 322 CLEAR_TXBUF();
Wolfgang Betz 34:edda6a7238ec 323
Wolfgang Betz 69:22e9b407effa 324 state = SPIRIT1_STATUS();
jmhong 83:54b207156a91 325 if(state == SPIRIT1_STATE_STANDBY)
jmhong 83:54b207156a91 326 {
jmhong 83:54b207156a91 327 printf("[SEND] 3-1, set_ready_state() call, if(state == SPIRIT1_STATE_STANDBY) in \n");
Wolfgang Betz 69:22e9b407effa 328 cmd_strobe(SPIRIT1_STROBE_READY);
jmhong 83:54b207156a91 329 }
jmhong 83:54b207156a91 330 else if(state == SPIRIT1_STATE_RX)
jmhong 83:54b207156a91 331 {
jmhong 83:54b207156a91 332 printf("[SEND] 3-2, set_ready_state() call, if(state == SPIRIT1_STATE_RX) in \n");
Wolfgang Betz 69:22e9b407effa 333 cmd_strobe(SPIRIT1_STROBE_SABORT);
jmhong 83:54b207156a91 334 }
jmhong 83:54b207156a91 335 else if(state != SPIRIT1_STATE_READY)
jmhong 83:54b207156a91 336 {
Wolfgang Betz 34:edda6a7238ec 337 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 338 debug("\r\nAssert failed in: %s (%d): state=%x\r\n", __func__, __LINE__, state>>1);
Wolfgang Betz 34:edda6a7238ec 339 #endif
jmhong 83:54b207156a91 340 printf("[SEND] 3-3, set_ready_state() call, else if(state != SPIRIT1_STATE_READY) in, something is wrong. \n");
Wolfgang Betz 69:22e9b407effa 341 }
Wolfgang Betz 34:edda6a7238ec 342
Wolfgang Betz 69:22e9b407effa 343 BUSYWAIT_UNTIL((SPIRIT1_STATUS() == SPIRIT1_STATE_READY) && ((last_state & XO_ON) == XO_ON), STATE_TIMEOUT);
jmhong 83:54b207156a91 344 if(last_state != (SPIRIT1_STATE_READY | XO_ON))
jmhong 83:54b207156a91 345 {
Wolfgang Betz 69:22e9b407effa 346 error("\r\nSpirit1: failed to become ready (%x) => pls. reset!\r\n", last_state);
Wolfgang Betz 69:22e9b407effa 347 enable_spirit_irq();
Wolfgang Betz 69:22e9b407effa 348 return;
Wolfgang Betz 69:22e9b407effa 349 }
Wolfgang Betz 34:edda6a7238ec 350
Wolfgang Betz 69:22e9b407effa 351 irq_clear_status();
Wolfgang Betz 34:edda6a7238ec 352
Wolfgang Betz 69:22e9b407effa 353 enable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 354 }
Wolfgang Betz 34:edda6a7238ec 355
jmhong 83:54b207156a91 356 int SimpleSpirit1::off(void)
jmhong 83:54b207156a91 357 {
jmhong 83:54b207156a91 358 if(spirit_on == ON)
jmhong 83:54b207156a91 359 {
Wolfgang Betz 69:22e9b407effa 360 /* Disables the mcu to get IRQ from the SPIRIT1 */
Wolfgang Betz 69:22e9b407effa 361 disable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 362
Wolfgang Betz 69:22e9b407effa 363 /* first stop rx/tx */
Wolfgang Betz 69:22e9b407effa 364 set_ready_state();
Wolfgang Betz 34:edda6a7238ec 365
Wolfgang Betz 34:edda6a7238ec 366 #ifdef USE_STANDBY_STATE
Wolfgang Betz 69:22e9b407effa 367 /* Puts the SPIRIT1 in STANDBY */
Wolfgang Betz 69:22e9b407effa 368 cmd_strobe(SPIRIT1_STROBE_STANDBY);
Wolfgang Betz 69:22e9b407effa 369 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_STANDBY, STATE_TIMEOUT);
Wolfgang Betz 69:22e9b407effa 370 if((last_state & SPIRIT1_STATE_STATEBITS) != SPIRIT1_STATE_STANDBY) {
Wolfgang Betz 69:22e9b407effa 371 error("\r\nSpirit1: failed to enter standby (%x)\r\n", last_state>>1);
Wolfgang Betz 69:22e9b407effa 372 return 1;
Wolfgang Betz 69:22e9b407effa 373 }
Wolfgang Betz 34:edda6a7238ec 374 #endif // USE_STANDBY_STATE
Wolfgang Betz 34:edda6a7238ec 375
Wolfgang Betz 69:22e9b407effa 376 spirit_on = OFF;
Wolfgang Betz 69:22e9b407effa 377 _nr_of_irq_disables = 1;
Wolfgang Betz 69:22e9b407effa 378 }
Wolfgang Betz 69:22e9b407effa 379 return 0;
Wolfgang Betz 34:edda6a7238ec 380 }
Wolfgang Betz 34:edda6a7238ec 381
jmhong 83:54b207156a91 382 int SimpleSpirit1::on(void)
jmhong 83:54b207156a91 383 {
jmhong 83:54b207156a91 384 if(spirit_on == OFF)
jmhong 83:54b207156a91 385 {
Wolfgang Betz 69:22e9b407effa 386 set_ready_state();
Wolfgang Betz 34:edda6a7238ec 387
Wolfgang Betz 69:22e9b407effa 388 /* now we go to Rx */
Wolfgang Betz 69:22e9b407effa 389 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 34:edda6a7238ec 390
Wolfgang Betz 69:22e9b407effa 391 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, STATE_TIMEOUT);
Wolfgang Betz 69:22e9b407effa 392 if((last_state & SPIRIT1_STATE_STATEBITS) != SPIRIT1_STATE_RX) {
Wolfgang Betz 69:22e9b407effa 393 error("\r\nSpirit1: failed to enter rx (%x) => retry\r\n", last_state>>1);
Wolfgang Betz 69:22e9b407effa 394 }
Wolfgang Betz 34:edda6a7238ec 395
Wolfgang Betz 69:22e9b407effa 396 /* Enables the mcu to get IRQ from the SPIRIT1 */
Wolfgang Betz 69:22e9b407effa 397 spirit_on = ON;
Wolfgang Betz 34:edda6a7238ec 398 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 399 debug_if(!(_nr_of_irq_disables == 1), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
Wolfgang Betz 34:edda6a7238ec 400 #endif
Wolfgang Betz 69:22e9b407effa 401 enable_spirit_irq();
Wolfgang Betz 69:22e9b407effa 402 }
Wolfgang Betz 34:edda6a7238ec 403
Wolfgang Betz 34:edda6a7238ec 404 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 405 if(SPIRIT1_STATUS() != SPIRIT1_STATE_RX) {
Wolfgang Betz 69:22e9b407effa 406 debug("\r\nAssert failed in: %s (%d): state=%x\r\n", __func__, __LINE__, last_state>>1);
Wolfgang Betz 69:22e9b407effa 407 }
Wolfgang Betz 34:edda6a7238ec 408 #endif
Wolfgang Betz 34:edda6a7238ec 409
Wolfgang Betz 69:22e9b407effa 410 return 0;
Wolfgang Betz 34:edda6a7238ec 411 }
Wolfgang Betz 34:edda6a7238ec 412
Wolfgang Betz 34:edda6a7238ec 413 uint8_t SimpleSpirit1::refresh_state(void) {
Wolfgang Betz 69:22e9b407effa 414 uint8_t mcstate;
Wolfgang Betz 34:edda6a7238ec 415
Wolfgang Betz 69:22e9b407effa 416 SpiritSpiReadRegisters(MC_STATE0_BASE, 1, &mcstate);
Wolfgang Betz 34:edda6a7238ec 417
Wolfgang Betz 69:22e9b407effa 418 return mcstate;
Wolfgang Betz 34:edda6a7238ec 419 }
Wolfgang Betz 34:edda6a7238ec 420
Wolfgang Betz 34:edda6a7238ec 421 int SimpleSpirit1::read(void *buf, unsigned int bufsize)
jmhong 83:54b207156a91 422 {
Wolfgang Betz 69:22e9b407effa 423 disable_spirit_irq();
jmhong 83:54b207156a91 424 printf("read() 1 ");
Wolfgang Betz 34:edda6a7238ec 425
Wolfgang Betz 69:22e9b407effa 426 /* Checks if the RX buffer is empty */
Wolfgang Betz 69:22e9b407effa 427 if(IS_RXBUF_EMPTY()) {
Wolfgang Betz 43:a512f909514a 428 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 429 debug("\r\nBuffer is empty\r\n");
Wolfgang Betz 43:a512f909514a 430 #endif
jmhong 83:54b207156a91 431 printf("[DEBUG] 2-1");
Wolfgang Betz 69:22e9b407effa 432 set_ready_state();
Wolfgang Betz 34:edda6a7238ec 433
Wolfgang Betz 69:22e9b407effa 434 cmd_strobe(SPIRIT1_STROBE_RX);
Wolfgang Betz 69:22e9b407effa 435 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, STATE_TIMEOUT);
Wolfgang Betz 69:22e9b407effa 436 enable_spirit_irq();
Wolfgang Betz 69:22e9b407effa 437 return 0;
Wolfgang Betz 69:22e9b407effa 438 }
Wolfgang Betz 34:edda6a7238ec 439
Wolfgang Betz 69:22e9b407effa 440 if(bufsize < spirit_rx_len) {
Wolfgang Betz 69:22e9b407effa 441 enable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 442
Wolfgang Betz 69:22e9b407effa 443 /* If buf has the correct size */
Wolfgang Betz 34:edda6a7238ec 444 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 445 debug("\r\nTOO SMALL BUF\r\n");
Wolfgang Betz 34:edda6a7238ec 446 #endif
Wolfgang Betz 69:22e9b407effa 447 return 0;
Wolfgang Betz 69:22e9b407effa 448 } else {
Wolfgang Betz 69:22e9b407effa 449 /* Copies the packet received */
jmhong 83:54b207156a91 450
Wolfgang Betz 69:22e9b407effa 451 memcpy(buf, spirit_rx_buf, spirit_rx_len);
jmhong 83:54b207156a91 452 bufsize = spirit_rx_len;
jmhong 83:54b207156a91 453 printf("recv 3-1");
jmhong 83:54b207156a91 454
Wolfgang Betz 69:22e9b407effa 455 CLEAR_RXBUF();
jmhong 83:54b207156a91 456 printf(" 3-2");
jmhong 83:54b207156a91 457
Wolfgang Betz 69:22e9b407effa 458 enable_spirit_irq();
jmhong 83:54b207156a91 459 printf(" 3-3 read ok\n");
Wolfgang Betz 34:edda6a7238ec 460
Wolfgang Betz 69:22e9b407effa 461 return bufsize;
Wolfgang Betz 69:22e9b407effa 462 }
Wolfgang Betz 34:edda6a7238ec 463
Wolfgang Betz 34:edda6a7238ec 464 }
Wolfgang Betz 34:edda6a7238ec 465
Wolfgang Betz 34:edda6a7238ec 466 int SimpleSpirit1::channel_clear(void)
Wolfgang Betz 34:edda6a7238ec 467 {
Wolfgang Betz 69:22e9b407effa 468 float rssi_value;
Wolfgang Betz 69:22e9b407effa 469 /* Local variable used to memorize the SPIRIT1 state */
Wolfgang Betz 69:22e9b407effa 470 uint8_t spirit_state = ON;
Wolfgang Betz 34:edda6a7238ec 471
Wolfgang Betz 69:22e9b407effa 472 if(spirit_on == OFF) {
Wolfgang Betz 69:22e9b407effa 473 /* Wakes up the SPIRIT1 */
Wolfgang Betz 69:22e9b407effa 474 on();
Wolfgang Betz 69:22e9b407effa 475 spirit_state = OFF;
Wolfgang Betz 69:22e9b407effa 476 }
Wolfgang Betz 34:edda6a7238ec 477
Wolfgang Betz 34:edda6a7238ec 478 #ifndef NDEBUG
Wolfgang Betz 69:22e9b407effa 479 if(SPIRIT1_STATUS() != SPIRIT1_STATE_RX) {
Wolfgang Betz 69:22e9b407effa 480 debug("\r\nAssert failed in: %s (%d): state=%x\r\n", __func__, __LINE__, last_state>>1);
Wolfgang Betz 69:22e9b407effa 481 }
Wolfgang Betz 34:edda6a7238ec 482 #endif
Wolfgang Betz 34:edda6a7238ec 483
Wolfgang Betz 69:22e9b407effa 484 disable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 485
Wolfgang Betz 69:22e9b407effa 486 /* Reset State to Ready */
Wolfgang Betz 69:22e9b407effa 487 set_ready_state();
Wolfgang Betz 34:edda6a7238ec 488
Wolfgang Betz 69:22e9b407effa 489 /* Stores the RSSI value */
Wolfgang Betz 69:22e9b407effa 490 rssi_value = qi_get_rssi_dbm();
Wolfgang Betz 34:edda6a7238ec 491
Wolfgang Betz 69:22e9b407effa 492 enable_spirit_irq();
Wolfgang Betz 34:edda6a7238ec 493
Wolfgang Betz 69:22e9b407effa 494 /* Puts the SPIRIT1 in its previous state */
jmhong 83:54b207156a91 495 if(spirit_state==OFF) {
Wolfgang Betz 69:22e9b407effa 496 off();
Wolfgang Betz 34:edda6a7238ec 497 #ifndef NDEBUG
Wolfgang Betz 34:edda6a7238ec 498 #ifdef USE_STANDBY_STATE
Wolfgang Betz 69:22e9b407effa 499 if(SPIRIT1_STATUS() != SPIRIT1_STATE_STANDBY) {
jmhong 83:54b207156a91 500 #else
jmhong 83:54b207156a91 501 if(SPIRIT1_STATUS() != SPIRIT1_STATE_READY) {
jmhong 83:54b207156a91 502 #endif
jmhong 83:54b207156a91 503 debug("\r\nAssert failed in: %s (%d): state=%x\r\n", __func__, __LINE__, last_state>>1);
jmhong 83:54b207156a91 504 }
jmhong 83:54b207156a91 505 #endif
jmhong 83:54b207156a91 506 } else {
jmhong 83:54b207156a91 507 disable_spirit_irq();
jmhong 83:54b207156a91 508
jmhong 83:54b207156a91 509 set_ready_state();
Wolfgang Betz 34:edda6a7238ec 510
jmhong 83:54b207156a91 511 cmd_strobe(SPIRIT1_STROBE_RX);
jmhong 83:54b207156a91 512 BUSYWAIT_UNTIL(SPIRIT1_STATUS() == SPIRIT1_STATE_RX, STATE_TIMEOUT);
jmhong 83:54b207156a91 513 if((last_state & SPIRIT1_STATE_STATEBITS) != SPIRIT1_STATE_RX) {
jmhong 83:54b207156a91 514 error("\r\nSpirit1: (#2) failed to enter rx (%x) => retry\r\n", last_state>>1);
jmhong 83:54b207156a91 515 }
Wolfgang Betz 34:edda6a7238ec 516
jmhong 83:54b207156a91 517 enable_spirit_irq();
jmhong 83:54b207156a91 518
jmhong 83:54b207156a91 519 #ifndef NDEBUG
jmhong 83:54b207156a91 520 if(SPIRIT1_STATUS() != SPIRIT1_STATE_RX) {
jmhong 83:54b207156a91 521 debug("\r\nAssert failed in: %s (%d): state=%x\r\n", __func__, __LINE__, last_state>>1);
jmhong 83:54b207156a91 522 }
jmhong 83:54b207156a91 523 #endif
Wolfgang Betz 82:a18c22d2b83a 524 }
Wolfgang Betz 34:edda6a7238ec 525
jmhong 83:54b207156a91 526 /* Checks the RSSI value with the threshold */
jmhong 83:54b207156a91 527 if(rssi_value<CCA_THRESHOLD) {
jmhong 83:54b207156a91 528 return 0;
jmhong 83:54b207156a91 529 } else {
jmhong 83:54b207156a91 530 return 1;
jmhong 83:54b207156a91 531 }
jmhong 83:54b207156a91 532 }
Wolfgang Betz 34:edda6a7238ec 533
jmhong 83:54b207156a91 534 int SimpleSpirit1::get_pending_packet(void)
jmhong 83:54b207156a91 535 {
jmhong 83:54b207156a91 536 return !IS_RXBUF_EMPTY();
Wolfgang Betz 82:a18c22d2b83a 537 }
Wolfgang Betz 82:a18c22d2b83a 538
jmhong 83:54b207156a91 539 /** Spirit Irq Callback **/
jmhong 83:54b207156a91 540 /* betzw - TODO: use threaded interrupt handling when `MBED_CONF_RTOS_PRESENT` is defined (see `atmel-rf-driver`) */
jmhong 83:54b207156a91 541 void SimpleSpirit1::IrqHandler() {
jmhong 83:54b207156a91 542 st_lib_spirit_irqs x_irq_status;
Wolfgang Betz 82:a18c22d2b83a 543
jmhong 83:54b207156a91 544 /* get interrupt source from radio */
jmhong 83:54b207156a91 545 irq_get_status(&x_irq_status);
Wolfgang Betz 82:a18c22d2b83a 546
jmhong 83:54b207156a91 547 /* The IRQ_TX_DATA_SENT notifies the packet has been sent. Puts the SPIRIT1 in RX */
jmhong 83:54b207156a91 548 if(x_irq_status.IRQ_TX_DATA_SENT) { /* betzw - NOTE: MUST be handled before `IRQ_RX_DATA_READY` for Nanostack integration!
Wolfgang Betz 82:a18c22d2b83a 549 Logically, Nanostack only expects the "DONE" after "SUCCESS" (if it gets
Wolfgang Betz 82:a18c22d2b83a 550 DONE before SUCCESS, it assumes you're not going to bother to send SUCCESS).
jmhong 83:54b207156a91 551 */
Wolfgang Betz 82:a18c22d2b83a 552 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 553 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 554 debug_if(!((*tmp) & IRQ_TX_DATA_SENT_MASK), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 555 debug_if(tx_fifo_remaining != 0, "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 556 #endif
jmhong 83:54b207156a91 557
jmhong 83:54b207156a91 558 if(_spirit_tx_started) {
jmhong 83:54b207156a91 559 _spirit_tx_started = false;
jmhong 83:54b207156a91 560
jmhong 83:54b207156a91 561 /* call user callback */
jmhong 83:54b207156a91 562 if(_current_irq_callback) {
jmhong 83:54b207156a91 563 _current_irq_callback(TX_DONE);
jmhong 83:54b207156a91 564 }
jmhong 83:54b207156a91 565 }
jmhong 83:54b207156a91 566
jmhong 83:54b207156a91 567 /* Disable handling of other TX flags */
jmhong 83:54b207156a91 568 x_irq_status.IRQ_TX_FIFO_ALMOST_EMPTY = S_RESET;
jmhong 83:54b207156a91 569 tx_fifo_buffer = NULL;
jmhong 83:54b207156a91 570 }
jmhong 83:54b207156a91 571
jmhong 83:54b207156a91 572 #ifndef RX_FIFO_THR_WA
jmhong 83:54b207156a91 573 /* The IRQ_TX_FIFO_ALMOST_EMPTY notifies an nearly empty TX fifo */
jmhong 83:54b207156a91 574 if(x_irq_status.IRQ_TX_FIFO_ALMOST_EMPTY) {
jmhong 83:54b207156a91 575 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 576 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 577 debug_if(!((*tmp) & IRQ_TX_FIFO_ALMOST_EMPTY_MASK), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 578 debug_if(!_spirit_tx_started, "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 579 debug_if(tx_fifo_buffer == NULL, "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
Wolfgang Betz 82:a18c22d2b83a 580 #endif
Wolfgang Betz 82:a18c22d2b83a 581
jmhong 83:54b207156a91 582 int8_t fifo_available = SPIRIT_MAX_FIFO_LEN/2; // fill-up half fifo
jmhong 83:54b207156a91 583 int8_t to_send = (tx_fifo_remaining > fifo_available) ? fifo_available : tx_fifo_remaining;
jmhong 83:54b207156a91 584
jmhong 83:54b207156a91 585 tx_fifo_remaining -= to_send;
jmhong 83:54b207156a91 586
jmhong 83:54b207156a91 587 /* Fill FIFO Buffer */
jmhong 83:54b207156a91 588 if(to_send > 0) {
jmhong 83:54b207156a91 589 spi_write_linear_fifo(to_send, (uint8_t*)&tx_fifo_buffer[tx_buffer_pos]);
jmhong 83:54b207156a91 590 }
jmhong 83:54b207156a91 591 tx_buffer_pos += to_send;
jmhong 83:54b207156a91 592 }
jmhong 83:54b207156a91 593 #endif // !RX_FIFO_THR_WA
jmhong 83:54b207156a91 594
jmhong 83:54b207156a91 595 /* TX FIFO underflow/overflow error */
jmhong 83:54b207156a91 596 if(x_irq_status.IRQ_TX_FIFO_ERROR) {
jmhong 83:54b207156a91 597 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 598 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 599 debug("\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
jmhong 83:54b207156a91 600 debug_if(!((*tmp) & IRQ_TX_FIFO_ERROR_MASK), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 601 #endif
jmhong 83:54b207156a91 602 if(_spirit_tx_started) {
jmhong 83:54b207156a91 603 _spirit_tx_started = false;
jmhong 83:54b207156a91 604 /* call user callback */
jmhong 83:54b207156a91 605 if(_current_irq_callback) {
jmhong 83:54b207156a91 606 _current_irq_callback(TX_ERR);
jmhong 83:54b207156a91 607 }
jmhong 83:54b207156a91 608 }
jmhong 83:54b207156a91 609
jmhong 83:54b207156a91 610 /* reset data still to be sent */
jmhong 83:54b207156a91 611 tx_fifo_remaining = 0;
jmhong 83:54b207156a91 612 }
Wolfgang Betz 82:a18c22d2b83a 613
jmhong 83:54b207156a91 614 /* The IRQ_RX_DATA_READY notifies a new packet arrived */
jmhong 83:54b207156a91 615 if(x_irq_status.IRQ_RX_DATA_READY) {
jmhong 83:54b207156a91 616 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 617 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 618 debug_if(!((*tmp) & IRQ_RX_DATA_READY_MASK), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 619 #endif
jmhong 83:54b207156a91 620
jmhong 83:54b207156a91 621 if(!_is_receiving) { // spurious irq?!? (betzw: see comments on macro 'RX_FIFO_THR_WA'!)
jmhong 83:54b207156a91 622 #ifdef HEAVY_DEBUG
jmhong 83:54b207156a91 623 debug("\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
jmhong 83:54b207156a91 624 #endif
jmhong 83:54b207156a91 625 } else {
jmhong 83:54b207156a91 626 _is_receiving = false; // Finished receiving
jmhong 83:54b207156a91 627 stop_rx_timeout();
jmhong 83:54b207156a91 628
jmhong 83:54b207156a91 629 spirit_rx_len = pkt_basic_get_received_pkt_length();
jmhong 83:54b207156a91 630
jmhong 83:54b207156a91 631 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 632 debug_if(!(spirit_rx_len <= MAX_PACKET_LEN), "\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
jmhong 83:54b207156a91 633 #endif
jmhong 83:54b207156a91 634
jmhong 83:54b207156a91 635 if(spirit_rx_len <= MAX_PACKET_LEN) {
jmhong 83:54b207156a91 636 uint8_t to_receive = spirit_rx_len - _spirit_rx_pos;
jmhong 83:54b207156a91 637 if(to_receive > 0) {
jmhong 83:54b207156a91 638 spi_read_linear_fifo(to_receive, &spirit_rx_buf[_spirit_rx_pos]);
jmhong 83:54b207156a91 639 _spirit_rx_pos += to_receive;
jmhong 83:54b207156a91 640 }
jmhong 83:54b207156a91 641 }
jmhong 83:54b207156a91 642
jmhong 83:54b207156a91 643 cmd_strobe(SPIRIT1_STROBE_FRX);
jmhong 83:54b207156a91 644
jmhong 83:54b207156a91 645 last_rssi = qi_get_rssi(); //MGR
jmhong 83:54b207156a91 646 last_sqi = qi_get_sqi(); //MGR
jmhong 83:54b207156a91 647
jmhong 83:54b207156a91 648 /* call user callback */
jmhong 83:54b207156a91 649 if((_spirit_rx_pos == spirit_rx_len) && _current_irq_callback) {
jmhong 83:54b207156a91 650 _current_irq_callback(RX_DONE);
jmhong 83:54b207156a91 651 }
jmhong 83:54b207156a91 652
jmhong 83:54b207156a91 653 /* Disable handling of other RX flags */
jmhong 83:54b207156a91 654 x_irq_status.IRQ_RX_FIFO_ALMOST_FULL = S_RESET;
Wolfgang Betz 69:22e9b407effa 655 }
Wolfgang Betz 69:22e9b407effa 656 }
Wolfgang Betz 34:edda6a7238ec 657
Wolfgang Betz 82:a18c22d2b83a 658 #ifndef RX_FIFO_THR_WA
jmhong 83:54b207156a91 659 /* RX FIFO almost full */
jmhong 83:54b207156a91 660 if(x_irq_status.IRQ_RX_FIFO_ALMOST_FULL) {
jmhong 83:54b207156a91 661 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 662 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 663 debug_if(!((*tmp) & IRQ_RX_FIFO_ALMOST_FULL_MASK), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
jmhong 83:54b207156a91 664 #endif
jmhong 83:54b207156a91 665 if(!_is_receiving) { // spurious irq?!?
Wolfgang Betz 34:edda6a7238ec 666 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 667 debug("\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
Wolfgang Betz 34:edda6a7238ec 668 #endif
jmhong 83:54b207156a91 669 } else {
jmhong 83:54b207156a91 670 uint8_t fifo_available = linear_fifo_read_num_elements_rx_fifo();
jmhong 83:54b207156a91 671 if((fifo_available + _spirit_rx_pos) <= MAX_PACKET_LEN) {
jmhong 83:54b207156a91 672 spi_read_linear_fifo(fifo_available, &spirit_rx_buf[_spirit_rx_pos]);
jmhong 83:54b207156a91 673 _spirit_rx_pos += fifo_available;
jmhong 83:54b207156a91 674 } else {
jmhong 83:54b207156a91 675 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 676 debug("\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
jmhong 83:54b207156a91 677 #endif
jmhong 83:54b207156a91 678 }
jmhong 83:54b207156a91 679 }
Wolfgang Betz 82:a18c22d2b83a 680 }
Wolfgang Betz 82:a18c22d2b83a 681 #endif // !RX_FIFO_THR_WA
Wolfgang Betz 82:a18c22d2b83a 682
jmhong 83:54b207156a91 683 /* Reception errors */
jmhong 83:54b207156a91 684 if((x_irq_status.IRQ_RX_FIFO_ERROR) || (x_irq_status.IRQ_RX_DATA_DISC)) {
Wolfgang Betz 82:a18c22d2b83a 685 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 686 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 687 debug("\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
jmhong 83:54b207156a91 688 debug_if(!((*tmp) & (IRQ_RX_FIFO_ERROR_MASK | IRQ_RX_DATA_DISC_MASK)), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
Wolfgang Betz 82:a18c22d2b83a 689 #endif
jmhong 83:54b207156a91 690 rx_timeout_handler();
jmhong 83:54b207156a91 691 if(_spirit_tx_started) {
jmhong 83:54b207156a91 692 _spirit_tx_started = false;
jmhong 83:54b207156a91 693 /* call user callback */
jmhong 83:54b207156a91 694 if(_current_irq_callback) {
jmhong 83:54b207156a91 695 _current_irq_callback(TX_ERR);
jmhong 83:54b207156a91 696 }
Wolfgang Betz 82:a18c22d2b83a 697 }
Wolfgang Betz 82:a18c22d2b83a 698 }
Wolfgang Betz 45:2d01cc9bc761 699
jmhong 83:54b207156a91 700 /* The IRQ_VALID_SYNC is used to notify a new packet is coming */
jmhong 83:54b207156a91 701 if(x_irq_status.IRQ_VALID_SYNC) {
Wolfgang Betz 82:a18c22d2b83a 702 #ifdef DEBUG_IRQ
jmhong 83:54b207156a91 703 uint32_t *tmp = (uint32_t*)&x_irq_status;
jmhong 83:54b207156a91 704 debug_if(!((*tmp) & IRQ_VALID_SYNC_MASK), "\r\nAssert failed in: %s (%d)\r\n", __func__, __LINE__);
Wolfgang Betz 82:a18c22d2b83a 705 #endif
jmhong 83:54b207156a91 706 /* betzw - NOTE: there is a race condition between Spirit1 receiving packets and
jmhong 83:54b207156a91 707 * the MCU trying to send a packet, which gets resolved in favor of
jmhong 83:54b207156a91 708 * sending.
jmhong 83:54b207156a91 709 */
jmhong 83:54b207156a91 710 if(_spirit_tx_started) {
Wolfgang Betz 43:a512f909514a 711 #ifdef DEBUG_IRQ
Wolfgang Betz 69:22e9b407effa 712 debug("\r\n%s (%d): irq=%x\r\n", __func__, __LINE__, *tmp);
Wolfgang Betz 43:a512f909514a 713 #endif
jmhong 83:54b207156a91 714 } else {
jmhong 83:54b207156a91 715 _is_receiving = true;
jmhong 83:54b207156a91 716 start_rx_timeout();
Wolfgang Betz 69:22e9b407effa 717 }
Wolfgang Betz 69:22e9b407effa 718 }
Wolfgang Betz 69:22e9b407effa 719 }