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).
mbed_driver_api.cpp@27:e68ffb6ac223, 2016-11-15 (annotated)
- Committer:
- Wolfgang Betz
- Date:
- Tue Nov 15 12:07:07 2016 +0100
- Revision:
- 27:e68ffb6ac223
- Parent:
- 25:2ec45788f28c
- Child:
- 28:6a71e15d5272
Working without tracing
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| Wolfgang Betz |
10:dedd44d58c0f | 1 | #include "SimpleSpirit1.h" |
| Wolfgang Betz |
10:dedd44d58c0f | 2 | #include "nanostack/platform/arm_hal_phy.h" |
| Wolfgang Betz |
12:b8056eda4028 | 3 | #include "platform/arm_hal_interrupt.h" |
| Wolfgang Betz |
12:b8056eda4028 | 4 | |
| Wolfgang Betz |
12:b8056eda4028 | 5 | #include "mbed_trace.h" |
| Wolfgang Betz |
12:b8056eda4028 | 6 | #define TRACE_GROUP "SPIRIT" |
| Wolfgang Betz |
10:dedd44d58c0f | 7 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 8 | /* Define beyond macro if you want to perform heavy debug tracing also in IRQ context */ |
| Wolfgang Betz |
16:25dc4b811ad3 | 9 | // #define HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 10 | |
| Wolfgang Betz |
20:0b738b9ca855 | 11 | /* Define beyond macro if you want to use acknowledgment frames with only 3 bytes */ |
| Wolfgang Betz |
20:0b738b9ca855 | 12 | #define SHORT_ACK_FRAMES |
| Wolfgang Betz |
20:0b738b9ca855 | 13 | |
| Wolfgang Betz |
11:b769d6caad82 | 14 | /*Atmel RF Part Type*/ |
| Wolfgang Betz |
11:b769d6caad82 | 15 | // betzw - TODO |
| Wolfgang Betz |
11:b769d6caad82 | 16 | typedef enum |
| Wolfgang Betz |
11:b769d6caad82 | 17 | { |
| Wolfgang Betz |
11:b769d6caad82 | 18 | ATMEL_UNKNOW_DEV = 0, |
| Wolfgang Betz |
11:b769d6caad82 | 19 | ATMEL_AT86RF212, |
| Wolfgang Betz |
11:b769d6caad82 | 20 | ATMEL_AT86RF231, |
| Wolfgang Betz |
11:b769d6caad82 | 21 | ATMEL_AT86RF233 |
| Wolfgang Betz |
11:b769d6caad82 | 22 | }rf_trx_part_e; |
| Wolfgang Betz |
11:b769d6caad82 | 23 | |
| Wolfgang Betz |
10:dedd44d58c0f | 24 | static uint8_t mac_address[8] = { |
| Wolfgang Betz |
10:dedd44d58c0f | 25 | MBED_CONF_SPIRIT1_MAC_ADDRESS_0, |
| Wolfgang Betz |
10:dedd44d58c0f | 26 | MBED_CONF_SPIRIT1_MAC_ADDRESS_1, |
| Wolfgang Betz |
10:dedd44d58c0f | 27 | MBED_CONF_SPIRIT1_MAC_ADDRESS_2, |
| Wolfgang Betz |
10:dedd44d58c0f | 28 | MBED_CONF_SPIRIT1_MAC_ADDRESS_3, |
| Wolfgang Betz |
10:dedd44d58c0f | 29 | MBED_CONF_SPIRIT1_MAC_ADDRESS_4, |
| Wolfgang Betz |
10:dedd44d58c0f | 30 | MBED_CONF_SPIRIT1_MAC_ADDRESS_5, |
| Wolfgang Betz |
10:dedd44d58c0f | 31 | MBED_CONF_SPIRIT1_MAC_ADDRESS_6, |
| Wolfgang Betz |
10:dedd44d58c0f | 32 | MBED_CONF_SPIRIT1_MAC_ADDRESS_7 |
| Wolfgang Betz |
10:dedd44d58c0f | 33 | }; |
| Wolfgang Betz |
10:dedd44d58c0f | 34 | static phy_device_driver_s device_driver; |
| Wolfgang Betz |
10:dedd44d58c0f | 35 | static int8_t rf_radio_driver_id = -1; |
| Wolfgang Betz |
10:dedd44d58c0f | 36 | |
| Wolfgang Betz |
10:dedd44d58c0f | 37 | const phy_rf_channel_configuration_s phy_subghz = {868000000, 1000000, 250000, 11, M_GFSK}; |
| Wolfgang Betz |
10:dedd44d58c0f | 38 | |
| Wolfgang Betz |
10:dedd44d58c0f | 39 | static phy_device_channel_page_s phy_channel_pages[] = { |
| Wolfgang Betz |
10:dedd44d58c0f | 40 | {CHANNEL_PAGE_2, &phy_subghz}, |
| Wolfgang Betz |
10:dedd44d58c0f | 41 | {CHANNEL_PAGE_0, NULL} |
| Wolfgang Betz |
10:dedd44d58c0f | 42 | }; |
| Wolfgang Betz |
10:dedd44d58c0f | 43 | |
| Wolfgang Betz |
10:dedd44d58c0f | 44 | static uint8_t tx_sequence = 0xff; |
| Wolfgang Betz |
10:dedd44d58c0f | 45 | static uint8_t mac_tx_handle = 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 46 | |
| Wolfgang Betz |
10:dedd44d58c0f | 47 | static SimpleSpirit1 *rf_device = NULL; |
| Wolfgang Betz |
10:dedd44d58c0f | 48 | static uint8_t rf_rx_buf[MAX_PACKET_LEN]; |
| Wolfgang Betz |
10:dedd44d58c0f | 49 | |
| Wolfgang Betz |
12:b8056eda4028 | 50 | static uint8_t stored_mac_address[8]; |
| Wolfgang Betz |
13:739d89e71f31 | 51 | static uint16_t stored_short_adr; |
| Wolfgang Betz |
13:739d89e71f31 | 52 | static uint16_t stored_pan_id; |
| Wolfgang Betz |
12:b8056eda4028 | 53 | |
| Wolfgang Betz |
12:b8056eda4028 | 54 | #define RF_SIG_ACK_NEEDED (1<<0) |
| Wolfgang Betz |
12:b8056eda4028 | 55 | static Thread rf_ack_sender(osPriorityRealtime); |
| Wolfgang Betz |
27:e68ffb6ac223 | 56 | static volatile uint8_t rf_rx_sequence; |
| Wolfgang Betz |
20:0b738b9ca855 | 57 | #ifndef SHORT_ACK_FRAMES |
| Wolfgang Betz |
27:e68ffb6ac223 | 58 | static volatile uint8_t rf_src_adr[8]; |
| Wolfgang Betz |
27:e68ffb6ac223 | 59 | static volatile uint8_t rf_src_adr_len = 0; |
| Wolfgang Betz |
20:0b738b9ca855 | 60 | #endif |
| Wolfgang Betz |
27:e68ffb6ac223 | 61 | static volatile bool rf_ack_sent = false; |
| Wolfgang Betz |
12:b8056eda4028 | 62 | |
| Wolfgang Betz |
12:b8056eda4028 | 63 | /* MAC frame helper macros */ |
| Wolfgang Betz |
12:b8056eda4028 | 64 | #define MAC_FCF_FRAME_TYPE_MASK 0x0007 |
| Wolfgang Betz |
12:b8056eda4028 | 65 | #define MAC_FCF_FRAME_TYPE_SHIFT 0 |
| Wolfgang Betz |
12:b8056eda4028 | 66 | #define MAC_FCF_SECURITY_BIT_MASK 0x0008 |
| Wolfgang Betz |
12:b8056eda4028 | 67 | #define MAC_FCF_SECURITY_BIT_SHIFT 3 |
| Wolfgang Betz |
12:b8056eda4028 | 68 | #define MAC_FCF_PENDING_BIT_MASK 0x0010 |
| Wolfgang Betz |
12:b8056eda4028 | 69 | #define MAC_FCF_PENDING_BIT_SHIFT 4 |
| Wolfgang Betz |
12:b8056eda4028 | 70 | #define MAC_FCF_ACK_REQ_BIT_MASK 0x0020 |
| Wolfgang Betz |
12:b8056eda4028 | 71 | #define MAC_FCF_ACK_REQ_BIT_SHIFT 5 |
| Wolfgang Betz |
12:b8056eda4028 | 72 | #define MAC_FCF_INTRA_PANID_MASK 0x0040 |
| Wolfgang Betz |
12:b8056eda4028 | 73 | #define MAC_FCF_INTRA_PANID_SHIFT 6 |
| Wolfgang Betz |
12:b8056eda4028 | 74 | #define MAC_FCF_DST_ADDR_MASK 0x0c00 |
| Wolfgang Betz |
12:b8056eda4028 | 75 | #define MAC_FCF_DST_ADDR_SHIFT 10 |
| Wolfgang Betz |
12:b8056eda4028 | 76 | #define MAC_FCF_VERSION_MASK 0x3000 |
| Wolfgang Betz |
12:b8056eda4028 | 77 | #define MAC_FCF_VERSION_SHIFT 12 |
| Wolfgang Betz |
12:b8056eda4028 | 78 | #define MAC_FCF_SRC_ADDR_MASK 0xc000 |
| Wolfgang Betz |
12:b8056eda4028 | 79 | #define MAC_FCF_SRC_ADDR_SHIFT 14 |
| Wolfgang Betz |
12:b8056eda4028 | 80 | |
| Wolfgang Betz |
12:b8056eda4028 | 81 | /* MAC supported frame types */ |
| Wolfgang Betz |
12:b8056eda4028 | 82 | #define FC_BEACON_FRAME 0x00 |
| Wolfgang Betz |
12:b8056eda4028 | 83 | #define FC_DATA_FRAME 0x01 |
| Wolfgang Betz |
12:b8056eda4028 | 84 | #define FC_ACK_FRAME 0x02 |
| Wolfgang Betz |
12:b8056eda4028 | 85 | #define FC_CMD_FRAME 0x03 |
| Wolfgang Betz |
12:b8056eda4028 | 86 | |
| Wolfgang Betz |
12:b8056eda4028 | 87 | static void rf_if_lock(void) |
| Wolfgang Betz |
12:b8056eda4028 | 88 | { |
| Wolfgang Betz |
12:b8056eda4028 | 89 | platform_enter_critical(); |
| Wolfgang Betz |
12:b8056eda4028 | 90 | } |
| Wolfgang Betz |
12:b8056eda4028 | 91 | |
| Wolfgang Betz |
12:b8056eda4028 | 92 | static void rf_if_unlock(void) |
| Wolfgang Betz |
12:b8056eda4028 | 93 | { |
| Wolfgang Betz |
12:b8056eda4028 | 94 | platform_exit_critical(); |
| Wolfgang Betz |
12:b8056eda4028 | 95 | } |
| Wolfgang Betz |
12:b8056eda4028 | 96 | |
| Wolfgang Betz |
13:739d89e71f31 | 97 | static inline uint16_t rf_read_16_bit(uint8_t *data_ptr) { // little-endian |
| Wolfgang Betz |
13:739d89e71f31 | 98 | uint16_t ret; |
| Wolfgang Betz |
13:739d89e71f31 | 99 | |
| Wolfgang Betz |
13:739d89e71f31 | 100 | ret = ((uint16_t)data_ptr[0]) + (((uint16_t)data_ptr[1]) << 8); |
| Wolfgang Betz |
13:739d89e71f31 | 101 | return ret; |
| Wolfgang Betz |
13:739d89e71f31 | 102 | } |
| Wolfgang Betz |
13:739d89e71f31 | 103 | |
| Wolfgang Betz |
14:898a9d48dd03 | 104 | static int8_t rf_trigger_send(uint8_t *data_ptr, uint16_t data_length, uint8_t tx_handle, data_protocol_e data_protocol) |
| Wolfgang Betz |
10:dedd44d58c0f | 105 | { |
| Wolfgang Betz |
22:9165bd73c61e | 106 | #ifndef NDEBUG |
| Wolfgang Betz |
22:9165bd73c61e | 107 | debug_if(!(data_length >= 3), "\n\rassert failed in: %s (%d)\n\r", __func__, __LINE__); |
| Wolfgang Betz |
22:9165bd73c61e | 108 | #endif |
| Wolfgang Betz |
22:9165bd73c61e | 109 | |
| Wolfgang Betz |
22:9165bd73c61e | 110 | /* Give 'rf_ack_sender' a better chance to run */ |
| Wolfgang Betz |
22:9165bd73c61e | 111 | Thread::yield(); |
| Wolfgang Betz |
12:b8056eda4028 | 112 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 113 | /* Get Lock */ |
| Wolfgang Betz |
16:25dc4b811ad3 | 114 | rf_if_lock(); |
| Wolfgang Betz |
16:25dc4b811ad3 | 115 | |
| Wolfgang Betz |
10:dedd44d58c0f | 116 | /*Check if transmitter is busy*/ |
| Wolfgang Betz |
23:4192649f35da | 117 | if(rf_device->is_receiving()) { /* betzw - WAS: (rf_device->channel_clear() != 0)), do NOT use this but rather study and enable automatic CCA */ |
| Wolfgang Betz |
13:739d89e71f31 | 118 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 119 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 120 | /* Release Lock */ |
| Wolfgang Betz |
16:25dc4b811ad3 | 121 | rf_if_unlock(); |
| Wolfgang Betz |
16:25dc4b811ad3 | 122 | |
| Wolfgang Betz |
12:b8056eda4028 | 123 | /*Return busy*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 124 | return -1; |
| Wolfgang Betz |
10:dedd44d58c0f | 125 | } else { |
| Wolfgang Betz |
13:739d89e71f31 | 126 | uint16_t fcf = rf_read_16_bit(data_ptr); |
| Wolfgang Betz |
13:739d89e71f31 | 127 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 128 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
27:e68ffb6ac223 | 129 | uint16_t need_ack; |
| Wolfgang Betz |
27:e68ffb6ac223 | 130 | |
| Wolfgang Betz |
12:b8056eda4028 | 131 | /*Check if transmitted data needs to be acked*/ |
| Wolfgang Betz |
13:739d89e71f31 | 132 | if((fcf & MAC_FCF_ACK_REQ_BIT_MASK) >> MAC_FCF_ACK_REQ_BIT_SHIFT) |
| Wolfgang Betz |
12:b8056eda4028 | 133 | need_ack = 1; |
| Wolfgang Betz |
12:b8056eda4028 | 134 | else |
| Wolfgang Betz |
12:b8056eda4028 | 135 | need_ack = 0; |
| Wolfgang Betz |
27:e68ffb6ac223 | 136 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 137 | |
| Wolfgang Betz |
12:b8056eda4028 | 138 | /*Store the sequence number for ACK handling*/ |
| Wolfgang Betz |
12:b8056eda4028 | 139 | tx_sequence = *(data_ptr + 2); |
| Wolfgang Betz |
12:b8056eda4028 | 140 | |
| Wolfgang Betz |
12:b8056eda4028 | 141 | /*Store TX handle*/ |
| Wolfgang Betz |
12:b8056eda4028 | 142 | mac_tx_handle = tx_handle; |
| Wolfgang Betz |
10:dedd44d58c0f | 143 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 144 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
25:2ec45788f28c | 145 | tr_info("%s (%d), len=%d, tx_handle=%x, tx_seq=%x, need_ack=%d (%x:%x, %x:%x, %x:%x, %x:%x)", __func__, __LINE__, |
| Wolfgang Betz |
14:898a9d48dd03 | 146 | data_length, tx_handle, tx_sequence, need_ack, |
| Wolfgang Betz |
27:e68ffb6ac223 | 147 | data_ptr[3], data_ptr[4], data_ptr[5], data_ptr[6], |
| Wolfgang Betz |
14:898a9d48dd03 | 148 | data_ptr[7], data_ptr[8], data_ptr[9], data_ptr[10]); |
| Wolfgang Betz |
27:e68ffb6ac223 | 149 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 150 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 151 | /*Send the packet*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 152 | rf_device->send(data_ptr, data_length); |
| Wolfgang Betz |
12:b8056eda4028 | 153 | |
| Wolfgang Betz |
12:b8056eda4028 | 154 | /* Release Lock */ |
| Wolfgang Betz |
12:b8056eda4028 | 155 | rf_if_unlock(); |
| Wolfgang Betz |
10:dedd44d58c0f | 156 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 157 | |
| Wolfgang Betz |
12:b8056eda4028 | 158 | /*Return success*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 159 | return 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 160 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 161 | |
| Wolfgang Betz |
10:dedd44d58c0f | 162 | static int8_t rf_interface_state_control(phy_interface_state_e new_state, uint8_t rf_channel) |
| Wolfgang Betz |
10:dedd44d58c0f | 163 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 164 | int8_t ret_val = 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 165 | switch (new_state) |
| Wolfgang Betz |
10:dedd44d58c0f | 166 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 167 | /*Reset PHY driver and set to idle*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 168 | case PHY_INTERFACE_RESET: |
| Wolfgang Betz |
12:b8056eda4028 | 169 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 170 | rf_device->reset_board(); |
| Wolfgang Betz |
10:dedd44d58c0f | 171 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 172 | /*Disable PHY Interface driver*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 173 | case PHY_INTERFACE_DOWN: |
| Wolfgang Betz |
12:b8056eda4028 | 174 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 175 | ret_val = rf_device->off(); |
| Wolfgang Betz |
10:dedd44d58c0f | 176 | if(ret_val != 0) ret_val = -1; |
| Wolfgang Betz |
10:dedd44d58c0f | 177 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 178 | /*Enable PHY Interface driver*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 179 | case PHY_INTERFACE_UP: |
| Wolfgang Betz |
10:dedd44d58c0f | 180 | ret_val = rf_device->on(); |
| Wolfgang Betz |
10:dedd44d58c0f | 181 | if(ret_val != 0) { |
| Wolfgang Betz |
12:b8056eda4028 | 182 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 183 | ret_val = -1; |
| Wolfgang Betz |
10:dedd44d58c0f | 184 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 185 | } |
| Wolfgang Betz |
12:b8056eda4028 | 186 | tr_debug("%s (%d) - channel: %d", __func__, __LINE__, (int)rf_channel); |
| Wolfgang Betz |
10:dedd44d58c0f | 187 | rf_device->set_channel(rf_channel); |
| Wolfgang Betz |
10:dedd44d58c0f | 188 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 189 | /*Enable wireless interface ED scan mode*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 190 | case PHY_INTERFACE_RX_ENERGY_STATE: |
| Wolfgang Betz |
12:b8056eda4028 | 191 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 192 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 193 | /*Enable Sniffer state*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 194 | case PHY_INTERFACE_SNIFFER_STATE: |
| Wolfgang Betz |
10:dedd44d58c0f | 195 | // TODO - if we really need this - WAS: rf_setup_sniffer(rf_channel); |
| Wolfgang Betz |
12:b8056eda4028 | 196 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 197 | ret_val = -1; |
| Wolfgang Betz |
10:dedd44d58c0f | 198 | break; |
| Wolfgang Betz |
12:b8056eda4028 | 199 | default: |
| Wolfgang Betz |
12:b8056eda4028 | 200 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
12:b8056eda4028 | 201 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 202 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 203 | return ret_val; |
| Wolfgang Betz |
10:dedd44d58c0f | 204 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 205 | |
| Wolfgang Betz |
10:dedd44d58c0f | 206 | static int8_t rf_extension(phy_extension_type_e extension_type, uint8_t *data_ptr) |
| Wolfgang Betz |
10:dedd44d58c0f | 207 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 208 | switch (extension_type) |
| Wolfgang Betz |
10:dedd44d58c0f | 209 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 210 | /*Control MAC pending bit for Indirect data transmission*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 211 | case PHY_EXTENSION_CTRL_PENDING_BIT: |
| Wolfgang Betz |
12:b8056eda4028 | 212 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
11:b769d6caad82 | 213 | break; |
| Wolfgang Betz |
11:b769d6caad82 | 214 | |
| Wolfgang Betz |
10:dedd44d58c0f | 215 | /*Return frame pending status*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 216 | case PHY_EXTENSION_READ_LAST_ACK_PENDING_STATUS: |
| Wolfgang Betz |
27:e68ffb6ac223 | 217 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
27:e68ffb6ac223 | 218 | *data_ptr = 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 219 | break; |
| Wolfgang Betz |
11:b769d6caad82 | 220 | |
| Wolfgang Betz |
10:dedd44d58c0f | 221 | /*Set channel, used for setting channel for energy scan*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 222 | case PHY_EXTENSION_SET_CHANNEL: |
| Wolfgang Betz |
12:b8056eda4028 | 223 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 224 | break; |
| Wolfgang Betz |
11:b769d6caad82 | 225 | |
| Wolfgang Betz |
10:dedd44d58c0f | 226 | /*Read energy on the channel*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 227 | case PHY_EXTENSION_READ_CHANNEL_ENERGY: |
| Wolfgang Betz |
10:dedd44d58c0f | 228 | // TODO: *data_ptr = rf_get_channel_energy(); |
| Wolfgang Betz |
12:b8056eda4028 | 229 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
11:b769d6caad82 | 230 | *data_ptr = rf_device->get_last_rssi_dbm(); |
| Wolfgang Betz |
10:dedd44d58c0f | 231 | break; |
| Wolfgang Betz |
11:b769d6caad82 | 232 | |
| Wolfgang Betz |
10:dedd44d58c0f | 233 | /*Read status of the link*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 234 | case PHY_EXTENSION_READ_LINK_STATUS: |
| Wolfgang Betz |
10:dedd44d58c0f | 235 | // TODO: *data_ptr = rf_get_link_status(); |
| Wolfgang Betz |
12:b8056eda4028 | 236 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
12:b8056eda4028 | 237 | *data_ptr = rf_device->get_last_lqi()*17; |
| Wolfgang Betz |
10:dedd44d58c0f | 238 | break; |
| Wolfgang Betz |
11:b769d6caad82 | 239 | |
| Wolfgang Betz |
10:dedd44d58c0f | 240 | default: |
| Wolfgang Betz |
12:b8056eda4028 | 241 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 242 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 243 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 244 | return 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 245 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 246 | |
| Wolfgang Betz |
12:b8056eda4028 | 247 | #if 0 // Not used in this example |
| Wolfgang Betz |
12:b8056eda4028 | 248 | static inline void rf_set_mac_48bit(uint8_t *ptr) { |
| Wolfgang Betz |
12:b8056eda4028 | 249 | tr_debug("%s (%d), adr0=%x, adr1=%x, adr2=%x, adr3=%x, adr4=%x, adr5=%x", |
| Wolfgang Betz |
12:b8056eda4028 | 250 | __func__, __LINE__, |
| Wolfgang Betz |
12:b8056eda4028 | 251 | ptr[0], ptr[1], ptr[2], ptr[3], ptr[4], ptr[5]); |
| Wolfgang Betz |
12:b8056eda4028 | 252 | } |
| Wolfgang Betz |
12:b8056eda4028 | 253 | #endif // 0 |
| Wolfgang Betz |
12:b8056eda4028 | 254 | |
| Wolfgang Betz |
12:b8056eda4028 | 255 | static inline void rf_set_mac_address(uint8_t *ptr) { |
| Wolfgang Betz |
12:b8056eda4028 | 256 | tr_debug("%s (%d), adr0=%x, adr1=%x, adr2=%x, adr3=%x, adr4=%x, adr5=%x, adr6=%x, adr7=%x", |
| Wolfgang Betz |
12:b8056eda4028 | 257 | __func__, __LINE__, |
| Wolfgang Betz |
12:b8056eda4028 | 258 | ptr[0], ptr[1], ptr[2], ptr[3], ptr[4], ptr[5], ptr[6], ptr[7]); |
| Wolfgang Betz |
12:b8056eda4028 | 259 | for(int i = 0; i < 8; i++) { |
| Wolfgang Betz |
12:b8056eda4028 | 260 | stored_mac_address[i] = ptr[i]; |
| Wolfgang Betz |
12:b8056eda4028 | 261 | } |
| Wolfgang Betz |
12:b8056eda4028 | 262 | } |
| Wolfgang Betz |
12:b8056eda4028 | 263 | |
| Wolfgang Betz |
12:b8056eda4028 | 264 | static inline void rf_set_short_adr(uint8_t *ptr) { |
| Wolfgang Betz |
13:739d89e71f31 | 265 | stored_short_adr = (ptr[0] << 8) + ptr[1]; // big-endian |
| Wolfgang Betz |
13:739d89e71f31 | 266 | tr_debug("%s (%d), adr0=%x, adr1=%x, val=%d", |
| Wolfgang Betz |
12:b8056eda4028 | 267 | __func__, __LINE__, |
| Wolfgang Betz |
13:739d89e71f31 | 268 | ptr[0], ptr[1], stored_short_adr); |
| Wolfgang Betz |
12:b8056eda4028 | 269 | } |
| Wolfgang Betz |
12:b8056eda4028 | 270 | |
| Wolfgang Betz |
12:b8056eda4028 | 271 | static inline void rf_set_pan_id(uint8_t *ptr) { |
| Wolfgang Betz |
13:739d89e71f31 | 272 | stored_pan_id = (ptr[0] << 8) + ptr[1]; // big-endian |
| Wolfgang Betz |
13:739d89e71f31 | 273 | tr_debug("%s (%d), adr0=%x, adr1=%x, val=%d", |
| Wolfgang Betz |
12:b8056eda4028 | 274 | __func__, __LINE__, |
| Wolfgang Betz |
13:739d89e71f31 | 275 | ptr[0], ptr[1], stored_pan_id); |
| Wolfgang Betz |
12:b8056eda4028 | 276 | } |
| Wolfgang Betz |
12:b8056eda4028 | 277 | |
| Wolfgang Betz |
10:dedd44d58c0f | 278 | static int8_t rf_address_write(phy_address_type_e address_type, uint8_t *address_ptr) |
| Wolfgang Betz |
10:dedd44d58c0f | 279 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 280 | switch (address_type) |
| Wolfgang Betz |
10:dedd44d58c0f | 281 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 282 | /*Set 48-bit address*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 283 | case PHY_MAC_48BIT: |
| Wolfgang Betz |
10:dedd44d58c0f | 284 | /* Not used in this example */ |
| Wolfgang Betz |
12:b8056eda4028 | 285 | // betzw - WAS: rf_set_mac_48bit(address_ptr); |
| Wolfgang Betz |
10:dedd44d58c0f | 286 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 287 | /*Set 64-bit address*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 288 | case PHY_MAC_64BIT: |
| Wolfgang Betz |
10:dedd44d58c0f | 289 | rf_set_mac_address(address_ptr); |
| Wolfgang Betz |
10:dedd44d58c0f | 290 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 291 | /*Set 16-bit address*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 292 | case PHY_MAC_16BIT: |
| Wolfgang Betz |
10:dedd44d58c0f | 293 | rf_set_short_adr(address_ptr); |
| Wolfgang Betz |
10:dedd44d58c0f | 294 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 295 | /*Set PAN Id*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 296 | case PHY_MAC_PANID: |
| Wolfgang Betz |
10:dedd44d58c0f | 297 | rf_set_pan_id(address_ptr); |
| Wolfgang Betz |
10:dedd44d58c0f | 298 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 299 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 300 | |
| Wolfgang Betz |
10:dedd44d58c0f | 301 | return 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 302 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 303 | |
| Wolfgang Betz |
10:dedd44d58c0f | 304 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
12:b8056eda4028 | 305 | static void rf_handle_ack(uint8_t seq_number) |
| Wolfgang Betz |
10:dedd44d58c0f | 306 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 307 | /*Received ACK sequence must be equal with transmitted packet sequence*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 308 | if(tx_sequence == seq_number) |
| Wolfgang Betz |
10:dedd44d58c0f | 309 | { |
| Wolfgang Betz |
27:e68ffb6ac223 | 310 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
27:e68ffb6ac223 | 311 | tr_info("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
27:e68ffb6ac223 | 312 | #endif |
| Wolfgang Betz |
10:dedd44d58c0f | 313 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 314 | /*Call PHY TX Done API*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 315 | if(device_driver.phy_tx_done_cb){ |
| Wolfgang Betz |
13:739d89e71f31 | 316 | device_driver.phy_tx_done_cb(rf_radio_driver_id, mac_tx_handle, PHY_LINK_TX_DONE, 0, 0); |
| Wolfgang Betz |
10:dedd44d58c0f | 317 | } |
| Wolfgang Betz |
13:739d89e71f31 | 318 | } else { |
| Wolfgang Betz |
16:25dc4b811ad3 | 319 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
27:e68ffb6ac223 | 320 | tr_info("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 321 | #endif |
| Wolfgang Betz |
10:dedd44d58c0f | 322 | } |
| Wolfgang Betz |
12:b8056eda4028 | 323 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 324 | |
| Wolfgang Betz |
12:b8056eda4028 | 325 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
12:b8056eda4028 | 326 | static inline bool rf_check_mac_address(uint8_t *dest) { |
| Wolfgang Betz |
12:b8056eda4028 | 327 | for(int i = 0; i < 8; i++) { |
| Wolfgang Betz |
13:739d89e71f31 | 328 | if(dest[i] != stored_mac_address[7-i]) return false; |
| Wolfgang Betz |
12:b8056eda4028 | 329 | } |
| Wolfgang Betz |
12:b8056eda4028 | 330 | return true; |
| Wolfgang Betz |
12:b8056eda4028 | 331 | } |
| Wolfgang Betz |
12:b8056eda4028 | 332 | |
| Wolfgang Betz |
12:b8056eda4028 | 333 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
12:b8056eda4028 | 334 | /* Returns true if packet should be accepted */ |
| Wolfgang Betz |
12:b8056eda4028 | 335 | static bool rf_check_destination(int len, uint8_t *ack_requested) { |
| Wolfgang Betz |
14:898a9d48dd03 | 336 | uint8_t frame_type; |
| Wolfgang Betz |
13:739d89e71f31 | 337 | uint16_t dst_pan_id; |
| Wolfgang Betz |
13:739d89e71f31 | 338 | uint16_t dst_short_adr; |
| Wolfgang Betz |
12:b8056eda4028 | 339 | uint8_t dst_addr_mode = 0x0; /*0x00 = no address 0x01 = reserved 0x02 = 16-bit short address 0x03 = 64-bit extended address */ |
| Wolfgang Betz |
12:b8056eda4028 | 340 | uint8_t src_addr_mode = 0x0; /*0x00 = no address 0x01 = reserved 0x02 = 16-bit short address 0x03 = 64-bit extended address */ |
| Wolfgang Betz |
13:739d89e71f31 | 341 | uint8_t min_size = 3; // FCF & SeqNr |
| Wolfgang Betz |
20:0b738b9ca855 | 342 | bool ret = false; |
| Wolfgang Betz |
27:e68ffb6ac223 | 343 | #if !defined(SHORT_ACK_FRAMES) || defined(HEAVY_TRACING) |
| Wolfgang Betz |
14:898a9d48dd03 | 344 | bool panid_compr = false; |
| Wolfgang Betz |
27:e68ffb6ac223 | 345 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 346 | |
| Wolfgang Betz |
14:898a9d48dd03 | 347 | if(len < 3) { |
| Wolfgang Betz |
14:898a9d48dd03 | 348 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
14:898a9d48dd03 | 349 | return false; |
| Wolfgang Betz |
14:898a9d48dd03 | 350 | } |
| Wolfgang Betz |
12:b8056eda4028 | 351 | |
| Wolfgang Betz |
13:739d89e71f31 | 352 | uint16_t fcf = rf_read_16_bit(rf_rx_buf); |
| Wolfgang Betz |
14:898a9d48dd03 | 353 | frame_type = ((fcf & MAC_FCF_FRAME_TYPE_MASK) >> MAC_FCF_FRAME_TYPE_SHIFT); |
| Wolfgang Betz |
13:739d89e71f31 | 354 | (*ack_requested) = ((fcf & MAC_FCF_ACK_REQ_BIT_MASK) >> MAC_FCF_ACK_REQ_BIT_SHIFT); |
| Wolfgang Betz |
13:739d89e71f31 | 355 | dst_addr_mode = ((fcf & MAC_FCF_DST_ADDR_MASK) >> MAC_FCF_DST_ADDR_SHIFT); |
| Wolfgang Betz |
13:739d89e71f31 | 356 | src_addr_mode = ((fcf & MAC_FCF_SRC_ADDR_MASK) >> MAC_FCF_SRC_ADDR_SHIFT); |
| Wolfgang Betz |
21:d5c10e5742f6 | 357 | #if !defined(SHORT_ACK_FRAMES) || defined(HEAVY_TRACING) |
| Wolfgang Betz |
14:898a9d48dd03 | 358 | panid_compr = ((fcf & MAC_FCF_INTRA_PANID_MASK) >> MAC_FCF_INTRA_PANID_SHIFT); |
| Wolfgang Betz |
20:0b738b9ca855 | 359 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 360 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 361 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
25:2ec45788f28c | 362 | tr_info("%s (%d): len=%d, ftype=%x, snr=%x, ack=%d, dst=%x, src=%x, intra=%d", __func__, __LINE__, len, frame_type, |
| Wolfgang Betz |
14:898a9d48dd03 | 363 | rf_rx_buf[2], (*ack_requested), dst_addr_mode, src_addr_mode, panid_compr); |
| Wolfgang Betz |
27:e68ffb6ac223 | 364 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 365 | |
| Wolfgang Betz |
20:0b738b9ca855 | 366 | if(frame_type == FC_ACK_FRAME) { // betzw: we support up to two different forms of ACK frames! |
| Wolfgang Betz |
20:0b738b9ca855 | 367 | #ifdef SHORT_ACK_FRAMES |
| Wolfgang Betz |
20:0b738b9ca855 | 368 | if((len == 3) && (dst_addr_mode == 0x0) && (src_addr_mode == 0x0)) { |
| Wolfgang Betz |
20:0b738b9ca855 | 369 | ret = true; |
| Wolfgang Betz |
20:0b738b9ca855 | 370 | } |
| Wolfgang Betz |
20:0b738b9ca855 | 371 | #else // !SHORT_ACK_FRAMES |
| Wolfgang Betz |
14:898a9d48dd03 | 372 | if((dst_addr_mode == 0x3) && (src_addr_mode == 0x3)) { |
| Wolfgang Betz |
14:898a9d48dd03 | 373 | if(panid_compr) { // no PAN ID is in the frame |
| Wolfgang Betz |
14:898a9d48dd03 | 374 | ret = rf_check_mac_address(&rf_rx_buf[3]); |
| Wolfgang Betz |
16:25dc4b811ad3 | 375 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 376 | if(!ret) tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 377 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 378 | } else { // presence of dest pan id (even if indicating src pan id) |
| Wolfgang Betz |
14:898a9d48dd03 | 379 | ret = rf_check_mac_address(&rf_rx_buf[5]); |
| Wolfgang Betz |
16:25dc4b811ad3 | 380 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 381 | if(!ret) tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 382 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 383 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 384 | } else if(dst_addr_mode == 0x2) { |
| Wolfgang Betz |
14:898a9d48dd03 | 385 | dst_short_adr = rf_read_16_bit(&rf_rx_buf[5]); |
| Wolfgang Betz |
14:898a9d48dd03 | 386 | if(dst_short_adr == stored_short_adr) { |
| Wolfgang Betz |
21:d5c10e5742f6 | 387 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
14:898a9d48dd03 | 388 | ret = true; |
| Wolfgang Betz |
14:898a9d48dd03 | 389 | } else { |
| Wolfgang Betz |
16:25dc4b811ad3 | 390 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 391 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 392 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 393 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 394 | } |
| Wolfgang Betz |
20:0b738b9ca855 | 395 | #endif // !SHORT_ACK_FRAMES |
| Wolfgang Betz |
20:0b738b9ca855 | 396 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 397 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
27:e68ffb6ac223 | 398 | tr_info("%s (%d): ret=%d", __func__, __LINE__, ret); |
| Wolfgang Betz |
16:25dc4b811ad3 | 399 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 400 | (*ack_requested) = 0; // Never acknowledge ACK frames |
| Wolfgang Betz |
14:898a9d48dd03 | 401 | return ret; |
| Wolfgang Betz |
14:898a9d48dd03 | 402 | } |
| Wolfgang Betz |
13:739d89e71f31 | 403 | |
| Wolfgang Betz |
12:b8056eda4028 | 404 | switch(dst_addr_mode) { |
| Wolfgang Betz |
12:b8056eda4028 | 405 | case 0x00: |
| Wolfgang Betz |
13:739d89e71f31 | 406 | ret = true; // no check possible; |
| Wolfgang Betz |
12:b8056eda4028 | 407 | break; |
| Wolfgang Betz |
12:b8056eda4028 | 408 | case 0x02: |
| Wolfgang Betz |
14:898a9d48dd03 | 409 | min_size += 4; // pan id + short dest adr |
| Wolfgang Betz |
13:739d89e71f31 | 410 | |
| Wolfgang Betz |
14:898a9d48dd03 | 411 | if(len < 5) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 412 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 413 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 414 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 415 | return false; |
| Wolfgang Betz |
13:739d89e71f31 | 416 | } |
| Wolfgang Betz |
13:739d89e71f31 | 417 | |
| Wolfgang Betz |
14:898a9d48dd03 | 418 | dst_pan_id = rf_read_16_bit(&rf_rx_buf[3]); |
| Wolfgang Betz |
14:898a9d48dd03 | 419 | if(dst_pan_id == 0xFFFF) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 420 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 421 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 422 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 423 | ret = true; |
| Wolfgang Betz |
14:898a9d48dd03 | 424 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 425 | } |
| Wolfgang Betz |
13:739d89e71f31 | 426 | |
| Wolfgang Betz |
14:898a9d48dd03 | 427 | if(dst_pan_id == stored_pan_id) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 428 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 429 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 430 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 431 | ret = true; |
| Wolfgang Betz |
12:b8056eda4028 | 432 | break; |
| Wolfgang Betz |
13:739d89e71f31 | 433 | } else { |
| Wolfgang Betz |
16:25dc4b811ad3 | 434 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 435 | tr_debug("%s (%d): %d!=%d", __func__, __LINE__, dst_pan_id, stored_pan_id); |
| Wolfgang Betz |
16:25dc4b811ad3 | 436 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 437 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 438 | |
| Wolfgang Betz |
14:898a9d48dd03 | 439 | if(len < 7) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 440 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 441 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 442 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 443 | return false; |
| Wolfgang Betz |
14:898a9d48dd03 | 444 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 445 | |
| Wolfgang Betz |
14:898a9d48dd03 | 446 | dst_short_adr = rf_read_16_bit(&rf_rx_buf[5]); |
| Wolfgang Betz |
14:898a9d48dd03 | 447 | if(dst_short_adr == stored_short_adr) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 448 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 449 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 450 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 451 | ret = true; |
| Wolfgang Betz |
14:898a9d48dd03 | 452 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 453 | } else { |
| Wolfgang Betz |
16:25dc4b811ad3 | 454 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 455 | tr_debug("%s (%d): %d!=%d", __func__, __LINE__, dst_short_adr, stored_short_adr); |
| Wolfgang Betz |
16:25dc4b811ad3 | 456 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 457 | } |
| Wolfgang Betz |
12:b8056eda4028 | 458 | break; |
| Wolfgang Betz |
12:b8056eda4028 | 459 | case 0x03: |
| Wolfgang Betz |
14:898a9d48dd03 | 460 | min_size += 10; // pan id + dest mac addr |
| Wolfgang Betz |
13:739d89e71f31 | 461 | |
| Wolfgang Betz |
14:898a9d48dd03 | 462 | if(len < 5) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 463 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 464 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 465 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 466 | return false; |
| Wolfgang Betz |
12:b8056eda4028 | 467 | } |
| Wolfgang Betz |
12:b8056eda4028 | 468 | |
| Wolfgang Betz |
14:898a9d48dd03 | 469 | dst_pan_id = rf_read_16_bit(&rf_rx_buf[3]); |
| Wolfgang Betz |
14:898a9d48dd03 | 470 | if(dst_pan_id == 0xFFFF) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 471 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 472 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 473 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 474 | ret = true; |
| Wolfgang Betz |
14:898a9d48dd03 | 475 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 476 | } |
| Wolfgang Betz |
13:739d89e71f31 | 477 | |
| Wolfgang Betz |
14:898a9d48dd03 | 478 | if(dst_pan_id == stored_pan_id) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 479 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 480 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 481 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 482 | ret = true; |
| Wolfgang Betz |
14:898a9d48dd03 | 483 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 484 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 485 | |
| Wolfgang Betz |
14:898a9d48dd03 | 486 | if(len < 13) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 487 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 488 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 489 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 490 | return false; |
| Wolfgang Betz |
14:898a9d48dd03 | 491 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 492 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 493 | ret = rf_check_mac_address(&rf_rx_buf[5]); |
| Wolfgang Betz |
12:b8056eda4028 | 494 | break; |
| Wolfgang Betz |
12:b8056eda4028 | 495 | default: |
| Wolfgang Betz |
12:b8056eda4028 | 496 | /* not supported */ |
| Wolfgang Betz |
16:25dc4b811ad3 | 497 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
13:739d89e71f31 | 498 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 499 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 500 | return false; |
| Wolfgang Betz |
12:b8056eda4028 | 501 | } |
| Wolfgang Betz |
12:b8056eda4028 | 502 | |
| Wolfgang Betz |
13:739d89e71f31 | 503 | if(ret && (*ack_requested)) { |
| Wolfgang Betz |
20:0b738b9ca855 | 504 | rf_rx_sequence = rf_rx_buf[2]; |
| Wolfgang Betz |
20:0b738b9ca855 | 505 | |
| Wolfgang Betz |
20:0b738b9ca855 | 506 | #ifndef SHORT_ACK_FRAMES |
| Wolfgang Betz |
14:898a9d48dd03 | 507 | if(!panid_compr) { // Src PAN Id is present |
| Wolfgang Betz |
14:898a9d48dd03 | 508 | min_size += 2; // src pan id |
| Wolfgang Betz |
14:898a9d48dd03 | 509 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 510 | switch(src_addr_mode) { |
| Wolfgang Betz |
14:898a9d48dd03 | 511 | case 0x00: |
| Wolfgang Betz |
13:739d89e71f31 | 512 | (*ack_requested) = 0; // cannot send acknowledgment |
| Wolfgang Betz |
14:898a9d48dd03 | 513 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 514 | case 0x02: |
| Wolfgang Betz |
14:898a9d48dd03 | 515 | min_size += 2; // short src adr |
| Wolfgang Betz |
14:898a9d48dd03 | 516 | if(len < min_size) { |
| Wolfgang Betz |
14:898a9d48dd03 | 517 | (*ack_requested) = 0; // cannot send acknowledgment |
| Wolfgang Betz |
14:898a9d48dd03 | 518 | } else { |
| Wolfgang Betz |
14:898a9d48dd03 | 519 | rf_src_adr_len = 2; |
| Wolfgang Betz |
14:898a9d48dd03 | 520 | rf_src_adr[0] = rf_rx_buf[min_size-2]; |
| Wolfgang Betz |
14:898a9d48dd03 | 521 | rf_src_adr[1] = rf_rx_buf[min_size-1]; |
| Wolfgang Betz |
16:25dc4b811ad3 | 522 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 523 | tr_debug("%s (%d): %x:%x", __func__, __LINE__, rf_src_adr[0], rf_src_adr[1]); |
| Wolfgang Betz |
16:25dc4b811ad3 | 524 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 525 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 526 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 527 | case 0x03: |
| Wolfgang Betz |
14:898a9d48dd03 | 528 | min_size += 8; // src mac adr |
| Wolfgang Betz |
14:898a9d48dd03 | 529 | if(len < min_size) { |
| Wolfgang Betz |
14:898a9d48dd03 | 530 | (*ack_requested) = 0; // cannot send acknowledgment |
| Wolfgang Betz |
14:898a9d48dd03 | 531 | } else { |
| Wolfgang Betz |
14:898a9d48dd03 | 532 | rf_src_adr_len = 8; |
| Wolfgang Betz |
14:898a9d48dd03 | 533 | memcpy(&rf_src_adr[0], &rf_rx_buf[min_size-8], rf_src_adr_len); |
| Wolfgang Betz |
16:25dc4b811ad3 | 534 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 535 | tr_debug("%s (%d): %x:%x", __func__, __LINE__, rf_src_adr[0], rf_src_adr[1]); |
| Wolfgang Betz |
16:25dc4b811ad3 | 536 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 537 | } |
| Wolfgang Betz |
14:898a9d48dd03 | 538 | break; |
| Wolfgang Betz |
14:898a9d48dd03 | 539 | default: |
| Wolfgang Betz |
14:898a9d48dd03 | 540 | /* not supported */ |
| Wolfgang Betz |
16:25dc4b811ad3 | 541 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 542 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 543 | #endif |
| Wolfgang Betz |
14:898a9d48dd03 | 544 | return false; |
| Wolfgang Betz |
12:b8056eda4028 | 545 | } |
| Wolfgang Betz |
20:0b738b9ca855 | 546 | #endif // !SHORT_ACK_FRAMES |
| Wolfgang Betz |
12:b8056eda4028 | 547 | } |
| Wolfgang Betz |
12:b8056eda4028 | 548 | |
| Wolfgang Betz |
22:9165bd73c61e | 549 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
25:2ec45788f28c | 550 | tr_info("%s (%d), ret=%d, ack=%d", __func__, __LINE__, ret, (*ack_requested)); |
| Wolfgang Betz |
16:25dc4b811ad3 | 551 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 552 | return ret; |
| Wolfgang Betz |
12:b8056eda4028 | 553 | } |
| Wolfgang Betz |
12:b8056eda4028 | 554 | |
| Wolfgang Betz |
12:b8056eda4028 | 555 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
12:b8056eda4028 | 556 | static inline void rf_send_ack() { |
| Wolfgang Betz |
12:b8056eda4028 | 557 | rf_ack_sender.signal_set(RF_SIG_ACK_NEEDED); |
| Wolfgang Betz |
10:dedd44d58c0f | 558 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 559 | |
| Wolfgang Betz |
10:dedd44d58c0f | 560 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
10:dedd44d58c0f | 561 | static inline void rf_handle_rx_end(void) |
| Wolfgang Betz |
10:dedd44d58c0f | 562 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 563 | uint8_t rf_lqi; |
| Wolfgang Betz |
10:dedd44d58c0f | 564 | int8_t rf_rssi; |
| Wolfgang Betz |
10:dedd44d58c0f | 565 | uint16_t rf_buffer_len; |
| Wolfgang Betz |
12:b8056eda4028 | 566 | uint8_t ack_requested = 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 567 | |
| Wolfgang Betz |
10:dedd44d58c0f | 568 | /* Get received data */ |
| Wolfgang Betz |
10:dedd44d58c0f | 569 | rf_buffer_len = rf_device->read(rf_rx_buf, MAX_PACKET_LEN); |
| Wolfgang Betz |
10:dedd44d58c0f | 570 | if(!rf_buffer_len) |
| Wolfgang Betz |
10:dedd44d58c0f | 571 | return; |
| Wolfgang Betz |
10:dedd44d58c0f | 572 | |
| Wolfgang Betz |
25:2ec45788f28c | 573 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
25:2ec45788f28c | 574 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
25:2ec45788f28c | 575 | #endif |
| Wolfgang Betz |
25:2ec45788f28c | 576 | |
| Wolfgang Betz |
25:2ec45788f28c | 577 | /* Check if packet should be accepted */ |
| Wolfgang Betz |
12:b8056eda4028 | 578 | if(!rf_check_destination(rf_buffer_len, &ack_requested)) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 579 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
13:739d89e71f31 | 580 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 581 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 582 | return; |
| Wolfgang Betz |
12:b8056eda4028 | 583 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 584 | |
| Wolfgang Betz |
12:b8056eda4028 | 585 | /* If waiting for ACK, check here if the packet is an ACK to a message previously sent */ |
| Wolfgang Betz |
13:739d89e71f31 | 586 | uint16_t fcf = rf_read_16_bit(rf_rx_buf); |
| Wolfgang Betz |
13:739d89e71f31 | 587 | if(((fcf & MAC_FCF_FRAME_TYPE_MASK) >> MAC_FCF_FRAME_TYPE_SHIFT) == FC_ACK_FRAME) { |
| Wolfgang Betz |
12:b8056eda4028 | 588 | /*Send sequence number in ACK handler*/ |
| Wolfgang Betz |
16:25dc4b811ad3 | 589 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
12:b8056eda4028 | 590 | tr_debug("%s (%d), len=%u", __func__, __LINE__, (unsigned int)rf_buffer_len); |
| Wolfgang Betz |
16:25dc4b811ad3 | 591 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 592 | rf_handle_ack(rf_rx_buf[2]); |
| Wolfgang Betz |
12:b8056eda4028 | 593 | return; |
| Wolfgang Betz |
12:b8056eda4028 | 594 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 595 | |
| Wolfgang Betz |
12:b8056eda4028 | 596 | /* Kick off ACK sending */ |
| Wolfgang Betz |
12:b8056eda4028 | 597 | if(ack_requested) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 598 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 599 | tr_debug("%s (%d), len=%u", __func__, __LINE__, (unsigned int)rf_buffer_len); |
| Wolfgang Betz |
16:25dc4b811ad3 | 600 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 601 | rf_send_ack(); |
| Wolfgang Betz |
10:dedd44d58c0f | 602 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 603 | |
| Wolfgang Betz |
10:dedd44d58c0f | 604 | /* Get link information */ |
| Wolfgang Betz |
10:dedd44d58c0f | 605 | rf_rssi = (int8_t)rf_device->get_last_rssi_dbm(); |
| Wolfgang Betz |
10:dedd44d58c0f | 606 | rf_lqi = (uint8_t)rf_device->get_last_lqi(); |
| Wolfgang Betz |
12:b8056eda4028 | 607 | rf_lqi *= 17; // scale to 8-bit value |
| Wolfgang Betz |
10:dedd44d58c0f | 608 | |
| Wolfgang Betz |
10:dedd44d58c0f | 609 | /* Note: Checksum of the packet must be checked and removed before entering here */ |
| Wolfgang Betz |
12:b8056eda4028 | 610 | /* TODO - betzw: what to do? */ |
| Wolfgang Betz |
12:b8056eda4028 | 611 | // rf_buffer_len -= 2; |
| Wolfgang Betz |
10:dedd44d58c0f | 612 | |
| Wolfgang Betz |
24:03e351bfc9c9 | 613 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
24:03e351bfc9c9 | 614 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
24:03e351bfc9c9 | 615 | #endif |
| Wolfgang Betz |
24:03e351bfc9c9 | 616 | |
| Wolfgang Betz |
24:03e351bfc9c9 | 617 | /* Send received data and link information to the network stack */ |
| Wolfgang Betz |
10:dedd44d58c0f | 618 | if( device_driver.phy_rx_cb ){ |
| Wolfgang Betz |
10:dedd44d58c0f | 619 | device_driver.phy_rx_cb(rf_rx_buf, rf_buffer_len, rf_lqi, rf_rssi, rf_radio_driver_id); |
| Wolfgang Betz |
10:dedd44d58c0f | 620 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 621 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 622 | |
| Wolfgang Betz |
10:dedd44d58c0f | 623 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
10:dedd44d58c0f | 624 | static inline void rf_handle_tx_end(void) |
| Wolfgang Betz |
10:dedd44d58c0f | 625 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 626 | phy_link_tx_status_e phy_status = PHY_LINK_TX_SUCCESS; |
| Wolfgang Betz |
10:dedd44d58c0f | 627 | |
| Wolfgang Betz |
12:b8056eda4028 | 628 | /* Check if this is an ACK sending which is still pending */ |
| Wolfgang Betz |
12:b8056eda4028 | 629 | if(rf_ack_sent) { |
| Wolfgang Betz |
12:b8056eda4028 | 630 | rf_ack_sent = false; |
| Wolfgang Betz |
16:25dc4b811ad3 | 631 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 632 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 633 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 634 | return; // no need to inform stack |
| Wolfgang Betz |
12:b8056eda4028 | 635 | } |
| Wolfgang Betz |
12:b8056eda4028 | 636 | |
| Wolfgang Betz |
10:dedd44d58c0f | 637 | /*Call PHY TX Done API*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 638 | if(device_driver.phy_tx_done_cb){ |
| Wolfgang Betz |
13:739d89e71f31 | 639 | device_driver.phy_tx_done_cb(rf_radio_driver_id, mac_tx_handle, phy_status, 0, 0); |
| Wolfgang Betz |
10:dedd44d58c0f | 640 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 641 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 642 | |
| Wolfgang Betz |
10:dedd44d58c0f | 643 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
10:dedd44d58c0f | 644 | static inline void rf_handle_tx_err(void) { |
| Wolfgang Betz |
10:dedd44d58c0f | 645 | phy_link_tx_status_e phy_status = PHY_LINK_TX_FAIL; |
| Wolfgang Betz |
10:dedd44d58c0f | 646 | |
| Wolfgang Betz |
10:dedd44d58c0f | 647 | /*Call PHY TX Done API*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 648 | if(device_driver.phy_tx_done_cb){ |
| Wolfgang Betz |
13:739d89e71f31 | 649 | device_driver.phy_tx_done_cb(rf_radio_driver_id, mac_tx_handle, phy_status, 0, 0); |
| Wolfgang Betz |
10:dedd44d58c0f | 650 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 651 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 652 | |
| Wolfgang Betz |
10:dedd44d58c0f | 653 | /* Note: we are in IRQ context */ |
| Wolfgang Betz |
10:dedd44d58c0f | 654 | static void rf_callback_func(int event) { |
| Wolfgang Betz |
10:dedd44d58c0f | 655 | switch(event) { |
| Wolfgang Betz |
10:dedd44d58c0f | 656 | case SimpleSpirit1::RX_DONE: |
| Wolfgang Betz |
10:dedd44d58c0f | 657 | rf_handle_rx_end(); |
| Wolfgang Betz |
10:dedd44d58c0f | 658 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 659 | case SimpleSpirit1::TX_DONE: |
| Wolfgang Betz |
10:dedd44d58c0f | 660 | rf_handle_tx_end(); |
| Wolfgang Betz |
10:dedd44d58c0f | 661 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 662 | case SimpleSpirit1::TX_ERR: |
| Wolfgang Betz |
16:25dc4b811ad3 | 663 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
14:898a9d48dd03 | 664 | tr_debug("%s (%d): TX_ERR!!!", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 665 | #endif |
| Wolfgang Betz |
10:dedd44d58c0f | 666 | rf_handle_tx_err(); |
| Wolfgang Betz |
10:dedd44d58c0f | 667 | break; |
| Wolfgang Betz |
10:dedd44d58c0f | 668 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 669 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 670 | |
| Wolfgang Betz |
20:0b738b9ca855 | 671 | #ifdef SHORT_ACK_FRAMES |
| Wolfgang Betz |
20:0b738b9ca855 | 672 | static void rf_ack_loop(void) { |
| Wolfgang Betz |
20:0b738b9ca855 | 673 | static uint16_t buffer[2] = { |
| Wolfgang Betz |
20:0b738b9ca855 | 674 | (FC_ACK_FRAME << MAC_FCF_FRAME_TYPE_SHIFT), |
| Wolfgang Betz |
20:0b738b9ca855 | 675 | 0x0 |
| Wolfgang Betz |
20:0b738b9ca855 | 676 | }; |
| Wolfgang Betz |
20:0b738b9ca855 | 677 | |
| Wolfgang Betz |
20:0b738b9ca855 | 678 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
20:0b738b9ca855 | 679 | |
| Wolfgang Betz |
20:0b738b9ca855 | 680 | do { |
| Wolfgang Betz |
20:0b738b9ca855 | 681 | /* Wait for signal */ |
| Wolfgang Betz |
20:0b738b9ca855 | 682 | rf_ack_sender.signal_wait(RF_SIG_ACK_NEEDED); |
| Wolfgang Betz |
20:0b738b9ca855 | 683 | |
| Wolfgang Betz |
20:0b738b9ca855 | 684 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
20:0b738b9ca855 | 685 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
20:0b738b9ca855 | 686 | #endif |
| Wolfgang Betz |
20:0b738b9ca855 | 687 | |
| Wolfgang Betz |
20:0b738b9ca855 | 688 | /* Get Lock */ |
| Wolfgang Betz |
20:0b738b9ca855 | 689 | rf_if_lock(); |
| Wolfgang Betz |
20:0b738b9ca855 | 690 | |
| Wolfgang Betz |
20:0b738b9ca855 | 691 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
20:0b738b9ca855 | 692 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
20:0b738b9ca855 | 693 | #endif |
| Wolfgang Betz |
20:0b738b9ca855 | 694 | |
| Wolfgang Betz |
20:0b738b9ca855 | 695 | /* Prepare payload */ |
| Wolfgang Betz |
20:0b738b9ca855 | 696 | uint8_t *ptr = (uint8_t*)&buffer[1]; |
| Wolfgang Betz |
20:0b738b9ca855 | 697 | ptr[0] = rf_rx_sequence; // Sequence number |
| Wolfgang Betz |
20:0b738b9ca855 | 698 | |
| Wolfgang Betz |
20:0b738b9ca855 | 699 | /* Wait for device not receiving */ |
| Wolfgang Betz |
20:0b738b9ca855 | 700 | while(rf_device->is_receiving()) { |
| Wolfgang Betz |
20:0b738b9ca855 | 701 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
27:e68ffb6ac223 | 702 | tr_info("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
20:0b738b9ca855 | 703 | #endif |
| Wolfgang Betz |
20:0b738b9ca855 | 704 | wait_us(10); |
| Wolfgang Betz |
20:0b738b9ca855 | 705 | } |
| Wolfgang Betz |
20:0b738b9ca855 | 706 | |
| Wolfgang Betz |
20:0b738b9ca855 | 707 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
21:d5c10e5742f6 | 708 | tr_debug("%s (%d), hdr=%x, nr=%x", __func__, __LINE__, buffer[0], ptr[0]); |
| Wolfgang Betz |
20:0b738b9ca855 | 709 | #endif |
| Wolfgang Betz |
20:0b738b9ca855 | 710 | |
| Wolfgang Betz |
20:0b738b9ca855 | 711 | /* Set information that we have sent an ACK */ |
| Wolfgang Betz |
20:0b738b9ca855 | 712 | rf_ack_sent = true; |
| Wolfgang Betz |
20:0b738b9ca855 | 713 | |
| Wolfgang Betz |
20:0b738b9ca855 | 714 | /*Send the packet*/ |
| Wolfgang Betz |
20:0b738b9ca855 | 715 | rf_device->send((uint8_t*)buffer, 3); |
| Wolfgang Betz |
20:0b738b9ca855 | 716 | |
| Wolfgang Betz |
22:9165bd73c61e | 717 | tr_debug("%s (%d), hdr=%x, nr=%x", __func__, __LINE__, buffer[0], ptr[0]); |
| Wolfgang Betz |
22:9165bd73c61e | 718 | |
| Wolfgang Betz |
22:9165bd73c61e | 719 | /* Release Lock */ |
| Wolfgang Betz |
20:0b738b9ca855 | 720 | rf_if_unlock(); |
| Wolfgang Betz |
20:0b738b9ca855 | 721 | |
| Wolfgang Betz |
22:9165bd73c61e | 722 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
20:0b738b9ca855 | 723 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
22:9165bd73c61e | 724 | #endif |
| Wolfgang Betz |
20:0b738b9ca855 | 725 | } while(true); |
| Wolfgang Betz |
20:0b738b9ca855 | 726 | } |
| Wolfgang Betz |
20:0b738b9ca855 | 727 | #else // !SHORT_ACK_FRAMES |
| Wolfgang Betz |
12:b8056eda4028 | 728 | static void rf_ack_loop(void) { |
| Wolfgang Betz |
14:898a9d48dd03 | 729 | static uint16_t buffer[6]; |
| Wolfgang Betz |
13:739d89e71f31 | 730 | uint8_t *dest; |
| Wolfgang Betz |
14:898a9d48dd03 | 731 | uint8_t msg_len; |
| Wolfgang Betz |
14:898a9d48dd03 | 732 | |
| Wolfgang Betz |
14:898a9d48dd03 | 733 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
12:b8056eda4028 | 734 | |
| Wolfgang Betz |
12:b8056eda4028 | 735 | do { |
| Wolfgang Betz |
12:b8056eda4028 | 736 | /* Wait for signal */ |
| Wolfgang Betz |
12:b8056eda4028 | 737 | rf_ack_sender.signal_wait(RF_SIG_ACK_NEEDED); |
| Wolfgang Betz |
12:b8056eda4028 | 738 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 739 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 740 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 741 | #endif |
| Wolfgang Betz |
16:25dc4b811ad3 | 742 | |
| Wolfgang Betz |
14:898a9d48dd03 | 743 | /* Get Lock */ |
| Wolfgang Betz |
12:b8056eda4028 | 744 | rf_if_lock(); |
| Wolfgang Betz |
12:b8056eda4028 | 745 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 746 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 747 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 748 | #endif |
| Wolfgang Betz |
16:25dc4b811ad3 | 749 | |
| Wolfgang Betz |
14:898a9d48dd03 | 750 | /* Prepare header */ |
| Wolfgang Betz |
13:739d89e71f31 | 751 | uint8_t *ptr = (uint8_t*)&buffer[1]; |
| Wolfgang Betz |
13:739d89e71f31 | 752 | if(rf_src_adr_len == 2) { |
| Wolfgang Betz |
20:0b738b9ca855 | 753 | buffer[0] = (FC_ACK_FRAME << MAC_FCF_FRAME_TYPE_SHIFT) | (0x02 << MAC_FCF_DST_ADDR_SHIFT); // dest PAN id present |
| Wolfgang Betz |
14:898a9d48dd03 | 754 | dest = &ptr[3]; |
| Wolfgang Betz |
14:898a9d48dd03 | 755 | msg_len = 7; |
| Wolfgang Betz |
13:739d89e71f31 | 756 | } else { |
| Wolfgang Betz |
20:0b738b9ca855 | 757 | buffer[0] = |
| Wolfgang Betz |
20:0b738b9ca855 | 758 | (FC_ACK_FRAME << MAC_FCF_FRAME_TYPE_SHIFT) | |
| Wolfgang Betz |
14:898a9d48dd03 | 759 | (0x03 << MAC_FCF_DST_ADDR_SHIFT) | |
| Wolfgang Betz |
14:898a9d48dd03 | 760 | (0x03 << MAC_FCF_SRC_ADDR_SHIFT) | |
| Wolfgang Betz |
14:898a9d48dd03 | 761 | (0x01 << MAC_FCF_INTRA_PANID_SHIFT); // no PAN IDs |
| Wolfgang Betz |
14:898a9d48dd03 | 762 | dest = &ptr[1]; |
| Wolfgang Betz |
14:898a9d48dd03 | 763 | msg_len = 11; |
| Wolfgang Betz |
13:739d89e71f31 | 764 | } |
| Wolfgang Betz |
13:739d89e71f31 | 765 | |
| Wolfgang Betz |
13:739d89e71f31 | 766 | /* Prepare payload */ |
| Wolfgang Betz |
13:739d89e71f31 | 767 | ptr[0] = rf_rx_sequence; // Sequence number |
| Wolfgang Betz |
13:739d89e71f31 | 768 | memcpy(dest, &rf_src_adr[0], rf_src_adr_len); |
| Wolfgang Betz |
13:739d89e71f31 | 769 | |
| Wolfgang Betz |
12:b8056eda4028 | 770 | /* Wait for device not receiving */ |
| Wolfgang Betz |
12:b8056eda4028 | 771 | while(rf_device->is_receiving()) { |
| Wolfgang Betz |
16:25dc4b811ad3 | 772 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
16:25dc4b811ad3 | 773 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
16:25dc4b811ad3 | 774 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 775 | wait_us(10); |
| Wolfgang Betz |
12:b8056eda4028 | 776 | } |
| Wolfgang Betz |
12:b8056eda4028 | 777 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 778 | #ifdef HEAVY_TRACING |
| Wolfgang Betz |
13:739d89e71f31 | 779 | tr_debug("%s (%d), hdr=%x, nr=%x, pan0=%x, pan1=%x, adr0=%x, adr1=%x", __func__, __LINE__, |
| Wolfgang Betz |
13:739d89e71f31 | 780 | buffer[0], ptr[0], ptr[1], ptr[2], ptr[3], ptr[4]); |
| Wolfgang Betz |
16:25dc4b811ad3 | 781 | #endif |
| Wolfgang Betz |
13:739d89e71f31 | 782 | |
| Wolfgang Betz |
13:739d89e71f31 | 783 | /* Set information that we have sent an ACK */ |
| Wolfgang Betz |
12:b8056eda4028 | 784 | rf_ack_sent = true; |
| Wolfgang Betz |
12:b8056eda4028 | 785 | |
| Wolfgang Betz |
12:b8056eda4028 | 786 | /*Send the packet*/ |
| Wolfgang Betz |
14:898a9d48dd03 | 787 | rf_device->send((uint8_t*)buffer, msg_len); |
| Wolfgang Betz |
12:b8056eda4028 | 788 | |
| Wolfgang Betz |
12:b8056eda4028 | 789 | /* Release Lock */ |
| Wolfgang Betz |
12:b8056eda4028 | 790 | rf_if_unlock(); |
| Wolfgang Betz |
16:25dc4b811ad3 | 791 | |
| Wolfgang Betz |
16:25dc4b811ad3 | 792 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
12:b8056eda4028 | 793 | } while(true); |
| Wolfgang Betz |
12:b8056eda4028 | 794 | } |
| Wolfgang Betz |
20:0b738b9ca855 | 795 | #endif // !SHORT_ACK_FRAMES |
| Wolfgang Betz |
12:b8056eda4028 | 796 | |
| Wolfgang Betz |
10:dedd44d58c0f | 797 | static void rf_init(void) { |
| Wolfgang Betz |
27:e68ffb6ac223 | 798 | #ifndef NDEBUG |
| Wolfgang Betz |
27:e68ffb6ac223 | 799 | osStatus ret; |
| Wolfgang Betz |
27:e68ffb6ac223 | 800 | #endif |
| Wolfgang Betz |
27:e68ffb6ac223 | 801 | |
| Wolfgang Betz |
10:dedd44d58c0f | 802 | rf_device = &SimpleSpirit1::CreateInstance(D11, D12, D13, D9, D10, D2); |
| Wolfgang Betz |
10:dedd44d58c0f | 803 | rf_device->attach_irq_callback(rf_callback_func); |
| Wolfgang Betz |
12:b8056eda4028 | 804 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 805 | #ifndef NDEBUG |
| Wolfgang Betz |
27:e68ffb6ac223 | 806 | ret = |
| Wolfgang Betz |
27:e68ffb6ac223 | 807 | #endif |
| Wolfgang Betz |
12:b8056eda4028 | 808 | rf_ack_sender.start(rf_ack_loop); |
| Wolfgang Betz |
27:e68ffb6ac223 | 809 | |
| Wolfgang Betz |
27:e68ffb6ac223 | 810 | #ifndef NDEBUG |
| Wolfgang Betz |
27:e68ffb6ac223 | 811 | debug_if(!(ret == osOK), "\n\rassert failed in: %s (%d)\n\r", __func__, __LINE__); |
| Wolfgang Betz |
27:e68ffb6ac223 | 812 | #endif |
| Wolfgang Betz |
10:dedd44d58c0f | 813 | } |
| Wolfgang Betz |
10:dedd44d58c0f | 814 | |
| Wolfgang Betz |
11:b769d6caad82 | 815 | extern "C" int8_t rf_device_register(void) |
| Wolfgang Betz |
10:dedd44d58c0f | 816 | { |
| Wolfgang Betz |
10:dedd44d58c0f | 817 | /* Do some initialization */ |
| Wolfgang Betz |
10:dedd44d58c0f | 818 | rf_init(); |
| Wolfgang Betz |
10:dedd44d58c0f | 819 | |
| Wolfgang Betz |
10:dedd44d58c0f | 820 | /* Set pointer to MAC address */ |
| Wolfgang Betz |
10:dedd44d58c0f | 821 | device_driver.PHY_MAC = mac_address; |
| Wolfgang Betz |
10:dedd44d58c0f | 822 | |
| Wolfgang Betz |
10:dedd44d58c0f | 823 | /* Set driver Name */ |
| Wolfgang Betz |
10:dedd44d58c0f | 824 | device_driver.driver_description = (char*)"Spirit1 Sub-GHz RF"; |
| Wolfgang Betz |
10:dedd44d58c0f | 825 | |
| Wolfgang Betz |
10:dedd44d58c0f | 826 | /*Type of RF PHY is SubGHz*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 827 | device_driver.link_type = PHY_LINK_15_4_SUBGHZ_TYPE; |
| Wolfgang Betz |
10:dedd44d58c0f | 828 | |
| Wolfgang Betz |
10:dedd44d58c0f | 829 | /*Maximum size of payload is 255*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 830 | device_driver.phy_MTU = MAX_PACKET_LEN; |
| Wolfgang Betz |
11:b769d6caad82 | 831 | |
| Wolfgang Betz |
10:dedd44d58c0f | 832 | /*No header in PHY*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 833 | device_driver.phy_header_length = 0; |
| Wolfgang Betz |
11:b769d6caad82 | 834 | |
| Wolfgang Betz |
10:dedd44d58c0f | 835 | /*No tail in PHY*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 836 | device_driver.phy_tail_length = 0; |
| Wolfgang Betz |
10:dedd44d58c0f | 837 | |
| Wolfgang Betz |
10:dedd44d58c0f | 838 | /*Set up driver functions*/ |
| Wolfgang Betz |
11:b769d6caad82 | 839 | device_driver.address_write = &rf_address_write; |
| Wolfgang Betz |
10:dedd44d58c0f | 840 | device_driver.extension = &rf_extension; |
| Wolfgang Betz |
10:dedd44d58c0f | 841 | device_driver.state_control = &rf_interface_state_control; |
| Wolfgang Betz |
14:898a9d48dd03 | 842 | device_driver.tx = &rf_trigger_send; |
| Wolfgang Betz |
10:dedd44d58c0f | 843 | |
| Wolfgang Betz |
10:dedd44d58c0f | 844 | /*Set supported channel pages*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 845 | device_driver.phy_channel_pages = phy_channel_pages; |
| Wolfgang Betz |
10:dedd44d58c0f | 846 | |
| Wolfgang Betz |
10:dedd44d58c0f | 847 | //Nullify rx/tx callbacks |
| Wolfgang Betz |
10:dedd44d58c0f | 848 | device_driver.phy_rx_cb = NULL; |
| Wolfgang Betz |
10:dedd44d58c0f | 849 | device_driver.phy_tx_done_cb = NULL; |
| Wolfgang Betz |
10:dedd44d58c0f | 850 | device_driver.arm_net_virtual_rx_cb = NULL; |
| Wolfgang Betz |
10:dedd44d58c0f | 851 | device_driver.arm_net_virtual_tx_cb = NULL; |
| Wolfgang Betz |
10:dedd44d58c0f | 852 | |
| Wolfgang Betz |
10:dedd44d58c0f | 853 | /*Register device driver*/ |
| Wolfgang Betz |
10:dedd44d58c0f | 854 | rf_radio_driver_id = arm_net_phy_register(&device_driver); |
| Wolfgang Betz |
10:dedd44d58c0f | 855 | |
| Wolfgang Betz |
12:b8056eda4028 | 856 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
10:dedd44d58c0f | 857 | return rf_radio_driver_id; |
| Wolfgang Betz |
10:dedd44d58c0f | 858 | } |
| Wolfgang Betz |
11:b769d6caad82 | 859 | |
| Wolfgang Betz |
11:b769d6caad82 | 860 | /* |
| Wolfgang Betz |
11:b769d6caad82 | 861 | * \brief Function reads the MAC address array. |
| Wolfgang Betz |
11:b769d6caad82 | 862 | * |
| Wolfgang Betz |
11:b769d6caad82 | 863 | * \param ptr Pointer to read array |
| Wolfgang Betz |
11:b769d6caad82 | 864 | * |
| Wolfgang Betz |
11:b769d6caad82 | 865 | * \return none |
| Wolfgang Betz |
11:b769d6caad82 | 866 | */ |
| Wolfgang Betz |
11:b769d6caad82 | 867 | extern "C" void rf_read_mac_address(uint8_t *ptr) |
| Wolfgang Betz |
11:b769d6caad82 | 868 | { |
| Wolfgang Betz |
12:b8056eda4028 | 869 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
11:b769d6caad82 | 870 | memcpy(ptr, mac_address, 8); |
| Wolfgang Betz |
11:b769d6caad82 | 871 | } |
| Wolfgang Betz |
11:b769d6caad82 | 872 | |
| Wolfgang Betz |
11:b769d6caad82 | 873 | /* |
| Wolfgang Betz |
11:b769d6caad82 | 874 | * \brief Function returns the generated 8-bit random value for seeding Pseudo-random generator. This value was generated by reading noise from RF channel in RF initialisation. |
| Wolfgang Betz |
11:b769d6caad82 | 875 | * |
| Wolfgang Betz |
11:b769d6caad82 | 876 | * \param none |
| Wolfgang Betz |
11:b769d6caad82 | 877 | * |
| Wolfgang Betz |
11:b769d6caad82 | 878 | * \return random RSSI value |
| Wolfgang Betz |
11:b769d6caad82 | 879 | */ |
| Wolfgang Betz |
11:b769d6caad82 | 880 | extern "C" int8_t rf_read_random(void) |
| Wolfgang Betz |
11:b769d6caad82 | 881 | { |
| Wolfgang Betz |
24:03e351bfc9c9 | 882 | float tmp; |
| Wolfgang Betz |
24:03e351bfc9c9 | 883 | |
| Wolfgang Betz |
24:03e351bfc9c9 | 884 | rf_device->channel_clear(); |
| Wolfgang Betz |
24:03e351bfc9c9 | 885 | tmp = rf_device->get_last_rssi_dbm(); |
| Wolfgang Betz |
24:03e351bfc9c9 | 886 | tmp *= -10; |
| Wolfgang Betz |
24:03e351bfc9c9 | 887 | |
| Wolfgang Betz |
24:03e351bfc9c9 | 888 | tr_debug("%s (%d): ret=%d", __func__, __LINE__, (uint8_t)tmp); |
| Wolfgang Betz |
24:03e351bfc9c9 | 889 | return (uint8_t)tmp; |
| Wolfgang Betz |
11:b769d6caad82 | 890 | } |
| Wolfgang Betz |
11:b769d6caad82 | 891 | |
| Wolfgang Betz |
11:b769d6caad82 | 892 | /* |
| Wolfgang Betz |
11:b769d6caad82 | 893 | * \brief Read connected radio part. |
| Wolfgang Betz |
11:b769d6caad82 | 894 | * |
| Wolfgang Betz |
11:b769d6caad82 | 895 | * This function only return valid information when rf_init() is called |
| Wolfgang Betz |
11:b769d6caad82 | 896 | * |
| Wolfgang Betz |
11:b769d6caad82 | 897 | * \return |
| Wolfgang Betz |
11:b769d6caad82 | 898 | */ |
| Wolfgang Betz |
11:b769d6caad82 | 899 | extern "C" rf_trx_part_e rf_radio_type_read(void) |
| Wolfgang Betz |
11:b769d6caad82 | 900 | { |
| Wolfgang Betz |
12:b8056eda4028 | 901 | tr_debug("%s (%d)", __func__, __LINE__); |
| Wolfgang Betz |
12:b8056eda4028 | 902 | return ATMEL_UNKNOW_DEV; |
| Wolfgang Betz |
11:b769d6caad82 | 903 | } |
X-NUCLEO-IDS01A4 Sub-1GHz RF Expansion Board