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