MAC ie library update:

Added new discover function for discover
mac_ie_header_sub_id_discover(). Function compare standard header id and
first byte from content.

source/6LoWPAN/MAC/mac_ie_lib.c

@@ -94,3 +94,25 @@ uint8_t mac_ie_header_discover(uint8_t *header_ptr, uint16_t length, mac_header_
  }
  return 0;
 }
+
+uint8_t mac_ie_header_sub_id_discover(uint8_t *header_ptr, uint16_t length, mac_header_IE_t * header_ie, uint8_t sub_id)
+{
+ mac_header_IE_t ie_element;
+ uint8_t *sub_id_ptr;
+ while (length > 2) {
+ mac_ie_header_parse(&ie_element, header_ptr);
+ 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;
+}

source/6LoWPAN/MAC/mac_ie_lib.h

@@ -25,5 +25,6 @@ uint8_t *mac_ie_header_base_write(uint8_t *ptr, uint8_t type, uint16_t length);
 uint8_t *mac_ie_payload_base_write(uint8_t *ptr, uint8_t type, uint16_t length);
 uint16_t mac_ie_payload_discover(uint8_t *payload_ptr, uint16_t length, struct mac_payload_IE_s * payload_ie);
 uint8_t mac_ie_header_discover(uint8_t *header_ptr, uint16_t length, struct mac_header_IE_s * header_ie);
+uint8_t mac_ie_header_sub_id_discover(uint8_t *header_ptr, uint16_t length, mac_header_IE_t * header_ie, uint8_t sub_id);
 
 #endif /* MAC_IE_LIB_H_ */

test/nanostack/unittest/stub/mac_ie_lib_stub.c

@@ -45,3 +45,10 @@ uint8_t mac_ie_header_discover(uint8_t *header_ptr, uint16_t length, mac_header_
  header_ie->content_ptr = payload_ptr;
  return mac_ie_lib_stub_def.value_uint8;
 }
+
+
+uint8_t mac_ie_header_sub_id_discover(uint8_t *header_ptr, uint16_t length, mac_header_IE_t * header_ie, uint8_t sub_id)
+{
+ header_ie->content_ptr = payload_ptr;
+ return mac_ie_lib_stub_def.value_uint8;
+}