Diff: sn_coap_protocol.c

Revision:

0:aafd54b05111

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/sn_coap_protocol.c	Tue Feb 18 01:01:58 2014 +0000
@@ -0,0 +1,3167 @@
+/**
+ * \file sn_coap_protocol.c
+ *
+ * \brief CoAP Protocol implementation
+ *
+ * Functionality: CoAP Protocol
+ *
+ *  Created on: Jul 19, 2011
+ *      Author: tero
+ *
+ * \note Supports draft-ietf-core-coap-18
+ */
+
+
+/* * * * * * * * * * * * * * */
+/* * * * INCLUDE FILES * * * */
+/* * * * * * * * * * * * * * */
+
+#include <stdio.h>
+#include <stdint.h>
+#include <stdlib.h> /* For libary malloc() */
+#include <string.h> /* For memset() and memcpy() */
+#ifndef REAL_EMBEDDED
+#include <time.h>
+#endif
+
+#include "nsdl_types.h"
+#include "sn_nsdl.h"
+#include "sn_coap_header.h"
+#include "sn_coap_protocol.h"
+#include "sn_coap_header_internal.h"
+#include "sn_coap_protocol_internal.h"
+#include "sn_linked_list.h"
+
+/* * * * * * * * * * * * * * * * * * * * */
+/* * * * LOCAL FUNCTION PROTOTYPES * * * */
+/* * * * * * * * * * * * * * * * * * * * */
+
+
+static void                  sn_coap_protocol_linked_list_ack_info_store(uint16_t msg_id, uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr);
+static int32_t               sn_coap_protocol_linked_list_ack_info_search(uint16_t msg_id, uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr);
+static void                  sn_coap_protocol_linked_list_ack_info_remove(uint16_t msg_id, sn_nsdl_addr_s *addr_ptr);
+static void                  sn_coap_protocol_linked_list_ack_info_remove_old_ones(void);
+static void 				 sn_coap_protocol_send_rst(uint16_t msg_id, sn_nsdl_addr_s *addr_ptr);
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */
+static void                  sn_coap_protocol_linked_list_duplication_info_store(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id);
+static int8_t                sn_coap_protocol_linked_list_duplication_info_search(sn_nsdl_addr_s *scr_addr_ptr, uint16_t msg_id);
+static void                  sn_coap_protocol_linked_list_duplication_info_remove(uint8_t *scr_addr_ptr, uint16_t port, uint16_t msg_id);
+static void                  sn_coap_protocol_linked_list_duplication_info_remove_old_ones(void);
+#endif
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */
+static void                  sn_coap_protocol_linked_list_blockwise_msg_remove_current();
+static void                  sn_coap_protocol_linked_list_blockwise_payload_store(sn_nsdl_addr_s *addr_ptr, uint16_t stored_payload_len, uint8_t *stored_payload_ptr);
+static uint8_t              *sn_coap_protocol_linked_list_blockwise_payload_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t *payload_length);
+static void                  sn_coap_protocol_linked_list_blockwise_payload_remove_oldest();
+static uint16_t              sn_coap_protocol_linked_list_blockwise_payloads_get_len(sn_nsdl_addr_s *src_addr_ptr);
+static void                  sn_coap_protocol_linked_list_blockwise_remove_old_data(void);
+static sn_coap_hdr_s 		*sn_coap_handle_blockwise_message(sn_nsdl_addr_s *src_addr_ptr, sn_coap_hdr_s *received_coap_msg_ptr);
+static int8_t 				 sn_coap_convert_block_size(uint16_t block_size);
+static sn_coap_hdr_s 		*sn_coap_protocol_copy_header(sn_coap_hdr_s *source_header_ptr);
+#endif
+#if ENABLE_RESENDINGS
+static sn_nsdl_transmit_s   *sn_coap_protocol_build_msg(void *src_msg_ptr);
+static void                  sn_coap_protocol_linked_list_send_msg_store(sn_nsdl_addr_s *dst_addr_ptr, uint16_t send_packet_data_len, uint8_t *send_packet_data_ptr, uint32_t sending_time);
+static sn_nsdl_transmit_s   *sn_coap_protocol_linked_list_send_msg_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id);
+static void                  sn_coap_protocol_linked_list_send_msg_remove(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id);
+static coap_send_msg_s      *sn_coap_protocol_allocate_mem_for_msg(sn_nsdl_addr_s *dst_addr_ptr, uint16_t packet_data_len);
+static void                  sn_coap_protocol_release_allocated_send_msg_mem(coap_send_msg_s *freed_send_msg_ptr);
+static uint16_t				 sn_coap_count_linked_list_size(sn_linked_list_t *linked_list_ptr);
+#endif
+static void 				 coap_protocol_free_lists(void);
+
+/* * * * * * * * * * * * * * * * * */
+/* * * * GLOBAL DECLARATIONS * * * */
+/* * * * * * * * * * * * * * * * * */
+
+#if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */
+static sn_linked_list_t *global_linked_list_resent_msgs_ptr                 = NULL; /* Active resending messages are stored to this Linked list */
+#endif
+static sn_linked_list_t *global_linked_list_ack_info_ptr                    = NULL; /* Message Acknowledgement info is stored to this Linked list */
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */
+static sn_linked_list_t *global_linked_list_duplication_msgs_ptr            = NULL; /* Messages for duplicated messages detection is stored to this Linked list */
+#endif
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwise is not used at all, this part of code will not be compiled */
+static sn_linked_list_t *global_linked_list_blockwise_sent_msgs_ptr         = NULL; /* Blockwise message to to be sent is stored to this Linked list */
+static sn_linked_list_t *global_linked_list_blockwise_received_payloads_ptr = NULL; /* Blockwise payload to to be received is stored to this Linked list */
+#endif
+
+ static uint16_t          global_message_id                                  	= 100;  /* Increasing Message ID which is written to CoAP message header in building */
+ static uint32_t          global_system_time                                 	= 0;    /* System time seconds */
+
+
+ uint16_t 				sn_coap_block_data_size 							= 0;
+
+ uint8_t 					sn_coap_resending_queue_msgs 						= 0;
+ uint8_t					sn_coap_resending_queue_bytes						= 0;
+ uint8_t 					sn_coap_resending_count		 						= 0;
+ uint8_t					sn_coap_resending_intervall							= 0;
+
+ uint8_t					sn_coap_duplication_buffer_size						= 0;
+
+
+ static void              *(*sn_coap_protocol_malloc)(uint16_t)              = NULL; /* Function pointer for used malloc() function */
+ static void              (*sn_coap_protocol_free)(void*)                    = NULL; /* Function pointer for used free()   function */
+ static uint8_t 			(*sn_coap_tx_callback)(sn_nsdl_capab_e , uint8_t *, uint16_t, sn_nsdl_addr_s *) = NULL;
+
+
+static uint8_t 	resource_path_ptr[]			= {'r','d'};
+static uint8_t 	ep_name_parameter_string[]	= {'h','='};
+static uint8_t	resource_type_parameter[]	= {'r','t','='};
+
+/**
+ * \fn int8_t sn_coap_register(sn_coap_hdr_s *coap_hdr_ptr, registration_info_t *endpoint_info_ptr)
+ *
+ * \brief Builds RD registrtion request packet
+ *
+ * \param *coap_hdr_ptr is destination for built Packet data
+ * \param *endpoint_info_ptr pointer to struct that contains endpoint info parameters
+ *
+ * \return Return value 0 given on success. In failure cases:\n
+ *          -1 = Failure
+ */
+
+int8_t sn_coap_register(sn_coap_hdr_s *coap_hdr_ptr, registration_info_t *endpoint_info_ptr)
+{
+	uint8_t *temp_ptr;
+
+	coap_hdr_ptr->msg_code = COAP_MSG_CODE_REQUEST_POST;
+	coap_hdr_ptr->msg_type = COAP_MSG_TYPE_CONFIRMABLE;
+	coap_hdr_ptr->msg_id = global_message_id++;
+
+	coap_hdr_ptr->uri_path_len = sizeof(resource_path_ptr);
+	coap_hdr_ptr->uri_path_ptr = resource_path_ptr;
+
+	/* Payload copy */
+	coap_hdr_ptr->payload_len = endpoint_info_ptr->links_len;
+	coap_hdr_ptr->payload_ptr = sn_coap_protocol_malloc(coap_hdr_ptr->payload_len);
+	if(!coap_hdr_ptr->payload_ptr)
+		return -1;
+	memcpy(coap_hdr_ptr->payload_ptr, endpoint_info_ptr->links_ptr, coap_hdr_ptr->payload_len);
+
+	/* Options allocation */
+	if(!coap_hdr_ptr->options_list_ptr)
+	{
+		coap_hdr_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+		if(!coap_hdr_ptr->options_list_ptr)
+		{
+			sn_coap_protocol_free(coap_hdr_ptr->payload_ptr);
+			return -1;
+		}
+	}
+	memset(coap_hdr_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+
+	/* Uri query filling */
+	coap_hdr_ptr->options_list_ptr->uri_query_len = sizeof(ep_name_parameter_string) + endpoint_info_ptr->endpoint_len +
+													sizeof(resource_type_parameter) + endpoint_info_ptr->endpoint_type_len + 1; // + 1 for '&'
+
+	coap_hdr_ptr->options_list_ptr->uri_query_ptr = sn_coap_protocol_malloc(coap_hdr_ptr->options_list_ptr->uri_query_len);
+	if(!coap_hdr_ptr->options_list_ptr->uri_query_ptr)
+	{
+		sn_coap_protocol_free(coap_hdr_ptr->options_list_ptr);
+		sn_coap_protocol_free(coap_hdr_ptr->payload_ptr);
+		return -1;
+	}
+
+	temp_ptr = coap_hdr_ptr->options_list_ptr->uri_query_ptr;
+
+	memcpy(temp_ptr, ep_name_parameter_string, sizeof(ep_name_parameter_string));
+	temp_ptr += sizeof(ep_name_parameter_string);
+
+	memcpy(temp_ptr, endpoint_info_ptr->endpoint_ptr, endpoint_info_ptr->endpoint_len);
+	temp_ptr += endpoint_info_ptr->endpoint_len;
+
+	*temp_ptr++ = '&';
+
+	memcpy(temp_ptr, resource_type_parameter, sizeof(resource_type_parameter));
+	temp_ptr += sizeof(resource_type_parameter);
+
+	memcpy(temp_ptr, endpoint_info_ptr->endpoint_type_ptr, endpoint_info_ptr->endpoint_type_len);
+	temp_ptr += endpoint_info_ptr->endpoint_type_len;
+
+	return 0;
+}
+
+/**
+ * \fn int8_t sn_coap_register_update(sn_coap_hdr_s *coap_hdr_ptr, uint8_t *location, uint8_t length)
+ *
+ * \brief Builds RD update request packet
+ *
+ * \param *coap_hdr_ptr is destination for built Packet data
+ * \param *location The location returned when registering with the RD
+ * \param length length of the location
+ *
+ * \return Return value 0 given on success. In failure cases:\n
+ *          -1 = Failure
+ */
+
+int8_t 	sn_coap_register_update(sn_coap_hdr_s *coap_hdr_ptr, uint8_t *location, uint8_t length)
+{
+	coap_hdr_ptr->msg_code = COAP_MSG_CODE_REQUEST_PUT;
+	coap_hdr_ptr->msg_type = COAP_MSG_TYPE_CONFIRMABLE;
+	coap_hdr_ptr->msg_id = global_message_id++;
+	coap_hdr_ptr->uri_path_len = length;
+	coap_hdr_ptr->uri_path_ptr = location;
+
+	return 0;
+}
+
+/**
+ * \fn int8_t sn_coap_deregister(sn_coap_hdr_s *coap_hdr_ptr, uint8_t *location, uint8_t length)
+ *
+ * \brief Builds RD de-registrtion request packet
+ *
+ * \param *coap_hdr_ptr is destination for built Packet data
+ * \param *location The location returned when registering with the RD
+ * \param length length of the location
+ *
+ * \return Return value 0 given on success. In failure cases:\n
+ *          -1 = Failure
+ */
+
+int8_t 	sn_coap_deregister(sn_coap_hdr_s *coap_hdr_ptr, uint8_t *location, uint8_t length)
+{
+	coap_hdr_ptr->msg_code = COAP_MSG_CODE_REQUEST_DELETE;
+	coap_hdr_ptr->msg_type = COAP_MSG_TYPE_CONFIRMABLE;
+	coap_hdr_ptr->msg_id = global_message_id++;
+	coap_hdr_ptr->uri_path_len = length;
+	coap_hdr_ptr->uri_path_ptr = location;
+
+	return 0;
+}
+
+/**
+ * \fn int8_t sn_coap_protocol_destroy(void)
+ *
+ * \brief Frees all memory from CoAP protocol part
+ *
+ * \return Return value is always 0
+ */
+
+int8_t sn_coap_protocol_destroy(void)
+{
+#if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */
+	if(global_linked_list_resent_msgs_ptr)
+	{
+				uint16_t size =  sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr);
+				uint16_t i = 0;
+				coap_send_msg_s*tmp;
+				for(i=0;i<size;i++)
+				{
+					tmp = sn_linked_list_get_first_node(global_linked_list_resent_msgs_ptr);
+
+					if(tmp)
+					{
+						if(tmp->send_msg_ptr)
+						{
+							if(tmp->send_msg_ptr->dst_addr_ptr)
+							{
+								if(tmp->send_msg_ptr->dst_addr_ptr->addr_ptr)
+								{
+									sn_coap_protocol_free(tmp->send_msg_ptr->dst_addr_ptr->addr_ptr);
+									tmp->send_msg_ptr->dst_addr_ptr->addr_ptr = 0;
+								}
+								if(tmp->send_msg_ptr->dst_addr_ptr->socket_information)
+								{
+									sn_coap_protocol_free(tmp->send_msg_ptr->dst_addr_ptr->socket_information);
+									tmp->send_msg_ptr->dst_addr_ptr->socket_information = 0;
+								}
+								sn_coap_protocol_free(tmp->send_msg_ptr->dst_addr_ptr);
+								tmp->send_msg_ptr->dst_addr_ptr = 0;
+							}
+							if(tmp->send_msg_ptr->packet_ptr)
+							{
+								sn_coap_protocol_free(tmp->send_msg_ptr->packet_ptr);
+								tmp->send_msg_ptr->packet_ptr = 0;
+							}
+							sn_coap_protocol_free(tmp->send_msg_ptr);
+							tmp->send_msg_ptr = 0;
+						}
+						sn_linked_list_remove_current_node(global_linked_list_resent_msgs_ptr);
+						sn_coap_protocol_free(tmp);
+						tmp = 0;
+					}
+				}
+
+				if(!sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr))
+				{
+					sn_coap_protocol_free(global_linked_list_resent_msgs_ptr);
+					global_linked_list_resent_msgs_ptr = 0;
+				}
+	}
+#endif
+
+	if(global_linked_list_ack_info_ptr)
+	{
+		uint16_t size =  sn_linked_list_count_nodes(global_linked_list_ack_info_ptr);
+		uint16_t i = 0;
+		coap_ack_info_s*tmp;
+
+		for(i=0;i<size;i++)
+		{
+			tmp = sn_linked_list_get_first_node(global_linked_list_ack_info_ptr);
+
+			if(tmp)
+			{
+				if(tmp->token_ptr)
+				{
+					sn_coap_protocol_free(tmp->token_ptr);
+					tmp->token_ptr = 0;
+				}
+				if(tmp->addr_ptr)
+				{
+					sn_coap_protocol_free(tmp->addr_ptr);
+					tmp->addr_ptr = 0;
+				}
+				sn_linked_list_remove_current_node(global_linked_list_ack_info_ptr);
+				sn_coap_protocol_free(tmp);
+				tmp = 0;
+			}
+		}
+
+		if(!sn_linked_list_count_nodes(global_linked_list_ack_info_ptr))
+		{
+			sn_coap_protocol_free(global_linked_list_ack_info_ptr);
+			global_linked_list_ack_info_ptr = 0;
+		}
+	}
+
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */
+	if(global_linked_list_duplication_msgs_ptr)
+	{
+
+	}
+#endif
+
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwise is not used at all, this part of code will not be compiled */
+	if(global_linked_list_blockwise_sent_msgs_ptr)
+	{
+
+	}
+	if(global_linked_list_blockwise_received_payloads_ptr)
+	{
+
+	}
+#endif
+return 0;
+}
+
+
+
+void coap_protocol_free_lists(void)
+{
+#if ENABLE_RESENDINGS
+	if(NULL != global_linked_list_resent_msgs_ptr)
+	{
+		sn_linked_list_free(global_linked_list_resent_msgs_ptr);
+		global_linked_list_resent_msgs_ptr = NULL;
+	}
+#endif
+	if(NULL != global_linked_list_ack_info_ptr)
+	{
+		sn_linked_list_free(global_linked_list_ack_info_ptr);
+		global_linked_list_ack_info_ptr = NULL;
+	}
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT
+	if(NULL != global_linked_list_duplication_msgs_ptr)
+	{
+		sn_linked_list_free(global_linked_list_duplication_msgs_ptr);
+		global_linked_list_duplication_msgs_ptr = NULL;
+	}
+#endif
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE
+	if(NULL != global_linked_list_blockwise_sent_msgs_ptr)
+	{
+		sn_linked_list_free(global_linked_list_blockwise_sent_msgs_ptr);
+		global_linked_list_blockwise_sent_msgs_ptr = NULL;
+	}
+	if(NULL != global_linked_list_blockwise_received_payloads_ptr)
+	{
+		sn_linked_list_free(global_linked_list_blockwise_received_payloads_ptr);
+		global_linked_list_blockwise_received_payloads_ptr = NULL;
+	}
+#endif
+
+}
+
+/**************************************************************************//**
+ * \fn int8_t sn_coap_protocol_init(void* (*used_malloc_func_ptr)(uint16_t), void (*used_free_func_ptr)(void*),
+		uint8_t (*used_tx_callback_ptr)(sn_nsdl_capab_e , uint8_t *, uint16_t, sn_nsdl_addr_s *))
+ *
+ * \brief Initializes CoAP Protocol part
+ *
+ * \param *used_malloc_func_ptr is function pointer for used malloc() function.
+ *        If set to NULL, CoAP Protocol part uses standard C-library malloc() function.
+ *
+ * \param *used_free_func_ptr is function pointer for used free() function.
+ *        If set to NULL, CoAP Protocol part uses standard C-library free() function.
+ *
+ * \param *used_tx_callback_ptr function callback pointer to tx function for sending coap messages
+ *****************************************************************************/
+
+int8_t sn_coap_protocol_init(void* (*used_malloc_func_ptr)(uint16_t), void (*used_free_func_ptr)(void*),
+		uint8_t (*used_tx_callback_ptr)(sn_nsdl_capab_e , uint8_t *, uint16_t, sn_nsdl_addr_s *))
+{
+    /* * * Handling malloc() * * */
+    if (used_malloc_func_ptr != NULL)
+        sn_coap_protocol_malloc = used_malloc_func_ptr;
+    else
+    	return -1;
+
+    /* * * Handling free() * * */
+    if (used_free_func_ptr != NULL)
+        sn_coap_protocol_free = used_free_func_ptr;
+    else
+    	return -1;
+
+    /* * * Handle tx callback * * */
+    if(used_tx_callback_ptr != NULL)
+    	sn_coap_tx_callback = used_tx_callback_ptr;
+    else
+    	return -1;
+
+    sn_linked_list_init(sn_coap_protocol_malloc, sn_coap_protocol_free);
+
+#if ENABLE_RESENDINGS  /* If Message resending is not used at all, this part of code will not be compiled */
+
+    /* * * * Create Linked list for storing active resending messages  * * * */
+    sn_coap_resending_queue_msgs = SN_COAP_RESENDING_QUEUE_SIZE_MSGS;
+    sn_coap_resending_queue_bytes = SN_COAP_RESENDING_QUEUE_SIZE_BYTES;
+    sn_coap_resending_intervall = DEFAULT_RESPONSE_TIMEOUT;
+    sn_coap_resending_count = SN_COAP_RESENDING_MAX_COUNT;
+
+    /* Check that Linked list is not already created */
+    if (global_linked_list_resent_msgs_ptr == NULL)
+    {
+        global_linked_list_resent_msgs_ptr = sn_linked_list_create();
+
+        if(global_linked_list_resent_msgs_ptr == NULL)
+        {
+        	coap_protocol_free_lists();
+        	return (-1);
+        }
+
+    }
+
+#endif /* ENABLE_RESENDINGS */
+
+    /* * * * Create Linked list for storing Acknowledgement info, if not already created * * * */
+    if (global_linked_list_ack_info_ptr == NULL)
+    {
+        global_linked_list_ack_info_ptr = sn_linked_list_create();
+
+        if(global_linked_list_ack_info_ptr == NULL)
+        {
+        	coap_protocol_free_lists();
+        	return (-1);
+        }
+
+    }
+
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */
+    /* * * * Create Linked list for storing Duplication info * * * */
+    sn_coap_duplication_buffer_size = SN_COAP_DUPLICATION_MAX_MSGS_COUNT;
+
+    /* Check that Linked list is not already created */
+    if (global_linked_list_duplication_msgs_ptr == NULL)
+    {
+        global_linked_list_duplication_msgs_ptr = sn_linked_list_create();
+
+        if(global_linked_list_duplication_msgs_ptr == NULL)
+        {
+        	coap_protocol_free_lists();
+        	return (-1);
+        }
+    }
+#endif
+
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */
+
+    sn_coap_block_data_size = SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE;
+
+    /* * * * Create Linked list for storing sent blockwise messages, if not already created  * * * */
+    if (global_linked_list_blockwise_sent_msgs_ptr == NULL)
+    {
+        global_linked_list_blockwise_sent_msgs_ptr = sn_linked_list_create();
+
+        if(global_linked_list_blockwise_sent_msgs_ptr == NULL)
+        {
+        	coap_protocol_free_lists();
+        	return (-1);
+        }
+
+    }
+
+    /* * * * Create Linked list for storing received blockwise payload, if not already created * * * */
+    if (global_linked_list_blockwise_received_payloads_ptr == NULL)
+    {
+        global_linked_list_blockwise_received_payloads_ptr = sn_linked_list_create();
+
+        if(global_linked_list_blockwise_received_payloads_ptr == NULL)
+        {
+        	coap_protocol_free_lists();
+        	return (-1);
+        }
+    }
+#endif /* ENABLE_RESENDINGS */
+
+    /* Randomize global message ID */
+#ifndef REAL_EMBEDDED
+   	srand(time(NULL));
+#endif
+    {
+	    uint8_t random_number = rand();
+	    global_message_id = 100 + random_number;
+    }
+
+	return 0;
+}
+
+/**************************************************************************//**
+ * \fn int8_t sn_coap_protocol_set_block_size(uint16_t block_size)
+ *
+ * \brief Sets block size
+ *
+ * \param uint16_t block_size maximum size of CoAP payload. Valid sizes are 16, 32, 64, 128, 256, 512 and 1024 bytes
+ * \return 	0 = success
+ * 			-1 = failure
+ */
+
+int8_t sn_coap_protocol_set_block_size(uint16_t block_size)
+{
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE
+	switch(block_size)
+	{
+	case 0:
+	case 16:
+	case 32:
+	case 64:
+	case 128:
+	case 256:
+	case 512:
+	case 1024:
+		sn_coap_block_data_size = block_size;
+		return 0;
+	default:
+		break;
+	}
+#endif
+	return -1;
+
+}
+
+/**************************************************************************//**
+ * \fn int8_t sn_coap_protocol_set_duplicate_buffer_size(uint8_t message_count)
+ *
+ * \brief Sets max number of messages saved for message duplication checks
+ *
+ * \param uint8_t message_count max number of messages saved for duplicate control
+ * \return 	0 = success
+ * 			-1 = failure
+ */
+
+int8_t sn_coap_protocol_set_duplicate_buffer_size(uint8_t message_count)
+{
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT
+	if(message_count <= SN_COAP_MAX_ALLOWED_DUPLICATION_MESSAGE_COUNT)
+	{
+		sn_coap_duplication_buffer_size = message_count;
+		return 0;
+	}
+#endif
+	return -1;
+}
+
+/**************************************************************************//**
+ * \fn int8_t sn_coap_protocol_set_retransmission_parameters(uint8_t resending_count, uint8_t resending_intervall)
+ *
+ * \brief Sets message retransmission parameters
+ *
+ * \param uint8_t resending_count max number of resendings for message
+ * \param uint8_t resending_intervall message resending inervall in seconds
+ * \return 	0 = success
+ * 			-1 = failure
+ */
+
+int8_t sn_coap_protocol_set_retransmission_parameters(uint8_t resending_count, uint8_t resending_intervall)
+{
+#if ENABLE_RESENDINGS
+	if(resending_count <= SN_COAP_MAX_ALLOWED_RESENDING_COUNT &&
+			resending_intervall <= SN_COAP_MAX_ALLOWED_RESPONSE_TIMEOUT && resending_intervall > 0)
+	{
+		sn_coap_resending_count = resending_count;
+		sn_coap_resending_intervall = resending_intervall;
+		return 0;
+	}
+#endif
+	return -1;
+}
+
+/**************************************************************************//**
+ * \fn int8_t sn_coap_protocol_set_retransmission_buffer(uint8_t buffer_size_messages, uint16_t buffer_size_bytes)
+ *
+ * \brief Sets message retransmission queue. Set size to '0' to disable feature. If both are set to '0', then re-sendings are disabled.
+ *
+ * \param uint8_t buffer_size_messages queue size - maximum number of messages to be saved to queue
+ * \param uint8_t buffer_size_bytes queue size - maximum size of messages saved to queue
+ * \return 	0 = success
+ * 			-1 = failure
+ */
+
+int8_t sn_coap_protocol_set_retransmission_buffer(uint8_t buffer_size_messages, uint16_t buffer_size_bytes)
+{
+#if ENABLE_RESENDINGS
+	if(buffer_size_bytes <= SN_COAP_MAX_ALLOWED_RESENDING_BUFF_SIZE_BYTES)
+		sn_coap_resending_queue_bytes = buffer_size_bytes;
+	if(buffer_size_bytes <= SN_COAP_MAX_ALLOWED_RESENDING_BUFF_SIZE_MSGS)
+		sn_coap_resending_queue_msgs = buffer_size_messages;
+
+#endif
+	return -1;
+
+}
+
+/**************************************************************************//**
+ * \fn int16_t sn_coap_protocol_build(sn_nsdl_addr_s *dst_addr_ptr, uint8_t *dst_packet_data_ptr, sn_coap_hdr_s *src_coap_msg_ptr)
+ *
+ * \brief Builds Packet data from given CoAP header structure to be sent
+ *
+ * \param *dst_addr_ptr is pointer to destination address where CoAP message
+ *        will be sent (CoAP builder needs that information for message resending purposes)
+ *
+ * \param *dst_packet_data_ptr is pointer to destination of built Packet data
+ *
+ * \param *src_coap_msg_ptr is pointer to source of built Packet data
+ *
+ * \return Return value is byte count of built Packet data.\n
+ *         Note: If message is blockwised, all payload is not sent at the same time\n
+ *         In failure cases:\n
+ *          -1 = Failure in CoAP header structure\n
+ *          -2 = Failure in given pointer (= NULL)\n
+ *          -3 = Failure in Reset message\ŋ
+ *         If there is not enough memory (or User given limit exceeded) for storing
+ *         resending messages, situation is ignored.
+ *****************************************************************************/
+
+int16_t sn_coap_protocol_build(sn_nsdl_addr_s *dst_addr_ptr,
+                      uint8_t *dst_packet_data_ptr,
+                      sn_coap_hdr_s *src_coap_msg_ptr)
+{
+    int32_t  message_id           = -3;
+    int16_t  byte_count_built     = 0;
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */
+    uint16_t original_payload_len = 0;
+#endif
+
+    /* * * * Check given pointers  * * * */
+    if ((dst_addr_ptr == NULL) || (dst_packet_data_ptr == NULL) || (src_coap_msg_ptr == NULL))
+        return -2;
+
+    if(dst_addr_ptr->addr_ptr == NULL)
+    	return -2;
+
+    /* Check if built Message type is Reset message or Message code is some of response messages or empty	*/
+    /* (for these messages CoAP writes same Message ID which was stored earlier from request message) 		*/
+    if (src_coap_msg_ptr->msg_type == COAP_MSG_TYPE_RESET ||
+    		(src_coap_msg_ptr->msg_code >= COAP_MSG_CODE_RESPONSE_CREATED || src_coap_msg_ptr->msg_code == COAP_MSG_CODE_EMPTY))
+    {
+        /* Check if there is Token option in built CoAP message */
+        /* (only these messages can be acknowledged because Token option is used as key for stored messages) */
+			if (src_coap_msg_ptr->token_ptr != NULL)
+			{
+				/* Search Message ID from Linked list with Token option and Address as key */
+				message_id = sn_coap_protocol_linked_list_ack_info_search(src_coap_msg_ptr->msg_id, src_coap_msg_ptr->token_len,
+																		  src_coap_msg_ptr->token_ptr, dst_addr_ptr);
+			}
+			else
+			{
+				message_id = sn_coap_protocol_linked_list_ack_info_search(src_coap_msg_ptr->msg_id, 0, NULL, dst_addr_ptr);
+			}
+
+            /* If Message ID found */
+            if (message_id >= 0)
+            {
+                /* * * * Manage received CoAP message acknowledgement  * * * */
+                /* Piggy-backed response message found */
+
+            	/* Client                   Server */
+
+            	/*       ------------------> Confirmable request message (CoAP stores Acknowledgement info to Linked list) */
+
+            	/*       <------------------ THIS IS DONE HERE: Piggy-backed acknowledgement response message (CoAP writes same
+                                                                Message ID than was in Request message).
+                                                                User has written correct Token option to the response message. */
+
+                if (src_coap_msg_ptr->msg_type != COAP_MSG_TYPE_RESET)
+                {
+                    /* Now is built Piggy-backed Acknowledgement response message */
+                    src_coap_msg_ptr->msg_type = COAP_MSG_TYPE_ACKNOWLEDGEMENT;
+                }
+
+                /* Remove Acknowledgement info from Linked list */
+                sn_coap_protocol_linked_list_ack_info_remove(src_coap_msg_ptr->msg_id, dst_addr_ptr);
+            }
+            else if (src_coap_msg_ptr->msg_type == COAP_MSG_TYPE_RESET)
+            {
+                /* There was not found Message ID for Reset message */
+                return -3;
+            }
+    }
+
+    /* Check if built Message type is else than Acknowledgement or Reset i.e. message type is Confirmable or Non-confirmable */
+    /* (for Acknowledgement and  Reset messages is written same Message ID than was in the Request message) */
+    if (src_coap_msg_ptr->msg_type != COAP_MSG_TYPE_ACKNOWLEDGEMENT &&
+        src_coap_msg_ptr->msg_type != COAP_MSG_TYPE_RESET &&
+        src_coap_msg_ptr->msg_id == 0)
+    {
+        /* * * * Generate new Message ID and increase it by one  * * * */
+		if(0 > message_id)
+		{
+			src_coap_msg_ptr->msg_id = global_message_id;
+			global_message_id++;
+		}
+    }
+
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */
+
+    /* If blockwising needed */
+    if ((src_coap_msg_ptr->payload_len > sn_coap_block_data_size) && (sn_coap_block_data_size > 0))
+    {
+        /* * * * Add Blockwise option to send CoAP message * * */
+
+    	if (src_coap_msg_ptr->options_list_ptr == NULL)
+        {
+            /* Allocate memory for less used options */
+            src_coap_msg_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+
+            if (src_coap_msg_ptr->options_list_ptr == NULL)
+            {
+                return -2;
+            }
+            memset(src_coap_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+        }
+
+
+        /* Check if Request message */
+        if (src_coap_msg_ptr->msg_code < COAP_MSG_CODE_RESPONSE_CREATED )
+        {
+            /* Add Blockwise option, use Block1 because Request payload */
+            src_coap_msg_ptr->options_list_ptr->block1_len = 1;
+            src_coap_msg_ptr->options_list_ptr->block1_ptr = sn_coap_protocol_malloc(1);
+
+            if (src_coap_msg_ptr->options_list_ptr->block1_ptr == NULL)
+            {
+                sn_coap_protocol_free(src_coap_msg_ptr->options_list_ptr);
+
+                return -2;
+            }
+
+            *(src_coap_msg_ptr->options_list_ptr->block1_ptr) = 0x08; 		/* First block  (BLOCK NUMBER, 4 MSB bits) + More to come (MORE, 1 bit) */
+            *(src_coap_msg_ptr->options_list_ptr->block1_ptr) |= sn_coap_convert_block_size(sn_coap_block_data_size);
+
+        }
+        else /* Response message */
+        {
+            /* Add Blockwise option, use Block2 because Response payload */
+            src_coap_msg_ptr->options_list_ptr->block2_len = 1;
+            src_coap_msg_ptr->options_list_ptr->block2_ptr = sn_coap_protocol_malloc(1);
+
+            if (src_coap_msg_ptr->options_list_ptr->block2_ptr == NULL)
+            {
+                sn_coap_protocol_free(src_coap_msg_ptr->options_list_ptr);
+                return -2;
+            }
+
+            *(src_coap_msg_ptr->options_list_ptr->block2_ptr) = 0x08; 		/* First block  (BLOCK NUMBER, 4 MSB bits) + More to come (MORE, 1 bit) */
+            *(src_coap_msg_ptr->options_list_ptr->block2_ptr) |= sn_coap_convert_block_size(sn_coap_block_data_size);
+        }
+
+        /* Store original Payload length */
+        original_payload_len = src_coap_msg_ptr->payload_len;
+
+        /* Change Payload length of send message because Payload is blockwised */
+        src_coap_msg_ptr->payload_len = sn_coap_block_data_size;
+    }
+
+#endif
+    /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
+    /* * * * Build Packet data from CoAP message by using CoAP Header builder  * * * */
+    /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
+
+    byte_count_built = sn_coap_builder(dst_packet_data_ptr, src_coap_msg_ptr);
+
+    if (byte_count_built < 0)
+    {
+        return byte_count_built;
+    }
+
+#if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */
+
+    /* Check if built Message type was confirmable, only these messages are resent */
+    if (src_coap_msg_ptr->msg_type == COAP_MSG_TYPE_CONFIRMABLE)
+    {
+        /* Store message to Linked list for resending purposes */
+        sn_coap_protocol_linked_list_send_msg_store(dst_addr_ptr, byte_count_built, dst_packet_data_ptr,
+                                                    global_system_time + (uint32_t)(sn_coap_resending_intervall * RESPONSE_RANDOM_FACTOR));
+    }
+
+#endif /* ENABLE_RESENDINGS */
+
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */
+
+    /* If blockwising needed */
+    if ((original_payload_len > sn_coap_block_data_size) && (sn_coap_block_data_size > 0))
+    {
+
+        /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
+        /* * * * Manage rest blockwise messages sending by storing them to Linked list * * * */
+        /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
+
+    	coap_blockwise_msg_s *stored_blockwise_msg_ptr;
+
+    	stored_blockwise_msg_ptr = sn_coap_protocol_malloc(sizeof(coap_blockwise_msg_s));
+    	if(!stored_blockwise_msg_ptr)
+    	{
+    		//block paylaod save failed, only first block can be build. Perhaps we should return error.
+    		return byte_count_built;
+    	}
+    	memset(stored_blockwise_msg_ptr, 0, sizeof(coap_blockwise_msg_s));
+
+    	/* Fill struct */
+    	stored_blockwise_msg_ptr->timestamp = global_system_time;
+
+    	stored_blockwise_msg_ptr->coap_msg_ptr = sn_coap_protocol_copy_header(src_coap_msg_ptr);
+
+    	stored_blockwise_msg_ptr->coap_msg_ptr->payload_len = original_payload_len;
+    	stored_blockwise_msg_ptr->coap_msg_ptr->payload_ptr = sn_coap_protocol_malloc(stored_blockwise_msg_ptr->coap_msg_ptr->payload_len);
+    	if(!stored_blockwise_msg_ptr->coap_msg_ptr->payload_ptr)
+    	{
+    		//block paylaod save failed, only first block can be build. Perhaps we should return error.
+    		sn_coap_protocol_free(stored_blockwise_msg_ptr);
+    		return byte_count_built;
+    	}
+    	memcpy(stored_blockwise_msg_ptr->coap_msg_ptr->payload_ptr, src_coap_msg_ptr->payload_ptr, stored_blockwise_msg_ptr->coap_msg_ptr->payload_len);
+
+    	sn_linked_list_add_node(global_linked_list_blockwise_sent_msgs_ptr, stored_blockwise_msg_ptr);
+    }
+
+    else if(src_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_GET)
+    {
+    	/* Add message to linked list - response can be in blocks and we need header to build response.. */
+    	coap_blockwise_msg_s *stored_blockwise_msg_ptr;
+
+    	stored_blockwise_msg_ptr = sn_coap_protocol_malloc(sizeof(coap_blockwise_msg_s));
+    	if(!stored_blockwise_msg_ptr)
+    	{
+    		return byte_count_built;
+    	}
+    	memset(stored_blockwise_msg_ptr, 0, sizeof(coap_blockwise_msg_s));
+
+    	/* Fill struct */
+    	stored_blockwise_msg_ptr->timestamp = global_system_time;
+
+    	stored_blockwise_msg_ptr->coap_msg_ptr = sn_coap_protocol_copy_header(src_coap_msg_ptr);
+
+    	sn_linked_list_add_node(global_linked_list_blockwise_sent_msgs_ptr, stored_blockwise_msg_ptr);
+    }
+
+#endif /* SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE */
+
+    /* * * * Return built CoAP message Packet data length  * * * */
+    return byte_count_built;
+}
+
+/**************************************************************************//**
+ * \fn sn_coap_hdr_s *sn_coap_protocol_parse(sn_nsdl_addr_s *src_addr_ptr, uint16_t packet_data_len, uint8_t *packet_data_ptr)
+ *
+ * \brief Parses received CoAP message from given Packet data
+ *
+ * \param *src_addr_ptr is pointer to source address of received CoAP message
+ *        (CoAP parser needs that information for Message acknowledgement)
+ *
+ * \param packet_data_len is length of given Packet data to be parsed to CoAP message
+ *
+ * \param *packet_data_ptr is pointer to source of Packet data to be parsed to CoAP message
+ *
+ * \return Return value is pointer to parsed CoAP message structure. This structure includes also coap_status field.\n
+ *         In following failure cases NULL is returned:\n
+ *          -Given NULL pointer\n
+ *          -Failure in parsed header of non-confirmable message\ŋ
+ *          -Out of memory (malloc() returns NULL)
+ *****************************************************************************/
+
+sn_coap_hdr_s *sn_coap_protocol_parse(sn_nsdl_addr_s *src_addr_ptr, uint16_t packet_data_len, uint8_t *packet_data_ptr)
+{
+    sn_coap_hdr_s   *returned_dst_coap_msg_ptr = NULL;
+    coap_version_e   coap_version              = COAP_VERSION_UNKNOWN;
+
+    /* * * * Check given pointer * * * */
+    if (src_addr_ptr == NULL || src_addr_ptr->addr_ptr == NULL ||
+        packet_data_ptr == NULL)
+    {
+        return NULL;
+    }
+
+    /* * * * Parse Packet data to CoAP message by using CoAP Header parser * * * */
+    returned_dst_coap_msg_ptr = sn_coap_parser(packet_data_len, packet_data_ptr, &coap_version);
+
+    /* Check status of returned pointer */
+    if (returned_dst_coap_msg_ptr == NULL)
+    {
+        /* Memory allocation error in parser */
+    	return NULL;
+    }
+
+    /* * * * Check validity of parsed Header values  * * * */
+    if (sn_coap_header_validity_check(returned_dst_coap_msg_ptr, coap_version) != 0)
+    {
+    	/* If message code is in a reserved class (1, 6 or 7), send reset. Message code class is 3 MSB of the message code byte 	*/
+    	if(((returned_dst_coap_msg_ptr->msg_code >> 5) == 1) ||			// if class == 1
+    			((returned_dst_coap_msg_ptr->msg_code >> 5) == 6) ||	// if class == 6
+    			((returned_dst_coap_msg_ptr->msg_code >> 5) == 7))		// if class == 7
+    	{
+    		sn_coap_protocol_send_rst(returned_dst_coap_msg_ptr->msg_id, src_addr_ptr);
+    	}
+
+		 /* Release memory of CoAP message */
+		sn_coap_parser_release_allocated_coap_msg_mem(returned_dst_coap_msg_ptr);
+
+		/* Return NULL because Header validity check failed */
+		return NULL;
+    }
+
+    /* Check if we need to send reset message */
+    /*  A recipient MUST acknowledge a Confirmable message with an Acknowledgement
+   		message or, if it lacks context to process the message properly
+   	   	(including the case where the message is Empty, uses a code with a
+   	   	reserved class (1, 6 or 7), or has a message format error), MUST
+   	   	reject it; rejecting a Confirmable message is effected by sending a
+   	   	matching Reset message and otherwise ignoring it. */
+    if(returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_CONFIRMABLE)
+    {
+    	/* CoAP ping */
+    	if(returned_dst_coap_msg_ptr->msg_code == COAP_MSG_CODE_EMPTY)
+    	{
+    		sn_coap_protocol_send_rst(returned_dst_coap_msg_ptr->msg_id, src_addr_ptr);
+
+    		/* Release memory of CoAP message */
+    		sn_coap_parser_release_allocated_coap_msg_mem(returned_dst_coap_msg_ptr);
+
+    		/* Return NULL because Header validity check failed */
+    		return NULL;
+    	}
+    }
+
+#if !SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is used, this part of code will not be compiled */
+        /* If blockwising used in received message */
+        if (returned_dst_coap_msg_ptr->options_list_ptr != NULL &&
+            (returned_dst_coap_msg_ptr->options_list_ptr->block1_ptr != NULL ||
+             returned_dst_coap_msg_ptr->options_list_ptr->block2_ptr != NULL))
+        {
+            /* Set returned status to User */
+            returned_dst_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_REJECTED;
+            //todo: send response -> not implemented
+            return returned_dst_coap_msg_ptr;
+        }
+#endif /* !SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE */
+
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication is used, this part of code will not be compiled */
+
+    /* * * * Manage received CoAP message duplicate detection  * * * */
+
+    /* Check if duplication message detected */
+    ret_status = sn_coap_protocol_linked_list_duplication_info_search(src_addr_ptr, msg_id);
+
+    /* If no message duplication detected */
+    if (ret_status == -1)
+    {
+        /* * * No Message duplication: Store received message for detecting later duplication * * */
+
+        /* Get count of stored duplication messages */
+        uint16_t stored_duplication_msgs_count = sn_linked_list_count_nodes(global_linked_list_duplication_msgs_ptr);
+
+        /* Check if there is no room to store message for duplication detection purposes */
+        if (stored_duplication_msgs_count >= sn_coap_duplication_buffer_size)
+        {
+            /* Get oldest stored duplication message */
+            coap_duplication_info_s *stored_duplication_info_ptr = sn_linked_list_get_last_node(global_linked_list_duplication_msgs_ptr);
+
+            /* Remove oldest stored duplication message for getting room for new duplication message */
+            sn_coap_protocol_linked_list_duplication_info_remove(stored_duplication_info_ptr->addr_ptr, stored_duplication_info_ptr->port, stored_duplication_info_ptr->msg_id);
+        }
+
+        /* Store Duplication info to Linked list */
+        sn_coap_protocol_linked_list_duplication_info_store(src_addr_ptr, msg_id);
+    }
+    else /* * * Message duplication detected * * */
+    {
+        /* Set returned status to User */
+        returned_dst_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_DUPLICATED_MSG;
+
+        /* Because duplicate message, return with coap_status set */
+        return returned_dst_coap_msg_ptr;
+    }
+#endif
+
+
+    /*** And here we check if message was block message ***/
+    /*** If so, we call own block handling function and ***/
+    /*** return to caller.								***/
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE
+
+    coap_blockwise_msg_s *stored_blockwise_msg_temp_ptr;
+
+    if (returned_dst_coap_msg_ptr->options_list_ptr != NULL &&
+        (returned_dst_coap_msg_ptr->options_list_ptr->block1_ptr != NULL ||
+         returned_dst_coap_msg_ptr->options_list_ptr->block2_ptr != NULL))
+    {
+    	returned_dst_coap_msg_ptr = sn_coap_handle_blockwise_message(src_addr_ptr, returned_dst_coap_msg_ptr);
+    }
+    else
+    {
+		stored_blockwise_msg_temp_ptr = sn_linked_list_get_last_node(global_linked_list_blockwise_sent_msgs_ptr);
+
+		/* Get ... */
+		while(stored_blockwise_msg_temp_ptr && (returned_dst_coap_msg_ptr->msg_id != stored_blockwise_msg_temp_ptr->coap_msg_ptr->msg_id))
+		{
+			stored_blockwise_msg_temp_ptr = sn_linked_list_get_previous_node(global_linked_list_blockwise_sent_msgs_ptr);
+		}
+
+		if(stored_blockwise_msg_temp_ptr)
+		{
+			sn_linked_list_remove_current_node(global_linked_list_blockwise_sent_msgs_ptr);
+
+			if(stored_blockwise_msg_temp_ptr->coap_msg_ptr)
+				sn_coap_parser_release_allocated_coap_msg_mem(stored_blockwise_msg_temp_ptr->coap_msg_ptr);
+
+			sn_coap_protocol_free(stored_blockwise_msg_temp_ptr);
+		}
+   	}
+
+    if(!returned_dst_coap_msg_ptr)
+    	return NULL;
+
+#endif
+
+    /* Check if received Message type was confirmable */
+    if (returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_CONFIRMABLE)
+    {
+        if (returned_dst_coap_msg_ptr->token_ptr != NULL)
+        {
+            /* * * * Manage received CoAP message acknowledgement  * * */
+
+            /* Client                   Server */
+
+            /*       ------------------> THIS IS DONE HERE: Confirmable request (CoAP stores Acknowledgement info to Linked list) */
+
+            /*       <------------------ Piggy-backed acknowledgement response message (CoAP writes same Message ID
+                                         than was in Request message).
+                                         User has written correct Token option to the response message. */
+
+            /* Store message's Acknowledgement info to Linked list */
+            sn_coap_protocol_linked_list_ack_info_store(returned_dst_coap_msg_ptr->msg_id, returned_dst_coap_msg_ptr->token_len, returned_dst_coap_msg_ptr->token_ptr, src_addr_ptr);
+        }
+        else
+        {
+        	sn_coap_protocol_linked_list_ack_info_store(returned_dst_coap_msg_ptr->msg_id, 0, NULL, src_addr_ptr);
+        }
+    }
+
+
+#if ENABLE_RESENDINGS  /* If Message resending is not used at all, this part of code will not be compiled */
+
+    /* Check if received Message type was acknowledgement */
+    if ((returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_ACKNOWLEDGEMENT) || (returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_RESET))
+    {
+        /* * * * Manage CoAP message resending by removing active resending message from Linked list * * */
+
+        /* Get node count i.e. count of active resending messages */
+        uint16_t stored_resending_msgs_count = sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr);
+
+        /* Check if there is ongoing active message resendings */
+        if (stored_resending_msgs_count > 0)
+        {
+            sn_nsdl_transmit_s *removed_msg_ptr = NULL;
+
+            /* Check if received message was confirmation for some active resending message */
+
+            removed_msg_ptr = sn_coap_protocol_linked_list_send_msg_search(src_addr_ptr, returned_dst_coap_msg_ptr->msg_id);
+
+            if (removed_msg_ptr != NULL)
+            {
+                /* Remove resending message from active message resending Linked list */
+                sn_coap_protocol_linked_list_send_msg_remove(src_addr_ptr, returned_dst_coap_msg_ptr->msg_id);
+            }
+        }
+    }
+#endif /* ENABLE_RESENDINGS */
+
+    /* * * * Return parsed CoAP message  * * * */
+    return (returned_dst_coap_msg_ptr);
+}
+
+/**************************************************************************//**
+ * \fn int8_t sn_coap_protocol_exec(uint32_t current_time)
+ *
+ * \brief Sends CoAP messages from re-sending queue, if there is any.
+ * 		  Cleans also old messages from the duplication list and from block receiving list
+ *
+ *        This function can be called e.g. once in a second but also more frequently.
+ *
+ * \param current_time is System time in seconds. This time is
+ *        used for message re-sending timing and to identify old saved data.
+ *
+ * \return 	0 if success
+ * 			-1 if failed
+ *****************************************************************************/
+
+int8_t sn_coap_protocol_exec(uint32_t current_time)
+{
+#if ENABLE_RESENDINGS
+    uint8_t stored_resending_msgs_count;
+#endif
+
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE
+    /* * * * Remove old blocwise data * * * */
+    sn_coap_protocol_linked_list_blockwise_remove_old_data();
+#endif
+
+    /* * * * Store current System time * * * */
+    global_system_time = current_time;
+
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT
+    /* * * * Remove old duplication messages * * * */
+    sn_coap_protocol_linked_list_duplication_info_remove_old_ones();
+#endif
+
+    /* Remove old Acknowledgement infos */
+    sn_coap_protocol_linked_list_ack_info_remove_old_ones();
+
+#if ENABLE_RESENDINGS
+    /* Check if there is ongoing active message sendings */
+    stored_resending_msgs_count = sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr);
+
+    if (stored_resending_msgs_count > 0)
+    {
+        coap_send_msg_s *stored_msg_ptr = sn_linked_list_get_last_node(global_linked_list_resent_msgs_ptr);
+        uint8_t          i              = 0;
+
+        for (i = 0; i < stored_resending_msgs_count; i++)
+        {
+            sn_nsdl_transmit_s *returned_msg_ptr = NULL;
+
+			/* Check if it is time to send this message */
+			if (current_time >= stored_msg_ptr->resending_time)
+			{
+				/* * * Increase Resending counter  * * */
+				stored_msg_ptr->resending_counter++;
+
+				/* * * * Allocate and build returned message from stored data  * * * */
+				returned_msg_ptr = sn_coap_protocol_build_msg(stored_msg_ptr);
+
+				if (returned_msg_ptr == NULL)
+				{
+					return -1;
+				}
+
+				/* Check if it was last sending of this message */
+				if (stored_msg_ptr->resending_counter >= sn_coap_resending_count)
+				{
+					/* Get message ID from stored sending message */
+					uint16_t temp_msg_id = (stored_msg_ptr->send_msg_ptr->packet_ptr[2] << 8);
+					temp_msg_id += (uint16_t)stored_msg_ptr->send_msg_ptr->packet_ptr[3];
+
+					/* Remove message from Linked list */
+					sn_coap_protocol_linked_list_send_msg_remove(stored_msg_ptr->send_msg_ptr->dst_addr_ptr, temp_msg_id);
+				}
+				else
+				{
+					/* * * Count new Resending time  * * */
+					stored_msg_ptr->resending_time = current_time + (((uint32_t)(sn_coap_resending_intervall * RESPONSE_RANDOM_FACTOR)) <<
+																	 stored_msg_ptr->resending_counter);
+				}
+
+				/* Send message  */
+				sn_coap_tx_callback(returned_msg_ptr->protocol, returned_msg_ptr->packet_ptr,
+									returned_msg_ptr->packet_len, returned_msg_ptr->dst_addr_ptr);
+
+				/* Free sent packet */
+				sn_coap_builder_release_allocated_send_msg_mem(returned_msg_ptr);
+				return 0;
+			}
+
+            /* Get next stored sending message from Linked list */
+            stored_msg_ptr = sn_linked_list_get_previous_node(global_linked_list_resent_msgs_ptr);
+        }
+    }
+
+#endif /* ENABLE_RESENDINGS */
+
+    return 0;
+}
+
+#if ENABLE_RESENDINGS  /* If Message resending is not used at all, this part of code will not be compiled */
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_send_msg_store(sn_nsdl_addr_s *dst_addr_ptr, uint16_t send_packet_data_len, uint8_t *send_packet_data_ptr, uint32_t sending_time)
+ *
+ * \brief Stores message to Linked list for sending purposes.
+
+ * \param *dst_addr_ptr is pointer to destination address where CoAP message will be sent
+ *
+ * \param send_packet_data_len is length of Packet data to be stored
+ *
+ * \param *send_packet_data_ptr is Packet data to be stored
+ *
+ * \param sending_time is stored sending time
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_send_msg_store(sn_nsdl_addr_s *dst_addr_ptr, uint16_t send_packet_data_len,
+                                                        uint8_t *send_packet_data_ptr, uint32_t sending_time)
+{
+
+    coap_send_msg_s *stored_msg_ptr              = NULL;
+
+    /* Blocking also needs this - to be removed... */
+    if(sn_coap_block_data_size == 0)
+    {
+    	/* If both parameters are "0", then resending is disabled */
+    	if((sn_coap_resending_queue_msgs == 0) && (sn_coap_resending_queue_bytes == 0))
+    		return;
+
+    	if (sn_coap_resending_queue_msgs > 0)
+		{
+    	    if(sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr) >= sn_coap_resending_queue_msgs)
+    	    	return;
+		}
+
+		/* Count resending queue size, if buffer size is defined */
+		if(sn_coap_resending_queue_bytes > 0)
+		{
+			if((sn_coap_count_linked_list_size(global_linked_list_resent_msgs_ptr) + send_packet_data_len) > sn_coap_resending_queue_bytes)
+				return;
+		}
+    }
+
+    /* Allocating memory for stored message */
+    stored_msg_ptr = sn_coap_protocol_allocate_mem_for_msg(dst_addr_ptr, send_packet_data_len);
+
+    if(stored_msg_ptr == 0)
+        return;
+
+    /* Filling of coap_send_msg_s with initialization values */
+    stored_msg_ptr->resending_counter = 0;
+    stored_msg_ptr->resending_time = sending_time;
+
+    /* Filling of sn_nsdl_transmit_s */
+    stored_msg_ptr->send_msg_ptr->protocol = SN_NSDL_PROTOCOL_COAP;
+    stored_msg_ptr->send_msg_ptr->packet_len = send_packet_data_len;
+    memcpy(stored_msg_ptr->send_msg_ptr->packet_ptr, send_packet_data_ptr, send_packet_data_len);
+
+    /* Filling of sn_nsdl_addr_s */
+    stored_msg_ptr->send_msg_ptr->dst_addr_ptr->type = dst_addr_ptr->type;
+    stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_len = dst_addr_ptr->addr_len;
+    memcpy(stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, dst_addr_ptr->addr_ptr, dst_addr_ptr->addr_len);
+    stored_msg_ptr->send_msg_ptr->dst_addr_ptr->port = dst_addr_ptr->port;
+
+    /* Storing Resending message to Linked list */
+    if(sn_linked_list_add_node(global_linked_list_resent_msgs_ptr, stored_msg_ptr) != 0)
+    	sn_coap_protocol_release_allocated_send_msg_mem(stored_msg_ptr);
+
+}
+
+/**************************************************************************//**
+ * \fn static sn_nsdl_transmit_s *sn_coap_protocol_linked_list_send_msg_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id)
+ *
+ * \brief Searches stored resending message from Linked list
+ *
+ * \param *src_addr_ptr is searching key for searched message
+ *
+ * \param msg_id is searching key for searched message
+ *
+ * \return Return value is pointer to found stored resending message in Linked
+ *         list or NULL if message not found
+ *****************************************************************************/
+
+static sn_nsdl_transmit_s *sn_coap_protocol_linked_list_send_msg_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id)
+{
+    coap_send_msg_s *stored_msg_ptr              = sn_linked_list_get_last_node(global_linked_list_resent_msgs_ptr);
+    uint16_t         stored_resending_msgs_count = sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr);
+    uint8_t          i                           = 0;
+
+    /* Loop all stored resending messages Linked list */
+    for (i = 0; i < stored_resending_msgs_count; i++)
+    {
+        /* Get message ID from stored resending message */
+        uint16_t temp_msg_id = (stored_msg_ptr->send_msg_ptr->packet_ptr[2] << 8);
+        temp_msg_id += (uint16_t)stored_msg_ptr->send_msg_ptr->packet_ptr[3];
+
+        /* If message's Message ID is same than is searched */
+        if (temp_msg_id == msg_id)
+        {
+            int8_t mem_cmp_result = memcmp(src_addr_ptr->addr_ptr, stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, src_addr_ptr->addr_len);
+
+            /* If message's Source address is same than is searched */
+            if (mem_cmp_result == 0)
+            {
+                /* If message's Source address port is same than is searched */
+                if (stored_msg_ptr->send_msg_ptr->dst_addr_ptr->port == src_addr_ptr->port)
+                {
+                    /* * * Message found, return pointer to that stored resending message * * * */
+                    return stored_msg_ptr->send_msg_ptr;
+                }
+            }
+        }
+
+        /* Get next stored message to be searched */
+        stored_msg_ptr = sn_linked_list_get_previous_node(global_linked_list_resent_msgs_ptr);
+    }
+
+    /* Message not found */
+    return NULL;
+}
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_send_msg_remove(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id)
+ *
+ * \brief Removes stored resending message from Linked list
+ *
+ * \param *src_addr_ptr is searching key for searched message
+ * \param msg_id is searching key for removed message
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_send_msg_remove(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id)
+{
+    coap_send_msg_s *stored_msg_ptr              = sn_linked_list_get_last_node(global_linked_list_resent_msgs_ptr);
+    uint16_t         stored_resending_msgs_count = sn_linked_list_count_nodes(global_linked_list_resent_msgs_ptr);
+    uint8_t          i                           = 0;
+
+    /* Loop all stored resending messages in Linked list */
+    for (i = 0; i < stored_resending_msgs_count; i++)
+    {
+        /* Get message ID from stored resending message */
+        uint16_t temp_msg_id = (stored_msg_ptr->send_msg_ptr->packet_ptr[2] << 8);
+        temp_msg_id += (uint16_t)stored_msg_ptr->send_msg_ptr->packet_ptr[3];
+
+        /* If message's Message ID is same than is searched */
+        if (temp_msg_id == msg_id)
+        {
+            int8_t mem_cmp_result = memcmp(src_addr_ptr->addr_ptr, stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, src_addr_ptr->addr_len);
+
+            /* If message's Source address is same than is searched */
+            if (mem_cmp_result == 0)
+            {
+                /* If message's Source address port is same than is searched */
+                if (stored_msg_ptr->send_msg_ptr->dst_addr_ptr->port == src_addr_ptr->port)
+                {
+                    /* * * Message found * * */
+
+                    /* Free memory of stored message */
+                    sn_coap_protocol_release_allocated_send_msg_mem(stored_msg_ptr);
+
+                    /* Remove message from Linked list */
+                    stored_msg_ptr = sn_linked_list_remove_current_node(global_linked_list_resent_msgs_ptr);
+
+                    return;
+                }
+            }
+        }
+
+        /* Get next stored message to be searched */
+        stored_msg_ptr = sn_linked_list_get_previous_node(global_linked_list_resent_msgs_ptr);
+    }
+}
+#endif /* ENABLE_RESENDINGS */
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_ack_info_store(uint16_t msg_id, uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr)
+ *
+ * \brief Stores Acknowledgement info to Linked list
+ *
+ * \param msg_id is Message ID to be stored
+ *
+ * \param token_len is length of Token to be stored
+ *
+ * \param *token_ptr is pointer to Token data to be stored
+ *
+ * \param *addr_ptr is pointer to Address information to be stored
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_ack_info_store(uint16_t msg_id, uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr)
+{
+    coap_ack_info_s *stored_ack_info_ptr = NULL;
+
+    /* Remove oldest ack infos from linked list */
+    if(sn_linked_list_count_nodes(global_linked_list_ack_info_ptr) >= SN_COAP_ACK_INFO_MAX_COUNT_MESSAGES_SAVED)
+    {
+    	stored_ack_info_ptr = sn_linked_list_get_last_node(global_linked_list_ack_info_ptr);
+
+    	if(stored_ack_info_ptr)
+    	{
+    		sn_linked_list_remove_current_node(global_linked_list_ack_info_ptr);
+
+    		if(stored_ack_info_ptr->addr_ptr)
+    			sn_coap_protocol_free(stored_ack_info_ptr->addr_ptr);
+
+    		if(stored_ack_info_ptr->token_ptr)
+    			sn_coap_protocol_free(stored_ack_info_ptr->token_ptr);
+
+    		sn_coap_protocol_free(stored_ack_info_ptr);
+
+    		stored_ack_info_ptr = NULL;
+    	}
+    }
+
+    /* * * * Allocating memory for stored Acknowledgement info * * * */
+
+    /* Allocate memory for stored Acknowledgement info's structure */
+    stored_ack_info_ptr = sn_coap_protocol_malloc(sizeof(coap_ack_info_s));
+
+    if (stored_ack_info_ptr == NULL)
+    {
+        return;
+    }
+
+    if(token_ptr)
+    {
+
+		/* Allocate memory for stored Acknowledgement info's token */
+		stored_ack_info_ptr->token_ptr = sn_coap_protocol_malloc(token_len);
+
+		if (stored_ack_info_ptr->token_ptr == NULL)
+		{
+			sn_coap_protocol_free(stored_ack_info_ptr);
+
+			return;
+		}
+
+    }
+
+    /* Allocate memory for stored Acknowledgement info's address */
+    stored_ack_info_ptr->addr_ptr = sn_coap_protocol_malloc(addr_ptr->addr_len);
+
+    if (stored_ack_info_ptr->addr_ptr == NULL)
+    {
+        sn_coap_protocol_free(stored_ack_info_ptr->token_ptr);
+        sn_coap_protocol_free(stored_ack_info_ptr);
+        return;
+    }
+
+    /* * * * Filling fields of stored Acknowledgement info * * * */
+
+    stored_ack_info_ptr->timestamp = global_system_time;
+    stored_ack_info_ptr->msg_id = msg_id;
+    stored_ack_info_ptr->token_len = token_len;
+    if(token_ptr)
+    {
+    	memcpy(stored_ack_info_ptr->token_ptr, token_ptr, token_len);
+    }
+    else
+    {
+    	stored_ack_info_ptr->token_ptr = NULL;
+    }
+    memcpy(stored_ack_info_ptr->addr_ptr, addr_ptr->addr_ptr, addr_ptr->addr_len);
+    stored_ack_info_ptr->port = addr_ptr->port;
+
+    /* * * * Storing Acknowledgement info to Linked list * * * */
+
+    if(sn_linked_list_add_node(global_linked_list_ack_info_ptr, stored_ack_info_ptr) != 0)
+    {
+    	sn_coap_protocol_free(stored_ack_info_ptr->addr_ptr);
+        sn_coap_protocol_free(stored_ack_info_ptr->token_ptr);
+        sn_coap_protocol_free(stored_ack_info_ptr);
+        return;
+    }
+}
+
+/**************************************************************************//**
+ * \fn static int32_t sn_coap_protocol_linked_list_ack_info_search(uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr)
+ *
+ * \brief Searches stored Message ID from Linked list
+ *
+ * \param token_len is length of Token key to be searched
+ *
+ * \param *token_ptr is pointer to Token key to be searched
+ *
+ * \param *addr_ptr is pointer to Address key to be searched
+ *
+ * \return Return value is found Message ID. If Message ID not found, -1 is returned.
+ *****************************************************************************/
+
+static int32_t sn_coap_protocol_linked_list_ack_info_search(uint16_t msg_id, uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr)
+{
+    coap_ack_info_s *stored_ack_info_ptr   = sn_linked_list_get_last_node(global_linked_list_ack_info_ptr);
+    uint16_t         stored_ack_info_count = sn_linked_list_count_nodes(global_linked_list_ack_info_ptr);
+    uint8_t          i                     = 0;
+    uint8_t mem_cmp_result = 0;
+
+    if(!addr_ptr)
+    	return -1;
+
+    if(!addr_ptr->addr_ptr)
+    	return -1;
+
+    /* Loop all nodes in Linked list for searching Message ID */
+    for (i = 0; i < stored_ack_info_count; i++)
+    {
+        if(!stored_ack_info_ptr)
+        	return -1;
+
+        /* If message's Token option is same than is searched */
+        if(msg_id == stored_ack_info_ptr->msg_id)
+        {
+        	if(stored_ack_info_ptr->addr_ptr)
+        	{
+				mem_cmp_result = memcmp(addr_ptr->addr_ptr, stored_ack_info_ptr->addr_ptr, addr_ptr->addr_len);
+
+				/* If message's Source address is same than is searched */
+				if (mem_cmp_result == 0)
+				{
+					/* If message's Source address port is same than is searched */
+					if (stored_ack_info_ptr->port == addr_ptr->port)
+					{
+						if(stored_ack_info_ptr->token_ptr && token_ptr)
+						{
+							if(stored_ack_info_ptr->token_len == token_len)
+							{
+								mem_cmp_result = memcmp(token_ptr, stored_ack_info_ptr->token_ptr, token_len);
+
+								if (mem_cmp_result == 0)
+								{
+									/* ACK found and token match */
+									return stored_ack_info_ptr->msg_id;
+								}
+
+							}
+							return (-2); /* Token does not match */
+						}
+						else
+						{
+							/* * * Correct Acknowledgement info found * * * */
+							return stored_ack_info_ptr->msg_id;
+						}
+					}
+				}
+			}
+        }
+        /* Get next stored Acknowledgement info to be searched */
+        stored_ack_info_ptr = sn_linked_list_get_previous_node(global_linked_list_ack_info_ptr);
+    }
+
+    return -1;
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_ack_info_remove(uint8_t token_len, uint8_t *token_ptr, sn_nsdl_addr_s *addr_ptr)
+ *
+ * \brief Removes stored Acknowledgement info from Linked list
+ *
+ * \param token_len is length of Token key to be removed
+ *
+ * \param *token_ptr is pointer to Token key to be removed
+ *
+ * \param *addr_ptr is pointer to Address key to be removed
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_ack_info_remove(uint16_t msg_id, sn_nsdl_addr_s *addr_ptr)
+{
+    uint16_t         stored_ack_info_count = sn_linked_list_count_nodes(global_linked_list_ack_info_ptr);
+    coap_ack_info_s *stored_ack_info_ptr   = sn_linked_list_get_last_node(global_linked_list_ack_info_ptr);
+    uint8_t          i                     = 0;
+
+    if(!addr_ptr)
+    	return;
+
+    if(!addr_ptr->addr_ptr)
+    	return;
+
+    /* Loop all stored Acknowledgement infos in Linked list */
+    for (i = 0; i < stored_ack_info_count; i++)
+    {
+        if(!stored_ack_info_ptr)
+        	return;
+
+        /* If message's Token option is same than is searched */
+        if (msg_id == stored_ack_info_ptr->msg_id)
+        {
+
+            if (stored_ack_info_ptr->port == addr_ptr->port)
+            {
+				if(stored_ack_info_ptr->addr_ptr)
+				{
+					/* If message's Address is same than is searched */
+					if (!memcmp(addr_ptr->addr_ptr, stored_ack_info_ptr->addr_ptr, addr_ptr->addr_len))
+					{
+						/* * * * Correct Acknowledgement info found, remove it from Linked list * * * */
+						stored_ack_info_ptr = sn_linked_list_remove_current_node(global_linked_list_ack_info_ptr);
+
+						/* Free memory of stored Acknowledgement info */
+						if(stored_ack_info_ptr->token_ptr)
+							sn_coap_protocol_free(stored_ack_info_ptr->token_ptr);
+
+						sn_coap_protocol_free(stored_ack_info_ptr->addr_ptr);
+						sn_coap_protocol_free(stored_ack_info_ptr);
+
+						return;
+					}
+            	}
+            }
+
+        }
+
+        /* Get next stored message to be searched */
+        stored_ack_info_ptr = sn_linked_list_get_previous_node(global_linked_list_ack_info_ptr);
+    }
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_ack_info_remove_old_ones(void)
+ *
+ * \brief Removes old stored Acknowledgement infos from Linked list
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_ack_info_remove_old_ones(void)
+{
+    coap_ack_info_s *removed_ack_info_ptr   = sn_linked_list_get_first_node(global_linked_list_ack_info_ptr);
+
+    /* Loop all stored Acknowledgement infos in Linked list */
+    while(removed_ack_info_ptr)
+    {
+        if ((global_system_time - removed_ack_info_ptr->timestamp)  > SN_COAP_ACK_INFO_MAX_TIME_MSGS_STORED)
+        {
+            /* * * * Old Acknowledgement info found, remove it from Linked list * * * */
+            removed_ack_info_ptr = sn_linked_list_remove_current_node(global_linked_list_ack_info_ptr);
+
+            /* Free memory of stored Acknowledgement info */
+            if(removed_ack_info_ptr->token_ptr)
+            {
+            	sn_coap_protocol_free(removed_ack_info_ptr->token_ptr);
+            }
+
+            if(removed_ack_info_ptr->addr_ptr)
+            {
+            	sn_coap_protocol_free(removed_ack_info_ptr->addr_ptr);
+            }
+
+            sn_coap_protocol_free(removed_ack_info_ptr);
+
+            /* Remove current node moved list automatically to next node. That is why we can fetch it now by calling get current node. */
+            removed_ack_info_ptr = sn_linked_list_get_current_node(global_linked_list_ack_info_ptr);
+        }
+        else
+        {
+            /* Get next stored message to be searched */
+            removed_ack_info_ptr = sn_linked_list_get_next_node(global_linked_list_ack_info_ptr);
+        }
+    }
+}
+
+static void sn_coap_protocol_send_rst(uint16_t msg_id, sn_nsdl_addr_s *addr_ptr)
+{
+	uint8_t packet_ptr[4];
+
+	/* Add CoAP version and message type */
+	packet_ptr[0] = COAP_VERSION_1;
+	packet_ptr[0] |= COAP_MSG_TYPE_RESET;
+
+	/* Add message code */
+	packet_ptr[1] = COAP_MSG_CODE_EMPTY;
+
+	/* Add message ID */
+	packet_ptr[2] = msg_id >> 8;
+	packet_ptr[3] = (uint8_t)msg_id;
+
+	/* Send RST */
+	sn_coap_tx_callback(SN_NSDL_PROTOCOL_COAP, packet_ptr, 4, addr_ptr);
+
+}
+#if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_duplication_info_store(sn_nsdl_addr_s *addr_ptr, uint16_t msg_id)
+ *
+ * \brief Stores Duplication info to Linked list
+ *
+ * \param msg_id is Message ID to be stored
+ * \param *addr_ptr is pointer to Address information to be stored
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_duplication_info_store(sn_nsdl_addr_s *addr_ptr,
+                                                                uint16_t msg_id)
+{
+    coap_duplication_info_s *stored_duplication_info_ptr = NULL;
+
+    /* * * * Allocating memory for stored Duplication info * * * */
+
+    /* Allocate memory for stored Duplication info's structure */
+    stored_duplication_info_ptr = sn_coap_protocol_malloc(sizeof(coap_duplication_info_s));
+
+    if (stored_duplication_info_ptr == NULL)
+    {
+        return;
+    }
+
+    /* Allocate memory for stored Duplication info's address */
+    stored_duplication_info_ptr->addr_ptr = sn_coap_protocol_malloc(addr_ptr->addr_len);
+
+    if (stored_duplication_info_ptr->addr_ptr == NULL)
+    {
+        sn_coap_protocol_free(stored_duplication_info_ptr);
+
+        return;
+    }
+
+    /* * * * Filling fields of stored Duplication info * * * */
+
+    stored_duplication_info_ptr->timestamp = global_system_time;
+    stored_duplication_info_ptr->addr_len = addr_ptr->addr_len;
+    memcpy(stored_duplication_info_ptr->addr_ptr, addr_ptr->addr_ptr, addr_ptr->addr_len);
+    stored_duplication_info_ptr->port = addr_ptr->port;
+    stored_duplication_info_ptr->msg_id = msg_id;
+
+    /* * * * Storing Duplication info to Linked list * * * */
+
+    sn_linked_list_add_node(global_linked_list_duplication_msgs_ptr, stored_duplication_info_ptr);
+}
+
+/**************************************************************************//**
+ * \fn static int8_t sn_coap_protocol_linked_list_duplication_info_search(sn_nsdl_addr_s *addr_ptr, uint16_t msg_id)
+ *
+ * \brief Searches stored message from Linked list (Address and Message ID as key)
+ *
+ * \param *addr_ptr is pointer to Address key to be searched
+ * \param msg_id is Message ID key to be searched
+ *
+ * \return Return value is 0 when message found and -1 if not found
+ *****************************************************************************/
+
+static int8_t sn_coap_protocol_linked_list_duplication_info_search(sn_nsdl_addr_s *addr_ptr,
+                                                                   uint16_t msg_id)
+{
+    coap_duplication_info_s *stored_duplication_info_ptr   = sn_linked_list_get_last_node(global_linked_list_duplication_msgs_ptr);
+    uint16_t                 stored_duplication_msgs_count = sn_linked_list_count_nodes(global_linked_list_duplication_msgs_ptr);
+    uint8_t                  i                             = 0;
+
+    /* Loop all nodes in Linked list for searching Message ID */
+    for (i = 0; i < stored_duplication_msgs_count; i++)
+    {
+        /* If message's Message ID is same than is searched */
+        if (stored_duplication_info_ptr->msg_id == msg_id)
+        {
+            int8_t mem_cmp_result = memcmp(addr_ptr->addr_ptr, stored_duplication_info_ptr->addr_ptr, addr_ptr->addr_len);
+
+            /* If message's Source address is same than is searched */
+            if (mem_cmp_result == 0)
+            {
+                /* If message's Source address port is same than is searched */
+                if (stored_duplication_info_ptr->port == addr_ptr->port)
+                {
+                    /* * * Correct Duplication info found * * * */
+                    return 0;
+                }
+            }
+        }
+        /* Get next stored Duplication info to be searched */
+        stored_duplication_info_ptr = sn_linked_list_get_previous_node(global_linked_list_duplication_msgs_ptr);
+    }
+
+    return -1;
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_duplication_info_remove(uint8_t *addr_ptr, uint16_t port, uint16_t msg_id)
+ *
+ * \brief Removes stored Duplication info from Linked list
+ *
+ * \param *addr_ptr is pointer to Address key to be removed
+ *
+ * \param port is Port key to be removed
+ *
+ * \param msg_id is Message ID key to be removed
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_duplication_info_remove(uint8_t *addr_ptr, uint16_t port, uint16_t msg_id)
+{
+    coap_duplication_info_s *removed_duplication_info_ptr  = sn_linked_list_get_last_node(global_linked_list_duplication_msgs_ptr);
+    uint16_t                 stored_duplication_msgs_count = sn_linked_list_count_nodes(global_linked_list_duplication_msgs_ptr);
+    uint8_t                  i                             = 0;
+
+    /* Loop all stored duplication messages in Linked list */
+    for (i = 0; i < stored_duplication_msgs_count; i++)
+    {
+        int8_t mem_cmp_result = memcmp(addr_ptr, removed_duplication_info_ptr->addr_ptr, removed_duplication_info_ptr->addr_len);
+
+        /* If message's Address is same than is searched */
+        if (mem_cmp_result == 0)
+        {
+            /* If message's Address prt is same than is searched */
+            if (removed_duplication_info_ptr->port == port)
+            {
+                /* If Message ID is same than is searched */
+                if (removed_duplication_info_ptr->msg_id == msg_id)
+                {
+                    /* * * * Correct Duplication info found, remove it from Linked list * * * */
+                    removed_duplication_info_ptr = sn_linked_list_remove_current_node(global_linked_list_duplication_msgs_ptr);
+
+                    /* Free memory of stored Duplication info */
+                    sn_coap_protocol_free(removed_duplication_info_ptr->addr_ptr);
+                    sn_coap_protocol_free(removed_duplication_info_ptr);
+
+                    return;
+                }
+            }
+        }
+
+        /* Get next stored message to be searched */
+        removed_duplication_info_ptr = sn_linked_list_get_previous_node(global_linked_list_duplication_msgs_ptr);
+    }
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_duplication_info_remove_old_ones(void)
+ *
+ * \brief Removes old stored Duplication detection infos from Linked list
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_duplication_info_remove_old_ones(void)
+{
+    coap_duplication_info_s *removed_duplication_info_ptr  = sn_linked_list_get_first_node(global_linked_list_duplication_msgs_ptr);
+
+    /* Loop all stored duplication messages in Linked list */
+    while(removed_duplication_info_ptr)
+    {
+        if ((global_system_time - removed_duplication_info_ptr->timestamp)  > SN_COAP_DUPLICATION_MAX_TIME_MSGS_STORED)
+        {
+            /* * * * Old Duplication info found, remove it from Linked list * * * */
+            removed_duplication_info_ptr = sn_linked_list_remove_current_node(global_linked_list_duplication_msgs_ptr);
+
+            /* Free memory of stored Duplication info */
+            sn_coap_protocol_free(removed_duplication_info_ptr->addr_ptr);
+            sn_coap_protocol_free(removed_duplication_info_ptr);
+
+            removed_duplication_info_ptr = sn_linked_list_get_current_node(global_linked_list_duplication_msgs_ptr);
+        }
+        else
+        {
+            /* Get next stored message to be searched */
+            removed_duplication_info_ptr = sn_linked_list_get_next_node(global_linked_list_duplication_msgs_ptr);
+        }
+    }
+}
+
+#endif /* SN_COAP_DUPLICATION_MAX_MSGS_COUNT */
+
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_blockwise_msg_remove_current()
+ *
+ * \brief Removes current stored blockwise message from Linked list
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_blockwise_msg_remove_current()
+{
+    coap_blockwise_msg_s *removed_msg_ptr = sn_linked_list_remove_current_node(global_linked_list_blockwise_sent_msgs_ptr);
+
+    if (removed_msg_ptr != NULL)
+    {
+        if(removed_msg_ptr->coap_msg_ptr->payload_ptr)
+        	sn_coap_protocol_free(removed_msg_ptr->coap_msg_ptr->payload_ptr);
+
+        sn_coap_parser_release_allocated_coap_msg_mem(removed_msg_ptr->coap_msg_ptr);
+
+        sn_coap_protocol_free(removed_msg_ptr);
+    }
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_blockwise_payload_store(sn_nsdl_addr_s *addr_ptr, uint16_t stored_payload_len, uint8_t *stored_payload_ptr)
+ *
+ * \brief Stores blockwise payload to Linked list
+ *
+ * \param *addr_ptr is pointer to Address information to be stored
+ * \param stored_payload_len is length of stored Payload
+ * \param *stored_payload_ptr is pointer to stored Payload
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_blockwise_payload_store(sn_nsdl_addr_s *addr_ptr,//TODO: addr + header parametreiksi, blokin offset talteen.
+                                                                 uint16_t stored_payload_len,
+                                                                 uint8_t *stored_payload_ptr)
+{
+	if(!addr_ptr || !stored_payload_len || !stored_payload_ptr)
+		return;
+
+    coap_blockwise_payload_s *stored_blockwise_payload_ptr = NULL;
+
+    /* * * * Allocating memory for stored Payload  * * * */
+
+    /* Allocate memory for stored Payload's structure */
+    stored_blockwise_payload_ptr = sn_coap_protocol_malloc(sizeof(coap_blockwise_payload_s));
+
+    if (stored_blockwise_payload_ptr == NULL)
+    {
+        return;
+    }
+
+    /* Allocate memory for stored Payload's data */
+    stored_blockwise_payload_ptr->payload_ptr = sn_coap_protocol_malloc(stored_payload_len);
+
+    if (stored_blockwise_payload_ptr->payload_ptr == NULL)
+    {
+        sn_coap_protocol_free(stored_blockwise_payload_ptr);
+
+        return;
+    }
+
+    /* Allocate memory for stored Payload's address */
+    stored_blockwise_payload_ptr->addr_ptr = sn_coap_protocol_malloc(addr_ptr->addr_len);
+
+    if (stored_blockwise_payload_ptr->addr_ptr == NULL)
+    {
+        sn_coap_protocol_free(stored_blockwise_payload_ptr);
+        sn_coap_protocol_free(stored_blockwise_payload_ptr->payload_ptr);
+
+        return;
+    }
+
+    /* * * * Filling fields of stored Payload  * * * */
+
+    stored_blockwise_payload_ptr->timestamp = global_system_time;
+
+    memcpy(stored_blockwise_payload_ptr->addr_ptr, addr_ptr->addr_ptr, addr_ptr->addr_len);
+    stored_blockwise_payload_ptr->port = addr_ptr->port;
+    memcpy(stored_blockwise_payload_ptr->payload_ptr, stored_payload_ptr, stored_payload_len);
+    stored_blockwise_payload_ptr->payload_len = stored_payload_len;
+
+    /* * * * Storing Payload to Linked list  * * * */
+
+    sn_linked_list_add_node(global_linked_list_blockwise_received_payloads_ptr, stored_blockwise_payload_ptr);//TODO: hukkAS
+}
+
+/**************************************************************************//**
+ * \fn static uint8_t *sn_coap_protocol_linked_list_blockwise_payload_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t *payload_length)
+ *
+ * \brief Searches stored blockwise payload from Linked list (Address as key)
+ *
+ * \param *addr_ptr is pointer to Address key to be searched
+ * \param *payload_length is pointer to returned Payload length
+ *
+ * \return Return value is pointer to found stored blockwise payload in Linked
+ *         list or NULL if payload not found
+ *****************************************************************************/
+
+static uint8_t *sn_coap_protocol_linked_list_blockwise_payload_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t *payload_length)
+{
+    coap_blockwise_payload_s *stored_payload_info_ptr       = sn_linked_list_get_last_node(global_linked_list_blockwise_received_payloads_ptr);
+    uint16_t                  stored_blockwise_payloads_count = sn_linked_list_count_nodes(global_linked_list_blockwise_received_payloads_ptr);
+    uint8_t                   i                               = 0;
+
+    /* Loop all stored blockwise payloads in Linked list */
+    for (i = 0; i < stored_blockwise_payloads_count; i++)
+    {
+        int8_t mem_cmp_result = memcmp(src_addr_ptr->addr_ptr, stored_payload_info_ptr->addr_ptr, src_addr_ptr->addr_len);
+
+        /* If payload's Source address is same than is searched */
+        if (mem_cmp_result == 0)
+        {
+            /* If payload's Source address port is same than is searched */
+            if (stored_payload_info_ptr->port == src_addr_ptr->port)
+            {
+                /* * * Correct Payload found * * * */
+                *payload_length = stored_payload_info_ptr->payload_len;
+
+                return stored_payload_info_ptr->payload_ptr;
+            }
+        }
+
+        /* Get next stored payload to be searched */
+        stored_payload_info_ptr = sn_linked_list_get_previous_node(global_linked_list_blockwise_received_payloads_ptr);
+    }
+
+    return NULL;
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_blockwise_payload_remove_oldest()
+ *
+ * \brief Removes current stored blockwise paylod from Linked list
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_blockwise_payload_remove_oldest()
+{
+    coap_blockwise_payload_s *removed_payload_ptr = NULL;
+
+    /* Set Linked list to point oldest node */
+    sn_linked_list_get_last_node(global_linked_list_blockwise_received_payloads_ptr);
+
+    /* Remove oldest node in Linked list*/
+    removed_payload_ptr = sn_linked_list_remove_current_node(global_linked_list_blockwise_received_payloads_ptr);
+
+    /* Free memory of stored payload */
+    if (removed_payload_ptr != NULL)
+    {
+        if (removed_payload_ptr->addr_ptr != NULL)
+        {
+            sn_coap_protocol_free(removed_payload_ptr->addr_ptr);
+        }
+
+        if (removed_payload_ptr->payload_ptr != NULL)
+        {
+            sn_coap_protocol_free(removed_payload_ptr->payload_ptr);
+        }
+
+        sn_coap_protocol_free(removed_payload_ptr);
+    }
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_blockwise_payload_remove_current()
+ *
+ * \brief Removes current stored blockwise paylod from Linked list
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_blockwise_payload_remove_current()
+{
+    coap_blockwise_payload_s *removed_payload_ptr = NULL;
+
+    /* Remove oldest node in Linked list*/
+    removed_payload_ptr = sn_linked_list_remove_current_node(global_linked_list_blockwise_received_payloads_ptr);
+
+    /* Free memory of stored payload */
+    if (removed_payload_ptr != NULL)
+    {
+        if (removed_payload_ptr->addr_ptr != NULL)
+        {
+            sn_coap_protocol_free(removed_payload_ptr->addr_ptr);
+        }
+
+        if (removed_payload_ptr->payload_ptr != NULL)
+        {
+            sn_coap_protocol_free(removed_payload_ptr->payload_ptr);
+        }
+
+        sn_coap_protocol_free(removed_payload_ptr);
+    }
+}
+
+/**************************************************************************//**
+ * \fn static uint16_t sn_coap_protocol_linked_list_blockwise_payloads_get_len(sn_nsdl_addr_s *src_addr_ptr)
+ *
+ * \brief Counts length of Payloads in Linked list (Address as key)
+ *
+ * \param *addr_ptr is pointer to Address key
+ *
+ * \return Return value is length of Payloads as bytes
+ *****************************************************************************/
+
+static uint16_t sn_coap_protocol_linked_list_blockwise_payloads_get_len(sn_nsdl_addr_s *src_addr_ptr)
+{
+    coap_blockwise_payload_s *searched_payload_info_ptr       = sn_linked_list_get_last_node(global_linked_list_blockwise_received_payloads_ptr);
+    uint16_t                  stored_blockwise_payloads_count = sn_linked_list_count_nodes(global_linked_list_blockwise_received_payloads_ptr);
+    uint8_t                   i                               = 0;
+    uint16_t                  ret_whole_payload_len           = 0;
+
+    /* Loop all stored blockwise payloads in Linked list */
+    for (i = 0; i < stored_blockwise_payloads_count; i++)
+    {
+        int8_t mem_cmp_result = memcmp(src_addr_ptr->addr_ptr, searched_payload_info_ptr->addr_ptr, src_addr_ptr->addr_len);
+
+        /* If payload's Source address is same than is searched */
+        if (mem_cmp_result == 0)
+        {
+            /* If payload's Source address port is same than is searched */
+            if (searched_payload_info_ptr->port == src_addr_ptr->port)
+            {
+                /* * * Correct Payload found * * * */
+                ret_whole_payload_len += searched_payload_info_ptr->payload_len;
+            }
+        }
+
+        /* Get next stored payload to be searched */
+        searched_payload_info_ptr = sn_linked_list_get_previous_node(global_linked_list_blockwise_received_payloads_ptr);
+    }
+
+    return ret_whole_payload_len;
+}
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_linked_list_blockwise_remove_old_data(void)
+ *
+ * \brief Removes old stored Blockwise messages and payloads from Linked list
+ *****************************************************************************/
+
+static void sn_coap_protocol_linked_list_blockwise_remove_old_data(void)
+{
+    coap_blockwise_msg_s     *removed_blocwise_msg_ptr        = sn_linked_list_get_first_node(global_linked_list_blockwise_sent_msgs_ptr);
+    coap_blockwise_payload_s *removed_blocwise_payload_ptr    = sn_linked_list_get_first_node(global_linked_list_blockwise_received_payloads_ptr);
+
+    /* Loop all stored Blockwise messages in Linked list */
+    while(removed_blocwise_msg_ptr)
+    {
+        if ((global_system_time - removed_blocwise_msg_ptr->timestamp)  > SN_COAP_BLOCKWISE_MAX_TIME_DATA_STORED)
+        {
+            /* * * * Old Blockise message found, remove it from Linked list * * * */
+            sn_coap_protocol_linked_list_blockwise_msg_remove_current();
+            removed_blocwise_msg_ptr = sn_linked_list_get_current_node(global_linked_list_blockwise_sent_msgs_ptr);
+        }
+        else
+        {
+            /* Get next stored message to be searched */
+            removed_blocwise_msg_ptr = sn_linked_list_get_next_node(global_linked_list_blockwise_sent_msgs_ptr);
+        }
+    }
+
+    /* Loop all stored Blockwise payloads in Linked list */
+    while(removed_blocwise_payload_ptr)
+    {
+        if ((global_system_time - removed_blocwise_payload_ptr->timestamp)  > SN_COAP_BLOCKWISE_MAX_TIME_DATA_STORED)
+        {
+            /* * * * Old Blockise payload found, remove it from Linked list * * * */
+            sn_coap_protocol_linked_list_blockwise_payload_remove_current();
+            removed_blocwise_payload_ptr = sn_linked_list_get_current_node(global_linked_list_blockwise_received_payloads_ptr);
+
+        }
+        else
+        {
+        	/* Get next stored payload to be searched */
+        	removed_blocwise_payload_ptr = sn_linked_list_get_next_node(global_linked_list_blockwise_received_payloads_ptr);
+        }
+    }
+}
+
+#endif /* SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE */
+
+#if ENABLE_RESENDINGS
+/**************************************************************************//**
+ * \fn sn_nsdl_transmit_s *sn_coap_protocol_build_msg(void *src_msg_ptr)
+ *
+ * \brief Builds message (sn_nsdl_transmit_s) from given data
+ *
+ * \param *src_msg_ptr is pointer to source of built message
+ *
+ * \return Return value is pointer to built message
+ *****************************************************************************/
+
+sn_nsdl_transmit_s *sn_coap_protocol_build_msg(void *src_msg_ptr)
+{
+    /* Allocate memory for structures behind sending messages list pointers */
+
+    sn_nsdl_transmit_s *returned_msg_ptr = sn_coap_protocol_malloc(sizeof(sn_nsdl_transmit_s));
+
+    if (returned_msg_ptr == NULL)
+        return NULL;
+
+    returned_msg_ptr->dst_addr_ptr = sn_coap_protocol_malloc(sizeof(sn_nsdl_addr_s));
+
+    if (returned_msg_ptr->dst_addr_ptr == NULL)
+    {
+        sn_coap_builder_release_allocated_send_msg_mem(returned_msg_ptr);
+        return NULL;
+    }
+
+    returned_msg_ptr->packet_ptr = sn_coap_protocol_malloc(((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->packet_len);
+
+    if (returned_msg_ptr->packet_ptr == NULL)
+    {
+        sn_coap_builder_release_allocated_send_msg_mem(returned_msg_ptr);
+        return NULL;
+    }
+
+    returned_msg_ptr->dst_addr_ptr->addr_ptr = sn_coap_protocol_malloc(((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->dst_addr_ptr->addr_len);
+
+    if (returned_msg_ptr->dst_addr_ptr->addr_ptr == NULL)
+    {
+        sn_coap_builder_release_allocated_send_msg_mem(returned_msg_ptr);
+        return NULL;
+    }
+
+    /* Filling of sn_nsdl_transmit_s */
+    returned_msg_ptr->protocol = ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->protocol;
+    returned_msg_ptr->packet_len = ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->packet_len;
+    memcpy(returned_msg_ptr->packet_ptr, ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->packet_ptr, ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->packet_len);
+
+    /* Filling of sn_nsdl_addr_s */
+    returned_msg_ptr->dst_addr_ptr->type = ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->dst_addr_ptr->type;
+    returned_msg_ptr->dst_addr_ptr->addr_len = ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->dst_addr_ptr->addr_len;
+    memcpy(returned_msg_ptr->dst_addr_ptr->addr_ptr, ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->dst_addr_ptr->addr_ptr, ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->dst_addr_ptr->addr_len);
+    returned_msg_ptr->dst_addr_ptr->port = ((coap_send_msg_s*)src_msg_ptr)->send_msg_ptr->dst_addr_ptr->port;
+
+    return returned_msg_ptr;
+}
+#endif /* ENABLE_RESENDINGS */
+
+
+#if ENABLE_RESENDINGS  /* If Message resending is not used at all, this part of code will not be compiled */
+/***************************************************************************//**
+ * \fn int8_t sn_coap_protocol_allocate_mem_for_msg(sn_nsdl_addr_s *dst_addr_ptr, uint16_t packet_data_len, coap_send_msg_s *msg_ptr)
+ *
+ * \brief Allocates memory for given message (send or blockwise message)
+ *
+ * \param *dst_addr_ptr is pointer to destination address where message will be sent
+ * \param packet_data_len is length of allocated Packet data
+ *
+ * \return pointer to allocated struct
+ *****************************************************************************/
+
+coap_send_msg_s *sn_coap_protocol_allocate_mem_for_msg(sn_nsdl_addr_s *dst_addr_ptr, uint16_t packet_data_len)
+{
+
+	coap_send_msg_s *msg_ptr = sn_coap_protocol_malloc(sizeof(coap_send_msg_s));
+
+    if (msg_ptr == NULL)
+        return 0;
+
+    memset(msg_ptr, 0, sizeof(coap_send_msg_s));
+
+    msg_ptr->send_msg_ptr = sn_coap_protocol_malloc(sizeof(sn_nsdl_transmit_s));
+
+    if (msg_ptr->send_msg_ptr == NULL)
+    {
+        sn_coap_protocol_release_allocated_send_msg_mem(msg_ptr);
+        return 0;
+    }
+
+    memset(msg_ptr->send_msg_ptr, 0 ,sizeof(sn_nsdl_transmit_s));
+
+    msg_ptr->send_msg_ptr->dst_addr_ptr = sn_coap_protocol_malloc(sizeof(sn_nsdl_addr_s));
+
+    if (msg_ptr->send_msg_ptr->dst_addr_ptr == NULL)
+    {
+        sn_coap_protocol_release_allocated_send_msg_mem(msg_ptr);
+        return 0;
+    }
+
+    memset(msg_ptr->send_msg_ptr->dst_addr_ptr, 0, sizeof(sn_nsdl_addr_s));
+
+    msg_ptr->send_msg_ptr->packet_ptr = sn_coap_protocol_malloc(packet_data_len);
+
+    if (msg_ptr->send_msg_ptr->packet_ptr == NULL)
+    {
+        sn_coap_protocol_release_allocated_send_msg_mem(msg_ptr);
+        return 0;
+    }
+
+    msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr = sn_coap_protocol_malloc(dst_addr_ptr->addr_len);
+
+    if (msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr == NULL)
+    {
+        sn_coap_protocol_release_allocated_send_msg_mem(msg_ptr);
+        return 0;
+    }
+
+    memset(msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, 0, dst_addr_ptr->addr_len);
+
+    return msg_ptr;
+}
+
+
+/**************************************************************************//**
+ * \fn static void sn_coap_protocol_release_allocated_send_msg_mem(coap_send_msg_s *freed_send_msg_ptr)
+ *
+ * \brief Releases memory of given Sending message (coap_send_msg_s)
+ *
+ * \param *freed_send_msg_ptr is pointer to released Sending message
+ *****************************************************************************/
+
+static void sn_coap_protocol_release_allocated_send_msg_mem(coap_send_msg_s *freed_send_msg_ptr)
+{
+    if (freed_send_msg_ptr != NULL)
+    {
+        sn_coap_builder_release_allocated_send_msg_mem(freed_send_msg_ptr->send_msg_ptr);
+        sn_coap_protocol_free(freed_send_msg_ptr);
+    }
+}
+
+/**************************************************************************//**
+ * \fn static uint16_t sn_coap_count_linked_list_size(sn_linked_list_t *linked_list_ptr)
+ *
+ * \brief Counts total message size of all messages in linked list
+ *
+ * \param sn_linked_list_t *linked_list_ptr pointer to linked list
+ *****************************************************************************/
+static uint16_t sn_coap_count_linked_list_size(sn_linked_list_t *linked_list_ptr)
+{
+	uint16_t total_size = 0;
+	uint16_t message_count = sn_linked_list_count_nodes(linked_list_ptr);
+	coap_send_msg_s *stored_msg_ptr = sn_linked_list_get_first_node(linked_list_ptr);
+
+	while(message_count--)
+	{
+		if(stored_msg_ptr)
+		{
+			if(stored_msg_ptr->send_msg_ptr)
+				total_size += stored_msg_ptr->send_msg_ptr->packet_len;
+		}
+		stored_msg_ptr = sn_linked_list_get_next_node(linked_list_ptr);
+	}
+
+	return total_size;
+}
+
+#endif
+#if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */
+
+/**************************************************************************//**
+ * \fn static int8_t sn_coap_handle_blockwise_message(void)
+ *
+ * \brief Handles all received blockwise messages
+ *
+ * \param *src_addr_ptr pointer to source address information struct
+ * \param *received_coap_msg_ptr pointer to parsed CoAP message structure
+ *****************************************************************************/
+
+static sn_coap_hdr_s *sn_coap_handle_blockwise_message(sn_nsdl_addr_s *src_addr_ptr, sn_coap_hdr_s *received_coap_msg_ptr)
+{
+    sn_coap_hdr_s *src_coap_blockwise_ack_msg_ptr = NULL;
+    uint16_t dst_packed_data_needed_mem = 0;
+    uint8_t *dst_ack_packet_data_ptr = NULL;
+    uint8_t block_temp = 0;
+
+    uint16_t original_payload_len = 0;
+    uint8_t *original_payload_ptr = NULL;
+
+	/* Block1 Option in a request (e.g., PUT or POST) */
+	// Blocked request sending, received ACK, sending next block..
+	if(received_coap_msg_ptr->options_list_ptr->block1_ptr)
+    {
+		if(received_coap_msg_ptr->msg_code > COAP_MSG_CODE_REQUEST_DELETE)
+		{
+			if(*(received_coap_msg_ptr->options_list_ptr->block1_ptr + (received_coap_msg_ptr->options_list_ptr->block1_len - 1)) & 0x08)
+			{
+				coap_blockwise_msg_s *stored_blockwise_msg_temp_ptr = sn_linked_list_get_last_node(global_linked_list_blockwise_sent_msgs_ptr);
+
+				/* Get  */
+				while(stored_blockwise_msg_temp_ptr && (received_coap_msg_ptr->msg_id != stored_blockwise_msg_temp_ptr->coap_msg_ptr->msg_id))
+            	{
+            		stored_blockwise_msg_temp_ptr = sn_linked_list_get_previous_node(global_linked_list_blockwise_sent_msgs_ptr);
+            	}
+
+				if(stored_blockwise_msg_temp_ptr)
+				{
+					/* Build response message */
+
+					uint16_t block_size = 1;
+					uint32_t block_number = 0;
+
+					/* Get block option parameters from received message */
+					if(received_coap_msg_ptr->options_list_ptr->block1_len == 3)
+					{
+						block_number = *(received_coap_msg_ptr->options_list_ptr->block1_ptr) << 12;
+						block_number |= *(received_coap_msg_ptr->options_list_ptr->block1_ptr + 1) << 4;
+						block_number |= (*(received_coap_msg_ptr->options_list_ptr->block1_ptr + 2)) >> 4;
+					}
+
+					else if(received_coap_msg_ptr->options_list_ptr->block1_len == 2)
+					{
+						block_number = *(received_coap_msg_ptr->options_list_ptr->block1_ptr) << 4;
+						block_number |= (*(received_coap_msg_ptr->options_list_ptr->block1_ptr + 1)) >> 4;
+					}
+					else if(received_coap_msg_ptr->options_list_ptr->block1_len == 1)
+					{
+						block_number = (*received_coap_msg_ptr->options_list_ptr->block1_ptr) >> 4;
+					}
+
+
+					block_temp = *(received_coap_msg_ptr->options_list_ptr->block1_ptr + (received_coap_msg_ptr->options_list_ptr->block1_len - 1)) & 0x07;
+					block_size = block_size << (block_temp + 4);
+
+
+					/* Build next block message */
+					src_coap_blockwise_ack_msg_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr;
+
+					if(src_coap_blockwise_ack_msg_ptr->options_list_ptr)
+					{
+						if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr)
+						{
+							sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr);
+							src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = 0;
+
+						}
+						if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr)
+						{
+							sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr);
+							src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0;
+						}
+					}
+					else
+					{
+						src_coap_blockwise_ack_msg_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+						if(!src_coap_blockwise_ack_msg_ptr->options_list_ptr)
+						{
+							sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+							return 0;
+						}
+						memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, (sizeof(sn_coap_options_list_s)));
+					}
+
+					block_number++;
+
+					if(block_number <= 0x0f)
+						src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = 1;
+					else if(block_number <= 0x0fff)
+						src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = 2;
+					else if(block_number <= 0x0fffff)
+						src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = 3;
+
+					src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len);
+
+					if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr == 0)
+					{
+						sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+						return 0;
+					}
+
+					*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len - 1)) = block_temp;
+					*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number << 4;
+
+
+					if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len == 3)
+					{
+						*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + 2) = block_number << 4;
+						*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + 1) |= block_number >> 4;
+						*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number >> 12;
+					}
+					else if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len == 2)
+					{
+						*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + 1) |= block_number << 4;
+						*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number >> 4;
+					}
+					else
+						*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number << 4;
+
+					original_payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len;
+					original_payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr;
+
+					if((block_size * (block_number+1)) > stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len)
+					{
+						src_coap_blockwise_ack_msg_ptr->payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len - (block_size * (block_number));
+						src_coap_blockwise_ack_msg_ptr->payload_ptr = src_coap_blockwise_ack_msg_ptr->payload_ptr + (block_size * block_number);
+					}
+
+					/* Not last block */
+					else
+					{
+						/* set more - bit */
+						*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len-1)) |= 0x08;
+						src_coap_blockwise_ack_msg_ptr->payload_len = block_size;
+						src_coap_blockwise_ack_msg_ptr->payload_ptr = src_coap_blockwise_ack_msg_ptr->payload_ptr + (block_size * block_number);
+					}
+
+					/* Build and send block message */
+	                dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr);
+
+	                dst_ack_packet_data_ptr = sn_coap_protocol_malloc(dst_packed_data_needed_mem);
+	                if(!dst_ack_packet_data_ptr)
+	                {
+	                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr);
+	                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+	                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+	                	sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+	                    return NULL;
+	                }
+	                src_coap_blockwise_ack_msg_ptr->msg_id = global_message_id++;
+
+	                sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr);
+
+					sn_coap_tx_callback(SN_NSDL_PROTOCOL_COAP, dst_ack_packet_data_ptr, dst_packed_data_needed_mem, src_addr_ptr);
+
+					sn_coap_protocol_free(dst_ack_packet_data_ptr);
+
+					stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len = original_payload_len;
+					stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr = original_payload_ptr;
+
+					received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_ACK;
+				}
+			}
+			else
+			{
+				sn_coap_protocol_linked_list_blockwise_msg_remove_current();
+				received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_ACK;
+			}
+		}
+
+		// Blocked request receiving
+		else
+		{
+			if(received_coap_msg_ptr->payload_len > sn_coap_block_data_size)
+				received_coap_msg_ptr->payload_len = sn_coap_block_data_size;
+
+			sn_coap_protocol_linked_list_blockwise_payload_store(src_addr_ptr, received_coap_msg_ptr->payload_len, received_coap_msg_ptr->payload_ptr);
+			/* If not last block (more value is set) */
+            /* Block option length can be 1-3 bytes. First 4-20 bits are for block number. Last 4 bits are ALWAYS more bit + block size. */
+            if(*(received_coap_msg_ptr->options_list_ptr->block1_ptr + (received_coap_msg_ptr->options_list_ptr->block1_len - 1)) & 0x08)
+            {
+            	//send ack
+                src_coap_blockwise_ack_msg_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_hdr_s));
+
+                if (src_coap_blockwise_ack_msg_ptr == NULL)
+                {
+                	sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+                    return NULL;
+                }
+
+                memset(src_coap_blockwise_ack_msg_ptr, 0, sizeof(sn_coap_hdr_s));
+
+                src_coap_blockwise_ack_msg_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+
+                if (src_coap_blockwise_ack_msg_ptr->options_list_ptr == NULL)
+                {
+                    sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+                    sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+                    return NULL;
+                }
+
+                memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+
+               if(received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_GET)
+                	src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_CONTENT;
+               else if(received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_POST)
+                	src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_CREATED;
+               else if(received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_PUT)
+                	src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_CHANGED;
+               else if(received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_DELETE)
+                	src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_DELETED;
+
+                src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = received_coap_msg_ptr->options_list_ptr->block1_len;
+                src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len);
+                if(!src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr)
+                {
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+                    return NULL;
+                }
+
+                src_coap_blockwise_ack_msg_ptr->msg_type = COAP_MSG_TYPE_ACKNOWLEDGEMENT;
+
+                memcpy(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr, received_coap_msg_ptr->options_list_ptr->block1_ptr, received_coap_msg_ptr->options_list_ptr->block1_len);
+
+                /* Check block size */
+                block_temp = (*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len - 1)) & 0x07);
+                if(block_temp > sn_coap_convert_block_size(sn_coap_block_data_size))
+                {
+                	*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len - 1)) &= 0xF8;
+                	*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len - 1)) |= sn_coap_convert_block_size(sn_coap_block_data_size);
+                }
+
+                src_coap_blockwise_ack_msg_ptr->msg_id = received_coap_msg_ptr->msg_id;
+
+                dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr);
+
+                dst_ack_packet_data_ptr = sn_coap_protocol_malloc(dst_packed_data_needed_mem);
+                if(!dst_ack_packet_data_ptr)
+                {
+                	sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+                    return NULL;
+                }
+
+                sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr);
+
+                sn_coap_tx_callback(SN_NSDL_PROTOCOL_COAP, dst_ack_packet_data_ptr, dst_packed_data_needed_mem, src_addr_ptr);
+
+                sn_coap_parser_release_allocated_coap_msg_mem(src_coap_blockwise_ack_msg_ptr);
+                sn_coap_protocol_free(dst_ack_packet_data_ptr);
+
+                received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVING;
+
+            }
+            else
+            {
+                /* * * This is the last block when whole Blockwise payload from received * * */
+                /* * * blockwise messages is gathered and returned to User               * * */
+
+                /* Store last Blockwise payload to Linked list */
+                uint16_t payload_len            = 0;
+                uint8_t *payload_ptr            = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len);
+                uint16_t whole_payload_len      = sn_coap_protocol_linked_list_blockwise_payloads_get_len(src_addr_ptr);
+                uint8_t *temp_whole_payload_ptr = NULL;
+
+                temp_whole_payload_ptr = sn_coap_protocol_malloc(whole_payload_len);
+                if(!temp_whole_payload_ptr)
+                {
+                	sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+                	return 0;
+                }
+
+                received_coap_msg_ptr->payload_ptr = temp_whole_payload_ptr;
+                received_coap_msg_ptr->payload_len = whole_payload_len;
+
+                /* Copy stored Blockwise payloads to returned whole Blockwise payload pointer */
+                while (payload_ptr != NULL)
+                {
+                    memcpy(temp_whole_payload_ptr, payload_ptr, payload_len);
+
+                    temp_whole_payload_ptr += payload_len;
+
+                    sn_coap_protocol_linked_list_blockwise_payload_remove_oldest();
+                    payload_ptr = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len);
+                }
+            	received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVED;
+            }
+		}
+    }
+
+
+	/* Block2 Option in a response (e.g., a 2.05 response for GET) */
+	/* Message ID must be same than in received message */
+	else
+    {
+		//This is response to request we made
+		if(received_coap_msg_ptr->msg_code > COAP_MSG_CODE_REQUEST_DELETE)
+		{
+			uint32_t block_number = 0;
+			coap_blockwise_msg_s     *previous_blockwise_msg_ptr = 0;
+
+            /* Store blockwise payload to Linked list */
+			//todo: add block number to stored values - just to make sure all packets are in order
+            sn_coap_protocol_linked_list_blockwise_payload_store(src_addr_ptr, received_coap_msg_ptr->payload_len, received_coap_msg_ptr->payload_ptr);
+
+			/* If not last block (more value is set) */
+            if(*(received_coap_msg_ptr->options_list_ptr->block2_ptr + (received_coap_msg_ptr->options_list_ptr->block2_len - 1)) & 0x08)
+            {
+            	//build and send ack
+            	received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVING;
+
+            	previous_blockwise_msg_ptr = sn_linked_list_get_first_node(global_linked_list_blockwise_sent_msgs_ptr);
+
+            	while(previous_blockwise_msg_ptr && (received_coap_msg_ptr->msg_id != previous_blockwise_msg_ptr->coap_msg_ptr->msg_id))
+            	{
+            		previous_blockwise_msg_ptr = sn_linked_list_get_next_node(global_linked_list_blockwise_sent_msgs_ptr);
+            	}
+
+            	if(!previous_blockwise_msg_ptr || !previous_blockwise_msg_ptr->coap_msg_ptr)
+            	{
+            		sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+            		return 0;
+            	}
+
+            	src_coap_blockwise_ack_msg_ptr = previous_blockwise_msg_ptr->coap_msg_ptr;
+
+            	sn_linked_list_remove_current_node(global_linked_list_blockwise_sent_msgs_ptr);
+            	sn_coap_protocol_free(previous_blockwise_msg_ptr);
+
+            	if(src_coap_blockwise_ack_msg_ptr->payload_ptr)
+            	{
+            		src_coap_blockwise_ack_msg_ptr->payload_ptr = 0;
+            		src_coap_blockwise_ack_msg_ptr->payload_len = 0;
+            	}
+
+				/* * * Then build CoAP Acknowledgement message * * */
+            	if(!src_coap_blockwise_ack_msg_ptr->options_list_ptr)
+            	{
+            		src_coap_blockwise_ack_msg_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+            		if(!src_coap_blockwise_ack_msg_ptr->options_list_ptr)
+            		{
+            			sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+            			sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+            			return 0;
+            		}
+            		memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+            	}
+
+            	src_coap_blockwise_ack_msg_ptr->msg_id = global_message_id++;
+
+            	if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr)
+            		sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr);
+
+            	/* Update block option */
+            	block_temp = *(received_coap_msg_ptr->options_list_ptr->block2_ptr + ( received_coap_msg_ptr->options_list_ptr->block2_len - 1)) & 0x07;
+
+				if(received_coap_msg_ptr->options_list_ptr->block2_len == 3)
+				{
+					block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 12;
+					block_number |= *(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1) << 4;
+					block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 2)) >> 4;
+				}
+
+				else if(received_coap_msg_ptr->options_list_ptr->block2_len == 2)
+				{
+					block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 4;
+					block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1)) >> 4;
+				}
+				else if(received_coap_msg_ptr->options_list_ptr->block2_len == 1)
+				{
+					block_number = (*received_coap_msg_ptr->options_list_ptr->block2_ptr) >> 4;
+				}
+
+				block_number ++;
+
+				if(block_number <= 0x0f)
+					src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = 1;
+				else if(block_number <= 0x0fff)
+					src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = 2;
+				else if(block_number <= 0x0fffff)
+					src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = 3;
+
+				src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len);
+
+				if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr == 0)
+				{
+					sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+					sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+					sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+					return 0;
+				}
+
+				*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len - 1)) = block_temp;
+
+				if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len == 3)
+				{
+					*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + 2) = block_number << 4;
+					*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + 1) |= block_number >> 4;
+					*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr |= block_number >> 12;
+				}
+				else if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len == 2)
+				{
+					*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + 1) = block_number << 4;
+					*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr |= block_number >> 4;
+				}
+				else
+					*src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr |= block_number << 4;
+
+                /* Then get needed memory count for Packet data */
+                dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr);
+
+                /* Then allocate memory for Packet data */
+                dst_ack_packet_data_ptr = sn_coap_protocol_malloc(dst_packed_data_needed_mem);
+                memset(dst_ack_packet_data_ptr, 0, dst_packed_data_needed_mem);
+
+                if (dst_ack_packet_data_ptr == NULL)
+                {
+                    sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+                    sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+                    sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr);
+                    sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+                    return NULL;
+                }
+
+                /* * * Then build Acknowledgement message to Packed data * * */
+                if ((sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr)) < 0)
+                {
+                	sn_coap_protocol_free(dst_ack_packet_data_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+                	sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr);
+                	sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+                    return NULL;
+                }
+
+                /* * * Save to linked list * * */
+            	coap_blockwise_msg_s *stored_blockwise_msg_ptr;
+
+            	stored_blockwise_msg_ptr = sn_coap_protocol_malloc(sizeof(coap_blockwise_msg_s));
+            	if(!stored_blockwise_msg_ptr)
+            	{
+            		sn_coap_parser_release_allocated_coap_msg_mem(received_coap_msg_ptr);
+            		return 0;
+            	}
+            	memset(stored_blockwise_msg_ptr, 0, sizeof(coap_blockwise_msg_s));
+
+            	stored_blockwise_msg_ptr->timestamp = global_system_time;
+
+            	stored_blockwise_msg_ptr->coap_msg_ptr = src_coap_blockwise_ack_msg_ptr;
+
+            	sn_linked_list_add_node(global_linked_list_blockwise_sent_msgs_ptr, stored_blockwise_msg_ptr); // todo check return value
+
+
+                /* * * Then release memory of CoAP Acknowledgement message * * */
+				sn_coap_tx_callback(SN_NSDL_PROTOCOL_COAP, dst_ack_packet_data_ptr,
+									dst_packed_data_needed_mem, src_addr_ptr);
+
+#if ENABLE_RESENDINGS
+				sn_coap_protocol_linked_list_send_msg_store(src_addr_ptr,
+															dst_packed_data_needed_mem,
+															dst_ack_packet_data_ptr,
+															global_system_time + (uint32_t)(sn_coap_resending_intervall * RESPONSE_RANDOM_FACTOR));
+#endif
+				sn_coap_protocol_free(dst_ack_packet_data_ptr);
+            }
+
+            //Last block received
+            else
+            {
+                /* * * This is the last block when whole Blockwise payload from received * * */
+                /* * * blockwise messages is gathered and returned to User               * * */
+
+                /* Store last Blockwise payload to Linked list */
+                uint16_t payload_len            = 0;
+                uint8_t *payload_ptr            = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len);
+                uint16_t whole_payload_len      = sn_coap_protocol_linked_list_blockwise_payloads_get_len(src_addr_ptr);
+                uint8_t *temp_whole_payload_ptr = NULL;
+
+                temp_whole_payload_ptr = sn_coap_protocol_malloc(whole_payload_len);
+                if(!temp_whole_payload_ptr)
+                	return 0;
+
+                received_coap_msg_ptr->payload_ptr = temp_whole_payload_ptr;
+                received_coap_msg_ptr->payload_len = whole_payload_len;
+
+                /* Copy stored Blockwise payloads to returned whole Blockwise payload pointer */
+                while (payload_ptr != NULL)
+                {
+                    memcpy(temp_whole_payload_ptr, payload_ptr, payload_len);
+
+                    temp_whole_payload_ptr += payload_len;
+
+                    sn_coap_protocol_linked_list_blockwise_payload_remove_oldest();
+                    payload_ptr = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len);
+                }
+            	received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVED;
+
+            	//todo: remove previous msg from list
+            }
+
+		}
+
+		//Now we send data to request
+		else
+		{
+			//Get message by using block number
+			coap_blockwise_msg_s *stored_blockwise_msg_temp_ptr = sn_linked_list_get_last_node(global_linked_list_blockwise_sent_msgs_ptr);
+			if(stored_blockwise_msg_temp_ptr)
+			{
+				uint16_t block_size = 1;
+				uint32_t block_number = 0;
+
+				/* Resolve block parameters */
+				if(received_coap_msg_ptr->options_list_ptr->block2_len == 3)
+				{
+					block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 12;
+					block_number |= *(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1) << 4;
+					block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 2)) >> 4;
+				}
+
+				else if(received_coap_msg_ptr->options_list_ptr->block2_len == 2)
+				{
+					block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 4;
+					block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1)) >> 4;
+				}
+				else if(received_coap_msg_ptr->options_list_ptr->block2_len == 1)
+				{
+					block_number = (*received_coap_msg_ptr->options_list_ptr->block2_ptr) >> 4;
+				}
+
+				block_temp = *(received_coap_msg_ptr->options_list_ptr->block2_ptr + (received_coap_msg_ptr->options_list_ptr->block2_len - 1)) & 0x07;
+				block_size = block_size << (block_temp + 4);
+
+				/* Build response message */
+				src_coap_blockwise_ack_msg_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr;
+
+				if(src_coap_blockwise_ack_msg_ptr->options_list_ptr)
+				{
+					if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr)
+					{
+						sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr);
+						src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = 0;
+
+					}
+					if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr)
+					{
+						sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr);
+						src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0;
+					}
+				}
+				else
+				{
+					src_coap_blockwise_ack_msg_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+					if(!src_coap_blockwise_ack_msg_ptr->options_list_ptr)
+					{
+						return 0;
+					}
+					memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, (sizeof(sn_coap_options_list_s)));
+				}
+
+
+				src_coap_blockwise_ack_msg_ptr->msg_id = received_coap_msg_ptr->msg_id;
+
+				src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = received_coap_msg_ptr->options_list_ptr->block2_len;
+				src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len);
+
+				if(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr == NULL)
+				{
+					sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr);
+					sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr);
+					return NULL;
+				}
+				memcpy(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr, received_coap_msg_ptr->options_list_ptr->block2_ptr, src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len);
+
+				/* * Payload part * */
+
+				/* Check if last block */
+
+				original_payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len;
+				original_payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr;
+
+				if((block_size * (block_number + 1)) > stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len)
+				{
+					src_coap_blockwise_ack_msg_ptr->payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len - (block_size * block_number);
+					src_coap_blockwise_ack_msg_ptr->payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr + (block_size * block_number);
+				}
+				/* Not last block */
+				else
+				{
+					/* set more - bit */
+					*(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len-1)) |= 0x08;
+					src_coap_blockwise_ack_msg_ptr->payload_len = block_size;
+					src_coap_blockwise_ack_msg_ptr->payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr + (block_size * block_number);
+				}
+
+				/* Build and send block message */
+                dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr);
+
+                dst_ack_packet_data_ptr = sn_coap_protocol_malloc(dst_packed_data_needed_mem);
+                if(!dst_ack_packet_data_ptr)
+                {
+                    return NULL;
+                }
+
+                sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr);
+
+				sn_coap_tx_callback(SN_NSDL_PROTOCOL_COAP, dst_ack_packet_data_ptr, dst_packed_data_needed_mem, src_addr_ptr);
+
+				sn_coap_protocol_free(dst_ack_packet_data_ptr);
+
+				stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len = original_payload_len;
+				stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr = original_payload_ptr;
+
+                if((block_size * (block_number + 1)) > stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len)
+                	sn_coap_protocol_linked_list_blockwise_msg_remove_current();
+
+				received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_ACK;
+			}
+		}
+    }
+	return received_coap_msg_ptr;
+}
+
+static int8_t sn_coap_convert_block_size(uint16_t block_size)
+{
+	if(block_size == 16)
+		return 0;
+	else if(block_size == 32)
+		return 1;
+	else if(block_size == 64)
+		return 2;
+	else if(block_size == 128)
+		return 3;
+	else if(block_size == 256)
+		return 4;
+	else if(block_size == 512)
+		return 5;
+	else if(block_size == 1024)
+		return 6;
+
+	return 0;
+}
+
+static sn_coap_hdr_s *sn_coap_protocol_copy_header(sn_coap_hdr_s *source_header_ptr)
+{
+	sn_coap_hdr_s *destination_header_ptr;
+
+	destination_header_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_hdr_s));
+	if(!destination_header_ptr)
+		return 0;
+	memset(destination_header_ptr, 0, sizeof(sn_coap_hdr_s));
+
+	destination_header_ptr->coap_status = source_header_ptr->coap_status;
+	destination_header_ptr->msg_type = source_header_ptr->msg_type;
+	destination_header_ptr->msg_code = source_header_ptr->msg_code;
+	destination_header_ptr->msg_id = source_header_ptr->msg_id;
+
+	if(source_header_ptr->uri_path_ptr)
+	{
+		destination_header_ptr->uri_path_len = source_header_ptr->uri_path_len;
+		destination_header_ptr->uri_path_ptr = sn_coap_protocol_malloc(source_header_ptr->uri_path_len);
+		if(!destination_header_ptr->uri_path_ptr)
+		{
+			sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+			return 0;
+		}
+		memcpy(destination_header_ptr->uri_path_ptr, source_header_ptr->uri_path_ptr, source_header_ptr->uri_path_len);
+	}
+
+	if(source_header_ptr->token_ptr)
+	{
+		destination_header_ptr->token_len = source_header_ptr->token_len;
+		destination_header_ptr->token_ptr = sn_coap_protocol_malloc(source_header_ptr->token_len);
+		if(!destination_header_ptr->token_ptr)
+		{
+			sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+			return 0;
+		}
+		memcpy(destination_header_ptr->token_ptr, source_header_ptr->token_ptr, source_header_ptr->token_len);
+	}
+
+	if(source_header_ptr->content_type_ptr)
+	{
+		destination_header_ptr->content_type_len = source_header_ptr->content_type_len;
+		destination_header_ptr->content_type_ptr = sn_coap_protocol_malloc(source_header_ptr->content_type_len);
+		if(!destination_header_ptr->content_type_ptr)
+		{
+			sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+			return 0;
+		}
+		memcpy(destination_header_ptr->content_type_ptr, source_header_ptr->content_type_ptr, source_header_ptr->content_type_len);
+	}
+
+	/* Options list */
+	if(source_header_ptr->options_list_ptr)
+	{
+		destination_header_ptr->options_list_ptr = sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s));
+		if(!destination_header_ptr->options_list_ptr)
+		{
+			sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+			return 0;
+		}
+		memset(destination_header_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+
+
+		if(source_header_ptr->options_list_ptr->max_age_ptr)
+		{
+			destination_header_ptr->options_list_ptr->max_age_len = source_header_ptr->options_list_ptr->max_age_len;
+			destination_header_ptr->options_list_ptr->max_age_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->max_age_len);
+			if(!destination_header_ptr->options_list_ptr->max_age_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->max_age_ptr, source_header_ptr->options_list_ptr->max_age_ptr, source_header_ptr->options_list_ptr->max_age_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->proxy_uri_ptr)
+		{
+			destination_header_ptr->options_list_ptr->proxy_uri_len = source_header_ptr->options_list_ptr->proxy_uri_len;
+			destination_header_ptr->options_list_ptr->proxy_uri_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->proxy_uri_len);
+			if(!destination_header_ptr->options_list_ptr->proxy_uri_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->proxy_uri_ptr, source_header_ptr->options_list_ptr->proxy_uri_ptr, source_header_ptr->options_list_ptr->proxy_uri_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->etag_ptr)
+		{
+			destination_header_ptr->options_list_ptr->etag_len = source_header_ptr->options_list_ptr->etag_len;
+			destination_header_ptr->options_list_ptr->etag_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->etag_len);
+			if(!destination_header_ptr->options_list_ptr->etag_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->etag_ptr, source_header_ptr->options_list_ptr->etag_ptr, source_header_ptr->options_list_ptr->etag_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->uri_host_ptr)
+		{
+			destination_header_ptr->options_list_ptr->uri_host_len = source_header_ptr->options_list_ptr->uri_host_len;
+			destination_header_ptr->options_list_ptr->uri_host_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->uri_host_len);
+			if(!destination_header_ptr->options_list_ptr->uri_host_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->uri_host_ptr, source_header_ptr->options_list_ptr->uri_host_ptr, source_header_ptr->options_list_ptr->uri_host_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->location_path_ptr)
+		{
+			destination_header_ptr->options_list_ptr->location_path_len = source_header_ptr->options_list_ptr->location_path_len;
+			destination_header_ptr->options_list_ptr->location_path_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->location_path_len);
+			if(!destination_header_ptr->options_list_ptr->location_path_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->location_path_ptr, source_header_ptr->options_list_ptr->location_path_ptr, source_header_ptr->options_list_ptr->location_path_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->uri_port_ptr)
+		{
+			destination_header_ptr->options_list_ptr->uri_port_len = source_header_ptr->options_list_ptr->uri_port_len;
+			destination_header_ptr->options_list_ptr->uri_port_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->uri_port_len);
+			if(!destination_header_ptr->options_list_ptr->uri_port_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->uri_port_ptr, source_header_ptr->options_list_ptr->uri_port_ptr, source_header_ptr->options_list_ptr->uri_port_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->location_query_ptr)
+		{
+			destination_header_ptr->options_list_ptr->location_query_len = source_header_ptr->options_list_ptr->location_query_len;
+			destination_header_ptr->options_list_ptr->location_query_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->location_query_len);
+			if(!destination_header_ptr->options_list_ptr->location_query_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->location_query_ptr, source_header_ptr->options_list_ptr->location_query_ptr, source_header_ptr->options_list_ptr->location_query_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->observe_ptr)
+		{
+			destination_header_ptr->options_list_ptr->observe_len = source_header_ptr->options_list_ptr->observe_len;
+			destination_header_ptr->options_list_ptr->observe_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->observe_len);
+			if(!destination_header_ptr->options_list_ptr->observe_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->observe_ptr, source_header_ptr->options_list_ptr->observe_ptr, source_header_ptr->options_list_ptr->observe_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->accept_ptr)
+		{
+			destination_header_ptr->options_list_ptr->accept_len = source_header_ptr->options_list_ptr->accept_len;
+			destination_header_ptr->options_list_ptr->accept_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->accept_len);
+			if(!destination_header_ptr->options_list_ptr->accept_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->accept_ptr, source_header_ptr->options_list_ptr->accept_ptr, source_header_ptr->options_list_ptr->accept_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->uri_query_ptr)
+		{
+			destination_header_ptr->options_list_ptr->uri_query_len = source_header_ptr->options_list_ptr->uri_query_len;
+			destination_header_ptr->options_list_ptr->uri_query_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->uri_query_len);
+			if(!destination_header_ptr->options_list_ptr->uri_query_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->uri_query_ptr, source_header_ptr->options_list_ptr->uri_query_ptr, source_header_ptr->options_list_ptr->uri_query_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->block1_ptr)
+		{
+			destination_header_ptr->options_list_ptr->block1_len = source_header_ptr->options_list_ptr->block1_len;
+			destination_header_ptr->options_list_ptr->block1_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->block1_len);
+			if(!destination_header_ptr->options_list_ptr->block1_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->block1_ptr, source_header_ptr->options_list_ptr->block1_ptr, source_header_ptr->options_list_ptr->block1_len);
+		}
+
+		if(source_header_ptr->options_list_ptr->block2_ptr)
+		{
+			destination_header_ptr->options_list_ptr->block2_len = source_header_ptr->options_list_ptr->block2_len;
+			destination_header_ptr->options_list_ptr->block2_ptr = sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->block2_len);
+			if(!destination_header_ptr->options_list_ptr->block2_ptr)
+			{
+				sn_coap_parser_release_allocated_coap_msg_mem(destination_header_ptr);
+				return 0;
+			}
+			memcpy(destination_header_ptr->options_list_ptr->block2_ptr, source_header_ptr->options_list_ptr->block2_ptr, source_header_ptr->options_list_ptr->block2_len);
+		}
+	}
+
+	return destination_header_ptr;
+}
+#endif
+