Added support for write/READ EA-IE header IE Element's

Change-Id: I59f67a53d6575e08cbaf97ea0041487ecd91750b

Author: Juha Heiskanen

source/6LoWPAN/ws/ws_common_defines.h

@@ -27,6 +27,7 @@
 #define WH_IE_RSL_TYPE              4   /**< Received Signal Level information */
 #define WH_IE_MHDS_TYPE             5   /**< MHDS information for mesh routing */
 #define WH_IE_VH_TYPE               6   /**< Vendor header information */
+#define WH_IE_EA_TYPE               9   /**< Eapol Auhtenticator EUI-64 header information */
 
 #define WS_WP_NESTED_IE             4 /**< WS nested Payload IE element'selement could include mltiple sub payload IE */
 

source/6LoWPAN/ws/ws_ie_lib.c

@@ -118,6 +118,14 @@ uint8_t *ws_wh_rsl_write(uint8_t *ptr, int8_t rssi)
     return ptr;
 }
 
+uint8_t *ws_wh_ea_write(uint8_t *ptr, uint8_t *eui64)
+{
+    ptr = ws_wh_header_base_write(ptr, 8, WH_IE_EA_TYPE);
+    memcpy(ptr, eui64, 8);
+    ptr += 8;
+    return ptr;
+}
+
 uint8_t *ws_wh_vh_write(uint8_t *ptr, uint8_t *vendor_header, uint8_t vendor_header_length)
 {
     ptr = ws_wh_header_base_write(ptr, vendor_header_length, WH_IE_VH_TYPE);
@@ -300,6 +308,18 @@ bool ws_wh_rsl_read(uint8_t *data, uint16_t length, int8_t *rsl)
     return true;
 }
 
+bool ws_wh_ea_read(uint8_t *data, uint16_t length, uint8_t *eui64)
+{
+    mac_header_IE_t rsl_ie_data;
+    rsl_ie_data.id = MAC_HEADER_ASSIGNED_EXTERNAL_ORG_IE_ID;
+    if (8 != mac_ie_header_sub_id_discover(data, length, &rsl_ie_data, WH_IE_EA_TYPE)) {
+        return false;
+    }
+    memcpy(eui64, rsl_ie_data.content_ptr, 8);
+
+    return true;
+}
+
 static uint8_t *ws_channel_plan_zero_read(uint8_t *ptr, ws_channel_plan_zero_t *plan)
 {
     plan->regulator_domain = *ptr++;

source/6LoWPAN/ws/ws_ie_lib.h

@@ -38,10 +38,12 @@ uint8_t *ws_wh_bt_write(uint8_t *ptr);
 uint8_t *ws_wh_fc_write(uint8_t *ptr, uint8_t flow_ctrl);
 uint8_t *ws_wh_rsl_write(uint8_t *ptr, int8_t rssi);
 uint8_t *ws_wh_vh_write(uint8_t *ptr, uint8_t *vendor_header, uint8_t vendor_header_length);
+uint8_t *ws_wh_ea_write(uint8_t *ptr, uint8_t *eui64);
 
 bool ws_wh_utt_read(uint8_t *data, uint16_t length, struct ws_utt_ie *utt_ie);
 bool ws_wh_bt_read(uint8_t *data, uint16_t length, struct ws_bt_ie *bt_ie);
 bool ws_wh_rsl_read(uint8_t *data, uint16_t length, int8_t *rsl);
+bool ws_wh_ea_read(uint8_t *data, uint16_t length, uint8_t *eui64);
 
 /* WS_WP_NESTED PAYLOD IE */
 uint8_t *ws_wp_base_write(uint8_t *ptr, uint16_t length);

source/6LoWPAN/ws/ws_llc.h

@@ -41,6 +41,7 @@ typedef struct wh_ie_sub_list_s {
     bool fc_ie: 1;   /**< Flow Control for Extended Direct Frame Exchange */
     bool rsl_ie: 1;  /**< Received Signal Level information */
     bool vh_ie: 1;   /**< Vendor header information */
+    bool ea_ie: 1;   /**< EAPOL autheticator EUI-64 header information */
 } wh_ie_sub_list_t;
 
 /**

test/nanostack/unittest/stub/ws_ie_lib_stub.c

@@ -164,6 +164,16 @@ bool ws_wh_utt_read(uint8_t *data, uint16_t length, struct ws_utt_ie *utt_ie)
     return ws_ie_lib_stub.utt_bool_value;
 }
 
+bool ws_wh_ea_read(uint8_t *data, uint16_t length, uint8_t *eui64)
+{
+    return ws_ie_lib_stub.utt_bool_value;
+}
+
+uint8_t *ws_wh_ea_write(uint8_t *ptr, uint8_t *eui64)
+{
+    return ptr + 11;
+}
+
 bool ws_wh_bt_read(uint8_t *data, uint16_t length, struct ws_bt_ie *bt_ie)
 {
     *bt_ie = ws_ie_lib_stub.bt_ie;