Fixed MPX header size calculation to MPX data request.

Author: Juha Heiskanen

source/6LoWPAN/ws/ws_llc_data_service.c

@@ -507,12 +507,12 @@ static void ws_llc_mpx_data_request(const mpx_api_t *api, const struct mcps_data
     uint16_t ie_header_length = ws_wh_headers_length(ie_header_mask, &base->ie_params);
     uint16_t nested_ie_length = ws_wp_nested_message_length(nested_wp_id, &base->ie_params);
 
-
-
     uint16_t over_head_size = ie_header_length;
     if (nested_ie_length) {
         over_head_size += nested_ie_length + 2;
     }
+    //Mpx header size
+    over_head_size += 5; //MPX FuLL frame 3 bytes + IE header 2 bytes
 
     //Allocate Message
     llc_message_t *message = llc_message_allocate(over_head_size , base, true);