mbed client lightswitch demo
Dependencies: mbed Socket lwip-eth lwip-sys lwip
Fork of mbed-client-classic-example-lwip by
mbed-client-c/source/libCoap/src/sn_coap_protocol.c@11:cada08fc8a70, 2016-06-09 (annotated)
- Committer:
- mbedAustin
- Date:
- Thu Jun 09 17:08:36 2016 +0000
- Revision:
- 11:cada08fc8a70
Commit for public Consumption
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mbedAustin | 11:cada08fc8a70 | 1 | /* |
mbedAustin | 11:cada08fc8a70 | 2 | * Copyright (c) 2011-2015 ARM Limited. All rights reserved. |
mbedAustin | 11:cada08fc8a70 | 3 | * SPDX-License-Identifier: Apache-2.0 |
mbedAustin | 11:cada08fc8a70 | 4 | * Licensed under the Apache License, Version 2.0 (the License); you may |
mbedAustin | 11:cada08fc8a70 | 5 | * not use this file except in compliance with the License. |
mbedAustin | 11:cada08fc8a70 | 6 | * You may obtain a copy of the License at |
mbedAustin | 11:cada08fc8a70 | 7 | * |
mbedAustin | 11:cada08fc8a70 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
mbedAustin | 11:cada08fc8a70 | 9 | * |
mbedAustin | 11:cada08fc8a70 | 10 | * Unless required by applicable law or agreed to in writing, software |
mbedAustin | 11:cada08fc8a70 | 11 | * distributed under the License is distributed on an AS IS BASIS, WITHOUT |
mbedAustin | 11:cada08fc8a70 | 12 | * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
mbedAustin | 11:cada08fc8a70 | 13 | * See the License for the specific language governing permissions and |
mbedAustin | 11:cada08fc8a70 | 14 | * limitations under the License. |
mbedAustin | 11:cada08fc8a70 | 15 | */ |
mbedAustin | 11:cada08fc8a70 | 16 | |
mbedAustin | 11:cada08fc8a70 | 17 | /** |
mbedAustin | 11:cada08fc8a70 | 18 | * \file sn_coap_protocol.c |
mbedAustin | 11:cada08fc8a70 | 19 | * |
mbedAustin | 11:cada08fc8a70 | 20 | * \brief CoAP Protocol implementation |
mbedAustin | 11:cada08fc8a70 | 21 | * |
mbedAustin | 11:cada08fc8a70 | 22 | * Functionality: CoAP Protocol |
mbedAustin | 11:cada08fc8a70 | 23 | * |
mbedAustin | 11:cada08fc8a70 | 24 | */ |
mbedAustin | 11:cada08fc8a70 | 25 | |
mbedAustin | 11:cada08fc8a70 | 26 | |
mbedAustin | 11:cada08fc8a70 | 27 | /* * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 28 | /* * * * INCLUDE FILES * * * */ |
mbedAustin | 11:cada08fc8a70 | 29 | /* * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 30 | |
mbedAustin | 11:cada08fc8a70 | 31 | #include <stdio.h> |
mbedAustin | 11:cada08fc8a70 | 32 | #include <stdlib.h> /* For libary malloc() */ |
mbedAustin | 11:cada08fc8a70 | 33 | #include <string.h> /* For memset() and memcpy() */ |
mbedAustin | 11:cada08fc8a70 | 34 | #ifdef __linux__ |
mbedAustin | 11:cada08fc8a70 | 35 | #include <time.h> |
mbedAustin | 11:cada08fc8a70 | 36 | #endif |
mbedAustin | 11:cada08fc8a70 | 37 | |
mbedAustin | 11:cada08fc8a70 | 38 | #include "ns_types.h" |
mbedAustin | 11:cada08fc8a70 | 39 | #include "sn_nsdl.h" |
mbedAustin | 11:cada08fc8a70 | 40 | #include "sn_coap_protocol.h" |
mbedAustin | 11:cada08fc8a70 | 41 | #include "sn_coap_header_internal.h" |
mbedAustin | 11:cada08fc8a70 | 42 | #include "sn_coap_protocol_internal.h" |
mbedAustin | 11:cada08fc8a70 | 43 | |
mbedAustin | 11:cada08fc8a70 | 44 | /* * * * * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 45 | /* * * * LOCAL FUNCTION PROTOTYPES * * * */ |
mbedAustin | 11:cada08fc8a70 | 46 | /* * * * * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 47 | |
mbedAustin | 11:cada08fc8a70 | 48 | static void sn_coap_protocol_send_rst(struct coap_s *handle, uint16_t msg_id, sn_nsdl_addr_s *addr_ptr, void *param); |
mbedAustin | 11:cada08fc8a70 | 49 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 50 | static void sn_coap_protocol_linked_list_duplication_info_store(struct coap_s *handle, sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id); |
mbedAustin | 11:cada08fc8a70 | 51 | static int8_t sn_coap_protocol_linked_list_duplication_info_search(sn_nsdl_addr_s *scr_addr_ptr, uint16_t msg_id); |
mbedAustin | 11:cada08fc8a70 | 52 | static void sn_coap_protocol_linked_list_duplication_info_remove(struct coap_s *handle, uint8_t *scr_addr_ptr, uint16_t port, uint16_t msg_id); |
mbedAustin | 11:cada08fc8a70 | 53 | static void sn_coap_protocol_linked_list_duplication_info_remove_old_ones(struct coap_s *handle); |
mbedAustin | 11:cada08fc8a70 | 54 | #endif |
mbedAustin | 11:cada08fc8a70 | 55 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 56 | static void sn_coap_protocol_linked_list_blockwise_msg_remove(struct coap_s *handle, coap_blockwise_msg_s *removed_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 57 | static void sn_coap_protocol_linked_list_blockwise_payload_store(struct coap_s *handle, sn_nsdl_addr_s *addr_ptr, uint16_t stored_payload_len, uint8_t *stored_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 58 | static uint8_t *sn_coap_protocol_linked_list_blockwise_payload_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t *payload_length); |
mbedAustin | 11:cada08fc8a70 | 59 | static void sn_coap_protocol_linked_list_blockwise_payload_remove(struct coap_s *handle, coap_blockwise_payload_s *removed_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 60 | static void sn_coap_protocol_linked_list_blockwise_payload_remove_oldest(struct coap_s *handle); |
mbedAustin | 11:cada08fc8a70 | 61 | static uint16_t sn_coap_protocol_linked_list_blockwise_payloads_get_len(sn_nsdl_addr_s *src_addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 62 | static void sn_coap_protocol_linked_list_blockwise_remove_old_data(struct coap_s *handle); |
mbedAustin | 11:cada08fc8a70 | 63 | static sn_coap_hdr_s *sn_coap_handle_blockwise_message(struct coap_s *handle, sn_nsdl_addr_s *src_addr_ptr, sn_coap_hdr_s *received_coap_msg_ptr, void *param); |
mbedAustin | 11:cada08fc8a70 | 64 | static int8_t sn_coap_convert_block_size(uint16_t block_size); |
mbedAustin | 11:cada08fc8a70 | 65 | static sn_coap_hdr_s *sn_coap_protocol_copy_header(struct coap_s *handle, sn_coap_hdr_s *source_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 66 | #endif |
mbedAustin | 11:cada08fc8a70 | 67 | #if ENABLE_RESENDINGS |
mbedAustin | 11:cada08fc8a70 | 68 | static void sn_coap_protocol_linked_list_send_msg_store(struct coap_s *handle, sn_nsdl_addr_s *dst_addr_ptr, uint16_t send_packet_data_len, uint8_t *send_packet_data_ptr, uint32_t sending_time, void *param); |
mbedAustin | 11:cada08fc8a70 | 69 | static sn_nsdl_transmit_s *sn_coap_protocol_linked_list_send_msg_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id); |
mbedAustin | 11:cada08fc8a70 | 70 | static void sn_coap_protocol_linked_list_send_msg_remove(struct coap_s *handle, sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id); |
mbedAustin | 11:cada08fc8a70 | 71 | static coap_send_msg_s *sn_coap_protocol_allocate_mem_for_msg(struct coap_s *handle, sn_nsdl_addr_s *dst_addr_ptr, uint16_t packet_data_len); |
mbedAustin | 11:cada08fc8a70 | 72 | static void sn_coap_protocol_release_allocated_send_msg_mem(struct coap_s *handle, coap_send_msg_s *freed_send_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 73 | static uint16_t sn_coap_count_linked_list_size(const coap_send_msg_list_t *linked_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 74 | #endif |
mbedAustin | 11:cada08fc8a70 | 75 | |
mbedAustin | 11:cada08fc8a70 | 76 | /* * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 77 | /* * * * GLOBAL DECLARATIONS * * * */ |
mbedAustin | 11:cada08fc8a70 | 78 | /* * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 79 | static uint16_t message_id; |
mbedAustin | 11:cada08fc8a70 | 80 | |
mbedAustin | 11:cada08fc8a70 | 81 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 82 | static coap_send_msg_list_t NS_LIST_NAME_INIT(global_linked_list_resent_msgs); /* Active resending messages are stored to this Linked list */ |
mbedAustin | 11:cada08fc8a70 | 83 | static uint16_t global_count_resent_msgs = 0; |
mbedAustin | 11:cada08fc8a70 | 84 | #endif |
mbedAustin | 11:cada08fc8a70 | 85 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 86 | static coap_duplication_info_list_t NS_LIST_NAME_INIT(global_linked_list_duplication_msgs); /* Messages for duplicated messages detection is stored to this Linked list */ |
mbedAustin | 11:cada08fc8a70 | 87 | static uint16_t global_count_duplication_msgs = 0; |
mbedAustin | 11:cada08fc8a70 | 88 | |
mbedAustin | 11:cada08fc8a70 | 89 | #endif |
mbedAustin | 11:cada08fc8a70 | 90 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwise is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 91 | static coap_blockwise_msg_list_t NS_LIST_NAME_INIT(global_linked_list_blockwise_sent_msgs); /* Blockwise message to to be sent is stored to this Linked list */ |
mbedAustin | 11:cada08fc8a70 | 92 | static coap_blockwise_payload_list_t NS_LIST_NAME_INIT(global_linked_list_blockwise_received_payloads); /* Blockwise payload to to be received is stored to this Linked list */ |
mbedAustin | 11:cada08fc8a70 | 93 | #endif |
mbedAustin | 11:cada08fc8a70 | 94 | |
mbedAustin | 11:cada08fc8a70 | 95 | static uint32_t global_system_time = 0; /* System time seconds */ |
mbedAustin | 11:cada08fc8a70 | 96 | |
mbedAustin | 11:cada08fc8a70 | 97 | uint16_t sn_coap_block_data_size = 0; |
mbedAustin | 11:cada08fc8a70 | 98 | |
mbedAustin | 11:cada08fc8a70 | 99 | uint8_t sn_coap_resending_queue_msgs = 0; |
mbedAustin | 11:cada08fc8a70 | 100 | uint8_t sn_coap_resending_queue_bytes = 0; |
mbedAustin | 11:cada08fc8a70 | 101 | uint8_t sn_coap_resending_count = 0; |
mbedAustin | 11:cada08fc8a70 | 102 | uint8_t sn_coap_resending_intervall = 0; |
mbedAustin | 11:cada08fc8a70 | 103 | |
mbedAustin | 11:cada08fc8a70 | 104 | uint8_t sn_coap_duplication_buffer_size = 0; |
mbedAustin | 11:cada08fc8a70 | 105 | |
mbedAustin | 11:cada08fc8a70 | 106 | |
mbedAustin | 11:cada08fc8a70 | 107 | int8_t sn_coap_protocol_destroy(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 108 | { |
mbedAustin | 11:cada08fc8a70 | 109 | if (handle == NULL) { |
mbedAustin | 11:cada08fc8a70 | 110 | return -1; |
mbedAustin | 11:cada08fc8a70 | 111 | } |
mbedAustin | 11:cada08fc8a70 | 112 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 113 | |
mbedAustin | 11:cada08fc8a70 | 114 | sn_coap_protocol_clear_retransmission_buffer(handle); |
mbedAustin | 11:cada08fc8a70 | 115 | |
mbedAustin | 11:cada08fc8a70 | 116 | #endif |
mbedAustin | 11:cada08fc8a70 | 117 | |
mbedAustin | 11:cada08fc8a70 | 118 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 119 | ns_list_foreach_safe(coap_duplication_info_s, tmp, &global_linked_list_duplication_msgs) { |
mbedAustin | 11:cada08fc8a70 | 120 | if (tmp->coap == handle) { |
mbedAustin | 11:cada08fc8a70 | 121 | if (tmp->addr_ptr) { |
mbedAustin | 11:cada08fc8a70 | 122 | handle->sn_coap_protocol_free(tmp->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 123 | tmp->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 124 | } |
mbedAustin | 11:cada08fc8a70 | 125 | ns_list_remove(&global_linked_list_duplication_msgs, tmp); |
mbedAustin | 11:cada08fc8a70 | 126 | global_count_duplication_msgs--; |
mbedAustin | 11:cada08fc8a70 | 127 | handle->sn_coap_protocol_free(tmp); |
mbedAustin | 11:cada08fc8a70 | 128 | tmp = 0; |
mbedAustin | 11:cada08fc8a70 | 129 | } |
mbedAustin | 11:cada08fc8a70 | 130 | } |
mbedAustin | 11:cada08fc8a70 | 131 | #endif |
mbedAustin | 11:cada08fc8a70 | 132 | |
mbedAustin | 11:cada08fc8a70 | 133 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwise is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 134 | ns_list_foreach_safe(coap_blockwise_msg_s, tmp, &global_linked_list_blockwise_sent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 135 | if (tmp->coap == handle) { |
mbedAustin | 11:cada08fc8a70 | 136 | if (tmp->coap_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 137 | if (tmp->coap_msg_ptr->payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 138 | handle->sn_coap_protocol_free(tmp->coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 139 | tmp->coap_msg_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 140 | } |
mbedAustin | 11:cada08fc8a70 | 141 | sn_coap_parser_release_allocated_coap_msg_mem(tmp->coap, tmp->coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 142 | } |
mbedAustin | 11:cada08fc8a70 | 143 | ns_list_remove(&global_linked_list_blockwise_sent_msgs, tmp); |
mbedAustin | 11:cada08fc8a70 | 144 | handle->sn_coap_protocol_free(tmp); |
mbedAustin | 11:cada08fc8a70 | 145 | tmp = 0; |
mbedAustin | 11:cada08fc8a70 | 146 | } |
mbedAustin | 11:cada08fc8a70 | 147 | } |
mbedAustin | 11:cada08fc8a70 | 148 | ns_list_foreach_safe(coap_blockwise_payload_s, tmp, &global_linked_list_blockwise_received_payloads) { |
mbedAustin | 11:cada08fc8a70 | 149 | if (tmp->coap == handle) { |
mbedAustin | 11:cada08fc8a70 | 150 | if (tmp->addr_ptr) { |
mbedAustin | 11:cada08fc8a70 | 151 | handle->sn_coap_protocol_free(tmp->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 152 | tmp->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 153 | } |
mbedAustin | 11:cada08fc8a70 | 154 | if (tmp->payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 155 | handle->sn_coap_protocol_free(tmp->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 156 | tmp->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 157 | } |
mbedAustin | 11:cada08fc8a70 | 158 | ns_list_remove(&global_linked_list_blockwise_received_payloads, tmp); |
mbedAustin | 11:cada08fc8a70 | 159 | handle->sn_coap_protocol_free(tmp); |
mbedAustin | 11:cada08fc8a70 | 160 | tmp = 0; |
mbedAustin | 11:cada08fc8a70 | 161 | } |
mbedAustin | 11:cada08fc8a70 | 162 | } |
mbedAustin | 11:cada08fc8a70 | 163 | #endif |
mbedAustin | 11:cada08fc8a70 | 164 | |
mbedAustin | 11:cada08fc8a70 | 165 | handle->sn_coap_protocol_free(handle); |
mbedAustin | 11:cada08fc8a70 | 166 | handle = 0; |
mbedAustin | 11:cada08fc8a70 | 167 | return 0; |
mbedAustin | 11:cada08fc8a70 | 168 | } |
mbedAustin | 11:cada08fc8a70 | 169 | |
mbedAustin | 11:cada08fc8a70 | 170 | struct coap_s *sn_coap_protocol_init(void *(*used_malloc_func_ptr)(uint16_t), void (*used_free_func_ptr)(void *), |
mbedAustin | 11:cada08fc8a70 | 171 | uint8_t (*used_tx_callback_ptr)(uint8_t *, uint16_t, sn_nsdl_addr_s *, void *), |
mbedAustin | 11:cada08fc8a70 | 172 | int8_t (*used_rx_callback_ptr)(sn_coap_hdr_s *, sn_nsdl_addr_s *, void *param)) |
mbedAustin | 11:cada08fc8a70 | 173 | { |
mbedAustin | 11:cada08fc8a70 | 174 | /* Check paramters */ |
mbedAustin | 11:cada08fc8a70 | 175 | if ((used_malloc_func_ptr == NULL) || (used_free_func_ptr == NULL) || (used_tx_callback_ptr == NULL)) { |
mbedAustin | 11:cada08fc8a70 | 176 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 177 | } |
mbedAustin | 11:cada08fc8a70 | 178 | |
mbedAustin | 11:cada08fc8a70 | 179 | struct coap_s *handle; |
mbedAustin | 11:cada08fc8a70 | 180 | handle = used_malloc_func_ptr(sizeof(struct coap_s)); |
mbedAustin | 11:cada08fc8a70 | 181 | if (handle == NULL) { |
mbedAustin | 11:cada08fc8a70 | 182 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 183 | } |
mbedAustin | 11:cada08fc8a70 | 184 | |
mbedAustin | 11:cada08fc8a70 | 185 | memset(handle, 0, sizeof(struct coap_s)); |
mbedAustin | 11:cada08fc8a70 | 186 | |
mbedAustin | 11:cada08fc8a70 | 187 | /* * * Handle tx callback * * */ |
mbedAustin | 11:cada08fc8a70 | 188 | handle->sn_coap_tx_callback = used_tx_callback_ptr; |
mbedAustin | 11:cada08fc8a70 | 189 | |
mbedAustin | 11:cada08fc8a70 | 190 | handle->sn_coap_protocol_free = used_free_func_ptr; |
mbedAustin | 11:cada08fc8a70 | 191 | handle->sn_coap_protocol_malloc = used_malloc_func_ptr; |
mbedAustin | 11:cada08fc8a70 | 192 | |
mbedAustin | 11:cada08fc8a70 | 193 | /* * * Handle rx callback * * */ |
mbedAustin | 11:cada08fc8a70 | 194 | /* If pointer = 0, then re-sending does not return error when failed */ |
mbedAustin | 11:cada08fc8a70 | 195 | handle->sn_coap_rx_callback = used_rx_callback_ptr; |
mbedAustin | 11:cada08fc8a70 | 196 | |
mbedAustin | 11:cada08fc8a70 | 197 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 198 | |
mbedAustin | 11:cada08fc8a70 | 199 | /* * * * Create Linked list for storing active resending messages * * * */ |
mbedAustin | 11:cada08fc8a70 | 200 | sn_coap_resending_queue_msgs = SN_COAP_RESENDING_QUEUE_SIZE_MSGS; |
mbedAustin | 11:cada08fc8a70 | 201 | sn_coap_resending_queue_bytes = SN_COAP_RESENDING_QUEUE_SIZE_BYTES; |
mbedAustin | 11:cada08fc8a70 | 202 | sn_coap_resending_intervall = DEFAULT_RESPONSE_TIMEOUT; |
mbedAustin | 11:cada08fc8a70 | 203 | sn_coap_resending_count = SN_COAP_RESENDING_MAX_COUNT; |
mbedAustin | 11:cada08fc8a70 | 204 | |
mbedAustin | 11:cada08fc8a70 | 205 | #endif /* ENABLE_RESENDINGS */ |
mbedAustin | 11:cada08fc8a70 | 206 | |
mbedAustin | 11:cada08fc8a70 | 207 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 208 | /* * * * Create Linked list for storing Duplication info * * * */ |
mbedAustin | 11:cada08fc8a70 | 209 | sn_coap_duplication_buffer_size = SN_COAP_DUPLICATION_MAX_MSGS_COUNT; |
mbedAustin | 11:cada08fc8a70 | 210 | #endif |
mbedAustin | 11:cada08fc8a70 | 211 | |
mbedAustin | 11:cada08fc8a70 | 212 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 213 | |
mbedAustin | 11:cada08fc8a70 | 214 | sn_coap_block_data_size = SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE; |
mbedAustin | 11:cada08fc8a70 | 215 | |
mbedAustin | 11:cada08fc8a70 | 216 | #endif /* ENABLE_RESENDINGS */ |
mbedAustin | 11:cada08fc8a70 | 217 | |
mbedAustin | 11:cada08fc8a70 | 218 | /* Randomize global message ID */ |
mbedAustin | 11:cada08fc8a70 | 219 | #if defined __linux__ || defined TARGET_LIKE_MBED |
mbedAustin | 11:cada08fc8a70 | 220 | srand(rand()^time(NULL)); |
mbedAustin | 11:cada08fc8a70 | 221 | |
mbedAustin | 11:cada08fc8a70 | 222 | message_id = rand() % 400 + 100; |
mbedAustin | 11:cada08fc8a70 | 223 | #else |
mbedAustin | 11:cada08fc8a70 | 224 | message_id = 100; |
mbedAustin | 11:cada08fc8a70 | 225 | #endif |
mbedAustin | 11:cada08fc8a70 | 226 | |
mbedAustin | 11:cada08fc8a70 | 227 | return handle; |
mbedAustin | 11:cada08fc8a70 | 228 | } |
mbedAustin | 11:cada08fc8a70 | 229 | |
mbedAustin | 11:cada08fc8a70 | 230 | int8_t sn_coap_protocol_set_block_size(uint16_t block_size) |
mbedAustin | 11:cada08fc8a70 | 231 | { |
mbedAustin | 11:cada08fc8a70 | 232 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE |
mbedAustin | 11:cada08fc8a70 | 233 | switch (block_size) { |
mbedAustin | 11:cada08fc8a70 | 234 | case 0: |
mbedAustin | 11:cada08fc8a70 | 235 | case 16: |
mbedAustin | 11:cada08fc8a70 | 236 | case 32: |
mbedAustin | 11:cada08fc8a70 | 237 | case 64: |
mbedAustin | 11:cada08fc8a70 | 238 | case 128: |
mbedAustin | 11:cada08fc8a70 | 239 | case 256: |
mbedAustin | 11:cada08fc8a70 | 240 | case 512: |
mbedAustin | 11:cada08fc8a70 | 241 | case 1024: |
mbedAustin | 11:cada08fc8a70 | 242 | sn_coap_block_data_size = block_size; |
mbedAustin | 11:cada08fc8a70 | 243 | return 0; |
mbedAustin | 11:cada08fc8a70 | 244 | default: |
mbedAustin | 11:cada08fc8a70 | 245 | break; |
mbedAustin | 11:cada08fc8a70 | 246 | } |
mbedAustin | 11:cada08fc8a70 | 247 | #endif |
mbedAustin | 11:cada08fc8a70 | 248 | return -1; |
mbedAustin | 11:cada08fc8a70 | 249 | |
mbedAustin | 11:cada08fc8a70 | 250 | } |
mbedAustin | 11:cada08fc8a70 | 251 | |
mbedAustin | 11:cada08fc8a70 | 252 | int8_t sn_coap_protocol_set_duplicate_buffer_size(uint8_t message_count) |
mbedAustin | 11:cada08fc8a70 | 253 | { |
mbedAustin | 11:cada08fc8a70 | 254 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT |
mbedAustin | 11:cada08fc8a70 | 255 | if (message_count <= SN_COAP_MAX_ALLOWED_DUPLICATION_MESSAGE_COUNT) { |
mbedAustin | 11:cada08fc8a70 | 256 | sn_coap_duplication_buffer_size = message_count; |
mbedAustin | 11:cada08fc8a70 | 257 | return 0; |
mbedAustin | 11:cada08fc8a70 | 258 | } |
mbedAustin | 11:cada08fc8a70 | 259 | #endif |
mbedAustin | 11:cada08fc8a70 | 260 | return -1; |
mbedAustin | 11:cada08fc8a70 | 261 | } |
mbedAustin | 11:cada08fc8a70 | 262 | |
mbedAustin | 11:cada08fc8a70 | 263 | int8_t sn_coap_protocol_set_retransmission_parameters(uint8_t resending_count, uint8_t resending_intervall) |
mbedAustin | 11:cada08fc8a70 | 264 | { |
mbedAustin | 11:cada08fc8a70 | 265 | #if ENABLE_RESENDINGS |
mbedAustin | 11:cada08fc8a70 | 266 | if (resending_count <= SN_COAP_MAX_ALLOWED_RESENDING_COUNT && |
mbedAustin | 11:cada08fc8a70 | 267 | resending_intervall <= SN_COAP_MAX_ALLOWED_RESPONSE_TIMEOUT) { |
mbedAustin | 11:cada08fc8a70 | 268 | sn_coap_resending_count = resending_count; |
mbedAustin | 11:cada08fc8a70 | 269 | |
mbedAustin | 11:cada08fc8a70 | 270 | if (resending_intervall == 0) { |
mbedAustin | 11:cada08fc8a70 | 271 | sn_coap_resending_intervall = 1; |
mbedAustin | 11:cada08fc8a70 | 272 | } else { |
mbedAustin | 11:cada08fc8a70 | 273 | sn_coap_resending_intervall = resending_intervall; |
mbedAustin | 11:cada08fc8a70 | 274 | } |
mbedAustin | 11:cada08fc8a70 | 275 | return 0; |
mbedAustin | 11:cada08fc8a70 | 276 | } |
mbedAustin | 11:cada08fc8a70 | 277 | #endif |
mbedAustin | 11:cada08fc8a70 | 278 | return -1; |
mbedAustin | 11:cada08fc8a70 | 279 | } |
mbedAustin | 11:cada08fc8a70 | 280 | |
mbedAustin | 11:cada08fc8a70 | 281 | int8_t sn_coap_protocol_set_retransmission_buffer(uint8_t buffer_size_messages, uint16_t buffer_size_bytes) |
mbedAustin | 11:cada08fc8a70 | 282 | { |
mbedAustin | 11:cada08fc8a70 | 283 | #if ENABLE_RESENDINGS |
mbedAustin | 11:cada08fc8a70 | 284 | if (buffer_size_bytes <= SN_COAP_MAX_ALLOWED_RESENDING_BUFF_SIZE_BYTES && |
mbedAustin | 11:cada08fc8a70 | 285 | buffer_size_messages <= SN_COAP_MAX_ALLOWED_RESENDING_BUFF_SIZE_MSGS ) { |
mbedAustin | 11:cada08fc8a70 | 286 | sn_coap_resending_queue_bytes = buffer_size_bytes; |
mbedAustin | 11:cada08fc8a70 | 287 | sn_coap_resending_queue_msgs = buffer_size_messages; |
mbedAustin | 11:cada08fc8a70 | 288 | return 0; |
mbedAustin | 11:cada08fc8a70 | 289 | } |
mbedAustin | 11:cada08fc8a70 | 290 | |
mbedAustin | 11:cada08fc8a70 | 291 | #endif |
mbedAustin | 11:cada08fc8a70 | 292 | return -1; |
mbedAustin | 11:cada08fc8a70 | 293 | |
mbedAustin | 11:cada08fc8a70 | 294 | } |
mbedAustin | 11:cada08fc8a70 | 295 | |
mbedAustin | 11:cada08fc8a70 | 296 | void sn_coap_protocol_clear_retransmission_buffer(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 297 | { |
mbedAustin | 11:cada08fc8a70 | 298 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 299 | ns_list_foreach_safe(coap_send_msg_s, tmp, &global_linked_list_resent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 300 | if (tmp->send_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 301 | if (tmp->send_msg_ptr->dst_addr_ptr) { |
mbedAustin | 11:cada08fc8a70 | 302 | if (tmp->send_msg_ptr->dst_addr_ptr->addr_ptr) { |
mbedAustin | 11:cada08fc8a70 | 303 | handle->sn_coap_protocol_free(tmp->send_msg_ptr->dst_addr_ptr->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 304 | tmp->send_msg_ptr->dst_addr_ptr->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 305 | } |
mbedAustin | 11:cada08fc8a70 | 306 | handle->sn_coap_protocol_free(tmp->send_msg_ptr->dst_addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 307 | tmp->send_msg_ptr->dst_addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 308 | } |
mbedAustin | 11:cada08fc8a70 | 309 | if (tmp->send_msg_ptr->packet_ptr) { |
mbedAustin | 11:cada08fc8a70 | 310 | handle->sn_coap_protocol_free(tmp->send_msg_ptr->packet_ptr); |
mbedAustin | 11:cada08fc8a70 | 311 | tmp->send_msg_ptr->packet_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 312 | } |
mbedAustin | 11:cada08fc8a70 | 313 | handle->sn_coap_protocol_free(tmp->send_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 314 | tmp->send_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 315 | } |
mbedAustin | 11:cada08fc8a70 | 316 | ns_list_remove(&global_linked_list_resent_msgs, tmp); |
mbedAustin | 11:cada08fc8a70 | 317 | --global_count_resent_msgs; |
mbedAustin | 11:cada08fc8a70 | 318 | handle->sn_coap_protocol_free(tmp); |
mbedAustin | 11:cada08fc8a70 | 319 | tmp = 0; |
mbedAustin | 11:cada08fc8a70 | 320 | } |
mbedAustin | 11:cada08fc8a70 | 321 | #endif |
mbedAustin | 11:cada08fc8a70 | 322 | } |
mbedAustin | 11:cada08fc8a70 | 323 | |
mbedAustin | 11:cada08fc8a70 | 324 | |
mbedAustin | 11:cada08fc8a70 | 325 | int16_t sn_coap_protocol_build(struct coap_s *handle, sn_nsdl_addr_s *dst_addr_ptr, |
mbedAustin | 11:cada08fc8a70 | 326 | uint8_t *dst_packet_data_ptr, sn_coap_hdr_s *src_coap_msg_ptr, void *param) |
mbedAustin | 11:cada08fc8a70 | 327 | { |
mbedAustin | 11:cada08fc8a70 | 328 | int16_t byte_count_built = 0; |
mbedAustin | 11:cada08fc8a70 | 329 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 330 | uint16_t original_payload_len = 0; |
mbedAustin | 11:cada08fc8a70 | 331 | #endif |
mbedAustin | 11:cada08fc8a70 | 332 | |
mbedAustin | 11:cada08fc8a70 | 333 | /* * * * Check given pointers * * * */ |
mbedAustin | 11:cada08fc8a70 | 334 | if ((dst_addr_ptr == NULL) || (dst_packet_data_ptr == NULL) || (src_coap_msg_ptr == NULL) || handle == NULL) { |
mbedAustin | 11:cada08fc8a70 | 335 | return -2; |
mbedAustin | 11:cada08fc8a70 | 336 | } |
mbedAustin | 11:cada08fc8a70 | 337 | |
mbedAustin | 11:cada08fc8a70 | 338 | if (dst_addr_ptr->addr_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 339 | return -2; |
mbedAustin | 11:cada08fc8a70 | 340 | } |
mbedAustin | 11:cada08fc8a70 | 341 | |
mbedAustin | 11:cada08fc8a70 | 342 | /* Check if built Message type is else than Acknowledgement or Reset i.e. message type is Confirmable or Non-confirmable */ |
mbedAustin | 11:cada08fc8a70 | 343 | /* (for Acknowledgement and Reset messages is written same Message ID than was in the Request message) */ |
mbedAustin | 11:cada08fc8a70 | 344 | if (src_coap_msg_ptr->msg_type != COAP_MSG_TYPE_ACKNOWLEDGEMENT && |
mbedAustin | 11:cada08fc8a70 | 345 | src_coap_msg_ptr->msg_type != COAP_MSG_TYPE_RESET && |
mbedAustin | 11:cada08fc8a70 | 346 | src_coap_msg_ptr->msg_id == 0) { |
mbedAustin | 11:cada08fc8a70 | 347 | /* * * * Generate new Message ID and increase it by one * * * */ |
mbedAustin | 11:cada08fc8a70 | 348 | src_coap_msg_ptr->msg_id = message_id; |
mbedAustin | 11:cada08fc8a70 | 349 | message_id++; |
mbedAustin | 11:cada08fc8a70 | 350 | if (message_id == 0) { |
mbedAustin | 11:cada08fc8a70 | 351 | message_id = 1; |
mbedAustin | 11:cada08fc8a70 | 352 | } |
mbedAustin | 11:cada08fc8a70 | 353 | } |
mbedAustin | 11:cada08fc8a70 | 354 | |
mbedAustin | 11:cada08fc8a70 | 355 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 356 | |
mbedAustin | 11:cada08fc8a70 | 357 | /* If blockwising needed */ |
mbedAustin | 11:cada08fc8a70 | 358 | if ((src_coap_msg_ptr->payload_len > sn_coap_block_data_size) && (sn_coap_block_data_size > 0)) { |
mbedAustin | 11:cada08fc8a70 | 359 | /* * * * Add Blockwise option to send CoAP message * * */ |
mbedAustin | 11:cada08fc8a70 | 360 | |
mbedAustin | 11:cada08fc8a70 | 361 | if (src_coap_msg_ptr->options_list_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 362 | /* Allocate memory for less used options */ |
mbedAustin | 11:cada08fc8a70 | 363 | src_coap_msg_ptr->options_list_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 364 | |
mbedAustin | 11:cada08fc8a70 | 365 | if (src_coap_msg_ptr->options_list_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 366 | return -2; |
mbedAustin | 11:cada08fc8a70 | 367 | } |
mbedAustin | 11:cada08fc8a70 | 368 | memset(src_coap_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 369 | } |
mbedAustin | 11:cada08fc8a70 | 370 | |
mbedAustin | 11:cada08fc8a70 | 371 | |
mbedAustin | 11:cada08fc8a70 | 372 | /* Check if Request message */ |
mbedAustin | 11:cada08fc8a70 | 373 | if (src_coap_msg_ptr->msg_code < COAP_MSG_CODE_RESPONSE_CREATED) { |
mbedAustin | 11:cada08fc8a70 | 374 | /* Add Blockwise option, use Block1 because Request payload */ |
mbedAustin | 11:cada08fc8a70 | 375 | src_coap_msg_ptr->options_list_ptr->block1_len = 1; |
mbedAustin | 11:cada08fc8a70 | 376 | if( src_coap_msg_ptr->options_list_ptr->block1_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 377 | handle->sn_coap_protocol_free(src_coap_msg_ptr->options_list_ptr->block1_ptr); |
mbedAustin | 11:cada08fc8a70 | 378 | src_coap_msg_ptr->options_list_ptr->block1_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 379 | } |
mbedAustin | 11:cada08fc8a70 | 380 | src_coap_msg_ptr->options_list_ptr->block1_ptr = handle->sn_coap_protocol_malloc(1); |
mbedAustin | 11:cada08fc8a70 | 381 | |
mbedAustin | 11:cada08fc8a70 | 382 | if (src_coap_msg_ptr->options_list_ptr->block1_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 383 | handle->sn_coap_protocol_free(src_coap_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 384 | src_coap_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 385 | return -2; |
mbedAustin | 11:cada08fc8a70 | 386 | } |
mbedAustin | 11:cada08fc8a70 | 387 | |
mbedAustin | 11:cada08fc8a70 | 388 | *(src_coap_msg_ptr->options_list_ptr->block1_ptr) = 0x08; /* First block (BLOCK NUMBER, 4 MSB bits) + More to come (MORE, 1 bit) */ |
mbedAustin | 11:cada08fc8a70 | 389 | *(src_coap_msg_ptr->options_list_ptr->block1_ptr) |= sn_coap_convert_block_size(sn_coap_block_data_size); |
mbedAustin | 11:cada08fc8a70 | 390 | |
mbedAustin | 11:cada08fc8a70 | 391 | } else { /* Response message */ |
mbedAustin | 11:cada08fc8a70 | 392 | /* Add Blockwise option, use Block2 because Response payload */ |
mbedAustin | 11:cada08fc8a70 | 393 | src_coap_msg_ptr->options_list_ptr->block2_len = 1; |
mbedAustin | 11:cada08fc8a70 | 394 | if( src_coap_msg_ptr->options_list_ptr->block2_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 395 | handle->sn_coap_protocol_free(src_coap_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 396 | src_coap_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 397 | } |
mbedAustin | 11:cada08fc8a70 | 398 | |
mbedAustin | 11:cada08fc8a70 | 399 | src_coap_msg_ptr->options_list_ptr->block2_ptr = handle->sn_coap_protocol_malloc(1); |
mbedAustin | 11:cada08fc8a70 | 400 | |
mbedAustin | 11:cada08fc8a70 | 401 | if (src_coap_msg_ptr->options_list_ptr->block2_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 402 | handle->sn_coap_protocol_free(src_coap_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 403 | src_coap_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 404 | return -2; |
mbedAustin | 11:cada08fc8a70 | 405 | } |
mbedAustin | 11:cada08fc8a70 | 406 | |
mbedAustin | 11:cada08fc8a70 | 407 | *(src_coap_msg_ptr->options_list_ptr->block2_ptr) = 0x08; /* First block (BLOCK NUMBER, 4 MSB bits) + More to come (MORE, 1 bit) */ |
mbedAustin | 11:cada08fc8a70 | 408 | *(src_coap_msg_ptr->options_list_ptr->block2_ptr) |= sn_coap_convert_block_size(sn_coap_block_data_size); |
mbedAustin | 11:cada08fc8a70 | 409 | } |
mbedAustin | 11:cada08fc8a70 | 410 | |
mbedAustin | 11:cada08fc8a70 | 411 | /* Store original Payload length */ |
mbedAustin | 11:cada08fc8a70 | 412 | original_payload_len = src_coap_msg_ptr->payload_len; |
mbedAustin | 11:cada08fc8a70 | 413 | |
mbedAustin | 11:cada08fc8a70 | 414 | /* Change Payload length of send message because Payload is blockwised */ |
mbedAustin | 11:cada08fc8a70 | 415 | src_coap_msg_ptr->payload_len = sn_coap_block_data_size; |
mbedAustin | 11:cada08fc8a70 | 416 | } |
mbedAustin | 11:cada08fc8a70 | 417 | |
mbedAustin | 11:cada08fc8a70 | 418 | #endif |
mbedAustin | 11:cada08fc8a70 | 419 | /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 420 | /* * * * Build Packet data from CoAP message by using CoAP Header builder * * * */ |
mbedAustin | 11:cada08fc8a70 | 421 | /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 422 | |
mbedAustin | 11:cada08fc8a70 | 423 | byte_count_built = sn_coap_builder(dst_packet_data_ptr, src_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 424 | |
mbedAustin | 11:cada08fc8a70 | 425 | if (byte_count_built < 0) { |
mbedAustin | 11:cada08fc8a70 | 426 | return byte_count_built; |
mbedAustin | 11:cada08fc8a70 | 427 | } |
mbedAustin | 11:cada08fc8a70 | 428 | |
mbedAustin | 11:cada08fc8a70 | 429 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 430 | |
mbedAustin | 11:cada08fc8a70 | 431 | /* Check if built Message type was confirmable, only these messages are resent */ |
mbedAustin | 11:cada08fc8a70 | 432 | if (src_coap_msg_ptr->msg_type == COAP_MSG_TYPE_CONFIRMABLE) { |
mbedAustin | 11:cada08fc8a70 | 433 | /* Store message to Linked list for resending purposes */ |
mbedAustin | 11:cada08fc8a70 | 434 | sn_coap_protocol_linked_list_send_msg_store(handle, dst_addr_ptr, byte_count_built, dst_packet_data_ptr, |
mbedAustin | 11:cada08fc8a70 | 435 | global_system_time + (uint32_t)(sn_coap_resending_intervall * RESPONSE_RANDOM_FACTOR), |
mbedAustin | 11:cada08fc8a70 | 436 | param); |
mbedAustin | 11:cada08fc8a70 | 437 | } |
mbedAustin | 11:cada08fc8a70 | 438 | |
mbedAustin | 11:cada08fc8a70 | 439 | #endif /* ENABLE_RESENDINGS */ |
mbedAustin | 11:cada08fc8a70 | 440 | |
mbedAustin | 11:cada08fc8a70 | 441 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 442 | |
mbedAustin | 11:cada08fc8a70 | 443 | /* If blockwising needed */ |
mbedAustin | 11:cada08fc8a70 | 444 | if ((original_payload_len > sn_coap_block_data_size) && (sn_coap_block_data_size > 0)) { |
mbedAustin | 11:cada08fc8a70 | 445 | |
mbedAustin | 11:cada08fc8a70 | 446 | /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 447 | /* * * * Manage rest blockwise messages sending by storing them to Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 448 | /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */ |
mbedAustin | 11:cada08fc8a70 | 449 | |
mbedAustin | 11:cada08fc8a70 | 450 | coap_blockwise_msg_s *stored_blockwise_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 451 | |
mbedAustin | 11:cada08fc8a70 | 452 | stored_blockwise_msg_ptr = handle->sn_coap_protocol_malloc(sizeof(coap_blockwise_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 453 | if (!stored_blockwise_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 454 | //block paylaod save failed, only first block can be build. Perhaps we should return error. |
mbedAustin | 11:cada08fc8a70 | 455 | return byte_count_built; |
mbedAustin | 11:cada08fc8a70 | 456 | } |
mbedAustin | 11:cada08fc8a70 | 457 | memset(stored_blockwise_msg_ptr, 0, sizeof(coap_blockwise_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 458 | |
mbedAustin | 11:cada08fc8a70 | 459 | /* Fill struct */ |
mbedAustin | 11:cada08fc8a70 | 460 | stored_blockwise_msg_ptr->timestamp = global_system_time; |
mbedAustin | 11:cada08fc8a70 | 461 | |
mbedAustin | 11:cada08fc8a70 | 462 | stored_blockwise_msg_ptr->coap_msg_ptr = sn_coap_protocol_copy_header(handle, src_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 463 | if( stored_blockwise_msg_ptr->coap_msg_ptr == NULL ){ |
mbedAustin | 11:cada08fc8a70 | 464 | handle->sn_coap_protocol_free(stored_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 465 | stored_blockwise_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 466 | return -2; |
mbedAustin | 11:cada08fc8a70 | 467 | } |
mbedAustin | 11:cada08fc8a70 | 468 | |
mbedAustin | 11:cada08fc8a70 | 469 | stored_blockwise_msg_ptr->coap_msg_ptr->payload_len = original_payload_len; |
mbedAustin | 11:cada08fc8a70 | 470 | stored_blockwise_msg_ptr->coap_msg_ptr->payload_ptr = handle->sn_coap_protocol_malloc(stored_blockwise_msg_ptr->coap_msg_ptr->payload_len); |
mbedAustin | 11:cada08fc8a70 | 471 | |
mbedAustin | 11:cada08fc8a70 | 472 | if (!stored_blockwise_msg_ptr->coap_msg_ptr->payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 473 | //block payload save failed, only first block can be build. Perhaps we should return error. |
mbedAustin | 11:cada08fc8a70 | 474 | sn_coap_parser_release_allocated_coap_msg_mem(handle, stored_blockwise_msg_ptr->coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 475 | handle->sn_coap_protocol_free(stored_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 476 | stored_blockwise_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 477 | return byte_count_built; |
mbedAustin | 11:cada08fc8a70 | 478 | } |
mbedAustin | 11:cada08fc8a70 | 479 | 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); |
mbedAustin | 11:cada08fc8a70 | 480 | |
mbedAustin | 11:cada08fc8a70 | 481 | stored_blockwise_msg_ptr->coap = handle; |
mbedAustin | 11:cada08fc8a70 | 482 | |
mbedAustin | 11:cada08fc8a70 | 483 | ns_list_add_to_end(&global_linked_list_blockwise_sent_msgs, stored_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 484 | } |
mbedAustin | 11:cada08fc8a70 | 485 | |
mbedAustin | 11:cada08fc8a70 | 486 | else if (src_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_GET) { |
mbedAustin | 11:cada08fc8a70 | 487 | /* Add message to linked list - response can be in blocks and we need header to build response.. */ |
mbedAustin | 11:cada08fc8a70 | 488 | coap_blockwise_msg_s *stored_blockwise_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 489 | |
mbedAustin | 11:cada08fc8a70 | 490 | stored_blockwise_msg_ptr = handle->sn_coap_protocol_malloc(sizeof(coap_blockwise_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 491 | if (!stored_blockwise_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 492 | return byte_count_built; |
mbedAustin | 11:cada08fc8a70 | 493 | } |
mbedAustin | 11:cada08fc8a70 | 494 | memset(stored_blockwise_msg_ptr, 0, sizeof(coap_blockwise_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 495 | |
mbedAustin | 11:cada08fc8a70 | 496 | /* Fill struct */ |
mbedAustin | 11:cada08fc8a70 | 497 | stored_blockwise_msg_ptr->timestamp = global_system_time; |
mbedAustin | 11:cada08fc8a70 | 498 | |
mbedAustin | 11:cada08fc8a70 | 499 | stored_blockwise_msg_ptr->coap_msg_ptr = sn_coap_protocol_copy_header(handle, src_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 500 | if( stored_blockwise_msg_ptr->coap_msg_ptr == NULL ){ |
mbedAustin | 11:cada08fc8a70 | 501 | handle->sn_coap_protocol_free(stored_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 502 | stored_blockwise_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 503 | return -2; |
mbedAustin | 11:cada08fc8a70 | 504 | } |
mbedAustin | 11:cada08fc8a70 | 505 | |
mbedAustin | 11:cada08fc8a70 | 506 | stored_blockwise_msg_ptr->coap = handle; |
mbedAustin | 11:cada08fc8a70 | 507 | |
mbedAustin | 11:cada08fc8a70 | 508 | ns_list_add_to_end(&global_linked_list_blockwise_sent_msgs, stored_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 509 | } |
mbedAustin | 11:cada08fc8a70 | 510 | |
mbedAustin | 11:cada08fc8a70 | 511 | #endif /* SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE */ |
mbedAustin | 11:cada08fc8a70 | 512 | |
mbedAustin | 11:cada08fc8a70 | 513 | /* * * * Return built CoAP message Packet data length * * * */ |
mbedAustin | 11:cada08fc8a70 | 514 | return byte_count_built; |
mbedAustin | 11:cada08fc8a70 | 515 | } |
mbedAustin | 11:cada08fc8a70 | 516 | |
mbedAustin | 11:cada08fc8a70 | 517 | sn_coap_hdr_s *sn_coap_protocol_parse(struct coap_s *handle, sn_nsdl_addr_s *src_addr_ptr, uint16_t packet_data_len, uint8_t *packet_data_ptr, void *param) |
mbedAustin | 11:cada08fc8a70 | 518 | { |
mbedAustin | 11:cada08fc8a70 | 519 | sn_coap_hdr_s *returned_dst_coap_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 520 | coap_version_e coap_version = COAP_VERSION_UNKNOWN; |
mbedAustin | 11:cada08fc8a70 | 521 | |
mbedAustin | 11:cada08fc8a70 | 522 | /* * * * Check given pointer * * * */ |
mbedAustin | 11:cada08fc8a70 | 523 | if (src_addr_ptr == NULL || src_addr_ptr->addr_ptr == NULL || |
mbedAustin | 11:cada08fc8a70 | 524 | packet_data_ptr == NULL || handle == NULL) { |
mbedAustin | 11:cada08fc8a70 | 525 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 526 | } |
mbedAustin | 11:cada08fc8a70 | 527 | |
mbedAustin | 11:cada08fc8a70 | 528 | /* * * * Parse Packet data to CoAP message by using CoAP Header parser * * * */ |
mbedAustin | 11:cada08fc8a70 | 529 | returned_dst_coap_msg_ptr = sn_coap_parser(handle, packet_data_len, packet_data_ptr, &coap_version); |
mbedAustin | 11:cada08fc8a70 | 530 | |
mbedAustin | 11:cada08fc8a70 | 531 | /* Check status of returned pointer */ |
mbedAustin | 11:cada08fc8a70 | 532 | if (returned_dst_coap_msg_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 533 | /* Memory allocation error in parser */ |
mbedAustin | 11:cada08fc8a70 | 534 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 535 | } |
mbedAustin | 11:cada08fc8a70 | 536 | |
mbedAustin | 11:cada08fc8a70 | 537 | /* * * * Check validity of parsed Header values * * * */ |
mbedAustin | 11:cada08fc8a70 | 538 | if (sn_coap_header_validity_check(returned_dst_coap_msg_ptr, coap_version) != 0) { |
mbedAustin | 11:cada08fc8a70 | 539 | /* 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 */ |
mbedAustin | 11:cada08fc8a70 | 540 | if (((returned_dst_coap_msg_ptr->msg_code >> 5) == 1) || // if class == 1 |
mbedAustin | 11:cada08fc8a70 | 541 | ((returned_dst_coap_msg_ptr->msg_code >> 5) == 6) || // if class == 6 |
mbedAustin | 11:cada08fc8a70 | 542 | ((returned_dst_coap_msg_ptr->msg_code >> 5) == 7)) { // if class == 7 |
mbedAustin | 11:cada08fc8a70 | 543 | sn_coap_protocol_send_rst(handle, returned_dst_coap_msg_ptr->msg_id, src_addr_ptr, handle); |
mbedAustin | 11:cada08fc8a70 | 544 | } |
mbedAustin | 11:cada08fc8a70 | 545 | |
mbedAustin | 11:cada08fc8a70 | 546 | /* Release memory of CoAP message */ |
mbedAustin | 11:cada08fc8a70 | 547 | sn_coap_parser_release_allocated_coap_msg_mem(handle, returned_dst_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 548 | |
mbedAustin | 11:cada08fc8a70 | 549 | /* Return NULL because Header validity check failed */ |
mbedAustin | 11:cada08fc8a70 | 550 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 551 | } |
mbedAustin | 11:cada08fc8a70 | 552 | |
mbedAustin | 11:cada08fc8a70 | 553 | /* Check if we need to send reset message */ |
mbedAustin | 11:cada08fc8a70 | 554 | /* A recipient MUST acknowledge a Confirmable message with an Acknowledgement |
mbedAustin | 11:cada08fc8a70 | 555 | message or, if it lacks context to process the message properly |
mbedAustin | 11:cada08fc8a70 | 556 | (including the case where the message is Empty, uses a code with a |
mbedAustin | 11:cada08fc8a70 | 557 | reserved class (1, 6 or 7), or has a message format error), MUST |
mbedAustin | 11:cada08fc8a70 | 558 | reject it; rejecting a Confirmable message is effected by sending a |
mbedAustin | 11:cada08fc8a70 | 559 | matching Reset message and otherwise ignoring it. */ |
mbedAustin | 11:cada08fc8a70 | 560 | if (returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_CONFIRMABLE) { |
mbedAustin | 11:cada08fc8a70 | 561 | /* CoAP ping */ |
mbedAustin | 11:cada08fc8a70 | 562 | if (returned_dst_coap_msg_ptr->msg_code == COAP_MSG_CODE_EMPTY) { |
mbedAustin | 11:cada08fc8a70 | 563 | sn_coap_protocol_send_rst(handle, returned_dst_coap_msg_ptr->msg_id, src_addr_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 564 | |
mbedAustin | 11:cada08fc8a70 | 565 | /* Release memory of CoAP message */ |
mbedAustin | 11:cada08fc8a70 | 566 | sn_coap_parser_release_allocated_coap_msg_mem(handle, returned_dst_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 567 | |
mbedAustin | 11:cada08fc8a70 | 568 | /* Return NULL because Header validity check failed */ |
mbedAustin | 11:cada08fc8a70 | 569 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 570 | } |
mbedAustin | 11:cada08fc8a70 | 571 | } |
mbedAustin | 11:cada08fc8a70 | 572 | |
mbedAustin | 11:cada08fc8a70 | 573 | #if !SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is used, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 574 | /* If blockwising used in received message */ |
mbedAustin | 11:cada08fc8a70 | 575 | if (returned_dst_coap_msg_ptr->options_list_ptr != NULL && |
mbedAustin | 11:cada08fc8a70 | 576 | (returned_dst_coap_msg_ptr->options_list_ptr->block1_ptr != NULL || |
mbedAustin | 11:cada08fc8a70 | 577 | returned_dst_coap_msg_ptr->options_list_ptr->block2_ptr != NULL)) { |
mbedAustin | 11:cada08fc8a70 | 578 | /* Set returned status to User */ |
mbedAustin | 11:cada08fc8a70 | 579 | returned_dst_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_REJECTED; |
mbedAustin | 11:cada08fc8a70 | 580 | //todo: send response -> not implemented |
mbedAustin | 11:cada08fc8a70 | 581 | return returned_dst_coap_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 582 | } |
mbedAustin | 11:cada08fc8a70 | 583 | #endif /* !SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE */ |
mbedAustin | 11:cada08fc8a70 | 584 | |
mbedAustin | 11:cada08fc8a70 | 585 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication is used, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 586 | |
mbedAustin | 11:cada08fc8a70 | 587 | /* * * * Manage received CoAP message duplicate detection * * * */ |
mbedAustin | 11:cada08fc8a70 | 588 | |
mbedAustin | 11:cada08fc8a70 | 589 | /* If no message duplication detected */ |
mbedAustin | 11:cada08fc8a70 | 590 | if (sn_coap_protocol_linked_list_duplication_info_search(src_addr_ptr, returned_dst_coap_msg_ptr->msg_id) == -1) { |
mbedAustin | 11:cada08fc8a70 | 591 | /* * * No Message duplication: Store received message for detecting later duplication * * */ |
mbedAustin | 11:cada08fc8a70 | 592 | |
mbedAustin | 11:cada08fc8a70 | 593 | /* Get count of stored duplication messages */ |
mbedAustin | 11:cada08fc8a70 | 594 | uint16_t stored_duplication_msgs_count = global_count_duplication_msgs; |
mbedAustin | 11:cada08fc8a70 | 595 | |
mbedAustin | 11:cada08fc8a70 | 596 | /* Check if there is no room to store message for duplication detection purposes */ |
mbedAustin | 11:cada08fc8a70 | 597 | if (stored_duplication_msgs_count >= sn_coap_duplication_buffer_size) { |
mbedAustin | 11:cada08fc8a70 | 598 | /* Get oldest stored duplication message */ |
mbedAustin | 11:cada08fc8a70 | 599 | coap_duplication_info_s *stored_duplication_info_ptr = ns_list_get_first(&global_linked_list_duplication_msgs); |
mbedAustin | 11:cada08fc8a70 | 600 | |
mbedAustin | 11:cada08fc8a70 | 601 | /* Remove oldest stored duplication message for getting room for new duplication message */ |
mbedAustin | 11:cada08fc8a70 | 602 | sn_coap_protocol_linked_list_duplication_info_remove(handle, stored_duplication_info_ptr->addr_ptr, stored_duplication_info_ptr->port, stored_duplication_info_ptr->msg_id); |
mbedAustin | 11:cada08fc8a70 | 603 | } |
mbedAustin | 11:cada08fc8a70 | 604 | |
mbedAustin | 11:cada08fc8a70 | 605 | /* Store Duplication info to Linked list */ |
mbedAustin | 11:cada08fc8a70 | 606 | sn_coap_protocol_linked_list_duplication_info_store(handle, src_addr_ptr, returned_dst_coap_msg_ptr->msg_id); |
mbedAustin | 11:cada08fc8a70 | 607 | } else { /* * * Message duplication detected * * */ |
mbedAustin | 11:cada08fc8a70 | 608 | /* Set returned status to User */ |
mbedAustin | 11:cada08fc8a70 | 609 | returned_dst_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_DUPLICATED_MSG; |
mbedAustin | 11:cada08fc8a70 | 610 | |
mbedAustin | 11:cada08fc8a70 | 611 | /* Because duplicate message, return with coap_status set */ |
mbedAustin | 11:cada08fc8a70 | 612 | return returned_dst_coap_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 613 | } |
mbedAustin | 11:cada08fc8a70 | 614 | #endif |
mbedAustin | 11:cada08fc8a70 | 615 | |
mbedAustin | 11:cada08fc8a70 | 616 | /*** And here we check if message was block message ***/ |
mbedAustin | 11:cada08fc8a70 | 617 | /*** If so, we call own block handling function and ***/ |
mbedAustin | 11:cada08fc8a70 | 618 | /*** return to caller. ***/ |
mbedAustin | 11:cada08fc8a70 | 619 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE |
mbedAustin | 11:cada08fc8a70 | 620 | |
mbedAustin | 11:cada08fc8a70 | 621 | if (returned_dst_coap_msg_ptr->options_list_ptr != NULL && |
mbedAustin | 11:cada08fc8a70 | 622 | (returned_dst_coap_msg_ptr->options_list_ptr->block1_ptr != NULL || |
mbedAustin | 11:cada08fc8a70 | 623 | returned_dst_coap_msg_ptr->options_list_ptr->block2_ptr != NULL)) { |
mbedAustin | 11:cada08fc8a70 | 624 | returned_dst_coap_msg_ptr = sn_coap_handle_blockwise_message(handle, src_addr_ptr, returned_dst_coap_msg_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 625 | } else { |
mbedAustin | 11:cada08fc8a70 | 626 | /* Get ... */ |
mbedAustin | 11:cada08fc8a70 | 627 | coap_blockwise_msg_s *stored_blockwise_msg_temp_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 628 | |
mbedAustin | 11:cada08fc8a70 | 629 | ns_list_foreach(coap_blockwise_msg_s, msg, &global_linked_list_blockwise_sent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 630 | if (returned_dst_coap_msg_ptr->msg_id == msg->coap_msg_ptr->msg_id) { |
mbedAustin | 11:cada08fc8a70 | 631 | stored_blockwise_msg_temp_ptr = msg; |
mbedAustin | 11:cada08fc8a70 | 632 | break; |
mbedAustin | 11:cada08fc8a70 | 633 | } |
mbedAustin | 11:cada08fc8a70 | 634 | } |
mbedAustin | 11:cada08fc8a70 | 635 | |
mbedAustin | 11:cada08fc8a70 | 636 | if (stored_blockwise_msg_temp_ptr) { |
mbedAustin | 11:cada08fc8a70 | 637 | ns_list_remove(&global_linked_list_blockwise_sent_msgs, stored_blockwise_msg_temp_ptr); |
mbedAustin | 11:cada08fc8a70 | 638 | |
mbedAustin | 11:cada08fc8a70 | 639 | if (stored_blockwise_msg_temp_ptr->coap_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 640 | if(stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr){ |
mbedAustin | 11:cada08fc8a70 | 641 | handle->sn_coap_protocol_free(stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 642 | stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 643 | } |
mbedAustin | 11:cada08fc8a70 | 644 | sn_coap_parser_release_allocated_coap_msg_mem(stored_blockwise_msg_temp_ptr->coap, stored_blockwise_msg_temp_ptr->coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 645 | } |
mbedAustin | 11:cada08fc8a70 | 646 | |
mbedAustin | 11:cada08fc8a70 | 647 | handle->sn_coap_protocol_free(stored_blockwise_msg_temp_ptr); |
mbedAustin | 11:cada08fc8a70 | 648 | stored_blockwise_msg_temp_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 649 | } |
mbedAustin | 11:cada08fc8a70 | 650 | } |
mbedAustin | 11:cada08fc8a70 | 651 | |
mbedAustin | 11:cada08fc8a70 | 652 | if (!returned_dst_coap_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 653 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 654 | } |
mbedAustin | 11:cada08fc8a70 | 655 | |
mbedAustin | 11:cada08fc8a70 | 656 | #endif |
mbedAustin | 11:cada08fc8a70 | 657 | |
mbedAustin | 11:cada08fc8a70 | 658 | |
mbedAustin | 11:cada08fc8a70 | 659 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 660 | |
mbedAustin | 11:cada08fc8a70 | 661 | /* Check if received Message type was acknowledgement */ |
mbedAustin | 11:cada08fc8a70 | 662 | if ((returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_ACKNOWLEDGEMENT) || (returned_dst_coap_msg_ptr->msg_type == COAP_MSG_TYPE_RESET)) { |
mbedAustin | 11:cada08fc8a70 | 663 | /* * * * Manage CoAP message resending by removing active resending message from Linked list * * */ |
mbedAustin | 11:cada08fc8a70 | 664 | |
mbedAustin | 11:cada08fc8a70 | 665 | /* Get node count i.e. count of active resending messages */ |
mbedAustin | 11:cada08fc8a70 | 666 | uint16_t stored_resending_msgs_count = global_count_resent_msgs; |
mbedAustin | 11:cada08fc8a70 | 667 | |
mbedAustin | 11:cada08fc8a70 | 668 | /* Check if there is ongoing active message resendings */ |
mbedAustin | 11:cada08fc8a70 | 669 | if (stored_resending_msgs_count > 0) { |
mbedAustin | 11:cada08fc8a70 | 670 | sn_nsdl_transmit_s *removed_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 671 | |
mbedAustin | 11:cada08fc8a70 | 672 | /* Check if received message was confirmation for some active resending message */ |
mbedAustin | 11:cada08fc8a70 | 673 | |
mbedAustin | 11:cada08fc8a70 | 674 | removed_msg_ptr = sn_coap_protocol_linked_list_send_msg_search(src_addr_ptr, returned_dst_coap_msg_ptr->msg_id); |
mbedAustin | 11:cada08fc8a70 | 675 | |
mbedAustin | 11:cada08fc8a70 | 676 | if (removed_msg_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 677 | /* Remove resending message from active message resending Linked list */ |
mbedAustin | 11:cada08fc8a70 | 678 | sn_coap_protocol_linked_list_send_msg_remove(handle, src_addr_ptr, returned_dst_coap_msg_ptr->msg_id); |
mbedAustin | 11:cada08fc8a70 | 679 | } |
mbedAustin | 11:cada08fc8a70 | 680 | } |
mbedAustin | 11:cada08fc8a70 | 681 | } |
mbedAustin | 11:cada08fc8a70 | 682 | #endif /* ENABLE_RESENDINGS */ |
mbedAustin | 11:cada08fc8a70 | 683 | |
mbedAustin | 11:cada08fc8a70 | 684 | /* * * * Return parsed CoAP message * * * */ |
mbedAustin | 11:cada08fc8a70 | 685 | return (returned_dst_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 686 | } |
mbedAustin | 11:cada08fc8a70 | 687 | |
mbedAustin | 11:cada08fc8a70 | 688 | |
mbedAustin | 11:cada08fc8a70 | 689 | int8_t sn_coap_protocol_exec(struct coap_s *handle, uint32_t current_time) |
mbedAustin | 11:cada08fc8a70 | 690 | { |
mbedAustin | 11:cada08fc8a70 | 691 | /* * * * Store current System time * * * */ |
mbedAustin | 11:cada08fc8a70 | 692 | global_system_time = current_time; |
mbedAustin | 11:cada08fc8a70 | 693 | |
mbedAustin | 11:cada08fc8a70 | 694 | if( !handle ){ |
mbedAustin | 11:cada08fc8a70 | 695 | return -1; |
mbedAustin | 11:cada08fc8a70 | 696 | } |
mbedAustin | 11:cada08fc8a70 | 697 | |
mbedAustin | 11:cada08fc8a70 | 698 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE |
mbedAustin | 11:cada08fc8a70 | 699 | /* * * * Remove old blocwise data * * * */ |
mbedAustin | 11:cada08fc8a70 | 700 | sn_coap_protocol_linked_list_blockwise_remove_old_data(handle); |
mbedAustin | 11:cada08fc8a70 | 701 | #endif |
mbedAustin | 11:cada08fc8a70 | 702 | |
mbedAustin | 11:cada08fc8a70 | 703 | |
mbedAustin | 11:cada08fc8a70 | 704 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT |
mbedAustin | 11:cada08fc8a70 | 705 | /* * * * Remove old duplication messages * * * */ |
mbedAustin | 11:cada08fc8a70 | 706 | sn_coap_protocol_linked_list_duplication_info_remove_old_ones(handle); |
mbedAustin | 11:cada08fc8a70 | 707 | #endif |
mbedAustin | 11:cada08fc8a70 | 708 | |
mbedAustin | 11:cada08fc8a70 | 709 | #if ENABLE_RESENDINGS |
mbedAustin | 11:cada08fc8a70 | 710 | /* Check if there is ongoing active message sendings */ |
mbedAustin | 11:cada08fc8a70 | 711 | ns_list_foreach_safe(coap_send_msg_s, stored_msg_ptr, &global_linked_list_resent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 712 | // First check that msg belongs to handle |
mbedAustin | 11:cada08fc8a70 | 713 | if( stored_msg_ptr->coap == handle ){ |
mbedAustin | 11:cada08fc8a70 | 714 | /* Check if it is time to send this message */ |
mbedAustin | 11:cada08fc8a70 | 715 | if (current_time >= stored_msg_ptr->resending_time) { |
mbedAustin | 11:cada08fc8a70 | 716 | /* * * Increase Resending counter * * */ |
mbedAustin | 11:cada08fc8a70 | 717 | stored_msg_ptr->resending_counter++; |
mbedAustin | 11:cada08fc8a70 | 718 | |
mbedAustin | 11:cada08fc8a70 | 719 | /* Check if all re-sendings have been done */ |
mbedAustin | 11:cada08fc8a70 | 720 | if (stored_msg_ptr->resending_counter > sn_coap_resending_count) { |
mbedAustin | 11:cada08fc8a70 | 721 | coap_version_e coap_version = COAP_VERSION_UNKNOWN; |
mbedAustin | 11:cada08fc8a70 | 722 | |
mbedAustin | 11:cada08fc8a70 | 723 | /* Get message ID from stored sending message */ |
mbedAustin | 11:cada08fc8a70 | 724 | uint16_t temp_msg_id = (stored_msg_ptr->send_msg_ptr->packet_ptr[2] << 8); |
mbedAustin | 11:cada08fc8a70 | 725 | temp_msg_id += (uint16_t)stored_msg_ptr->send_msg_ptr->packet_ptr[3]; |
mbedAustin | 11:cada08fc8a70 | 726 | |
mbedAustin | 11:cada08fc8a70 | 727 | /* If RX callback have been defined.. */ |
mbedAustin | 11:cada08fc8a70 | 728 | if (stored_msg_ptr->coap->sn_coap_rx_callback != 0) { |
mbedAustin | 11:cada08fc8a70 | 729 | sn_coap_hdr_s *tmp_coap_hdr_ptr; |
mbedAustin | 11:cada08fc8a70 | 730 | /* Parse CoAP message, set status and call RX callback */ |
mbedAustin | 11:cada08fc8a70 | 731 | tmp_coap_hdr_ptr = sn_coap_parser(stored_msg_ptr->coap, stored_msg_ptr->send_msg_ptr->packet_len, stored_msg_ptr->send_msg_ptr->packet_ptr, &coap_version); |
mbedAustin | 11:cada08fc8a70 | 732 | |
mbedAustin | 11:cada08fc8a70 | 733 | if (tmp_coap_hdr_ptr != 0) { |
mbedAustin | 11:cada08fc8a70 | 734 | tmp_coap_hdr_ptr->coap_status = COAP_STATUS_BUILDER_MESSAGE_SENDING_FAILED; |
mbedAustin | 11:cada08fc8a70 | 735 | |
mbedAustin | 11:cada08fc8a70 | 736 | stored_msg_ptr->coap->sn_coap_rx_callback(tmp_coap_hdr_ptr, stored_msg_ptr->send_msg_ptr->dst_addr_ptr, stored_msg_ptr->param); |
mbedAustin | 11:cada08fc8a70 | 737 | |
mbedAustin | 11:cada08fc8a70 | 738 | sn_coap_parser_release_allocated_coap_msg_mem(stored_msg_ptr->coap, tmp_coap_hdr_ptr); |
mbedAustin | 11:cada08fc8a70 | 739 | } |
mbedAustin | 11:cada08fc8a70 | 740 | } |
mbedAustin | 11:cada08fc8a70 | 741 | /* Remove message from Linked list */ |
mbedAustin | 11:cada08fc8a70 | 742 | sn_coap_protocol_linked_list_send_msg_remove(handle, stored_msg_ptr->send_msg_ptr->dst_addr_ptr, temp_msg_id); |
mbedAustin | 11:cada08fc8a70 | 743 | } else { |
mbedAustin | 11:cada08fc8a70 | 744 | /* Send message */ |
mbedAustin | 11:cada08fc8a70 | 745 | stored_msg_ptr->coap->sn_coap_tx_callback(stored_msg_ptr->send_msg_ptr->packet_ptr, |
mbedAustin | 11:cada08fc8a70 | 746 | stored_msg_ptr->send_msg_ptr->packet_len, stored_msg_ptr->send_msg_ptr->dst_addr_ptr, stored_msg_ptr->param); |
mbedAustin | 11:cada08fc8a70 | 747 | |
mbedAustin | 11:cada08fc8a70 | 748 | /* * * Count new Resending time * * */ |
mbedAustin | 11:cada08fc8a70 | 749 | stored_msg_ptr->resending_time = current_time + (((uint32_t)(sn_coap_resending_intervall * RESPONSE_RANDOM_FACTOR)) << |
mbedAustin | 11:cada08fc8a70 | 750 | stored_msg_ptr->resending_counter); |
mbedAustin | 11:cada08fc8a70 | 751 | } |
mbedAustin | 11:cada08fc8a70 | 752 | |
mbedAustin | 11:cada08fc8a70 | 753 | } |
mbedAustin | 11:cada08fc8a70 | 754 | } |
mbedAustin | 11:cada08fc8a70 | 755 | } |
mbedAustin | 11:cada08fc8a70 | 756 | |
mbedAustin | 11:cada08fc8a70 | 757 | #endif /* ENABLE_RESENDINGS */ |
mbedAustin | 11:cada08fc8a70 | 758 | |
mbedAustin | 11:cada08fc8a70 | 759 | return 0; |
mbedAustin | 11:cada08fc8a70 | 760 | } |
mbedAustin | 11:cada08fc8a70 | 761 | |
mbedAustin | 11:cada08fc8a70 | 762 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 763 | |
mbedAustin | 11:cada08fc8a70 | 764 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 765 | * \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) |
mbedAustin | 11:cada08fc8a70 | 766 | * |
mbedAustin | 11:cada08fc8a70 | 767 | * \brief Stores message to Linked list for sending purposes. |
mbedAustin | 11:cada08fc8a70 | 768 | |
mbedAustin | 11:cada08fc8a70 | 769 | * \param *dst_addr_ptr is pointer to destination address where CoAP message will be sent |
mbedAustin | 11:cada08fc8a70 | 770 | * |
mbedAustin | 11:cada08fc8a70 | 771 | * \param send_packet_data_len is length of Packet data to be stored |
mbedAustin | 11:cada08fc8a70 | 772 | * |
mbedAustin | 11:cada08fc8a70 | 773 | * \param *send_packet_data_ptr is Packet data to be stored |
mbedAustin | 11:cada08fc8a70 | 774 | * |
mbedAustin | 11:cada08fc8a70 | 775 | * \param sending_time is stored sending time |
mbedAustin | 11:cada08fc8a70 | 776 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 777 | |
mbedAustin | 11:cada08fc8a70 | 778 | static void sn_coap_protocol_linked_list_send_msg_store(struct coap_s *handle, sn_nsdl_addr_s *dst_addr_ptr, uint16_t send_packet_data_len, |
mbedAustin | 11:cada08fc8a70 | 779 | uint8_t *send_packet_data_ptr, uint32_t sending_time, void *param) |
mbedAustin | 11:cada08fc8a70 | 780 | { |
mbedAustin | 11:cada08fc8a70 | 781 | |
mbedAustin | 11:cada08fc8a70 | 782 | coap_send_msg_s *stored_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 783 | |
mbedAustin | 11:cada08fc8a70 | 784 | /* If both queue parameters are "0" or resending count is "0", then re-sending is disabled */ |
mbedAustin | 11:cada08fc8a70 | 785 | if (((sn_coap_resending_queue_msgs == 0) && (sn_coap_resending_queue_bytes == 0)) || (sn_coap_resending_count == 0)) { |
mbedAustin | 11:cada08fc8a70 | 786 | return; |
mbedAustin | 11:cada08fc8a70 | 787 | } |
mbedAustin | 11:cada08fc8a70 | 788 | |
mbedAustin | 11:cada08fc8a70 | 789 | if (sn_coap_resending_queue_msgs > 0) { |
mbedAustin | 11:cada08fc8a70 | 790 | if (global_count_resent_msgs >= sn_coap_resending_queue_msgs) { |
mbedAustin | 11:cada08fc8a70 | 791 | return; |
mbedAustin | 11:cada08fc8a70 | 792 | } |
mbedAustin | 11:cada08fc8a70 | 793 | } |
mbedAustin | 11:cada08fc8a70 | 794 | |
mbedAustin | 11:cada08fc8a70 | 795 | /* Count resending queue size, if buffer size is defined */ |
mbedAustin | 11:cada08fc8a70 | 796 | if (sn_coap_resending_queue_bytes > 0) { |
mbedAustin | 11:cada08fc8a70 | 797 | if ((sn_coap_count_linked_list_size(&global_linked_list_resent_msgs) + send_packet_data_len) > sn_coap_resending_queue_bytes) { |
mbedAustin | 11:cada08fc8a70 | 798 | return; |
mbedAustin | 11:cada08fc8a70 | 799 | } |
mbedAustin | 11:cada08fc8a70 | 800 | } |
mbedAustin | 11:cada08fc8a70 | 801 | |
mbedAustin | 11:cada08fc8a70 | 802 | /* Allocating memory for stored message */ |
mbedAustin | 11:cada08fc8a70 | 803 | stored_msg_ptr = sn_coap_protocol_allocate_mem_for_msg(handle, dst_addr_ptr, send_packet_data_len); |
mbedAustin | 11:cada08fc8a70 | 804 | |
mbedAustin | 11:cada08fc8a70 | 805 | if (stored_msg_ptr == 0) { |
mbedAustin | 11:cada08fc8a70 | 806 | return; |
mbedAustin | 11:cada08fc8a70 | 807 | } |
mbedAustin | 11:cada08fc8a70 | 808 | |
mbedAustin | 11:cada08fc8a70 | 809 | /* Filling of coap_send_msg_s with initialization values */ |
mbedAustin | 11:cada08fc8a70 | 810 | stored_msg_ptr->resending_counter = 0; |
mbedAustin | 11:cada08fc8a70 | 811 | stored_msg_ptr->resending_time = sending_time; |
mbedAustin | 11:cada08fc8a70 | 812 | |
mbedAustin | 11:cada08fc8a70 | 813 | /* Filling of sn_nsdl_transmit_s */ |
mbedAustin | 11:cada08fc8a70 | 814 | stored_msg_ptr->send_msg_ptr->protocol = SN_NSDL_PROTOCOL_COAP; |
mbedAustin | 11:cada08fc8a70 | 815 | stored_msg_ptr->send_msg_ptr->packet_len = send_packet_data_len; |
mbedAustin | 11:cada08fc8a70 | 816 | memcpy(stored_msg_ptr->send_msg_ptr->packet_ptr, send_packet_data_ptr, send_packet_data_len); |
mbedAustin | 11:cada08fc8a70 | 817 | |
mbedAustin | 11:cada08fc8a70 | 818 | /* Filling of sn_nsdl_addr_s */ |
mbedAustin | 11:cada08fc8a70 | 819 | stored_msg_ptr->send_msg_ptr->dst_addr_ptr->type = dst_addr_ptr->type; |
mbedAustin | 11:cada08fc8a70 | 820 | stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_len = dst_addr_ptr->addr_len; |
mbedAustin | 11:cada08fc8a70 | 821 | memcpy(stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, dst_addr_ptr->addr_ptr, dst_addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 822 | stored_msg_ptr->send_msg_ptr->dst_addr_ptr->port = dst_addr_ptr->port; |
mbedAustin | 11:cada08fc8a70 | 823 | |
mbedAustin | 11:cada08fc8a70 | 824 | stored_msg_ptr->coap = handle; |
mbedAustin | 11:cada08fc8a70 | 825 | stored_msg_ptr->param = param; |
mbedAustin | 11:cada08fc8a70 | 826 | |
mbedAustin | 11:cada08fc8a70 | 827 | /* Storing Resending message to Linked list */ |
mbedAustin | 11:cada08fc8a70 | 828 | ns_list_add_to_end(&global_linked_list_resent_msgs, stored_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 829 | ++global_count_resent_msgs; |
mbedAustin | 11:cada08fc8a70 | 830 | } |
mbedAustin | 11:cada08fc8a70 | 831 | |
mbedAustin | 11:cada08fc8a70 | 832 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 833 | * \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) |
mbedAustin | 11:cada08fc8a70 | 834 | * |
mbedAustin | 11:cada08fc8a70 | 835 | * \brief Searches stored resending message from Linked list |
mbedAustin | 11:cada08fc8a70 | 836 | * |
mbedAustin | 11:cada08fc8a70 | 837 | * \param *src_addr_ptr is searching key for searched message |
mbedAustin | 11:cada08fc8a70 | 838 | * |
mbedAustin | 11:cada08fc8a70 | 839 | * \param msg_id is searching key for searched message |
mbedAustin | 11:cada08fc8a70 | 840 | * |
mbedAustin | 11:cada08fc8a70 | 841 | * \return Return value is pointer to found stored resending message in Linked |
mbedAustin | 11:cada08fc8a70 | 842 | * list or NULL if message not found |
mbedAustin | 11:cada08fc8a70 | 843 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 844 | |
mbedAustin | 11:cada08fc8a70 | 845 | static sn_nsdl_transmit_s *sn_coap_protocol_linked_list_send_msg_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 846 | { |
mbedAustin | 11:cada08fc8a70 | 847 | /* Loop all stored resending messages Linked list */ |
mbedAustin | 11:cada08fc8a70 | 848 | ns_list_foreach(coap_send_msg_s, stored_msg_ptr, &global_linked_list_resent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 849 | /* Get message ID from stored resending message */ |
mbedAustin | 11:cada08fc8a70 | 850 | uint16_t temp_msg_id = (stored_msg_ptr->send_msg_ptr->packet_ptr[2] << 8); |
mbedAustin | 11:cada08fc8a70 | 851 | temp_msg_id += (uint16_t)stored_msg_ptr->send_msg_ptr->packet_ptr[3]; |
mbedAustin | 11:cada08fc8a70 | 852 | |
mbedAustin | 11:cada08fc8a70 | 853 | /* If message's Message ID is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 854 | if (temp_msg_id == msg_id) { |
mbedAustin | 11:cada08fc8a70 | 855 | /* If message's Source address is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 856 | if (0 == memcmp(src_addr_ptr->addr_ptr, stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, src_addr_ptr->addr_len)) { |
mbedAustin | 11:cada08fc8a70 | 857 | /* If message's Source address port is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 858 | if (stored_msg_ptr->send_msg_ptr->dst_addr_ptr->port == src_addr_ptr->port) { |
mbedAustin | 11:cada08fc8a70 | 859 | /* * * Message found, return pointer to that stored resending message * * * */ |
mbedAustin | 11:cada08fc8a70 | 860 | return stored_msg_ptr->send_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 861 | } |
mbedAustin | 11:cada08fc8a70 | 862 | } |
mbedAustin | 11:cada08fc8a70 | 863 | } |
mbedAustin | 11:cada08fc8a70 | 864 | } |
mbedAustin | 11:cada08fc8a70 | 865 | |
mbedAustin | 11:cada08fc8a70 | 866 | /* Message not found */ |
mbedAustin | 11:cada08fc8a70 | 867 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 868 | } |
mbedAustin | 11:cada08fc8a70 | 869 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 870 | * \fn static void sn_coap_protocol_linked_list_send_msg_remove(sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 871 | * |
mbedAustin | 11:cada08fc8a70 | 872 | * \brief Removes stored resending message from Linked list |
mbedAustin | 11:cada08fc8a70 | 873 | * |
mbedAustin | 11:cada08fc8a70 | 874 | * \param *src_addr_ptr is searching key for searched message |
mbedAustin | 11:cada08fc8a70 | 875 | * \param msg_id is searching key for removed message |
mbedAustin | 11:cada08fc8a70 | 876 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 877 | |
mbedAustin | 11:cada08fc8a70 | 878 | static void sn_coap_protocol_linked_list_send_msg_remove(struct coap_s *handle, sn_nsdl_addr_s *src_addr_ptr, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 879 | { |
mbedAustin | 11:cada08fc8a70 | 880 | /* Loop all stored resending messages in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 881 | ns_list_foreach(coap_send_msg_s, stored_msg_ptr, &global_linked_list_resent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 882 | /* Get message ID from stored resending message */ |
mbedAustin | 11:cada08fc8a70 | 883 | uint16_t temp_msg_id = (stored_msg_ptr->send_msg_ptr->packet_ptr[2] << 8); |
mbedAustin | 11:cada08fc8a70 | 884 | temp_msg_id += (uint16_t)stored_msg_ptr->send_msg_ptr->packet_ptr[3]; |
mbedAustin | 11:cada08fc8a70 | 885 | |
mbedAustin | 11:cada08fc8a70 | 886 | /* If message's Message ID is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 887 | if (temp_msg_id == msg_id) { |
mbedAustin | 11:cada08fc8a70 | 888 | /* If message's Source address is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 889 | if (0 == memcmp(src_addr_ptr->addr_ptr, stored_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, src_addr_ptr->addr_len)) { |
mbedAustin | 11:cada08fc8a70 | 890 | /* If message's Source address port is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 891 | if (stored_msg_ptr->send_msg_ptr->dst_addr_ptr->port == src_addr_ptr->port) { |
mbedAustin | 11:cada08fc8a70 | 892 | /* * * Message found * * */ |
mbedAustin | 11:cada08fc8a70 | 893 | |
mbedAustin | 11:cada08fc8a70 | 894 | /* Remove message from Linked list */ |
mbedAustin | 11:cada08fc8a70 | 895 | ns_list_remove(&global_linked_list_resent_msgs, stored_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 896 | --global_count_resent_msgs; |
mbedAustin | 11:cada08fc8a70 | 897 | |
mbedAustin | 11:cada08fc8a70 | 898 | /* Free memory of stored message */ |
mbedAustin | 11:cada08fc8a70 | 899 | sn_coap_protocol_release_allocated_send_msg_mem(handle, stored_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 900 | |
mbedAustin | 11:cada08fc8a70 | 901 | return; |
mbedAustin | 11:cada08fc8a70 | 902 | } |
mbedAustin | 11:cada08fc8a70 | 903 | } |
mbedAustin | 11:cada08fc8a70 | 904 | } |
mbedAustin | 11:cada08fc8a70 | 905 | } |
mbedAustin | 11:cada08fc8a70 | 906 | } |
mbedAustin | 11:cada08fc8a70 | 907 | #endif /* ENABLE_RESENDINGS */ |
mbedAustin | 11:cada08fc8a70 | 908 | |
mbedAustin | 11:cada08fc8a70 | 909 | |
mbedAustin | 11:cada08fc8a70 | 910 | static void sn_coap_protocol_send_rst(struct coap_s *handle, uint16_t msg_id, sn_nsdl_addr_s *addr_ptr, void *param) |
mbedAustin | 11:cada08fc8a70 | 911 | { |
mbedAustin | 11:cada08fc8a70 | 912 | uint8_t packet_ptr[4]; |
mbedAustin | 11:cada08fc8a70 | 913 | |
mbedAustin | 11:cada08fc8a70 | 914 | /* Add CoAP version and message type */ |
mbedAustin | 11:cada08fc8a70 | 915 | packet_ptr[0] = COAP_VERSION_1; |
mbedAustin | 11:cada08fc8a70 | 916 | packet_ptr[0] |= COAP_MSG_TYPE_RESET; |
mbedAustin | 11:cada08fc8a70 | 917 | |
mbedAustin | 11:cada08fc8a70 | 918 | /* Add message code */ |
mbedAustin | 11:cada08fc8a70 | 919 | packet_ptr[1] = COAP_MSG_CODE_EMPTY; |
mbedAustin | 11:cada08fc8a70 | 920 | |
mbedAustin | 11:cada08fc8a70 | 921 | /* Add message ID */ |
mbedAustin | 11:cada08fc8a70 | 922 | packet_ptr[2] = msg_id >> 8; |
mbedAustin | 11:cada08fc8a70 | 923 | packet_ptr[3] = (uint8_t)msg_id; |
mbedAustin | 11:cada08fc8a70 | 924 | |
mbedAustin | 11:cada08fc8a70 | 925 | /* Send RST */ |
mbedAustin | 11:cada08fc8a70 | 926 | handle->sn_coap_tx_callback(packet_ptr, 4, addr_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 927 | |
mbedAustin | 11:cada08fc8a70 | 928 | } |
mbedAustin | 11:cada08fc8a70 | 929 | #if SN_COAP_DUPLICATION_MAX_MSGS_COUNT /* If Message duplication detection is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 930 | |
mbedAustin | 11:cada08fc8a70 | 931 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 932 | * \fn static void sn_coap_protocol_linked_list_duplication_info_store(sn_nsdl_addr_s *addr_ptr, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 933 | * |
mbedAustin | 11:cada08fc8a70 | 934 | * \brief Stores Duplication info to Linked list |
mbedAustin | 11:cada08fc8a70 | 935 | * |
mbedAustin | 11:cada08fc8a70 | 936 | * \param msg_id is Message ID to be stored |
mbedAustin | 11:cada08fc8a70 | 937 | * \param *addr_ptr is pointer to Address information to be stored |
mbedAustin | 11:cada08fc8a70 | 938 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 939 | |
mbedAustin | 11:cada08fc8a70 | 940 | static void sn_coap_protocol_linked_list_duplication_info_store(struct coap_s *handle, sn_nsdl_addr_s *addr_ptr, |
mbedAustin | 11:cada08fc8a70 | 941 | uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 942 | { |
mbedAustin | 11:cada08fc8a70 | 943 | coap_duplication_info_s *stored_duplication_info_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 944 | |
mbedAustin | 11:cada08fc8a70 | 945 | /* * * * Allocating memory for stored Duplication info * * * */ |
mbedAustin | 11:cada08fc8a70 | 946 | |
mbedAustin | 11:cada08fc8a70 | 947 | /* Allocate memory for stored Duplication info's structure */ |
mbedAustin | 11:cada08fc8a70 | 948 | stored_duplication_info_ptr = handle->sn_coap_protocol_malloc(sizeof(coap_duplication_info_s)); |
mbedAustin | 11:cada08fc8a70 | 949 | |
mbedAustin | 11:cada08fc8a70 | 950 | if (stored_duplication_info_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 951 | return; |
mbedAustin | 11:cada08fc8a70 | 952 | } |
mbedAustin | 11:cada08fc8a70 | 953 | |
mbedAustin | 11:cada08fc8a70 | 954 | /* Allocate memory for stored Duplication info's address */ |
mbedAustin | 11:cada08fc8a70 | 955 | stored_duplication_info_ptr->addr_ptr = handle->sn_coap_protocol_malloc(addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 956 | |
mbedAustin | 11:cada08fc8a70 | 957 | if (stored_duplication_info_ptr->addr_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 958 | handle->sn_coap_protocol_free(stored_duplication_info_ptr); |
mbedAustin | 11:cada08fc8a70 | 959 | stored_duplication_info_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 960 | return; |
mbedAustin | 11:cada08fc8a70 | 961 | } |
mbedAustin | 11:cada08fc8a70 | 962 | |
mbedAustin | 11:cada08fc8a70 | 963 | /* * * * Filling fields of stored Duplication info * * * */ |
mbedAustin | 11:cada08fc8a70 | 964 | |
mbedAustin | 11:cada08fc8a70 | 965 | stored_duplication_info_ptr->timestamp = global_system_time; |
mbedAustin | 11:cada08fc8a70 | 966 | stored_duplication_info_ptr->addr_len = addr_ptr->addr_len; |
mbedAustin | 11:cada08fc8a70 | 967 | memcpy(stored_duplication_info_ptr->addr_ptr, addr_ptr->addr_ptr, addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 968 | stored_duplication_info_ptr->port = addr_ptr->port; |
mbedAustin | 11:cada08fc8a70 | 969 | stored_duplication_info_ptr->msg_id = msg_id; |
mbedAustin | 11:cada08fc8a70 | 970 | |
mbedAustin | 11:cada08fc8a70 | 971 | stored_duplication_info_ptr->coap = handle; |
mbedAustin | 11:cada08fc8a70 | 972 | |
mbedAustin | 11:cada08fc8a70 | 973 | /* * * * Storing Duplication info to Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 974 | |
mbedAustin | 11:cada08fc8a70 | 975 | ns_list_add_to_end(&global_linked_list_duplication_msgs, stored_duplication_info_ptr); |
mbedAustin | 11:cada08fc8a70 | 976 | ++global_count_duplication_msgs; |
mbedAustin | 11:cada08fc8a70 | 977 | } |
mbedAustin | 11:cada08fc8a70 | 978 | |
mbedAustin | 11:cada08fc8a70 | 979 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 980 | * \fn static int8_t sn_coap_protocol_linked_list_duplication_info_search(sn_nsdl_addr_s *addr_ptr, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 981 | * |
mbedAustin | 11:cada08fc8a70 | 982 | * \brief Searches stored message from Linked list (Address and Message ID as key) |
mbedAustin | 11:cada08fc8a70 | 983 | * |
mbedAustin | 11:cada08fc8a70 | 984 | * \param *addr_ptr is pointer to Address key to be searched |
mbedAustin | 11:cada08fc8a70 | 985 | * \param msg_id is Message ID key to be searched |
mbedAustin | 11:cada08fc8a70 | 986 | * |
mbedAustin | 11:cada08fc8a70 | 987 | * \return Return value is 0 when message found and -1 if not found |
mbedAustin | 11:cada08fc8a70 | 988 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 989 | |
mbedAustin | 11:cada08fc8a70 | 990 | static int8_t sn_coap_protocol_linked_list_duplication_info_search(sn_nsdl_addr_s *addr_ptr, |
mbedAustin | 11:cada08fc8a70 | 991 | uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 992 | { |
mbedAustin | 11:cada08fc8a70 | 993 | /* Loop all nodes in Linked list for searching Message ID */ |
mbedAustin | 11:cada08fc8a70 | 994 | ns_list_foreach(coap_duplication_info_s, stored_duplication_info_ptr, &global_linked_list_duplication_msgs) { |
mbedAustin | 11:cada08fc8a70 | 995 | /* If message's Message ID is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 996 | if (stored_duplication_info_ptr->msg_id == msg_id) { |
mbedAustin | 11:cada08fc8a70 | 997 | /* If message's Source address is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 998 | if (0 == memcmp(addr_ptr->addr_ptr, stored_duplication_info_ptr->addr_ptr, addr_ptr->addr_len)) { |
mbedAustin | 11:cada08fc8a70 | 999 | /* If message's Source address port is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1000 | if (stored_duplication_info_ptr->port == addr_ptr->port) { |
mbedAustin | 11:cada08fc8a70 | 1001 | /* * * Correct Duplication info found * * * */ |
mbedAustin | 11:cada08fc8a70 | 1002 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1003 | } |
mbedAustin | 11:cada08fc8a70 | 1004 | } |
mbedAustin | 11:cada08fc8a70 | 1005 | } |
mbedAustin | 11:cada08fc8a70 | 1006 | } |
mbedAustin | 11:cada08fc8a70 | 1007 | |
mbedAustin | 11:cada08fc8a70 | 1008 | return -1; |
mbedAustin | 11:cada08fc8a70 | 1009 | } |
mbedAustin | 11:cada08fc8a70 | 1010 | |
mbedAustin | 11:cada08fc8a70 | 1011 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1012 | * \fn static void sn_coap_protocol_linked_list_duplication_info_remove(struct coap_s *handle, uint8_t *addr_ptr, uint16_t port, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 1013 | * |
mbedAustin | 11:cada08fc8a70 | 1014 | * \brief Removes stored Duplication info from Linked list |
mbedAustin | 11:cada08fc8a70 | 1015 | * |
mbedAustin | 11:cada08fc8a70 | 1016 | * \param *addr_ptr is pointer to Address key to be removed |
mbedAustin | 11:cada08fc8a70 | 1017 | * |
mbedAustin | 11:cada08fc8a70 | 1018 | * \param port is Port key to be removed |
mbedAustin | 11:cada08fc8a70 | 1019 | * |
mbedAustin | 11:cada08fc8a70 | 1020 | * \param msg_id is Message ID key to be removed |
mbedAustin | 11:cada08fc8a70 | 1021 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1022 | |
mbedAustin | 11:cada08fc8a70 | 1023 | static void sn_coap_protocol_linked_list_duplication_info_remove(struct coap_s *handle, uint8_t *addr_ptr, uint16_t port, uint16_t msg_id) |
mbedAustin | 11:cada08fc8a70 | 1024 | { |
mbedAustin | 11:cada08fc8a70 | 1025 | /* Loop all stored duplication messages in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1026 | ns_list_foreach(coap_duplication_info_s, removed_duplication_info_ptr, &global_linked_list_duplication_msgs) { |
mbedAustin | 11:cada08fc8a70 | 1027 | /* If message's Address is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1028 | if (handle == removed_duplication_info_ptr->coap && 0 == memcmp(addr_ptr, removed_duplication_info_ptr->addr_ptr, removed_duplication_info_ptr->addr_len)) { |
mbedAustin | 11:cada08fc8a70 | 1029 | /* If message's Address prt is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1030 | if (removed_duplication_info_ptr->port == port) { |
mbedAustin | 11:cada08fc8a70 | 1031 | /* If Message ID is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1032 | if (removed_duplication_info_ptr->msg_id == msg_id) { |
mbedAustin | 11:cada08fc8a70 | 1033 | /* * * * Correct Duplication info found, remove it from Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 1034 | ns_list_remove(&global_linked_list_duplication_msgs, removed_duplication_info_ptr); |
mbedAustin | 11:cada08fc8a70 | 1035 | --global_count_duplication_msgs; |
mbedAustin | 11:cada08fc8a70 | 1036 | |
mbedAustin | 11:cada08fc8a70 | 1037 | /* Free memory of stored Duplication info */ |
mbedAustin | 11:cada08fc8a70 | 1038 | handle->sn_coap_protocol_free(removed_duplication_info_ptr->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1039 | removed_duplication_info_ptr->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1040 | handle->sn_coap_protocol_free(removed_duplication_info_ptr); |
mbedAustin | 11:cada08fc8a70 | 1041 | removed_duplication_info_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1042 | |
mbedAustin | 11:cada08fc8a70 | 1043 | return; |
mbedAustin | 11:cada08fc8a70 | 1044 | } |
mbedAustin | 11:cada08fc8a70 | 1045 | } |
mbedAustin | 11:cada08fc8a70 | 1046 | } |
mbedAustin | 11:cada08fc8a70 | 1047 | } |
mbedAustin | 11:cada08fc8a70 | 1048 | } |
mbedAustin | 11:cada08fc8a70 | 1049 | |
mbedAustin | 11:cada08fc8a70 | 1050 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1051 | * \fn static void sn_coap_protocol_linked_list_duplication_info_remove_old_ones(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 1052 | * |
mbedAustin | 11:cada08fc8a70 | 1053 | * \brief Removes old stored Duplication detection infos from Linked list |
mbedAustin | 11:cada08fc8a70 | 1054 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1055 | |
mbedAustin | 11:cada08fc8a70 | 1056 | static void sn_coap_protocol_linked_list_duplication_info_remove_old_ones(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 1057 | { |
mbedAustin | 11:cada08fc8a70 | 1058 | /* Loop all stored duplication messages in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1059 | ns_list_foreach_safe(coap_duplication_info_s, removed_duplication_info_ptr, &global_linked_list_duplication_msgs) { |
mbedAustin | 11:cada08fc8a70 | 1060 | if ((global_system_time - removed_duplication_info_ptr->timestamp) > SN_COAP_DUPLICATION_MAX_TIME_MSGS_STORED) { |
mbedAustin | 11:cada08fc8a70 | 1061 | /* * * * Old Duplication info found, remove it from Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 1062 | ns_list_remove(&global_linked_list_duplication_msgs, removed_duplication_info_ptr); |
mbedAustin | 11:cada08fc8a70 | 1063 | --global_count_duplication_msgs; |
mbedAustin | 11:cada08fc8a70 | 1064 | |
mbedAustin | 11:cada08fc8a70 | 1065 | /* Free memory of stored Duplication info */ |
mbedAustin | 11:cada08fc8a70 | 1066 | handle->sn_coap_protocol_free(removed_duplication_info_ptr->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1067 | removed_duplication_info_ptr->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1068 | handle->sn_coap_protocol_free(removed_duplication_info_ptr); |
mbedAustin | 11:cada08fc8a70 | 1069 | removed_duplication_info_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1070 | } |
mbedAustin | 11:cada08fc8a70 | 1071 | } |
mbedAustin | 11:cada08fc8a70 | 1072 | } |
mbedAustin | 11:cada08fc8a70 | 1073 | |
mbedAustin | 11:cada08fc8a70 | 1074 | #endif /* SN_COAP_DUPLICATION_MAX_MSGS_COUNT */ |
mbedAustin | 11:cada08fc8a70 | 1075 | |
mbedAustin | 11:cada08fc8a70 | 1076 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE |
mbedAustin | 11:cada08fc8a70 | 1077 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1078 | * \fn static void sn_coap_protocol_linked_list_blockwise_msg_remove(struct coap_s *handle, coap_blockwise_msg_s *removed_msg_ptr) |
mbedAustin | 11:cada08fc8a70 | 1079 | * |
mbedAustin | 11:cada08fc8a70 | 1080 | * \brief Removes stored blockwise message from Linked list |
mbedAustin | 11:cada08fc8a70 | 1081 | * |
mbedAustin | 11:cada08fc8a70 | 1082 | * \param removed_msg_ptr is message to be removed |
mbedAustin | 11:cada08fc8a70 | 1083 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1084 | |
mbedAustin | 11:cada08fc8a70 | 1085 | static void sn_coap_protocol_linked_list_blockwise_msg_remove(struct coap_s *handle, coap_blockwise_msg_s *removed_msg_ptr) |
mbedAustin | 11:cada08fc8a70 | 1086 | { |
mbedAustin | 11:cada08fc8a70 | 1087 | if( removed_msg_ptr->coap == handle ){ |
mbedAustin | 11:cada08fc8a70 | 1088 | ns_list_remove(&global_linked_list_blockwise_sent_msgs, removed_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1089 | |
mbedAustin | 11:cada08fc8a70 | 1090 | if( removed_msg_ptr->coap_msg_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 1091 | if (removed_msg_ptr->coap_msg_ptr->payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1092 | handle->sn_coap_protocol_free(removed_msg_ptr->coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1093 | removed_msg_ptr->coap_msg_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1094 | } |
mbedAustin | 11:cada08fc8a70 | 1095 | |
mbedAustin | 11:cada08fc8a70 | 1096 | sn_coap_parser_release_allocated_coap_msg_mem(handle, removed_msg_ptr->coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1097 | } |
mbedAustin | 11:cada08fc8a70 | 1098 | |
mbedAustin | 11:cada08fc8a70 | 1099 | handle->sn_coap_protocol_free(removed_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1100 | removed_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1101 | } |
mbedAustin | 11:cada08fc8a70 | 1102 | } |
mbedAustin | 11:cada08fc8a70 | 1103 | |
mbedAustin | 11:cada08fc8a70 | 1104 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1105 | * \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) |
mbedAustin | 11:cada08fc8a70 | 1106 | * |
mbedAustin | 11:cada08fc8a70 | 1107 | * \brief Stores blockwise payload to Linked list |
mbedAustin | 11:cada08fc8a70 | 1108 | * |
mbedAustin | 11:cada08fc8a70 | 1109 | * \param *addr_ptr is pointer to Address information to be stored |
mbedAustin | 11:cada08fc8a70 | 1110 | * \param stored_payload_len is length of stored Payload |
mbedAustin | 11:cada08fc8a70 | 1111 | * \param *stored_payload_ptr is pointer to stored Payload |
mbedAustin | 11:cada08fc8a70 | 1112 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1113 | |
mbedAustin | 11:cada08fc8a70 | 1114 | static void sn_coap_protocol_linked_list_blockwise_payload_store(struct coap_s *handle, sn_nsdl_addr_s *addr_ptr, |
mbedAustin | 11:cada08fc8a70 | 1115 | uint16_t stored_payload_len, |
mbedAustin | 11:cada08fc8a70 | 1116 | uint8_t *stored_payload_ptr) |
mbedAustin | 11:cada08fc8a70 | 1117 | { |
mbedAustin | 11:cada08fc8a70 | 1118 | if (!addr_ptr || !stored_payload_len || !stored_payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1119 | return; |
mbedAustin | 11:cada08fc8a70 | 1120 | } |
mbedAustin | 11:cada08fc8a70 | 1121 | |
mbedAustin | 11:cada08fc8a70 | 1122 | coap_blockwise_payload_s *stored_blockwise_payload_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1123 | |
mbedAustin | 11:cada08fc8a70 | 1124 | /* * * * Allocating memory for stored Payload * * * */ |
mbedAustin | 11:cada08fc8a70 | 1125 | |
mbedAustin | 11:cada08fc8a70 | 1126 | /* Allocate memory for stored Payload's structure */ |
mbedAustin | 11:cada08fc8a70 | 1127 | stored_blockwise_payload_ptr = handle->sn_coap_protocol_malloc(sizeof(coap_blockwise_payload_s)); |
mbedAustin | 11:cada08fc8a70 | 1128 | |
mbedAustin | 11:cada08fc8a70 | 1129 | if (stored_blockwise_payload_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1130 | return; |
mbedAustin | 11:cada08fc8a70 | 1131 | } |
mbedAustin | 11:cada08fc8a70 | 1132 | |
mbedAustin | 11:cada08fc8a70 | 1133 | /* Allocate memory for stored Payload's data */ |
mbedAustin | 11:cada08fc8a70 | 1134 | stored_blockwise_payload_ptr->payload_ptr = handle->sn_coap_protocol_malloc(stored_payload_len); |
mbedAustin | 11:cada08fc8a70 | 1135 | |
mbedAustin | 11:cada08fc8a70 | 1136 | if (stored_blockwise_payload_ptr->payload_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1137 | handle->sn_coap_protocol_free(stored_blockwise_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1138 | stored_blockwise_payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1139 | return; |
mbedAustin | 11:cada08fc8a70 | 1140 | } |
mbedAustin | 11:cada08fc8a70 | 1141 | |
mbedAustin | 11:cada08fc8a70 | 1142 | /* Allocate memory for stored Payload's address */ |
mbedAustin | 11:cada08fc8a70 | 1143 | stored_blockwise_payload_ptr->addr_ptr = handle->sn_coap_protocol_malloc(addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 1144 | |
mbedAustin | 11:cada08fc8a70 | 1145 | if (stored_blockwise_payload_ptr->addr_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1146 | handle->sn_coap_protocol_free(stored_blockwise_payload_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1147 | stored_blockwise_payload_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1148 | handle->sn_coap_protocol_free(stored_blockwise_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1149 | stored_blockwise_payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1150 | |
mbedAustin | 11:cada08fc8a70 | 1151 | return; |
mbedAustin | 11:cada08fc8a70 | 1152 | } |
mbedAustin | 11:cada08fc8a70 | 1153 | |
mbedAustin | 11:cada08fc8a70 | 1154 | /* * * * Filling fields of stored Payload * * * */ |
mbedAustin | 11:cada08fc8a70 | 1155 | |
mbedAustin | 11:cada08fc8a70 | 1156 | stored_blockwise_payload_ptr->timestamp = global_system_time; |
mbedAustin | 11:cada08fc8a70 | 1157 | |
mbedAustin | 11:cada08fc8a70 | 1158 | memcpy(stored_blockwise_payload_ptr->addr_ptr, addr_ptr->addr_ptr, addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 1159 | stored_blockwise_payload_ptr->port = addr_ptr->port; |
mbedAustin | 11:cada08fc8a70 | 1160 | memcpy(stored_blockwise_payload_ptr->payload_ptr, stored_payload_ptr, stored_payload_len); |
mbedAustin | 11:cada08fc8a70 | 1161 | stored_blockwise_payload_ptr->payload_len = stored_payload_len; |
mbedAustin | 11:cada08fc8a70 | 1162 | |
mbedAustin | 11:cada08fc8a70 | 1163 | stored_blockwise_payload_ptr->coap = handle; |
mbedAustin | 11:cada08fc8a70 | 1164 | |
mbedAustin | 11:cada08fc8a70 | 1165 | /* * * * Storing Payload to Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 1166 | |
mbedAustin | 11:cada08fc8a70 | 1167 | ns_list_add_to_end(&global_linked_list_blockwise_received_payloads, stored_blockwise_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1168 | } |
mbedAustin | 11:cada08fc8a70 | 1169 | |
mbedAustin | 11:cada08fc8a70 | 1170 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1171 | * \fn static uint8_t *sn_coap_protocol_linked_list_blockwise_payload_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t *payload_length) |
mbedAustin | 11:cada08fc8a70 | 1172 | * |
mbedAustin | 11:cada08fc8a70 | 1173 | * \brief Searches stored blockwise payload from Linked list (Address as key) |
mbedAustin | 11:cada08fc8a70 | 1174 | * |
mbedAustin | 11:cada08fc8a70 | 1175 | * \param *addr_ptr is pointer to Address key to be searched |
mbedAustin | 11:cada08fc8a70 | 1176 | * \param *payload_length is pointer to returned Payload length |
mbedAustin | 11:cada08fc8a70 | 1177 | * |
mbedAustin | 11:cada08fc8a70 | 1178 | * \return Return value is pointer to found stored blockwise payload in Linked |
mbedAustin | 11:cada08fc8a70 | 1179 | * list or NULL if payload not found |
mbedAustin | 11:cada08fc8a70 | 1180 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1181 | |
mbedAustin | 11:cada08fc8a70 | 1182 | static uint8_t *sn_coap_protocol_linked_list_blockwise_payload_search(sn_nsdl_addr_s *src_addr_ptr, uint16_t *payload_length) |
mbedAustin | 11:cada08fc8a70 | 1183 | { |
mbedAustin | 11:cada08fc8a70 | 1184 | /* Loop all stored blockwise payloads in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1185 | ns_list_foreach(coap_blockwise_payload_s, stored_payload_info_ptr, &global_linked_list_blockwise_received_payloads) { |
mbedAustin | 11:cada08fc8a70 | 1186 | /* If payload's Source address is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1187 | if (0 == memcmp(src_addr_ptr->addr_ptr, stored_payload_info_ptr->addr_ptr, src_addr_ptr->addr_len)) { |
mbedAustin | 11:cada08fc8a70 | 1188 | /* If payload's Source address port is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1189 | if (stored_payload_info_ptr->port == src_addr_ptr->port) { |
mbedAustin | 11:cada08fc8a70 | 1190 | /* * * Correct Payload found * * * */ |
mbedAustin | 11:cada08fc8a70 | 1191 | *payload_length = stored_payload_info_ptr->payload_len; |
mbedAustin | 11:cada08fc8a70 | 1192 | |
mbedAustin | 11:cada08fc8a70 | 1193 | return stored_payload_info_ptr->payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 1194 | } |
mbedAustin | 11:cada08fc8a70 | 1195 | } |
mbedAustin | 11:cada08fc8a70 | 1196 | } |
mbedAustin | 11:cada08fc8a70 | 1197 | |
mbedAustin | 11:cada08fc8a70 | 1198 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1199 | } |
mbedAustin | 11:cada08fc8a70 | 1200 | |
mbedAustin | 11:cada08fc8a70 | 1201 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1202 | * \fn static void sn_coap_protocol_linked_list_blockwise_payload_remove_oldest(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 1203 | * |
mbedAustin | 11:cada08fc8a70 | 1204 | * \brief Removes current stored blockwise paylod from Linked list |
mbedAustin | 11:cada08fc8a70 | 1205 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1206 | |
mbedAustin | 11:cada08fc8a70 | 1207 | static void sn_coap_protocol_linked_list_blockwise_payload_remove_oldest(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 1208 | { |
mbedAustin | 11:cada08fc8a70 | 1209 | coap_blockwise_payload_s *removed_payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 1210 | |
mbedAustin | 11:cada08fc8a70 | 1211 | /* Remove oldest node in Linked list*/ |
mbedAustin | 11:cada08fc8a70 | 1212 | removed_payload_ptr = ns_list_get_first(&global_linked_list_blockwise_received_payloads); |
mbedAustin | 11:cada08fc8a70 | 1213 | |
mbedAustin | 11:cada08fc8a70 | 1214 | if (removed_payload_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1215 | sn_coap_protocol_linked_list_blockwise_payload_remove(handle, removed_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1216 | } |
mbedAustin | 11:cada08fc8a70 | 1217 | } |
mbedAustin | 11:cada08fc8a70 | 1218 | |
mbedAustin | 11:cada08fc8a70 | 1219 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1220 | * \fn static void sn_coap_protocol_linked_list_blockwise_payload_remove(struct coap_s *handle, |
mbedAustin | 11:cada08fc8a70 | 1221 | * coap_blockwise_msg_s *removed_msg_ptr) |
mbedAustin | 11:cada08fc8a70 | 1222 | * |
mbedAustin | 11:cada08fc8a70 | 1223 | * \brief Removes stored blockwise payload from Linked list |
mbedAustin | 11:cada08fc8a70 | 1224 | * |
mbedAustin | 11:cada08fc8a70 | 1225 | * \param removed_payload_ptr is payload to be removed |
mbedAustin | 11:cada08fc8a70 | 1226 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1227 | |
mbedAustin | 11:cada08fc8a70 | 1228 | static void sn_coap_protocol_linked_list_blockwise_payload_remove(struct coap_s *handle, |
mbedAustin | 11:cada08fc8a70 | 1229 | coap_blockwise_payload_s *removed_payload_ptr) |
mbedAustin | 11:cada08fc8a70 | 1230 | { |
mbedAustin | 11:cada08fc8a70 | 1231 | ns_list_remove(&global_linked_list_blockwise_received_payloads, removed_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1232 | |
mbedAustin | 11:cada08fc8a70 | 1233 | /* Free memory of stored payload */ |
mbedAustin | 11:cada08fc8a70 | 1234 | if (removed_payload_ptr->addr_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1235 | handle->sn_coap_protocol_free(removed_payload_ptr->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1236 | removed_payload_ptr->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1237 | } |
mbedAustin | 11:cada08fc8a70 | 1238 | |
mbedAustin | 11:cada08fc8a70 | 1239 | if (removed_payload_ptr->payload_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1240 | handle->sn_coap_protocol_free(removed_payload_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1241 | removed_payload_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1242 | } |
mbedAustin | 11:cada08fc8a70 | 1243 | |
mbedAustin | 11:cada08fc8a70 | 1244 | handle->sn_coap_protocol_free(removed_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1245 | removed_payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1246 | } |
mbedAustin | 11:cada08fc8a70 | 1247 | |
mbedAustin | 11:cada08fc8a70 | 1248 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1249 | * \fn static uint16_t sn_coap_protocol_linked_list_blockwise_payloads_get_len(sn_nsdl_addr_s *src_addr_ptr) |
mbedAustin | 11:cada08fc8a70 | 1250 | * |
mbedAustin | 11:cada08fc8a70 | 1251 | * \brief Counts length of Payloads in Linked list (Address as key) |
mbedAustin | 11:cada08fc8a70 | 1252 | * |
mbedAustin | 11:cada08fc8a70 | 1253 | * \param *addr_ptr is pointer to Address key |
mbedAustin | 11:cada08fc8a70 | 1254 | * |
mbedAustin | 11:cada08fc8a70 | 1255 | * \return Return value is length of Payloads as bytes |
mbedAustin | 11:cada08fc8a70 | 1256 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1257 | |
mbedAustin | 11:cada08fc8a70 | 1258 | static uint16_t sn_coap_protocol_linked_list_blockwise_payloads_get_len(sn_nsdl_addr_s *src_addr_ptr) |
mbedAustin | 11:cada08fc8a70 | 1259 | { |
mbedAustin | 11:cada08fc8a70 | 1260 | uint16_t ret_whole_payload_len = 0; |
mbedAustin | 11:cada08fc8a70 | 1261 | |
mbedAustin | 11:cada08fc8a70 | 1262 | /* Loop all stored blockwise payloads in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1263 | ns_list_foreach(coap_blockwise_payload_s, searched_payload_info_ptr, &global_linked_list_blockwise_received_payloads) { |
mbedAustin | 11:cada08fc8a70 | 1264 | /* If payload's Source address is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1265 | if (0 == memcmp(src_addr_ptr->addr_ptr, searched_payload_info_ptr->addr_ptr, src_addr_ptr->addr_len)) { |
mbedAustin | 11:cada08fc8a70 | 1266 | /* If payload's Source address port is same than is searched */ |
mbedAustin | 11:cada08fc8a70 | 1267 | if (searched_payload_info_ptr->port == src_addr_ptr->port) { |
mbedAustin | 11:cada08fc8a70 | 1268 | /* * * Correct Payload found * * * */ |
mbedAustin | 11:cada08fc8a70 | 1269 | ret_whole_payload_len += searched_payload_info_ptr->payload_len; |
mbedAustin | 11:cada08fc8a70 | 1270 | } |
mbedAustin | 11:cada08fc8a70 | 1271 | } |
mbedAustin | 11:cada08fc8a70 | 1272 | } |
mbedAustin | 11:cada08fc8a70 | 1273 | |
mbedAustin | 11:cada08fc8a70 | 1274 | return ret_whole_payload_len; |
mbedAustin | 11:cada08fc8a70 | 1275 | } |
mbedAustin | 11:cada08fc8a70 | 1276 | |
mbedAustin | 11:cada08fc8a70 | 1277 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1278 | * \fn static void sn_coap_protocol_linked_list_blockwise_remove_old_data(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 1279 | * |
mbedAustin | 11:cada08fc8a70 | 1280 | * \brief Removes old stored Blockwise messages and payloads from Linked list |
mbedAustin | 11:cada08fc8a70 | 1281 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1282 | |
mbedAustin | 11:cada08fc8a70 | 1283 | static void sn_coap_protocol_linked_list_blockwise_remove_old_data(struct coap_s *handle) |
mbedAustin | 11:cada08fc8a70 | 1284 | { |
mbedAustin | 11:cada08fc8a70 | 1285 | /* Loop all stored Blockwise messages in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1286 | ns_list_foreach_safe(coap_blockwise_msg_s, removed_blocwise_msg_ptr, &global_linked_list_blockwise_sent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 1287 | if ((global_system_time - removed_blocwise_msg_ptr->timestamp) > SN_COAP_BLOCKWISE_MAX_TIME_DATA_STORED) { |
mbedAustin | 11:cada08fc8a70 | 1288 | //TODO: Check do we need to check handle == removed_blocwise_msg_ptr->coap here? |
mbedAustin | 11:cada08fc8a70 | 1289 | |
mbedAustin | 11:cada08fc8a70 | 1290 | /* * * * Old Blockise message found, remove it from Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 1291 | if( removed_blocwise_msg_ptr->coap_msg_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 1292 | if(removed_blocwise_msg_ptr->coap_msg_ptr->payload_ptr){ |
mbedAustin | 11:cada08fc8a70 | 1293 | handle->sn_coap_protocol_free(removed_blocwise_msg_ptr->coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1294 | removed_blocwise_msg_ptr->coap_msg_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1295 | } |
mbedAustin | 11:cada08fc8a70 | 1296 | sn_coap_parser_release_allocated_coap_msg_mem(handle, removed_blocwise_msg_ptr->coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1297 | removed_blocwise_msg_ptr->coap_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1298 | } |
mbedAustin | 11:cada08fc8a70 | 1299 | sn_coap_protocol_linked_list_blockwise_msg_remove(handle, removed_blocwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1300 | } |
mbedAustin | 11:cada08fc8a70 | 1301 | } |
mbedAustin | 11:cada08fc8a70 | 1302 | |
mbedAustin | 11:cada08fc8a70 | 1303 | /* Loop all stored Blockwise payloads in Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1304 | ns_list_foreach_safe(coap_blockwise_payload_s, removed_blocwise_payload_ptr, &global_linked_list_blockwise_received_payloads) { |
mbedAustin | 11:cada08fc8a70 | 1305 | if ((global_system_time - removed_blocwise_payload_ptr->timestamp) > SN_COAP_BLOCKWISE_MAX_TIME_DATA_STORED) { |
mbedAustin | 11:cada08fc8a70 | 1306 | /* * * * Old Blockise payload found, remove it from Linked list * * * */ |
mbedAustin | 11:cada08fc8a70 | 1307 | sn_coap_protocol_linked_list_blockwise_payload_remove(handle, removed_blocwise_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1308 | } |
mbedAustin | 11:cada08fc8a70 | 1309 | } |
mbedAustin | 11:cada08fc8a70 | 1310 | } |
mbedAustin | 11:cada08fc8a70 | 1311 | |
mbedAustin | 11:cada08fc8a70 | 1312 | #endif /* SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE */ |
mbedAustin | 11:cada08fc8a70 | 1313 | |
mbedAustin | 11:cada08fc8a70 | 1314 | |
mbedAustin | 11:cada08fc8a70 | 1315 | #if ENABLE_RESENDINGS /* If Message resending is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 1316 | /***************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1317 | * \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) |
mbedAustin | 11:cada08fc8a70 | 1318 | * |
mbedAustin | 11:cada08fc8a70 | 1319 | * \brief Allocates memory for given message (send or blockwise message) |
mbedAustin | 11:cada08fc8a70 | 1320 | * |
mbedAustin | 11:cada08fc8a70 | 1321 | * \param *dst_addr_ptr is pointer to destination address where message will be sent |
mbedAustin | 11:cada08fc8a70 | 1322 | * \param packet_data_len is length of allocated Packet data |
mbedAustin | 11:cada08fc8a70 | 1323 | * |
mbedAustin | 11:cada08fc8a70 | 1324 | * \return pointer to allocated struct |
mbedAustin | 11:cada08fc8a70 | 1325 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1326 | |
mbedAustin | 11:cada08fc8a70 | 1327 | coap_send_msg_s *sn_coap_protocol_allocate_mem_for_msg(struct coap_s *handle, sn_nsdl_addr_s *dst_addr_ptr, uint16_t packet_data_len) |
mbedAustin | 11:cada08fc8a70 | 1328 | { |
mbedAustin | 11:cada08fc8a70 | 1329 | |
mbedAustin | 11:cada08fc8a70 | 1330 | coap_send_msg_s *msg_ptr = handle->sn_coap_protocol_malloc(sizeof(coap_send_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 1331 | |
mbedAustin | 11:cada08fc8a70 | 1332 | if (msg_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1333 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1334 | } |
mbedAustin | 11:cada08fc8a70 | 1335 | |
mbedAustin | 11:cada08fc8a70 | 1336 | memset(msg_ptr, 0, sizeof(coap_send_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 1337 | |
mbedAustin | 11:cada08fc8a70 | 1338 | msg_ptr->send_msg_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_nsdl_transmit_s)); |
mbedAustin | 11:cada08fc8a70 | 1339 | |
mbedAustin | 11:cada08fc8a70 | 1340 | if (msg_ptr->send_msg_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1341 | sn_coap_protocol_release_allocated_send_msg_mem(handle, msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1342 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1343 | } |
mbedAustin | 11:cada08fc8a70 | 1344 | |
mbedAustin | 11:cada08fc8a70 | 1345 | memset(msg_ptr->send_msg_ptr, 0 , sizeof(sn_nsdl_transmit_s)); |
mbedAustin | 11:cada08fc8a70 | 1346 | |
mbedAustin | 11:cada08fc8a70 | 1347 | msg_ptr->send_msg_ptr->dst_addr_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_nsdl_addr_s)); |
mbedAustin | 11:cada08fc8a70 | 1348 | |
mbedAustin | 11:cada08fc8a70 | 1349 | if (msg_ptr->send_msg_ptr->dst_addr_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1350 | sn_coap_protocol_release_allocated_send_msg_mem(handle, msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1351 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1352 | } |
mbedAustin | 11:cada08fc8a70 | 1353 | |
mbedAustin | 11:cada08fc8a70 | 1354 | memset(msg_ptr->send_msg_ptr->dst_addr_ptr, 0, sizeof(sn_nsdl_addr_s)); |
mbedAustin | 11:cada08fc8a70 | 1355 | |
mbedAustin | 11:cada08fc8a70 | 1356 | msg_ptr->send_msg_ptr->packet_ptr = handle->sn_coap_protocol_malloc(packet_data_len); |
mbedAustin | 11:cada08fc8a70 | 1357 | |
mbedAustin | 11:cada08fc8a70 | 1358 | if (msg_ptr->send_msg_ptr->packet_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1359 | sn_coap_protocol_release_allocated_send_msg_mem(handle, msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1360 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1361 | } |
mbedAustin | 11:cada08fc8a70 | 1362 | |
mbedAustin | 11:cada08fc8a70 | 1363 | msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr = handle->sn_coap_protocol_malloc(dst_addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 1364 | |
mbedAustin | 11:cada08fc8a70 | 1365 | if (msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1366 | sn_coap_protocol_release_allocated_send_msg_mem(handle, msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1367 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1368 | } |
mbedAustin | 11:cada08fc8a70 | 1369 | |
mbedAustin | 11:cada08fc8a70 | 1370 | memset(msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr, 0, dst_addr_ptr->addr_len); |
mbedAustin | 11:cada08fc8a70 | 1371 | |
mbedAustin | 11:cada08fc8a70 | 1372 | return msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 1373 | } |
mbedAustin | 11:cada08fc8a70 | 1374 | |
mbedAustin | 11:cada08fc8a70 | 1375 | |
mbedAustin | 11:cada08fc8a70 | 1376 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1377 | * \fn static void sn_coap_protocol_release_allocated_send_msg_mem(struct coap_s *handle, coap_send_msg_s *freed_send_msg_ptr) |
mbedAustin | 11:cada08fc8a70 | 1378 | * |
mbedAustin | 11:cada08fc8a70 | 1379 | * \brief Releases memory of given Sending message (coap_send_msg_s) |
mbedAustin | 11:cada08fc8a70 | 1380 | * |
mbedAustin | 11:cada08fc8a70 | 1381 | * \param *freed_send_msg_ptr is pointer to released Sending message |
mbedAustin | 11:cada08fc8a70 | 1382 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1383 | |
mbedAustin | 11:cada08fc8a70 | 1384 | static void sn_coap_protocol_release_allocated_send_msg_mem(struct coap_s *handle, coap_send_msg_s *freed_send_msg_ptr) |
mbedAustin | 11:cada08fc8a70 | 1385 | { |
mbedAustin | 11:cada08fc8a70 | 1386 | if (freed_send_msg_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1387 | if (freed_send_msg_ptr->send_msg_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1388 | if (freed_send_msg_ptr->send_msg_ptr->dst_addr_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1389 | if (freed_send_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1390 | handle->sn_coap_protocol_free(freed_send_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1391 | freed_send_msg_ptr->send_msg_ptr->dst_addr_ptr->addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1392 | } |
mbedAustin | 11:cada08fc8a70 | 1393 | |
mbedAustin | 11:cada08fc8a70 | 1394 | handle->sn_coap_protocol_free(freed_send_msg_ptr->send_msg_ptr->dst_addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1395 | freed_send_msg_ptr->send_msg_ptr->dst_addr_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1396 | } |
mbedAustin | 11:cada08fc8a70 | 1397 | |
mbedAustin | 11:cada08fc8a70 | 1398 | if (freed_send_msg_ptr->send_msg_ptr->packet_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1399 | handle->sn_coap_protocol_free(freed_send_msg_ptr->send_msg_ptr->packet_ptr); |
mbedAustin | 11:cada08fc8a70 | 1400 | freed_send_msg_ptr->send_msg_ptr->packet_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1401 | } |
mbedAustin | 11:cada08fc8a70 | 1402 | |
mbedAustin | 11:cada08fc8a70 | 1403 | handle->sn_coap_protocol_free(freed_send_msg_ptr->send_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1404 | freed_send_msg_ptr->send_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1405 | } |
mbedAustin | 11:cada08fc8a70 | 1406 | |
mbedAustin | 11:cada08fc8a70 | 1407 | handle->sn_coap_protocol_free(freed_send_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1408 | freed_send_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1409 | } |
mbedAustin | 11:cada08fc8a70 | 1410 | } |
mbedAustin | 11:cada08fc8a70 | 1411 | |
mbedAustin | 11:cada08fc8a70 | 1412 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1413 | * \fn static uint16_t sn_coap_count_linked_list_size(const coap_send_msg_list_t *linked_list_ptr) |
mbedAustin | 11:cada08fc8a70 | 1414 | * |
mbedAustin | 11:cada08fc8a70 | 1415 | * \brief Counts total message size of all messages in linked list |
mbedAustin | 11:cada08fc8a70 | 1416 | * |
mbedAustin | 11:cada08fc8a70 | 1417 | * \param const coap_send_msg_list_t *linked_list_ptr pointer to linked list |
mbedAustin | 11:cada08fc8a70 | 1418 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1419 | static uint16_t sn_coap_count_linked_list_size(const coap_send_msg_list_t *linked_list_ptr) |
mbedAustin | 11:cada08fc8a70 | 1420 | { |
mbedAustin | 11:cada08fc8a70 | 1421 | uint16_t total_size = 0; |
mbedAustin | 11:cada08fc8a70 | 1422 | |
mbedAustin | 11:cada08fc8a70 | 1423 | ns_list_foreach(coap_send_msg_s, stored_msg_ptr, linked_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1424 | if (stored_msg_ptr->send_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1425 | total_size += stored_msg_ptr->send_msg_ptr->packet_len; |
mbedAustin | 11:cada08fc8a70 | 1426 | } |
mbedAustin | 11:cada08fc8a70 | 1427 | } |
mbedAustin | 11:cada08fc8a70 | 1428 | |
mbedAustin | 11:cada08fc8a70 | 1429 | return total_size; |
mbedAustin | 11:cada08fc8a70 | 1430 | } |
mbedAustin | 11:cada08fc8a70 | 1431 | |
mbedAustin | 11:cada08fc8a70 | 1432 | #endif |
mbedAustin | 11:cada08fc8a70 | 1433 | #if SN_COAP_BLOCKWISE_MAX_PAYLOAD_SIZE /* If Message blockwising is not used at all, this part of code will not be compiled */ |
mbedAustin | 11:cada08fc8a70 | 1434 | |
mbedAustin | 11:cada08fc8a70 | 1435 | /**************************************************************************//** |
mbedAustin | 11:cada08fc8a70 | 1436 | * \fn static int8_t sn_coap_handle_blockwise_message(void) |
mbedAustin | 11:cada08fc8a70 | 1437 | * |
mbedAustin | 11:cada08fc8a70 | 1438 | * \brief Handles all received blockwise messages |
mbedAustin | 11:cada08fc8a70 | 1439 | * |
mbedAustin | 11:cada08fc8a70 | 1440 | * \param *src_addr_ptr pointer to source address information struct |
mbedAustin | 11:cada08fc8a70 | 1441 | * \param *received_coap_msg_ptr pointer to parsed CoAP message structure |
mbedAustin | 11:cada08fc8a70 | 1442 | *****************************************************************************/ |
mbedAustin | 11:cada08fc8a70 | 1443 | |
mbedAustin | 11:cada08fc8a70 | 1444 | static sn_coap_hdr_s *sn_coap_handle_blockwise_message(struct coap_s *handle, sn_nsdl_addr_s *src_addr_ptr, sn_coap_hdr_s *received_coap_msg_ptr, void *param) |
mbedAustin | 11:cada08fc8a70 | 1445 | { |
mbedAustin | 11:cada08fc8a70 | 1446 | sn_coap_hdr_s *src_coap_blockwise_ack_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1447 | uint16_t dst_packed_data_needed_mem = 0; |
mbedAustin | 11:cada08fc8a70 | 1448 | uint8_t *dst_ack_packet_data_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1449 | uint8_t block_temp = 0; |
mbedAustin | 11:cada08fc8a70 | 1450 | |
mbedAustin | 11:cada08fc8a70 | 1451 | uint16_t original_payload_len = 0; |
mbedAustin | 11:cada08fc8a70 | 1452 | uint8_t *original_payload_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1453 | |
mbedAustin | 11:cada08fc8a70 | 1454 | /* Block1 Option in a request (e.g., PUT or POST) */ |
mbedAustin | 11:cada08fc8a70 | 1455 | // Blocked request sending, received ACK, sending next block.. |
mbedAustin | 11:cada08fc8a70 | 1456 | if (received_coap_msg_ptr->options_list_ptr->block1_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1457 | if (received_coap_msg_ptr->msg_code > COAP_MSG_CODE_REQUEST_DELETE) { |
mbedAustin | 11:cada08fc8a70 | 1458 | if (*(received_coap_msg_ptr->options_list_ptr->block1_ptr + (received_coap_msg_ptr->options_list_ptr->block1_len - 1)) & 0x08) { |
mbedAustin | 11:cada08fc8a70 | 1459 | coap_blockwise_msg_s *stored_blockwise_msg_temp_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1460 | |
mbedAustin | 11:cada08fc8a70 | 1461 | /* Get */ |
mbedAustin | 11:cada08fc8a70 | 1462 | ns_list_foreach(coap_blockwise_msg_s, msg, &global_linked_list_blockwise_sent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 1463 | if (msg->coap_msg_ptr && received_coap_msg_ptr->msg_id == msg->coap_msg_ptr->msg_id) { |
mbedAustin | 11:cada08fc8a70 | 1464 | stored_blockwise_msg_temp_ptr = msg; |
mbedAustin | 11:cada08fc8a70 | 1465 | break; |
mbedAustin | 11:cada08fc8a70 | 1466 | } |
mbedAustin | 11:cada08fc8a70 | 1467 | } |
mbedAustin | 11:cada08fc8a70 | 1468 | |
mbedAustin | 11:cada08fc8a70 | 1469 | if (stored_blockwise_msg_temp_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1470 | /* Build response message */ |
mbedAustin | 11:cada08fc8a70 | 1471 | |
mbedAustin | 11:cada08fc8a70 | 1472 | uint16_t block_size = 1; |
mbedAustin | 11:cada08fc8a70 | 1473 | uint32_t block_number = 0; |
mbedAustin | 11:cada08fc8a70 | 1474 | |
mbedAustin | 11:cada08fc8a70 | 1475 | /* Get block option parameters from received message */ |
mbedAustin | 11:cada08fc8a70 | 1476 | if (received_coap_msg_ptr->options_list_ptr->block1_len == 3) { |
mbedAustin | 11:cada08fc8a70 | 1477 | block_number = *(received_coap_msg_ptr->options_list_ptr->block1_ptr) << 12; |
mbedAustin | 11:cada08fc8a70 | 1478 | block_number |= *(received_coap_msg_ptr->options_list_ptr->block1_ptr + 1) << 4; |
mbedAustin | 11:cada08fc8a70 | 1479 | block_number |= (*(received_coap_msg_ptr->options_list_ptr->block1_ptr + 2)) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1480 | } |
mbedAustin | 11:cada08fc8a70 | 1481 | |
mbedAustin | 11:cada08fc8a70 | 1482 | else if (received_coap_msg_ptr->options_list_ptr->block1_len == 2) { |
mbedAustin | 11:cada08fc8a70 | 1483 | block_number = *(received_coap_msg_ptr->options_list_ptr->block1_ptr) << 4; |
mbedAustin | 11:cada08fc8a70 | 1484 | block_number |= (*(received_coap_msg_ptr->options_list_ptr->block1_ptr + 1)) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1485 | } else if (received_coap_msg_ptr->options_list_ptr->block1_len == 1) { |
mbedAustin | 11:cada08fc8a70 | 1486 | block_number = (*received_coap_msg_ptr->options_list_ptr->block1_ptr) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1487 | } |
mbedAustin | 11:cada08fc8a70 | 1488 | |
mbedAustin | 11:cada08fc8a70 | 1489 | |
mbedAustin | 11:cada08fc8a70 | 1490 | block_temp = *(received_coap_msg_ptr->options_list_ptr->block1_ptr + (received_coap_msg_ptr->options_list_ptr->block1_len - 1)) & 0x07; |
mbedAustin | 11:cada08fc8a70 | 1491 | block_size = block_size << (block_temp + 4); |
mbedAustin | 11:cada08fc8a70 | 1492 | |
mbedAustin | 11:cada08fc8a70 | 1493 | |
mbedAustin | 11:cada08fc8a70 | 1494 | /* Build next block message */ |
mbedAustin | 11:cada08fc8a70 | 1495 | src_coap_blockwise_ack_msg_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 1496 | |
mbedAustin | 11:cada08fc8a70 | 1497 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1498 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1499 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr); |
mbedAustin | 11:cada08fc8a70 | 1500 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1501 | |
mbedAustin | 11:cada08fc8a70 | 1502 | } |
mbedAustin | 11:cada08fc8a70 | 1503 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1504 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 1505 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1506 | } |
mbedAustin | 11:cada08fc8a70 | 1507 | } else { |
mbedAustin | 11:cada08fc8a70 | 1508 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 1509 | if (!src_coap_blockwise_ack_msg_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1510 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1511 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1512 | } |
mbedAustin | 11:cada08fc8a70 | 1513 | memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, (sizeof(sn_coap_options_list_s))); |
mbedAustin | 11:cada08fc8a70 | 1514 | } |
mbedAustin | 11:cada08fc8a70 | 1515 | |
mbedAustin | 11:cada08fc8a70 | 1516 | block_number++; |
mbedAustin | 11:cada08fc8a70 | 1517 | |
mbedAustin | 11:cada08fc8a70 | 1518 | if (block_number <= 0x0f) { |
mbedAustin | 11:cada08fc8a70 | 1519 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = 1; |
mbedAustin | 11:cada08fc8a70 | 1520 | } else if (block_number <= 0x0fff) { |
mbedAustin | 11:cada08fc8a70 | 1521 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = 2; |
mbedAustin | 11:cada08fc8a70 | 1522 | } else if (block_number <= 0x0fffff) { |
mbedAustin | 11:cada08fc8a70 | 1523 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = 3; |
mbedAustin | 11:cada08fc8a70 | 1524 | } |
mbedAustin | 11:cada08fc8a70 | 1525 | |
mbedAustin | 11:cada08fc8a70 | 1526 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = handle->sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len); |
mbedAustin | 11:cada08fc8a70 | 1527 | |
mbedAustin | 11:cada08fc8a70 | 1528 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr == 0) { |
mbedAustin | 11:cada08fc8a70 | 1529 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1530 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1531 | } |
mbedAustin | 11:cada08fc8a70 | 1532 | |
mbedAustin | 11:cada08fc8a70 | 1533 | *(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; |
mbedAustin | 11:cada08fc8a70 | 1534 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1535 | |
mbedAustin | 11:cada08fc8a70 | 1536 | |
mbedAustin | 11:cada08fc8a70 | 1537 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len == 3) { |
mbedAustin | 11:cada08fc8a70 | 1538 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + 2) = block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1539 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + 1) |= block_number >> 4; |
mbedAustin | 11:cada08fc8a70 | 1540 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number >> 12; |
mbedAustin | 11:cada08fc8a70 | 1541 | } else if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len == 2) { |
mbedAustin | 11:cada08fc8a70 | 1542 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + 1) |= block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1543 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number >> 4; |
mbedAustin | 11:cada08fc8a70 | 1544 | } else { |
mbedAustin | 11:cada08fc8a70 | 1545 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr |= block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1546 | } |
mbedAustin | 11:cada08fc8a70 | 1547 | |
mbedAustin | 11:cada08fc8a70 | 1548 | original_payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len; |
mbedAustin | 11:cada08fc8a70 | 1549 | original_payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 1550 | |
mbedAustin | 11:cada08fc8a70 | 1551 | if ((block_size * (block_number + 1)) > stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len) { |
mbedAustin | 11:cada08fc8a70 | 1552 | src_coap_blockwise_ack_msg_ptr->payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len - (block_size * (block_number)); |
mbedAustin | 11:cada08fc8a70 | 1553 | src_coap_blockwise_ack_msg_ptr->payload_ptr = src_coap_blockwise_ack_msg_ptr->payload_ptr + (block_size * block_number); |
mbedAustin | 11:cada08fc8a70 | 1554 | } |
mbedAustin | 11:cada08fc8a70 | 1555 | |
mbedAustin | 11:cada08fc8a70 | 1556 | /* Not last block */ |
mbedAustin | 11:cada08fc8a70 | 1557 | else { |
mbedAustin | 11:cada08fc8a70 | 1558 | /* set more - bit */ |
mbedAustin | 11:cada08fc8a70 | 1559 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len - 1)) |= 0x08; |
mbedAustin | 11:cada08fc8a70 | 1560 | src_coap_blockwise_ack_msg_ptr->payload_len = block_size; |
mbedAustin | 11:cada08fc8a70 | 1561 | src_coap_blockwise_ack_msg_ptr->payload_ptr = src_coap_blockwise_ack_msg_ptr->payload_ptr + (block_size * block_number); |
mbedAustin | 11:cada08fc8a70 | 1562 | } |
mbedAustin | 11:cada08fc8a70 | 1563 | |
mbedAustin | 11:cada08fc8a70 | 1564 | /* Build and send block message */ |
mbedAustin | 11:cada08fc8a70 | 1565 | dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1566 | |
mbedAustin | 11:cada08fc8a70 | 1567 | dst_ack_packet_data_ptr = handle->sn_coap_protocol_malloc(dst_packed_data_needed_mem); |
mbedAustin | 11:cada08fc8a70 | 1568 | if (!dst_ack_packet_data_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1569 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr); |
mbedAustin | 11:cada08fc8a70 | 1570 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1571 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1572 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1573 | handle->sn_coap_protocol_free(original_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1574 | original_payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1575 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1576 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1577 | stored_blockwise_msg_temp_ptr->coap_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1578 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1579 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1580 | } |
mbedAustin | 11:cada08fc8a70 | 1581 | src_coap_blockwise_ack_msg_ptr->msg_id = message_id++; |
mbedAustin | 11:cada08fc8a70 | 1582 | if (message_id == 0) { |
mbedAustin | 11:cada08fc8a70 | 1583 | message_id = 1; |
mbedAustin | 11:cada08fc8a70 | 1584 | } |
mbedAustin | 11:cada08fc8a70 | 1585 | |
mbedAustin | 11:cada08fc8a70 | 1586 | sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1587 | |
mbedAustin | 11:cada08fc8a70 | 1588 | handle->sn_coap_tx_callback(dst_ack_packet_data_ptr, dst_packed_data_needed_mem, src_addr_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 1589 | |
mbedAustin | 11:cada08fc8a70 | 1590 | handle->sn_coap_protocol_free(dst_ack_packet_data_ptr); |
mbedAustin | 11:cada08fc8a70 | 1591 | dst_ack_packet_data_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1592 | |
mbedAustin | 11:cada08fc8a70 | 1593 | stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len = original_payload_len; |
mbedAustin | 11:cada08fc8a70 | 1594 | stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr = original_payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 1595 | |
mbedAustin | 11:cada08fc8a70 | 1596 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_ACK; |
mbedAustin | 11:cada08fc8a70 | 1597 | } |
mbedAustin | 11:cada08fc8a70 | 1598 | } else { |
mbedAustin | 11:cada08fc8a70 | 1599 | // XXX what was this trying to free? |
mbedAustin | 11:cada08fc8a70 | 1600 | //sn_coap_protocol_linked_list_blockwise_msg_remove_current(); |
mbedAustin | 11:cada08fc8a70 | 1601 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_ACK; |
mbedAustin | 11:cada08fc8a70 | 1602 | } |
mbedAustin | 11:cada08fc8a70 | 1603 | } |
mbedAustin | 11:cada08fc8a70 | 1604 | |
mbedAustin | 11:cada08fc8a70 | 1605 | // Blocked request receiving |
mbedAustin | 11:cada08fc8a70 | 1606 | else { |
mbedAustin | 11:cada08fc8a70 | 1607 | if (received_coap_msg_ptr->payload_len > sn_coap_block_data_size) { |
mbedAustin | 11:cada08fc8a70 | 1608 | received_coap_msg_ptr->payload_len = sn_coap_block_data_size; |
mbedAustin | 11:cada08fc8a70 | 1609 | } |
mbedAustin | 11:cada08fc8a70 | 1610 | |
mbedAustin | 11:cada08fc8a70 | 1611 | sn_coap_protocol_linked_list_blockwise_payload_store(handle, src_addr_ptr, received_coap_msg_ptr->payload_len, received_coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1612 | /* If not last block (more value is set) */ |
mbedAustin | 11:cada08fc8a70 | 1613 | /* 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. */ |
mbedAustin | 11:cada08fc8a70 | 1614 | if (*(received_coap_msg_ptr->options_list_ptr->block1_ptr + (received_coap_msg_ptr->options_list_ptr->block1_len - 1)) & 0x08) { |
mbedAustin | 11:cada08fc8a70 | 1615 | //send ack |
mbedAustin | 11:cada08fc8a70 | 1616 | src_coap_blockwise_ack_msg_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_hdr_s)); |
mbedAustin | 11:cada08fc8a70 | 1617 | |
mbedAustin | 11:cada08fc8a70 | 1618 | if (src_coap_blockwise_ack_msg_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1619 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1620 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1621 | } |
mbedAustin | 11:cada08fc8a70 | 1622 | |
mbedAustin | 11:cada08fc8a70 | 1623 | memset(src_coap_blockwise_ack_msg_ptr, 0, sizeof(sn_coap_hdr_s)); |
mbedAustin | 11:cada08fc8a70 | 1624 | |
mbedAustin | 11:cada08fc8a70 | 1625 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 1626 | |
mbedAustin | 11:cada08fc8a70 | 1627 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1628 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1629 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1630 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1631 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1632 | } |
mbedAustin | 11:cada08fc8a70 | 1633 | |
mbedAustin | 11:cada08fc8a70 | 1634 | memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 1635 | |
mbedAustin | 11:cada08fc8a70 | 1636 | if (received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_GET) { |
mbedAustin | 11:cada08fc8a70 | 1637 | src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_CONTENT; |
mbedAustin | 11:cada08fc8a70 | 1638 | } else if (received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_POST) { |
mbedAustin | 11:cada08fc8a70 | 1639 | src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_CREATED; |
mbedAustin | 11:cada08fc8a70 | 1640 | } else if (received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_PUT) { |
mbedAustin | 11:cada08fc8a70 | 1641 | src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_CHANGED; |
mbedAustin | 11:cada08fc8a70 | 1642 | } else if (received_coap_msg_ptr->msg_code == COAP_MSG_CODE_REQUEST_DELETE) { |
mbedAustin | 11:cada08fc8a70 | 1643 | src_coap_blockwise_ack_msg_ptr->msg_code = COAP_MSG_CODE_RESPONSE_DELETED; |
mbedAustin | 11:cada08fc8a70 | 1644 | } |
mbedAustin | 11:cada08fc8a70 | 1645 | |
mbedAustin | 11:cada08fc8a70 | 1646 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len = received_coap_msg_ptr->options_list_ptr->block1_len; |
mbedAustin | 11:cada08fc8a70 | 1647 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = handle->sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len); |
mbedAustin | 11:cada08fc8a70 | 1648 | if (!src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1649 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1650 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1651 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1652 | src_coap_blockwise_ack_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1653 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1654 | } |
mbedAustin | 11:cada08fc8a70 | 1655 | |
mbedAustin | 11:cada08fc8a70 | 1656 | src_coap_blockwise_ack_msg_ptr->msg_type = COAP_MSG_TYPE_ACKNOWLEDGEMENT; |
mbedAustin | 11:cada08fc8a70 | 1657 | |
mbedAustin | 11:cada08fc8a70 | 1658 | 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); |
mbedAustin | 11:cada08fc8a70 | 1659 | |
mbedAustin | 11:cada08fc8a70 | 1660 | /* Check block size */ |
mbedAustin | 11:cada08fc8a70 | 1661 | 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); |
mbedAustin | 11:cada08fc8a70 | 1662 | if (block_temp > sn_coap_convert_block_size(sn_coap_block_data_size)) { |
mbedAustin | 11:cada08fc8a70 | 1663 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_len - 1)) &= 0xF8; |
mbedAustin | 11:cada08fc8a70 | 1664 | *(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); |
mbedAustin | 11:cada08fc8a70 | 1665 | } |
mbedAustin | 11:cada08fc8a70 | 1666 | |
mbedAustin | 11:cada08fc8a70 | 1667 | src_coap_blockwise_ack_msg_ptr->msg_id = received_coap_msg_ptr->msg_id; |
mbedAustin | 11:cada08fc8a70 | 1668 | |
mbedAustin | 11:cada08fc8a70 | 1669 | dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1670 | |
mbedAustin | 11:cada08fc8a70 | 1671 | dst_ack_packet_data_ptr = handle->sn_coap_protocol_malloc(dst_packed_data_needed_mem); |
mbedAustin | 11:cada08fc8a70 | 1672 | if (!dst_ack_packet_data_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1673 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1674 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr); |
mbedAustin | 11:cada08fc8a70 | 1675 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1676 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1677 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1678 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1679 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1680 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1681 | } |
mbedAustin | 11:cada08fc8a70 | 1682 | |
mbedAustin | 11:cada08fc8a70 | 1683 | sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1684 | |
mbedAustin | 11:cada08fc8a70 | 1685 | handle->sn_coap_tx_callback(dst_ack_packet_data_ptr, dst_packed_data_needed_mem, src_addr_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 1686 | |
mbedAustin | 11:cada08fc8a70 | 1687 | sn_coap_parser_release_allocated_coap_msg_mem(handle, src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1688 | handle->sn_coap_protocol_free(dst_ack_packet_data_ptr); |
mbedAustin | 11:cada08fc8a70 | 1689 | dst_ack_packet_data_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1690 | |
mbedAustin | 11:cada08fc8a70 | 1691 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVING; |
mbedAustin | 11:cada08fc8a70 | 1692 | |
mbedAustin | 11:cada08fc8a70 | 1693 | } else { |
mbedAustin | 11:cada08fc8a70 | 1694 | /* * * This is the last block when whole Blockwise payload from received * * */ |
mbedAustin | 11:cada08fc8a70 | 1695 | /* * * blockwise messages is gathered and returned to User * * */ |
mbedAustin | 11:cada08fc8a70 | 1696 | |
mbedAustin | 11:cada08fc8a70 | 1697 | /* Store last Blockwise payload to Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1698 | uint16_t payload_len = 0; |
mbedAustin | 11:cada08fc8a70 | 1699 | uint8_t *payload_ptr = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len); |
mbedAustin | 11:cada08fc8a70 | 1700 | uint16_t whole_payload_len = sn_coap_protocol_linked_list_blockwise_payloads_get_len(src_addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1701 | uint8_t *temp_whole_payload_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1702 | |
mbedAustin | 11:cada08fc8a70 | 1703 | temp_whole_payload_ptr = handle->sn_coap_protocol_malloc(whole_payload_len); |
mbedAustin | 11:cada08fc8a70 | 1704 | if (!temp_whole_payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1705 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1706 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1707 | } |
mbedAustin | 11:cada08fc8a70 | 1708 | |
mbedAustin | 11:cada08fc8a70 | 1709 | //TODO: This might cause crashes, but if not deleted leaks memory? |
mbedAustin | 11:cada08fc8a70 | 1710 | if( received_coap_msg_ptr->payload_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 1711 | free(received_coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1712 | } |
mbedAustin | 11:cada08fc8a70 | 1713 | received_coap_msg_ptr->payload_ptr = temp_whole_payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 1714 | received_coap_msg_ptr->payload_len = whole_payload_len; |
mbedAustin | 11:cada08fc8a70 | 1715 | |
mbedAustin | 11:cada08fc8a70 | 1716 | /* Copy stored Blockwise payloads to returned whole Blockwise payload pointer */ |
mbedAustin | 11:cada08fc8a70 | 1717 | while (payload_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1718 | memcpy(temp_whole_payload_ptr, payload_ptr, payload_len); |
mbedAustin | 11:cada08fc8a70 | 1719 | |
mbedAustin | 11:cada08fc8a70 | 1720 | temp_whole_payload_ptr += payload_len; |
mbedAustin | 11:cada08fc8a70 | 1721 | |
mbedAustin | 11:cada08fc8a70 | 1722 | sn_coap_protocol_linked_list_blockwise_payload_remove_oldest(handle); |
mbedAustin | 11:cada08fc8a70 | 1723 | payload_ptr = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len); |
mbedAustin | 11:cada08fc8a70 | 1724 | } |
mbedAustin | 11:cada08fc8a70 | 1725 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVED; |
mbedAustin | 11:cada08fc8a70 | 1726 | } |
mbedAustin | 11:cada08fc8a70 | 1727 | } |
mbedAustin | 11:cada08fc8a70 | 1728 | } |
mbedAustin | 11:cada08fc8a70 | 1729 | |
mbedAustin | 11:cada08fc8a70 | 1730 | |
mbedAustin | 11:cada08fc8a70 | 1731 | /* Block2 Option in a response (e.g., a 2.05 response for GET) */ |
mbedAustin | 11:cada08fc8a70 | 1732 | /* Message ID must be same than in received message */ |
mbedAustin | 11:cada08fc8a70 | 1733 | else { |
mbedAustin | 11:cada08fc8a70 | 1734 | //This is response to request we made |
mbedAustin | 11:cada08fc8a70 | 1735 | if (received_coap_msg_ptr->msg_code > COAP_MSG_CODE_REQUEST_DELETE) { |
mbedAustin | 11:cada08fc8a70 | 1736 | uint32_t block_number = 0; |
mbedAustin | 11:cada08fc8a70 | 1737 | |
mbedAustin | 11:cada08fc8a70 | 1738 | /* Store blockwise payload to Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1739 | //todo: add block number to stored values - just to make sure all packets are in order |
mbedAustin | 11:cada08fc8a70 | 1740 | sn_coap_protocol_linked_list_blockwise_payload_store(handle, src_addr_ptr, received_coap_msg_ptr->payload_len, received_coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1741 | |
mbedAustin | 11:cada08fc8a70 | 1742 | /* If not last block (more value is set) */ |
mbedAustin | 11:cada08fc8a70 | 1743 | if (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + (received_coap_msg_ptr->options_list_ptr->block2_len - 1)) & 0x08) { |
mbedAustin | 11:cada08fc8a70 | 1744 | coap_blockwise_msg_s *previous_blockwise_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1745 | |
mbedAustin | 11:cada08fc8a70 | 1746 | //build and send ack |
mbedAustin | 11:cada08fc8a70 | 1747 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVING; |
mbedAustin | 11:cada08fc8a70 | 1748 | |
mbedAustin | 11:cada08fc8a70 | 1749 | ns_list_foreach(coap_blockwise_msg_s, msg, &global_linked_list_blockwise_sent_msgs) { |
mbedAustin | 11:cada08fc8a70 | 1750 | if (received_coap_msg_ptr->msg_id == msg->coap_msg_ptr->msg_id) { |
mbedAustin | 11:cada08fc8a70 | 1751 | previous_blockwise_msg_ptr = msg; |
mbedAustin | 11:cada08fc8a70 | 1752 | break; |
mbedAustin | 11:cada08fc8a70 | 1753 | } |
mbedAustin | 11:cada08fc8a70 | 1754 | } |
mbedAustin | 11:cada08fc8a70 | 1755 | |
mbedAustin | 11:cada08fc8a70 | 1756 | if (!previous_blockwise_msg_ptr || !previous_blockwise_msg_ptr->coap_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1757 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1758 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1759 | } |
mbedAustin | 11:cada08fc8a70 | 1760 | |
mbedAustin | 11:cada08fc8a70 | 1761 | src_coap_blockwise_ack_msg_ptr = (sn_coap_hdr_s*)handle->sn_coap_protocol_malloc(sizeof(sn_coap_hdr_s)); |
mbedAustin | 11:cada08fc8a70 | 1762 | if( !src_coap_blockwise_ack_msg_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 1763 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1764 | } |
mbedAustin | 11:cada08fc8a70 | 1765 | memset(src_coap_blockwise_ack_msg_ptr,0,sizeof(sn_coap_hdr_s)); |
mbedAustin | 11:cada08fc8a70 | 1766 | |
mbedAustin | 11:cada08fc8a70 | 1767 | ns_list_remove(&global_linked_list_blockwise_sent_msgs, previous_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1768 | if( previous_blockwise_msg_ptr->coap_msg_ptr ){ |
mbedAustin | 11:cada08fc8a70 | 1769 | if(previous_blockwise_msg_ptr->coap_msg_ptr->payload_ptr){ |
mbedAustin | 11:cada08fc8a70 | 1770 | handle->sn_coap_protocol_free(previous_blockwise_msg_ptr->coap_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 1771 | previous_blockwise_msg_ptr->coap_msg_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1772 | } |
mbedAustin | 11:cada08fc8a70 | 1773 | sn_coap_parser_release_allocated_coap_msg_mem(handle, previous_blockwise_msg_ptr->coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1774 | previous_blockwise_msg_ptr->coap_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1775 | } |
mbedAustin | 11:cada08fc8a70 | 1776 | handle->sn_coap_protocol_free(previous_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1777 | previous_blockwise_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1778 | |
mbedAustin | 11:cada08fc8a70 | 1779 | // if (src_coap_blockwise_ack_msg_ptr->payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1780 | |
mbedAustin | 11:cada08fc8a70 | 1781 | // src_coap_blockwise_ack_msg_ptr->payload_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1782 | // src_coap_blockwise_ack_msg_ptr->payload_len = 0; |
mbedAustin | 11:cada08fc8a70 | 1783 | // } |
mbedAustin | 11:cada08fc8a70 | 1784 | |
mbedAustin | 11:cada08fc8a70 | 1785 | /* * * Then build CoAP Acknowledgement message * * */ |
mbedAustin | 11:cada08fc8a70 | 1786 | |
mbedAustin | 11:cada08fc8a70 | 1787 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 1788 | if (!src_coap_blockwise_ack_msg_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1789 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1790 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1791 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1792 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1793 | } |
mbedAustin | 11:cada08fc8a70 | 1794 | memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 1795 | |
mbedAustin | 11:cada08fc8a70 | 1796 | src_coap_blockwise_ack_msg_ptr->msg_id = message_id++; |
mbedAustin | 11:cada08fc8a70 | 1797 | if (message_id == 0) { |
mbedAustin | 11:cada08fc8a70 | 1798 | message_id = 1; |
mbedAustin | 11:cada08fc8a70 | 1799 | } |
mbedAustin | 11:cada08fc8a70 | 1800 | |
mbedAustin | 11:cada08fc8a70 | 1801 | // if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1802 | // handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 1803 | // src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1804 | // } |
mbedAustin | 11:cada08fc8a70 | 1805 | |
mbedAustin | 11:cada08fc8a70 | 1806 | /* Update block option */ |
mbedAustin | 11:cada08fc8a70 | 1807 | block_temp = *(received_coap_msg_ptr->options_list_ptr->block2_ptr + (received_coap_msg_ptr->options_list_ptr->block2_len - 1)) & 0x07; |
mbedAustin | 11:cada08fc8a70 | 1808 | |
mbedAustin | 11:cada08fc8a70 | 1809 | if (received_coap_msg_ptr->options_list_ptr->block2_len == 3) { |
mbedAustin | 11:cada08fc8a70 | 1810 | block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 12; |
mbedAustin | 11:cada08fc8a70 | 1811 | block_number |= *(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1) << 4; |
mbedAustin | 11:cada08fc8a70 | 1812 | block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 2)) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1813 | } |
mbedAustin | 11:cada08fc8a70 | 1814 | |
mbedAustin | 11:cada08fc8a70 | 1815 | else if (received_coap_msg_ptr->options_list_ptr->block2_len == 2) { |
mbedAustin | 11:cada08fc8a70 | 1816 | block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 4; |
mbedAustin | 11:cada08fc8a70 | 1817 | block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1)) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1818 | } else if (received_coap_msg_ptr->options_list_ptr->block2_len == 1) { |
mbedAustin | 11:cada08fc8a70 | 1819 | block_number = (*received_coap_msg_ptr->options_list_ptr->block2_ptr) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1820 | } |
mbedAustin | 11:cada08fc8a70 | 1821 | |
mbedAustin | 11:cada08fc8a70 | 1822 | block_number ++; |
mbedAustin | 11:cada08fc8a70 | 1823 | |
mbedAustin | 11:cada08fc8a70 | 1824 | if (block_number <= 0x0f) { |
mbedAustin | 11:cada08fc8a70 | 1825 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = 1; |
mbedAustin | 11:cada08fc8a70 | 1826 | } else if (block_number <= 0x0fff) { |
mbedAustin | 11:cada08fc8a70 | 1827 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = 2; |
mbedAustin | 11:cada08fc8a70 | 1828 | } else if (block_number <= 0x0fffff) { |
mbedAustin | 11:cada08fc8a70 | 1829 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = 3; |
mbedAustin | 11:cada08fc8a70 | 1830 | } |
mbedAustin | 11:cada08fc8a70 | 1831 | |
mbedAustin | 11:cada08fc8a70 | 1832 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = handle->sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len); |
mbedAustin | 11:cada08fc8a70 | 1833 | |
mbedAustin | 11:cada08fc8a70 | 1834 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr == 0) { |
mbedAustin | 11:cada08fc8a70 | 1835 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1836 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1837 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1838 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1839 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1840 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1841 | } |
mbedAustin | 11:cada08fc8a70 | 1842 | |
mbedAustin | 11:cada08fc8a70 | 1843 | *(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; |
mbedAustin | 11:cada08fc8a70 | 1844 | |
mbedAustin | 11:cada08fc8a70 | 1845 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len == 3) { |
mbedAustin | 11:cada08fc8a70 | 1846 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + 2) = block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1847 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + 1) |= block_number >> 4; |
mbedAustin | 11:cada08fc8a70 | 1848 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr |= block_number >> 12; |
mbedAustin | 11:cada08fc8a70 | 1849 | } else if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len == 2) { |
mbedAustin | 11:cada08fc8a70 | 1850 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + 1) = block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1851 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr |= block_number >> 4; |
mbedAustin | 11:cada08fc8a70 | 1852 | } else { |
mbedAustin | 11:cada08fc8a70 | 1853 | *src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr |= block_number << 4; |
mbedAustin | 11:cada08fc8a70 | 1854 | } |
mbedAustin | 11:cada08fc8a70 | 1855 | |
mbedAustin | 11:cada08fc8a70 | 1856 | /* Then get needed memory count for Packet data */ |
mbedAustin | 11:cada08fc8a70 | 1857 | dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1858 | |
mbedAustin | 11:cada08fc8a70 | 1859 | /* Then allocate memory for Packet data */ |
mbedAustin | 11:cada08fc8a70 | 1860 | dst_ack_packet_data_ptr = handle->sn_coap_protocol_malloc(dst_packed_data_needed_mem); |
mbedAustin | 11:cada08fc8a70 | 1861 | |
mbedAustin | 11:cada08fc8a70 | 1862 | if (dst_ack_packet_data_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 1863 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 1864 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1865 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1866 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1867 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1868 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1869 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1870 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1871 | } |
mbedAustin | 11:cada08fc8a70 | 1872 | memset(dst_ack_packet_data_ptr, 0, dst_packed_data_needed_mem); |
mbedAustin | 11:cada08fc8a70 | 1873 | |
mbedAustin | 11:cada08fc8a70 | 1874 | /* * * Then build Acknowledgement message to Packed data * * */ |
mbedAustin | 11:cada08fc8a70 | 1875 | if ((sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr)) < 0) { |
mbedAustin | 11:cada08fc8a70 | 1876 | handle->sn_coap_protocol_free(dst_ack_packet_data_ptr); |
mbedAustin | 11:cada08fc8a70 | 1877 | dst_ack_packet_data_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1878 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 1879 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1880 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1881 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1882 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1883 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1884 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1885 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 1886 | } |
mbedAustin | 11:cada08fc8a70 | 1887 | |
mbedAustin | 11:cada08fc8a70 | 1888 | /* * * Save to linked list * * */ |
mbedAustin | 11:cada08fc8a70 | 1889 | coap_blockwise_msg_s *stored_blockwise_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 1890 | |
mbedAustin | 11:cada08fc8a70 | 1891 | stored_blockwise_msg_ptr = handle->sn_coap_protocol_malloc(sizeof(coap_blockwise_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 1892 | if (!stored_blockwise_msg_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1893 | handle->sn_coap_protocol_free(dst_ack_packet_data_ptr); |
mbedAustin | 11:cada08fc8a70 | 1894 | dst_ack_packet_data_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1895 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 1896 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1897 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 1898 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1899 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1900 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1901 | sn_coap_parser_release_allocated_coap_msg_mem(handle, received_coap_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1902 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1903 | } |
mbedAustin | 11:cada08fc8a70 | 1904 | memset(stored_blockwise_msg_ptr, 0, sizeof(coap_blockwise_msg_s)); |
mbedAustin | 11:cada08fc8a70 | 1905 | |
mbedAustin | 11:cada08fc8a70 | 1906 | stored_blockwise_msg_ptr->timestamp = global_system_time; |
mbedAustin | 11:cada08fc8a70 | 1907 | |
mbedAustin | 11:cada08fc8a70 | 1908 | stored_blockwise_msg_ptr->coap_msg_ptr = src_coap_blockwise_ack_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 1909 | stored_blockwise_msg_ptr->coap = handle; |
mbedAustin | 11:cada08fc8a70 | 1910 | |
mbedAustin | 11:cada08fc8a70 | 1911 | ns_list_add_to_end(&global_linked_list_blockwise_sent_msgs, stored_blockwise_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 1912 | |
mbedAustin | 11:cada08fc8a70 | 1913 | /* * * Then release memory of CoAP Acknowledgement message * * */ |
mbedAustin | 11:cada08fc8a70 | 1914 | handle->sn_coap_tx_callback(dst_ack_packet_data_ptr, |
mbedAustin | 11:cada08fc8a70 | 1915 | dst_packed_data_needed_mem, src_addr_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 1916 | |
mbedAustin | 11:cada08fc8a70 | 1917 | #if ENABLE_RESENDINGS |
mbedAustin | 11:cada08fc8a70 | 1918 | sn_coap_protocol_linked_list_send_msg_store(handle, src_addr_ptr, |
mbedAustin | 11:cada08fc8a70 | 1919 | dst_packed_data_needed_mem, |
mbedAustin | 11:cada08fc8a70 | 1920 | dst_ack_packet_data_ptr, |
mbedAustin | 11:cada08fc8a70 | 1921 | global_system_time + (uint32_t)(sn_coap_resending_intervall * RESPONSE_RANDOM_FACTOR), param); |
mbedAustin | 11:cada08fc8a70 | 1922 | #endif |
mbedAustin | 11:cada08fc8a70 | 1923 | handle->sn_coap_protocol_free(dst_ack_packet_data_ptr); |
mbedAustin | 11:cada08fc8a70 | 1924 | dst_ack_packet_data_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1925 | } |
mbedAustin | 11:cada08fc8a70 | 1926 | |
mbedAustin | 11:cada08fc8a70 | 1927 | //Last block received |
mbedAustin | 11:cada08fc8a70 | 1928 | else { |
mbedAustin | 11:cada08fc8a70 | 1929 | /* * * This is the last block when whole Blockwise payload from received * * */ |
mbedAustin | 11:cada08fc8a70 | 1930 | /* * * blockwise messages is gathered and returned to User * * */ |
mbedAustin | 11:cada08fc8a70 | 1931 | |
mbedAustin | 11:cada08fc8a70 | 1932 | /* Store last Blockwise payload to Linked list */ |
mbedAustin | 11:cada08fc8a70 | 1933 | uint16_t payload_len = 0; |
mbedAustin | 11:cada08fc8a70 | 1934 | uint8_t *payload_ptr = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len); |
mbedAustin | 11:cada08fc8a70 | 1935 | uint16_t whole_payload_len = sn_coap_protocol_linked_list_blockwise_payloads_get_len(src_addr_ptr); |
mbedAustin | 11:cada08fc8a70 | 1936 | uint8_t *temp_whole_payload_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 1937 | |
mbedAustin | 11:cada08fc8a70 | 1938 | temp_whole_payload_ptr = handle->sn_coap_protocol_malloc(whole_payload_len); |
mbedAustin | 11:cada08fc8a70 | 1939 | if (!temp_whole_payload_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1940 | return 0; |
mbedAustin | 11:cada08fc8a70 | 1941 | } |
mbedAustin | 11:cada08fc8a70 | 1942 | |
mbedAustin | 11:cada08fc8a70 | 1943 | received_coap_msg_ptr->payload_ptr = temp_whole_payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 1944 | received_coap_msg_ptr->payload_len = whole_payload_len; |
mbedAustin | 11:cada08fc8a70 | 1945 | |
mbedAustin | 11:cada08fc8a70 | 1946 | /* Copy stored Blockwise payloads to returned whole Blockwise payload pointer */ |
mbedAustin | 11:cada08fc8a70 | 1947 | while (payload_ptr != NULL) { |
mbedAustin | 11:cada08fc8a70 | 1948 | memcpy(temp_whole_payload_ptr, payload_ptr, payload_len); |
mbedAustin | 11:cada08fc8a70 | 1949 | |
mbedAustin | 11:cada08fc8a70 | 1950 | temp_whole_payload_ptr += payload_len; |
mbedAustin | 11:cada08fc8a70 | 1951 | |
mbedAustin | 11:cada08fc8a70 | 1952 | sn_coap_protocol_linked_list_blockwise_payload_remove_oldest(handle); |
mbedAustin | 11:cada08fc8a70 | 1953 | payload_ptr = sn_coap_protocol_linked_list_blockwise_payload_search(src_addr_ptr, &payload_len); |
mbedAustin | 11:cada08fc8a70 | 1954 | } |
mbedAustin | 11:cada08fc8a70 | 1955 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_MSG_RECEIVED; |
mbedAustin | 11:cada08fc8a70 | 1956 | |
mbedAustin | 11:cada08fc8a70 | 1957 | //todo: remove previous msg from list |
mbedAustin | 11:cada08fc8a70 | 1958 | } |
mbedAustin | 11:cada08fc8a70 | 1959 | |
mbedAustin | 11:cada08fc8a70 | 1960 | } |
mbedAustin | 11:cada08fc8a70 | 1961 | |
mbedAustin | 11:cada08fc8a70 | 1962 | //Now we send data to request |
mbedAustin | 11:cada08fc8a70 | 1963 | else { |
mbedAustin | 11:cada08fc8a70 | 1964 | //Get message by using block number |
mbedAustin | 11:cada08fc8a70 | 1965 | //NOTE: Getting the first from list might not be correct one |
mbedAustin | 11:cada08fc8a70 | 1966 | coap_blockwise_msg_s *stored_blockwise_msg_temp_ptr = ns_list_get_first(&global_linked_list_blockwise_sent_msgs); |
mbedAustin | 11:cada08fc8a70 | 1967 | if (stored_blockwise_msg_temp_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1968 | uint16_t block_size = 1; |
mbedAustin | 11:cada08fc8a70 | 1969 | uint32_t block_number = 0; |
mbedAustin | 11:cada08fc8a70 | 1970 | |
mbedAustin | 11:cada08fc8a70 | 1971 | /* Resolve block parameters */ |
mbedAustin | 11:cada08fc8a70 | 1972 | if (received_coap_msg_ptr->options_list_ptr->block2_len == 3) { |
mbedAustin | 11:cada08fc8a70 | 1973 | block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 12; |
mbedAustin | 11:cada08fc8a70 | 1974 | block_number |= *(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1) << 4; |
mbedAustin | 11:cada08fc8a70 | 1975 | block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 2)) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1976 | } |
mbedAustin | 11:cada08fc8a70 | 1977 | |
mbedAustin | 11:cada08fc8a70 | 1978 | else if (received_coap_msg_ptr->options_list_ptr->block2_len == 2) { |
mbedAustin | 11:cada08fc8a70 | 1979 | block_number = *(received_coap_msg_ptr->options_list_ptr->block2_ptr) << 4; |
mbedAustin | 11:cada08fc8a70 | 1980 | block_number |= (*(received_coap_msg_ptr->options_list_ptr->block2_ptr + 1)) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1981 | } else if (received_coap_msg_ptr->options_list_ptr->block2_len == 1) { |
mbedAustin | 11:cada08fc8a70 | 1982 | block_number = (*received_coap_msg_ptr->options_list_ptr->block2_ptr) >> 4; |
mbedAustin | 11:cada08fc8a70 | 1983 | } |
mbedAustin | 11:cada08fc8a70 | 1984 | |
mbedAustin | 11:cada08fc8a70 | 1985 | block_temp = *(received_coap_msg_ptr->options_list_ptr->block2_ptr + (received_coap_msg_ptr->options_list_ptr->block2_len - 1)) & 0x07; |
mbedAustin | 11:cada08fc8a70 | 1986 | block_size = block_size << (block_temp + 4); |
mbedAustin | 11:cada08fc8a70 | 1987 | |
mbedAustin | 11:cada08fc8a70 | 1988 | /* Build response message */ |
mbedAustin | 11:cada08fc8a70 | 1989 | src_coap_blockwise_ack_msg_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 1990 | |
mbedAustin | 11:cada08fc8a70 | 1991 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1992 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1993 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr); |
mbedAustin | 11:cada08fc8a70 | 1994 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block1_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 1995 | |
mbedAustin | 11:cada08fc8a70 | 1996 | } |
mbedAustin | 11:cada08fc8a70 | 1997 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr) { |
mbedAustin | 11:cada08fc8a70 | 1998 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 1999 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 2000 | } |
mbedAustin | 11:cada08fc8a70 | 2001 | } else { |
mbedAustin | 11:cada08fc8a70 | 2002 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 2003 | if (!src_coap_blockwise_ack_msg_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2004 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2005 | } |
mbedAustin | 11:cada08fc8a70 | 2006 | memset(src_coap_blockwise_ack_msg_ptr->options_list_ptr, 0, (sizeof(sn_coap_options_list_s))); |
mbedAustin | 11:cada08fc8a70 | 2007 | } |
mbedAustin | 11:cada08fc8a70 | 2008 | |
mbedAustin | 11:cada08fc8a70 | 2009 | |
mbedAustin | 11:cada08fc8a70 | 2010 | src_coap_blockwise_ack_msg_ptr->msg_id = received_coap_msg_ptr->msg_id; |
mbedAustin | 11:cada08fc8a70 | 2011 | |
mbedAustin | 11:cada08fc8a70 | 2012 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len = received_coap_msg_ptr->options_list_ptr->block2_len; |
mbedAustin | 11:cada08fc8a70 | 2013 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = handle->sn_coap_protocol_malloc(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len); |
mbedAustin | 11:cada08fc8a70 | 2014 | |
mbedAustin | 11:cada08fc8a70 | 2015 | if (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr == NULL) { |
mbedAustin | 11:cada08fc8a70 | 2016 | if(src_coap_blockwise_ack_msg_ptr->payload_ptr){ |
mbedAustin | 11:cada08fc8a70 | 2017 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 2018 | } |
mbedAustin | 11:cada08fc8a70 | 2019 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 2020 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 2021 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 2022 | stored_blockwise_msg_temp_ptr->coap_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 2023 | src_coap_blockwise_ack_msg_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 2024 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 2025 | } |
mbedAustin | 11:cada08fc8a70 | 2026 | 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); |
mbedAustin | 11:cada08fc8a70 | 2027 | |
mbedAustin | 11:cada08fc8a70 | 2028 | /* * Payload part * */ |
mbedAustin | 11:cada08fc8a70 | 2029 | |
mbedAustin | 11:cada08fc8a70 | 2030 | /* Check if last block */ |
mbedAustin | 11:cada08fc8a70 | 2031 | |
mbedAustin | 11:cada08fc8a70 | 2032 | original_payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len; |
mbedAustin | 11:cada08fc8a70 | 2033 | original_payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 2034 | |
mbedAustin | 11:cada08fc8a70 | 2035 | if ((block_size * (block_number + 1)) > stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len) { |
mbedAustin | 11:cada08fc8a70 | 2036 | src_coap_blockwise_ack_msg_ptr->payload_len = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len - (block_size * block_number); |
mbedAustin | 11:cada08fc8a70 | 2037 | src_coap_blockwise_ack_msg_ptr->payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr + (block_size * block_number); |
mbedAustin | 11:cada08fc8a70 | 2038 | } |
mbedAustin | 11:cada08fc8a70 | 2039 | /* Not last block */ |
mbedAustin | 11:cada08fc8a70 | 2040 | else { |
mbedAustin | 11:cada08fc8a70 | 2041 | /* set more - bit */ |
mbedAustin | 11:cada08fc8a70 | 2042 | *(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr + (src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_len - 1)) |= 0x08; |
mbedAustin | 11:cada08fc8a70 | 2043 | src_coap_blockwise_ack_msg_ptr->payload_len = block_size; |
mbedAustin | 11:cada08fc8a70 | 2044 | src_coap_blockwise_ack_msg_ptr->payload_ptr = stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr + (block_size * block_number); |
mbedAustin | 11:cada08fc8a70 | 2045 | } |
mbedAustin | 11:cada08fc8a70 | 2046 | |
mbedAustin | 11:cada08fc8a70 | 2047 | /* Build and send block message */ |
mbedAustin | 11:cada08fc8a70 | 2048 | dst_packed_data_needed_mem = sn_coap_builder_calc_needed_packet_data_size(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 2049 | |
mbedAustin | 11:cada08fc8a70 | 2050 | dst_ack_packet_data_ptr = handle->sn_coap_protocol_malloc(dst_packed_data_needed_mem); |
mbedAustin | 11:cada08fc8a70 | 2051 | if (!dst_ack_packet_data_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2052 | if(original_payload_ptr){ |
mbedAustin | 11:cada08fc8a70 | 2053 | handle->sn_coap_protocol_free(original_payload_ptr); |
mbedAustin | 11:cada08fc8a70 | 2054 | original_payload_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 2055 | } |
mbedAustin | 11:cada08fc8a70 | 2056 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr); |
mbedAustin | 11:cada08fc8a70 | 2057 | src_coap_blockwise_ack_msg_ptr->options_list_ptr->block2_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 2058 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr->options_list_ptr); |
mbedAustin | 11:cada08fc8a70 | 2059 | src_coap_blockwise_ack_msg_ptr->options_list_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 2060 | handle->sn_coap_protocol_free(src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 2061 | stored_blockwise_msg_temp_ptr->coap_msg_ptr = NULL; |
mbedAustin | 11:cada08fc8a70 | 2062 | return NULL; |
mbedAustin | 11:cada08fc8a70 | 2063 | } |
mbedAustin | 11:cada08fc8a70 | 2064 | |
mbedAustin | 11:cada08fc8a70 | 2065 | sn_coap_builder(dst_ack_packet_data_ptr, src_coap_blockwise_ack_msg_ptr); |
mbedAustin | 11:cada08fc8a70 | 2066 | |
mbedAustin | 11:cada08fc8a70 | 2067 | handle->sn_coap_tx_callback(dst_ack_packet_data_ptr, dst_packed_data_needed_mem, src_addr_ptr, param); |
mbedAustin | 11:cada08fc8a70 | 2068 | |
mbedAustin | 11:cada08fc8a70 | 2069 | handle->sn_coap_protocol_free(dst_ack_packet_data_ptr); |
mbedAustin | 11:cada08fc8a70 | 2070 | dst_ack_packet_data_ptr = 0; |
mbedAustin | 11:cada08fc8a70 | 2071 | |
mbedAustin | 11:cada08fc8a70 | 2072 | stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len = original_payload_len; |
mbedAustin | 11:cada08fc8a70 | 2073 | stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_ptr = original_payload_ptr; |
mbedAustin | 11:cada08fc8a70 | 2074 | |
mbedAustin | 11:cada08fc8a70 | 2075 | if ((block_size * (block_number + 1)) > stored_blockwise_msg_temp_ptr->coap_msg_ptr->payload_len) { |
mbedAustin | 11:cada08fc8a70 | 2076 | sn_coap_protocol_linked_list_blockwise_msg_remove(handle, stored_blockwise_msg_temp_ptr); |
mbedAustin | 11:cada08fc8a70 | 2077 | } |
mbedAustin | 11:cada08fc8a70 | 2078 | |
mbedAustin | 11:cada08fc8a70 | 2079 | received_coap_msg_ptr->coap_status = COAP_STATUS_PARSER_BLOCKWISE_ACK; |
mbedAustin | 11:cada08fc8a70 | 2080 | } |
mbedAustin | 11:cada08fc8a70 | 2081 | } |
mbedAustin | 11:cada08fc8a70 | 2082 | } |
mbedAustin | 11:cada08fc8a70 | 2083 | return received_coap_msg_ptr; |
mbedAustin | 11:cada08fc8a70 | 2084 | } |
mbedAustin | 11:cada08fc8a70 | 2085 | |
mbedAustin | 11:cada08fc8a70 | 2086 | static int8_t sn_coap_convert_block_size(uint16_t block_size) |
mbedAustin | 11:cada08fc8a70 | 2087 | { |
mbedAustin | 11:cada08fc8a70 | 2088 | if (block_size == 16) { |
mbedAustin | 11:cada08fc8a70 | 2089 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2090 | } else if (block_size == 32) { |
mbedAustin | 11:cada08fc8a70 | 2091 | return 1; |
mbedAustin | 11:cada08fc8a70 | 2092 | } else if (block_size == 64) { |
mbedAustin | 11:cada08fc8a70 | 2093 | return 2; |
mbedAustin | 11:cada08fc8a70 | 2094 | } else if (block_size == 128) { |
mbedAustin | 11:cada08fc8a70 | 2095 | return 3; |
mbedAustin | 11:cada08fc8a70 | 2096 | } else if (block_size == 256) { |
mbedAustin | 11:cada08fc8a70 | 2097 | return 4; |
mbedAustin | 11:cada08fc8a70 | 2098 | } else if (block_size == 512) { |
mbedAustin | 11:cada08fc8a70 | 2099 | return 5; |
mbedAustin | 11:cada08fc8a70 | 2100 | } else if (block_size == 1024) { |
mbedAustin | 11:cada08fc8a70 | 2101 | return 6; |
mbedAustin | 11:cada08fc8a70 | 2102 | } |
mbedAustin | 11:cada08fc8a70 | 2103 | |
mbedAustin | 11:cada08fc8a70 | 2104 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2105 | } |
mbedAustin | 11:cada08fc8a70 | 2106 | |
mbedAustin | 11:cada08fc8a70 | 2107 | static sn_coap_hdr_s *sn_coap_protocol_copy_header(struct coap_s *handle, sn_coap_hdr_s *source_header_ptr) |
mbedAustin | 11:cada08fc8a70 | 2108 | { |
mbedAustin | 11:cada08fc8a70 | 2109 | sn_coap_hdr_s *destination_header_ptr; |
mbedAustin | 11:cada08fc8a70 | 2110 | |
mbedAustin | 11:cada08fc8a70 | 2111 | destination_header_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_hdr_s)); |
mbedAustin | 11:cada08fc8a70 | 2112 | if (!destination_header_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2113 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2114 | } |
mbedAustin | 11:cada08fc8a70 | 2115 | memset(destination_header_ptr, 0, sizeof(sn_coap_hdr_s)); |
mbedAustin | 11:cada08fc8a70 | 2116 | |
mbedAustin | 11:cada08fc8a70 | 2117 | destination_header_ptr->coap_status = source_header_ptr->coap_status; |
mbedAustin | 11:cada08fc8a70 | 2118 | destination_header_ptr->msg_type = source_header_ptr->msg_type; |
mbedAustin | 11:cada08fc8a70 | 2119 | destination_header_ptr->msg_code = source_header_ptr->msg_code; |
mbedAustin | 11:cada08fc8a70 | 2120 | destination_header_ptr->msg_id = source_header_ptr->msg_id; |
mbedAustin | 11:cada08fc8a70 | 2121 | |
mbedAustin | 11:cada08fc8a70 | 2122 | if (source_header_ptr->uri_path_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2123 | destination_header_ptr->uri_path_len = source_header_ptr->uri_path_len; |
mbedAustin | 11:cada08fc8a70 | 2124 | destination_header_ptr->uri_path_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->uri_path_len); |
mbedAustin | 11:cada08fc8a70 | 2125 | if (!destination_header_ptr->uri_path_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2126 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2127 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2128 | } |
mbedAustin | 11:cada08fc8a70 | 2129 | memcpy(destination_header_ptr->uri_path_ptr, source_header_ptr->uri_path_ptr, source_header_ptr->uri_path_len); |
mbedAustin | 11:cada08fc8a70 | 2130 | } |
mbedAustin | 11:cada08fc8a70 | 2131 | |
mbedAustin | 11:cada08fc8a70 | 2132 | if (source_header_ptr->token_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2133 | destination_header_ptr->token_len = source_header_ptr->token_len; |
mbedAustin | 11:cada08fc8a70 | 2134 | destination_header_ptr->token_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->token_len); |
mbedAustin | 11:cada08fc8a70 | 2135 | if (!destination_header_ptr->token_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2136 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2137 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2138 | } |
mbedAustin | 11:cada08fc8a70 | 2139 | memcpy(destination_header_ptr->token_ptr, source_header_ptr->token_ptr, source_header_ptr->token_len); |
mbedAustin | 11:cada08fc8a70 | 2140 | } |
mbedAustin | 11:cada08fc8a70 | 2141 | |
mbedAustin | 11:cada08fc8a70 | 2142 | if (source_header_ptr->content_type_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2143 | destination_header_ptr->content_type_len = source_header_ptr->content_type_len; |
mbedAustin | 11:cada08fc8a70 | 2144 | destination_header_ptr->content_type_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->content_type_len); |
mbedAustin | 11:cada08fc8a70 | 2145 | if (!destination_header_ptr->content_type_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2146 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2147 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2148 | } |
mbedAustin | 11:cada08fc8a70 | 2149 | memcpy(destination_header_ptr->content_type_ptr, source_header_ptr->content_type_ptr, source_header_ptr->content_type_len); |
mbedAustin | 11:cada08fc8a70 | 2150 | } |
mbedAustin | 11:cada08fc8a70 | 2151 | |
mbedAustin | 11:cada08fc8a70 | 2152 | /* Options list */ |
mbedAustin | 11:cada08fc8a70 | 2153 | if (source_header_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2154 | destination_header_ptr->options_list_ptr = handle->sn_coap_protocol_malloc(sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 2155 | if (!destination_header_ptr->options_list_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2156 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2157 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2158 | } |
mbedAustin | 11:cada08fc8a70 | 2159 | memset(destination_header_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s)); |
mbedAustin | 11:cada08fc8a70 | 2160 | |
mbedAustin | 11:cada08fc8a70 | 2161 | |
mbedAustin | 11:cada08fc8a70 | 2162 | if (source_header_ptr->options_list_ptr->max_age_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2163 | destination_header_ptr->options_list_ptr->max_age_len = source_header_ptr->options_list_ptr->max_age_len; |
mbedAustin | 11:cada08fc8a70 | 2164 | destination_header_ptr->options_list_ptr->max_age_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->max_age_len); |
mbedAustin | 11:cada08fc8a70 | 2165 | if (!destination_header_ptr->options_list_ptr->max_age_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2166 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2167 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2168 | } |
mbedAustin | 11:cada08fc8a70 | 2169 | 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); |
mbedAustin | 11:cada08fc8a70 | 2170 | } |
mbedAustin | 11:cada08fc8a70 | 2171 | |
mbedAustin | 11:cada08fc8a70 | 2172 | if (source_header_ptr->options_list_ptr->proxy_uri_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2173 | destination_header_ptr->options_list_ptr->proxy_uri_len = source_header_ptr->options_list_ptr->proxy_uri_len; |
mbedAustin | 11:cada08fc8a70 | 2174 | destination_header_ptr->options_list_ptr->proxy_uri_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->proxy_uri_len); |
mbedAustin | 11:cada08fc8a70 | 2175 | if (!destination_header_ptr->options_list_ptr->proxy_uri_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2176 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2177 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2178 | } |
mbedAustin | 11:cada08fc8a70 | 2179 | 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); |
mbedAustin | 11:cada08fc8a70 | 2180 | } |
mbedAustin | 11:cada08fc8a70 | 2181 | |
mbedAustin | 11:cada08fc8a70 | 2182 | if (source_header_ptr->options_list_ptr->etag_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2183 | destination_header_ptr->options_list_ptr->etag_len = source_header_ptr->options_list_ptr->etag_len; |
mbedAustin | 11:cada08fc8a70 | 2184 | destination_header_ptr->options_list_ptr->etag_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->etag_len); |
mbedAustin | 11:cada08fc8a70 | 2185 | if (!destination_header_ptr->options_list_ptr->etag_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2186 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2187 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2188 | } |
mbedAustin | 11:cada08fc8a70 | 2189 | 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); |
mbedAustin | 11:cada08fc8a70 | 2190 | } |
mbedAustin | 11:cada08fc8a70 | 2191 | |
mbedAustin | 11:cada08fc8a70 | 2192 | if (source_header_ptr->options_list_ptr->uri_host_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2193 | destination_header_ptr->options_list_ptr->uri_host_len = source_header_ptr->options_list_ptr->uri_host_len; |
mbedAustin | 11:cada08fc8a70 | 2194 | destination_header_ptr->options_list_ptr->uri_host_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->uri_host_len); |
mbedAustin | 11:cada08fc8a70 | 2195 | if (!destination_header_ptr->options_list_ptr->uri_host_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2196 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2197 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2198 | } |
mbedAustin | 11:cada08fc8a70 | 2199 | 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); |
mbedAustin | 11:cada08fc8a70 | 2200 | } |
mbedAustin | 11:cada08fc8a70 | 2201 | |
mbedAustin | 11:cada08fc8a70 | 2202 | if (source_header_ptr->options_list_ptr->location_path_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2203 | destination_header_ptr->options_list_ptr->location_path_len = source_header_ptr->options_list_ptr->location_path_len; |
mbedAustin | 11:cada08fc8a70 | 2204 | destination_header_ptr->options_list_ptr->location_path_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->location_path_len); |
mbedAustin | 11:cada08fc8a70 | 2205 | if (!destination_header_ptr->options_list_ptr->location_path_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2206 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2207 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2208 | } |
mbedAustin | 11:cada08fc8a70 | 2209 | 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); |
mbedAustin | 11:cada08fc8a70 | 2210 | } |
mbedAustin | 11:cada08fc8a70 | 2211 | |
mbedAustin | 11:cada08fc8a70 | 2212 | if (source_header_ptr->options_list_ptr->uri_port_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2213 | destination_header_ptr->options_list_ptr->uri_port_len = source_header_ptr->options_list_ptr->uri_port_len; |
mbedAustin | 11:cada08fc8a70 | 2214 | destination_header_ptr->options_list_ptr->uri_port_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->uri_port_len); |
mbedAustin | 11:cada08fc8a70 | 2215 | if (!destination_header_ptr->options_list_ptr->uri_port_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2216 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2217 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2218 | } |
mbedAustin | 11:cada08fc8a70 | 2219 | 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); |
mbedAustin | 11:cada08fc8a70 | 2220 | } |
mbedAustin | 11:cada08fc8a70 | 2221 | |
mbedAustin | 11:cada08fc8a70 | 2222 | if (source_header_ptr->options_list_ptr->location_query_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2223 | destination_header_ptr->options_list_ptr->location_query_len = source_header_ptr->options_list_ptr->location_query_len; |
mbedAustin | 11:cada08fc8a70 | 2224 | destination_header_ptr->options_list_ptr->location_query_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->location_query_len); |
mbedAustin | 11:cada08fc8a70 | 2225 | if (!destination_header_ptr->options_list_ptr->location_query_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2226 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2227 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2228 | } |
mbedAustin | 11:cada08fc8a70 | 2229 | 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); |
mbedAustin | 11:cada08fc8a70 | 2230 | } |
mbedAustin | 11:cada08fc8a70 | 2231 | |
mbedAustin | 11:cada08fc8a70 | 2232 | destination_header_ptr->options_list_ptr->observe = source_header_ptr->options_list_ptr->observe; |
mbedAustin | 11:cada08fc8a70 | 2233 | |
mbedAustin | 11:cada08fc8a70 | 2234 | if (source_header_ptr->options_list_ptr->observe_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2235 | destination_header_ptr->options_list_ptr->observe_len = source_header_ptr->options_list_ptr->observe_len; |
mbedAustin | 11:cada08fc8a70 | 2236 | destination_header_ptr->options_list_ptr->observe_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->observe_len); |
mbedAustin | 11:cada08fc8a70 | 2237 | if (!destination_header_ptr->options_list_ptr->observe_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2238 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2239 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2240 | } |
mbedAustin | 11:cada08fc8a70 | 2241 | 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); |
mbedAustin | 11:cada08fc8a70 | 2242 | } |
mbedAustin | 11:cada08fc8a70 | 2243 | |
mbedAustin | 11:cada08fc8a70 | 2244 | if (source_header_ptr->options_list_ptr->accept_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2245 | destination_header_ptr->options_list_ptr->accept_len = source_header_ptr->options_list_ptr->accept_len; |
mbedAustin | 11:cada08fc8a70 | 2246 | destination_header_ptr->options_list_ptr->accept_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->accept_len); |
mbedAustin | 11:cada08fc8a70 | 2247 | if (!destination_header_ptr->options_list_ptr->accept_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2248 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2249 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2250 | } |
mbedAustin | 11:cada08fc8a70 | 2251 | 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); |
mbedAustin | 11:cada08fc8a70 | 2252 | } |
mbedAustin | 11:cada08fc8a70 | 2253 | |
mbedAustin | 11:cada08fc8a70 | 2254 | if (source_header_ptr->options_list_ptr->uri_query_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2255 | destination_header_ptr->options_list_ptr->uri_query_len = source_header_ptr->options_list_ptr->uri_query_len; |
mbedAustin | 11:cada08fc8a70 | 2256 | destination_header_ptr->options_list_ptr->uri_query_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->uri_query_len); |
mbedAustin | 11:cada08fc8a70 | 2257 | if (!destination_header_ptr->options_list_ptr->uri_query_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2258 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2259 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2260 | } |
mbedAustin | 11:cada08fc8a70 | 2261 | 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); |
mbedAustin | 11:cada08fc8a70 | 2262 | } |
mbedAustin | 11:cada08fc8a70 | 2263 | |
mbedAustin | 11:cada08fc8a70 | 2264 | if (source_header_ptr->options_list_ptr->block1_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2265 | destination_header_ptr->options_list_ptr->block1_len = source_header_ptr->options_list_ptr->block1_len; |
mbedAustin | 11:cada08fc8a70 | 2266 | destination_header_ptr->options_list_ptr->block1_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->block1_len); |
mbedAustin | 11:cada08fc8a70 | 2267 | if (!destination_header_ptr->options_list_ptr->block1_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2268 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2269 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2270 | } |
mbedAustin | 11:cada08fc8a70 | 2271 | 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); |
mbedAustin | 11:cada08fc8a70 | 2272 | } |
mbedAustin | 11:cada08fc8a70 | 2273 | |
mbedAustin | 11:cada08fc8a70 | 2274 | if (source_header_ptr->options_list_ptr->block2_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2275 | destination_header_ptr->options_list_ptr->block2_len = source_header_ptr->options_list_ptr->block2_len; |
mbedAustin | 11:cada08fc8a70 | 2276 | destination_header_ptr->options_list_ptr->block2_ptr = handle->sn_coap_protocol_malloc(source_header_ptr->options_list_ptr->block2_len); |
mbedAustin | 11:cada08fc8a70 | 2277 | if (!destination_header_ptr->options_list_ptr->block2_ptr) { |
mbedAustin | 11:cada08fc8a70 | 2278 | sn_coap_parser_release_allocated_coap_msg_mem(handle, destination_header_ptr); |
mbedAustin | 11:cada08fc8a70 | 2279 | return 0; |
mbedAustin | 11:cada08fc8a70 | 2280 | } |
mbedAustin | 11:cada08fc8a70 | 2281 | 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); |
mbedAustin | 11:cada08fc8a70 | 2282 | } |
mbedAustin | 11:cada08fc8a70 | 2283 | } |
mbedAustin | 11:cada08fc8a70 | 2284 | |
mbedAustin | 11:cada08fc8a70 | 2285 | return destination_header_ptr; |
mbedAustin | 11:cada08fc8a70 | 2286 | } |
mbedAustin | 11:cada08fc8a70 | 2287 | #endif |
mbedAustin | 11:cada08fc8a70 | 2288 |