Fixed MAC Asynch message send and header build bug.

Author: Juha Heiskanen

source/MAC/IEEE802_15_4/mac_header_helper_functions.c

@@ -60,7 +60,7 @@ bool mac_dst_panid_present(const mac_fcf_sequence_t *header)
             presents = true;
         }
 
-    } else if (header->DstAddrMode) {
+    } else if (header->DstAddrMode && !header->SrcAddrMode) {
         if (header->frameVersion == MAC_FRAME_VERSION_2015) {
             if (!header->intraPan) {
                 presents = true;
@@ -69,9 +69,11 @@ bool mac_dst_panid_present(const mac_fcf_sequence_t *header)
             presents = true;
         }
 
-    } else {
+    } else if (!header->DstAddrMode && !header->SrcAddrMode) {
         if (header->frameVersion == MAC_FRAME_VERSION_2015) {
-            presents = true;
+            if (!header->intraPan) {
+                presents = true;
+            }
         }
     }
 
@@ -665,9 +667,14 @@ static uint8_t *mac_payload_ie_terimate(uint8_t *ptr)
 
 void mac_header_information_elements_preparation(mac_pre_build_frame_t *buffer)
 {
+    if (buffer->message_builded) {
+        return;
+    }
+
     if (buffer->headerIeLength ||  buffer->payloadsIeLength) {
         buffer->fcf_dsn.frameVersion = MAC_FRAME_VERSION_2015;
         buffer->fcf_dsn.informationElementsPresets = true;
+        buffer->message_builded = true;
         //Write Header elements
         if (buffer->headerIeLength) {
             buffer->mac_header_length_with_security += buffer->headerIeLength;

source/MAC/IEEE802_15_4/mac_mcps_sap.h

@@ -128,6 +128,7 @@ typedef struct mac_pre_build_frame{
     bool upper_layer_request;
     bool mac_allocated_payload_ptr:1;
     bool asynch_request:1;
+    bool message_builded:1;
     unsigned security_mic_len:5;    //Max possible lengths 0, 4, 8, 16 bytes
     unsigned priority:2;
     struct mac_pre_build_frame *next; //Pointer for queue purpose