FHSS: Synch callback to write ufsi

Author: Jarkko Paso

nanostack/fhss_api.h

@@ -38,15 +38,6 @@ typedef struct fhss_callback fhss_callback_t;
 #define FHSS_SYNCH_REQUEST_FRAME    1   /**< FHSS synchronization request frame */
 #define FHSS_DATA_FRAME             2   /**< FHSS data frame */
 
-/**
- * @brief FHSS information element types.
- */
-#define FHSS_UTT_IE              0   /**< UTT-IE */
-#define FHSS_BT_IE               1   /**< BT-IE */
-#define FHSS_US_IE               2   /**< US-IE */
-#define FHSS_BS_IE               3   /**< BS-IE */
-#define FHSS_PLAIN_SYNCH_INFO    4   /**< Plain synchronization information */
-
 /**
  * @brief FHSS synchronization info length.
  */
@@ -91,7 +82,6 @@ typedef bool fhss_use_broadcast_queue(const fhss_api_t *api, bool is_broadcast_a
  * @return -1 Transmission of the packet is currently not allowed, try again.
  * @return -2 Invalid api.
  * @return -3 Broadcast packet on Unicast channel (not allowed), push packet back to queue.
- * @return -4 Synchronization info missing.
  */
 typedef int fhss_tx_handle(const fhss_api_t *api, bool is_broadcast_addr, uint8_t *destination_address, int frame_type, uint16_t frame_length, uint8_t phy_header_length, uint8_t phy_tail_length, uint32_t tx_time);
 
@@ -164,13 +154,13 @@ typedef uint16_t fhss_get_retry_period(const fhss_api_t *api, uint8_t *destinati
 /**
  * @brief Write synchronization info to given pointer.
  * @param api FHSS instance.
- * @param info_ptr Pointer to written data.
- * @param info_type Type of the written info (UTT-IE, BT-IE, US-IE, BS-IE).
- * @param frame_type_id Frame type of packet which will be written in info element.
+ * @param ptr Pointer to data. Start of written data for Synch frame. Start of IE header for Data frame.
+ * @param length Length of IE header. Ignored when Synch frame.
+ * @param frame_type Frame type of packet (Frames types are defined by FHSS api).
  * @param tx_time TX time must be referenced to the first symbol following the SFD of the transmitted frame.
  * @return -1 on fail, write length otherwise.
  */
-typedef int16_t fhss_write_synch_info(const fhss_api_t *api, uint8_t *info_ptr, int info_type, int frame_type_id, uint32_t tx_time);
+typedef int16_t fhss_write_synch_info(const fhss_api_t *api, uint8_t *ptr, uint8_t length, int frame_type, uint32_t tx_time);
 
 /**
  * @brief Initialize MAC functions.

source/MAC/IEEE802_15_4/mac_header_helper_functions.c

@@ -20,6 +20,7 @@
 #include "ns_trace.h"
 #include "mlme.h"
 #include "mac_api.h"
+#include "fhss_api.h"
 #include "common_functions.h"
 #include "mac_common_defines.h"
 #include "MAC/IEEE802_15_4/mac_defines.h"
@@ -483,7 +484,7 @@ static uint8_t *mac_security_interface_aux_security_header_write(uint8_t *ptr, c
     return ptr;
 }
 
-uint8_t * mac_generic_packet_write(uint8_t *ptr, const mac_pre_build_frame_t *buffer)
+uint8_t * mac_generic_packet_write(struct protocol_interface_rf_mac_setup *rf_ptr, uint8_t *ptr, const mac_pre_build_frame_t *buffer)
 {
     ptr = mac_header_write_fcf_dsn(&buffer->fcf_dsn, ptr);
 
@@ -507,13 +508,16 @@ uint8_t * mac_generic_packet_write(uint8_t *ptr, const mac_pre_build_frame_t *bu
     if (buffer->fcf_dsn.securityEnabled) {
         ptr = mac_security_interface_aux_security_header_write(ptr, &buffer->aux_header);
     }
-
+    uint8_t *ie_start = ptr;
     //Copy Payload and set IE Elemets
     ptr = mac_header_information_elements_write(buffer, ptr);
     if (buffer->mac_payload_length) {
         memcpy(ptr, buffer->mac_payload, buffer->mac_payload_length );
         ptr += buffer->mac_payload_length;
     }
+    if (rf_ptr->fhss_api) {
+        rf_ptr->fhss_api->write_synch_info(rf_ptr->fhss_api, ie_start, buffer->headerIeLength, FHSS_DATA_FRAME, 0);
+    }
     return ptr;
 }
 

source/MAC/IEEE802_15_4/mac_header_helper_functions.h

@@ -25,6 +25,7 @@ struct mac_pre_parsed_frame_s;
 struct mac_pre_build_frame;
 struct mac_aux_security_header_s;
 struct ns_ie_iovec;
+struct protocol_interface_rf_mac_setup;
 
 uint8_t mac_security_mic_length_get(uint8_t security_level);
 uint8_t mac_header_security_aux_header_length(uint8_t security_level, uint8_t keyIdmode);
@@ -64,7 +65,7 @@ uint8_t mcps_mac_command_frame_id_get(const struct mac_pre_parsed_frame_s *buffe
 uint8_t *mcps_mac_payload_pointer_get(const struct mac_pre_parsed_frame_s *buffer);
 uint8_t *mcps_security_mic_pointer_get(const struct mac_pre_parsed_frame_s *buffer);
 /* Write Mac Header and payload */
-uint8_t * mac_generic_packet_write(uint8_t *ptr, const struct mac_pre_build_frame *buffer);
+uint8_t * mac_generic_packet_write(struct protocol_interface_rf_mac_setup *rf_ptr, uint8_t *ptr, const struct mac_pre_build_frame *buffer);
 
 
 /** get pointer to Mac header start point*/

source/MAC/IEEE802_15_4/mac_mcps_sap.c

@@ -1435,7 +1435,7 @@ static int8_t mcps_generic_packet_build(protocol_interface_rf_mac_setup_s *rf_pt
     tx_buf->len = frame_length;
 
     uint8_t *mhr_start = ptr;
-    ptr = mac_generic_packet_write(ptr, buffer);
+    ptr = mac_generic_packet_write(rf_ptr, ptr, buffer);
 
     if (buffer->fcf_dsn.securityEnabled) {
         mac_security_data_params_set(ccm_ptr, (mhr_start + (buffer->mac_header_length_with_security + open_payload)), (mac_payload_length - open_payload));

source/MAC/IEEE802_15_4/mac_pd_sap.c

@@ -220,8 +220,7 @@ void mac_pd_sap_state_machine(protocol_interface_rf_mac_setup_s *rf_mac_setup)
                     // FHSS synchronization info is written in the end of transmitted (Beacon) buffer
                     dev_driver_tx_buffer_s *tx_buf = &rf_mac_setup->dev_driver_tx_buffer;
                     synch_info = tx_buf->buf + rf_mac_setup->dev_driver->phy_driver->phy_header_length + tx_buf->len - FHSS_SYNCH_INFO_LENGTH;
-                    //TODO: Add proper frame type when they are defined
-                    rf_mac_setup->fhss_api->write_synch_info(rf_mac_setup->fhss_api, synch_info, FHSS_PLAIN_SYNCH_INFO, 0, 0);
+                    rf_mac_setup->fhss_api->write_synch_info(rf_mac_setup->fhss_api, synch_info, 0, FHSS_SYNCH_FRAME, 0);
                 }
                 // Change to destination channel and write synchronization info to Beacon frames here
                 int tx_handle_retval = rf_mac_setup->fhss_api->tx_handle(rf_mac_setup->fhss_api, !mac_is_ack_request_set(active_buf),

source/Service_Libs/fhss/fhss.c

@@ -929,22 +929,15 @@ static void fhss_update_channel_callback(fhss_structure_t *fhss_structure)
     }
 }
 
-static int16_t fhss_write_synch_info_callback(const fhss_api_t *api, uint8_t *info_ptr, int info_type, int frame_type_id, uint32_t tx_time)
+static int16_t fhss_write_synch_info_callback(const fhss_api_t *api, uint8_t *ptr, uint8_t length, int frame_type, uint32_t tx_time)
 {
     fhss_structure_t *fhss_structure = fhss_get_object_with_api(api);
-    (void) frame_type_id;
     (void) tx_time;
-    if (!fhss_structure) {
+    if (!fhss_structure || !ptr || (frame_type != FHSS_SYNCH_FRAME)) {
         return -1;
     }
-    if (info_type == FHSS_PLAIN_SYNCH_INFO) {
-        if (!info_ptr) {
-            return -1;
-        }
-        fhss_beacon_build(fhss_structure, info_ptr);
-        return FHSS_SYNCH_INFO_LENGTH;
-    }
-    return -1;
+    fhss_beacon_build(fhss_structure, ptr);
+    return FHSS_SYNCH_INFO_LENGTH;
 }
 
 static void fhss_data_tx_done_callback(const fhss_api_t *api, bool waiting_ack, bool tx_completed, uint8_t handle)

source/Service_Libs/fhss/fhss_ws.c

@@ -25,6 +25,7 @@
 #include "fhss_ws.h"
 #include "fhss_mac_interface.h"
 #include "nsdynmemLIB.h"
+#include "common_functions.h"
 #include "ns_trace.h"
 #include <string.h>
 
@@ -34,6 +35,16 @@
 #define FHSS_CHANNEL_DEBUG
 
 #define DEF_2E16 16777216
+#define IE_HEADER_LENGTH_MASK 0x007f
+#define IE_HEADER_ID_MASK 0x7f80
+#define WH_IE_ID        0x2a
+#define WH_SUB_ID_UTT   1
+
+struct ws_ie_t {
+    uint8_t *content_ptr;
+    unsigned length:7;
+    uint8_t id;
+};
 
 static void fhss_ws_update_uc_channel_callback(fhss_structure_t *fhss_structure);
 static void fhss_unicast_handler(const fhss_api_t *fhss_api, uint16_t delay);
@@ -262,18 +273,43 @@ static bool fhss_ws_check_tx_conditions_callback(const fhss_api_t *api, bool is_
     return true;
 }
 
-static int16_t fhss_ws_write_synch_info_callback(const fhss_api_t *api, uint8_t *info_ptr, int info_type, int frame_type_id, uint32_t tx_time)
+static uint8_t fhss_ws_ie_header_discover(uint8_t *header_ptr, uint16_t length, struct ws_ie_t *header_ie, uint8_t sub_id)
+{
+    struct ws_ie_t ie_element;
+    uint8_t *sub_id_ptr;
+    uint16_t ie_dummy;
+    while (length > 2) {
+        ie_dummy = common_read_16_bit_inverse(header_ptr);
+        ie_element.length = (ie_dummy & IE_HEADER_LENGTH_MASK);
+        ie_element.id = ((ie_dummy & IE_HEADER_ID_MASK) >> 7);
+        ie_element.content_ptr = header_ptr + 2;
+        sub_id_ptr = ie_element.content_ptr;
+        if (ie_element.length && (header_ie->id == ie_element.id) && (*sub_id_ptr == sub_id)) {
+            sub_id_ptr++;
+            ie_element.length--;
+            header_ie->content_ptr = sub_id_ptr;
+            header_ie->length = ie_element.length;
+            return ie_element.length;
+        }
+        length -= ie_element.length + 2;
+        header_ptr += ie_element.length + 2;
+    }
+    return 0;
+}
+
+static int16_t fhss_ws_write_synch_info_callback(const fhss_api_t *api, uint8_t *ptr, uint8_t length, int frame_type, uint32_t tx_time)
 {
     fhss_structure_t *fhss_structure = fhss_get_object_with_api(api);
-    (void) frame_type_id;
-    (void) tx_time;
-    (void) info_ptr;
-    (void) info_type;
-    if (!fhss_structure) {
+    if (!fhss_structure || !ptr || (frame_type != FHSS_DATA_FRAME)) {
         return -1;
     }
-
-    return -1;
+    struct ws_ie_t header_ie;
+    header_ie.id = WH_IE_ID;
+    if (fhss_ws_ie_header_discover(ptr, length, &header_ie, WH_SUB_ID_UTT)) {
+        uint32_t ufsi = fhss_ws_calculate_ufsi(fhss_structure, tx_time);
+        common_write_24_bit_inverse(ufsi, header_ie.content_ptr+1);
+    }
+    return 0;
 }
 
 static void fhss_ws_data_tx_done_callback(const fhss_api_t *api, bool waiting_ack, bool tx_completed, uint8_t handle)

test/nanostack/unittest/mac/mac_header_helper_functions/test_mac_header_helper_functions.c

@@ -480,6 +480,8 @@ bool test_mac_generic_packet_write()
     uint8_t ie_payload_test[30];
     uint8_t ie_header_test[30];
     uint8_t payload[20];
+    protocol_interface_rf_mac_setup_s rf_ptr;
+    memset(&rf_ptr, 0, sizeof(protocol_interface_rf_mac_setup_s));
 
     ns_ie_iovec_t header_ie;
     ns_ie_iovec_t payload_ie;
@@ -500,29 +502,29 @@ bool test_mac_generic_packet_write()
     frame2->fcf_dsn.SrcAddrMode = MAC_ADDR_MODE_16_BIT;
     frame2->fcf_dsn.intraPan = true;
     frame2->fcf_dsn.DstPanPresents = true;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+4+2
     if (test_pointer_move_length(ptr, buffer_ptr) != 9) {
         return false;
     }
 
     frame2->fcf_dsn.intraPan = false;
     frame2->fcf_dsn.SrcPanPresents = true;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+4+4
     if (test_pointer_move_length(ptr, buffer_ptr) != 11) {
         return false;
     }
     frame2->fcf_dsn.DstAddrMode = MAC_ADDR_MODE_64_BIT;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+10+4
     if (test_pointer_move_length(ptr, buffer_ptr) != 17) {
         return false;
     }
 
     frame2->fcf_dsn.intraPan = true;
     frame2->fcf_dsn.SrcPanPresents = false;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+10+2
     if (test_pointer_move_length(ptr, buffer_ptr) != 15) {
         return false;
@@ -531,13 +533,13 @@ bool test_mac_generic_packet_write()
     frame2->fcf_dsn.SrcPanPresents = true;
     frame2->fcf_dsn.DstPanPresents = false;
     frame2->fcf_dsn.DstAddrMode = MAC_ADDR_MODE_NONE;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+4
     if (test_pointer_move_length(ptr, buffer_ptr) != 7) {
         return false;
     }
     frame2->fcf_dsn.SrcAddrMode = MAC_ADDR_MODE_64_BIT;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+10
     if (test_pointer_move_length(ptr, buffer_ptr) != 13) {
         return false;
@@ -557,7 +559,7 @@ bool test_mac_generic_packet_write()
 
     frame2->fcf_dsn.DstAddrMode = MAC_ADDR_MODE_16_BIT;
 
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30
     if (test_pointer_move_length(ptr, buffer_ptr) != 45) {
         return false;
@@ -567,15 +569,15 @@ bool test_mac_generic_packet_write()
     frame2->ie_elements.payloadIovLength = 1;
     frame2->payloadsIeLength = 30;
 
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30 +2 +30
     if (test_pointer_move_length(ptr, buffer_ptr) != 77) {
         return false;
     }
 
     frame2->mac_payload = payload;
     frame2->mac_payload_length =20;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30 +2 +30 +20
     if (test_pointer_move_length(ptr, buffer_ptr) != 99) {
         return false;
@@ -588,27 +590,27 @@ bool test_mac_generic_packet_write()
     frame2->aux_header.KeyIndex = 1;
     frame2->aux_header.securityLevel = 7;
 
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30 +2 +30 +10 +6 +16
     if (test_pointer_move_length(ptr, buffer_ptr) != 94) {
         return false;
     }
     frame2->aux_header.KeyIdMode = MAC_KEY_ID_MODE_IDX;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30 +2 +30 +10 +6 +16
     if (test_pointer_move_length(ptr, buffer_ptr) != 95) {
         return false;
     }
 
     frame2->aux_header.KeyIdMode = MAC_KEY_ID_MODE_SRC4_IDX;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30 +2 +30 +10 +6 +16
     if (test_pointer_move_length(ptr, buffer_ptr) != 99) {
         return false;
     }
 
     frame2->aux_header.KeyIdMode = MAC_KEY_ID_MODE_SRC8_IDX;
-    ptr = mac_generic_packet_write(buffer_ptr, frame2);
+    ptr = mac_generic_packet_write(&rf_ptr, buffer_ptr, frame2);
     //3+8+4+30 +2 +30 +10 +6 +16
     if (test_pointer_move_length(ptr, buffer_ptr) != 103) {
         return false;

test/nanostack/unittest/stub/mac_header_helper_functions_stub.c

@@ -117,7 +117,7 @@ uint32_t mcps_mac_security_frame_counter_read(const mac_pre_parsed_frame_t *buff
     return mac_header_helper_functions_stub.security_header.frameCounter;
 }
 
-uint8_t * mac_generic_packet_write(uint8_t *ptr, const mac_pre_build_frame_t *buffer)
+uint8_t * mac_generic_packet_write(struct protocol_interface_rf_mac_setup *rf_ptr, uint8_t *ptr, const struct mac_pre_build_frame *buffer)
 {
     return mac_header_helper_functions_stub.uint8_ptr;
 }