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