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