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