hello
Dependents: nespresso_demo nespresso_endpoint EnvoyNespressoEndpointColorDetectorV2
Fork of nsdl by
sn_coap_parser.c@0:f6e4e1bbb3fe, 2014-06-04 (annotated)
- Committer:
- GeofferyOmlette
- Date:
- Wed Jun 04 15:38:26 2014 +0000
- Revision:
- 0:f6e4e1bbb3fe
hello
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
GeofferyOmlette | 0:f6e4e1bbb3fe | 1 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 2 | *\file sn_coap_parser.c |
GeofferyOmlette | 0:f6e4e1bbb3fe | 3 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 4 | * \brief CoAP Header parser |
GeofferyOmlette | 0:f6e4e1bbb3fe | 5 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 6 | * Functionality: Parses CoAP Header |
GeofferyOmlette | 0:f6e4e1bbb3fe | 7 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 8 | * Created on: Jun 30, 2011 |
GeofferyOmlette | 0:f6e4e1bbb3fe | 9 | * Author: tero |
GeofferyOmlette | 0:f6e4e1bbb3fe | 10 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 11 | * \note Supports draft-ietf-core-coap-12 |
GeofferyOmlette | 0:f6e4e1bbb3fe | 12 | */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 13 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 14 | /* * * * * * * * * * * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 15 | /* * * * INCLUDE FILES * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 16 | /* * * * * * * * * * * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 17 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 18 | #include <stdio.h> |
GeofferyOmlette | 0:f6e4e1bbb3fe | 19 | #include <string.h> /* For memset() and memcpy() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 20 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 21 | #include "nsdl_types.h" |
GeofferyOmlette | 0:f6e4e1bbb3fe | 22 | #include "sn_nsdl.h" |
GeofferyOmlette | 0:f6e4e1bbb3fe | 23 | #include "sn_coap_header.h" |
GeofferyOmlette | 0:f6e4e1bbb3fe | 24 | #include "sn_coap_protocol.h" |
GeofferyOmlette | 0:f6e4e1bbb3fe | 25 | #include "sn_coap_header_internal.h" |
GeofferyOmlette | 0:f6e4e1bbb3fe | 26 | #include "sn_coap_protocol_internal.h" |
GeofferyOmlette | 0:f6e4e1bbb3fe | 27 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 28 | /* * * * * * * * * * * * * * * * * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 29 | /* * * * LOCAL FUNCTION PROTOTYPES * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 30 | /* * * * * * * * * * * * * * * * * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 31 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 32 | static void sn_coap_parser_header_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr, coap_version_e *coap_version_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 33 | static int8_t sn_coap_parser_options_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr, uint8_t *packet_data_start_ptr, uint16_t packet_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 34 | static int8_t sn_coap_parser_options_parse_multiple_options(uint8_t **packet_data_pptr, uint16_t packet_left_len, uint8_t **dst_pptr, uint16_t *dst_len_ptr, sn_coap_option_numbers_e option, uint16_t option_number_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 35 | static int16_t sn_coap_parser_options_count_needed_memory_multiple_option(uint8_t *packet_data_ptr, uint16_t packet_left_len, sn_coap_option_numbers_e option, uint16_t option_number_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 36 | static int8_t sn_coap_parser_payload_parse(uint16_t packet_data_len, uint8_t *packet_data_start_ptr, uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 37 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 38 | /* * * * * * * * * * * * * * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 39 | /* * * * GLOBAL DECLARATIONS * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 40 | /* * * * * * * * * * * * * * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 41 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 42 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 43 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 44 | sn_coap_hdr_s *sn_coap_parser(uint16_t packet_data_len, uint8_t *packet_data_ptr, coap_version_e *coap_version_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 45 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 46 | uint8_t *data_temp_ptr = packet_data_ptr; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 47 | sn_coap_hdr_s *parsed_and_returned_coap_msg_ptr = NULL; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 48 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 49 | /* * * * Check given pointer * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 50 | if (packet_data_ptr == NULL || packet_data_len < 4) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 51 | return NULL; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 52 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 53 | /* * * * Allocate memory for parsed and returned CoAP message and initialize allocated memory with with zero values * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 54 | parsed_and_returned_coap_msg_ptr = sn_coap_malloc(sizeof(sn_coap_hdr_s)); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 55 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 56 | if (parsed_and_returned_coap_msg_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 57 | return NULL; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 58 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 59 | memset(parsed_and_returned_coap_msg_ptr, 0x00, sizeof(sn_coap_hdr_s)); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 60 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 61 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 62 | /* * * * Header parsing, move pointer over the header... * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 63 | sn_coap_parser_header_parse(&data_temp_ptr, parsed_and_returned_coap_msg_ptr, coap_version_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 64 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 65 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 66 | /* * * * Options parsing, move pointer over the options... * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 67 | if (sn_coap_parser_options_parse(&data_temp_ptr, parsed_and_returned_coap_msg_ptr, packet_data_ptr, packet_data_len) != 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 68 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 69 | /* Release memory of CoAP message */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 70 | sn_coap_parser_release_allocated_coap_msg_mem(parsed_and_returned_coap_msg_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 71 | return NULL; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 72 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 73 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 74 | /* * * * Payload parsing * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 75 | if(sn_coap_parser_payload_parse(packet_data_len, packet_data_ptr, &data_temp_ptr, parsed_and_returned_coap_msg_ptr) == -1) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 76 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 77 | /* Release memory of CoAP message */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 78 | sn_coap_parser_release_allocated_coap_msg_mem(parsed_and_returned_coap_msg_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 79 | return NULL; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 80 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 81 | /* * * * Return parsed CoAP message * * * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 82 | return parsed_and_returned_coap_msg_ptr; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 83 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 84 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 85 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 86 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 87 | void sn_coap_parser_release_allocated_coap_msg_mem(sn_coap_hdr_s *freed_coap_msg_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 88 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 89 | if (freed_coap_msg_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 90 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 91 | if (freed_coap_msg_ptr->uri_path_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 92 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 93 | sn_coap_free(freed_coap_msg_ptr->uri_path_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 94 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 95 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 96 | if (freed_coap_msg_ptr->token_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 97 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 98 | sn_coap_free(freed_coap_msg_ptr->token_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 99 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 100 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 101 | if (freed_coap_msg_ptr->content_type_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 102 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 103 | sn_coap_free(freed_coap_msg_ptr->content_type_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 104 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 105 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 106 | if (freed_coap_msg_ptr->options_list_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 107 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 108 | if (freed_coap_msg_ptr->options_list_ptr->max_age_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 109 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 110 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->max_age_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 111 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 112 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 113 | if (freed_coap_msg_ptr->options_list_ptr->proxy_uri_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 114 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 115 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->proxy_uri_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 116 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 117 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 118 | if (freed_coap_msg_ptr->options_list_ptr->etag_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 119 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 120 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->etag_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 121 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 122 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 123 | if (freed_coap_msg_ptr->options_list_ptr->uri_host_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 124 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 125 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->uri_host_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 126 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 127 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 128 | if (freed_coap_msg_ptr->options_list_ptr->location_path_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 129 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 130 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->location_path_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 131 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 132 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 133 | if (freed_coap_msg_ptr->options_list_ptr->uri_port_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 134 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 135 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->uri_port_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 136 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 137 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 138 | if (freed_coap_msg_ptr->options_list_ptr->location_query_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 139 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 140 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->location_query_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 141 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 142 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 143 | if (freed_coap_msg_ptr->options_list_ptr->observe_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 144 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 145 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->observe_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 146 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 147 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 148 | if (freed_coap_msg_ptr->options_list_ptr->uri_query_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 149 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 150 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->uri_query_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 151 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 152 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 153 | if (freed_coap_msg_ptr->options_list_ptr->block2_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 154 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 155 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->block2_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 156 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 157 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 158 | if (freed_coap_msg_ptr->options_list_ptr->block1_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 159 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 160 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->block1_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 161 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 162 | if (freed_coap_msg_ptr->options_list_ptr->accept_ptr != NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 163 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 164 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr->accept_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 165 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 166 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 167 | sn_coap_free(freed_coap_msg_ptr->options_list_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 168 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 169 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 170 | sn_coap_free(freed_coap_msg_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 171 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 172 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 173 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 174 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 175 | * \fn static void sn_coap_parser_header_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr, coap_version_e *coap_version_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 176 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 177 | * \brief Parses CoAP message's Header part from given Packet data |
GeofferyOmlette | 0:f6e4e1bbb3fe | 178 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 179 | * \param **packet_data_ptr is source for Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 180 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 181 | * \param *dst_coap_msg_ptr is destination for parsed CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 182 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 183 | * \param *coap_version_ptr is destination for parsed CoAP specification version |
GeofferyOmlette | 0:f6e4e1bbb3fe | 184 | */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 185 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 186 | static void sn_coap_parser_header_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr, coap_version_e *coap_version_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 187 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 188 | /* Parse CoAP Version and message type*/ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 189 | *coap_version_ptr = (coap_version_e)(**packet_data_pptr & COAP_HEADER_VERSION_MASK); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 190 | dst_coap_msg_ptr->msg_type = (sn_coap_msg_type_e)(**packet_data_pptr & COAP_HEADER_MSG_TYPE_MASK); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 191 | (*packet_data_pptr) += 1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 192 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 193 | /* Parse Message code */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 194 | dst_coap_msg_ptr->msg_code = (sn_coap_msg_code_e)**packet_data_pptr; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 195 | (*packet_data_pptr) += 1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 196 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 197 | /* Parse Message ID */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 198 | dst_coap_msg_ptr->msg_id = *(*packet_data_pptr+1); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 199 | dst_coap_msg_ptr->msg_id += **packet_data_pptr << COAP_HEADER_MSG_ID_MSB_SHIFT; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 200 | (*packet_data_pptr) += 2; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 201 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 202 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 203 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 204 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 205 | * \fn static uint8_t sn_coap_parser_options_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 206 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 207 | * \brief Parses CoAP message's Options part from given Packet data |
GeofferyOmlette | 0:f6e4e1bbb3fe | 208 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 209 | * \param **packet_data_pptr is source of Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 210 | * \param *dst_coap_msg_ptr is destination for parsed CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 211 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 212 | * \return Return value is 0 in ok case and -1 in failure case |
GeofferyOmlette | 0:f6e4e1bbb3fe | 213 | */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 214 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 215 | static int8_t sn_coap_parser_options_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr, uint8_t *packet_data_start_ptr, uint16_t packet_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 216 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 217 | uint8_t previous_option_number = 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 218 | uint8_t i = 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 219 | int8_t ret_status = 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 220 | uint16_t message_left = 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 221 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 222 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 223 | /* Parse token, if exists */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 224 | dst_coap_msg_ptr->token_len = *packet_data_start_ptr & COAP_HEADER_TOKEN_LENGTH_MASK; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 225 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 226 | if(dst_coap_msg_ptr->token_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 227 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 228 | if((dst_coap_msg_ptr->token_len > 8) || dst_coap_msg_ptr->token_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 229 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 230 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 231 | dst_coap_msg_ptr->token_ptr = sn_coap_malloc(dst_coap_msg_ptr->token_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 232 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 233 | if (dst_coap_msg_ptr->token_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 234 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 235 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 236 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 237 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 238 | memcpy(dst_coap_msg_ptr->token_ptr, *packet_data_pptr, dst_coap_msg_ptr->token_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 239 | (*packet_data_pptr) += dst_coap_msg_ptr->token_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 240 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 241 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 242 | message_left = packet_len - ((*packet_data_pptr) - packet_data_start_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 243 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 244 | /* Loop all Options */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 245 | while((**packet_data_pptr != 0xff) && message_left) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 246 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 247 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 248 | /* Get option length WITHOUT extensions */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 249 | uint16_t option_len = (**packet_data_pptr & 0x0F); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 250 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 251 | /* Option number length 15 is reserved for the future use - ERROR */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 252 | if(option_len == 15) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 253 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 254 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 255 | /* Resolve option delta */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 256 | uint16_t option_number = (**packet_data_pptr >> COAP_OPTIONS_OPTION_NUMBER_SHIFT); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 257 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 258 | if(option_number == 13) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 259 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 260 | option_number = *(*packet_data_pptr+1) + 13; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 261 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 262 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 263 | else if(option_number == 14) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 264 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 265 | option_number = *(*packet_data_pptr+2); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 266 | option_number += (*(*packet_data_pptr+1) << 8) + 269; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 267 | (*packet_data_pptr) += 2; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 268 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 269 | /* Option number 15 reserved for payload marker. This is handled as a error! */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 270 | else if(option_number == 15) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 271 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 272 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 273 | /* Add previous option to option delta and get option number */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 274 | option_number += previous_option_number; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 275 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 276 | /* Add possible option length extension to resolve full length of the option */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 277 | if(option_len == 13) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 278 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 279 | option_len = *(*packet_data_pptr+1) + 13; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 280 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 281 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 282 | else if(option_len == 14) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 283 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 284 | option_len = *(*packet_data_pptr+2); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 285 | option_len += (*(*packet_data_pptr+1) << 8) + 269; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 286 | (*packet_data_pptr) += 2; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 287 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 288 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 289 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 290 | /* * * Parse option itself * * */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 291 | /* Some options are handled independently in own functions */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 292 | previous_option_number = option_number; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 293 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 294 | /* Allocate options_list_ptr if needed */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 295 | switch (option_number) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 296 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 297 | case COAP_OPTION_MAX_AGE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 298 | case COAP_OPTION_PROXY_URI: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 299 | case COAP_OPTION_ETAG: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 300 | case COAP_OPTION_URI_HOST: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 301 | case COAP_OPTION_LOCATION_PATH: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 302 | case COAP_OPTION_URI_PORT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 303 | case COAP_OPTION_LOCATION_QUERY: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 304 | case COAP_OPTION_OBSERVE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 305 | case COAP_OPTION_URI_QUERY: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 306 | case COAP_OPTION_BLOCK2: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 307 | case COAP_OPTION_BLOCK1: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 308 | case COAP_OPTION_ACCEPT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 309 | if (dst_coap_msg_ptr->options_list_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 310 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 311 | dst_coap_msg_ptr->options_list_ptr = sn_coap_malloc(sizeof(sn_coap_options_list_s)); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 312 | if(NULL == dst_coap_msg_ptr->options_list_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 313 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 314 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 315 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 316 | memset(dst_coap_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s)); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 317 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 318 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 319 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 320 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 321 | /* Parse option */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 322 | switch (option_number) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 323 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 324 | case COAP_OPTION_CONTENT_FORMAT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 325 | if((option_len > 2) || (dst_coap_msg_ptr->content_type_ptr)) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 326 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 327 | dst_coap_msg_ptr->content_type_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 328 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 329 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 330 | if(option_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 331 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 332 | dst_coap_msg_ptr->content_type_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 333 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 334 | if (dst_coap_msg_ptr->content_type_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 335 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 336 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 337 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 338 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 339 | memcpy(dst_coap_msg_ptr->content_type_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 340 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 341 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 342 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 343 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 344 | case COAP_OPTION_MAX_AGE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 345 | if((option_len > 4) || dst_coap_msg_ptr->options_list_ptr->max_age_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 346 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 347 | dst_coap_msg_ptr->options_list_ptr->max_age_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 348 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 349 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 350 | if(option_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 351 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 352 | dst_coap_msg_ptr->options_list_ptr->max_age_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 353 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 354 | if (dst_coap_msg_ptr->options_list_ptr->max_age_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 355 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 356 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 357 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 358 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 359 | memcpy(dst_coap_msg_ptr->options_list_ptr->max_age_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 360 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 361 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 362 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 363 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 364 | case COAP_OPTION_PROXY_URI: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 365 | if ((option_len > 1034) || (option_len < 1) || dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 366 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 367 | dst_coap_msg_ptr->options_list_ptr->proxy_uri_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 368 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 369 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 370 | dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 371 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 372 | if (dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 373 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 374 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 375 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 376 | memcpy(dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 377 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 378 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 379 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 380 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 381 | case COAP_OPTION_ETAG: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 382 | if(dst_coap_msg_ptr->options_list_ptr->etag_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 383 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 384 | /* This is managed independently because User gives this option in one character table */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 385 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 386 | ret_status = sn_coap_parser_options_parse_multiple_options (packet_data_pptr, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 387 | message_left, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 388 | &dst_coap_msg_ptr->options_list_ptr->etag_ptr, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 389 | (uint16_t*)&dst_coap_msg_ptr->options_list_ptr->etag_len, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 390 | COAP_OPTION_LOCATION_PATH, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 391 | if (ret_status >= 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 392 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 393 | i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 394 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 395 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 396 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 397 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 398 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 399 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 400 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 401 | case COAP_OPTION_URI_HOST: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 402 | if((option_len > 255) || (option_len < 1) || dst_coap_msg_ptr->options_list_ptr->uri_host_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 403 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 404 | dst_coap_msg_ptr->options_list_ptr->uri_host_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 405 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 406 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 407 | dst_coap_msg_ptr->options_list_ptr->uri_host_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 408 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 409 | if (dst_coap_msg_ptr->options_list_ptr->uri_host_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 410 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 411 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 412 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 413 | memcpy(dst_coap_msg_ptr->options_list_ptr->uri_host_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 414 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 415 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 416 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 417 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 418 | case COAP_OPTION_LOCATION_PATH: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 419 | if(dst_coap_msg_ptr->options_list_ptr->location_path_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 420 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 421 | /* This is managed independently because User gives this option in one character table */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 422 | ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 423 | &dst_coap_msg_ptr->options_list_ptr->location_path_ptr, &dst_coap_msg_ptr->options_list_ptr->location_path_len, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 424 | COAP_OPTION_LOCATION_PATH, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 425 | if (ret_status >= 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 426 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 427 | i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 428 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 429 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 430 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 431 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 432 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 433 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 434 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 435 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 436 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 437 | case COAP_OPTION_URI_PORT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 438 | if((option_len > 2) || dst_coap_msg_ptr->options_list_ptr->uri_port_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 439 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 440 | dst_coap_msg_ptr->options_list_ptr->uri_port_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 441 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 442 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 443 | if(option_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 444 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 445 | dst_coap_msg_ptr->options_list_ptr->uri_port_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 446 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 447 | if (dst_coap_msg_ptr->options_list_ptr->uri_port_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 448 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 449 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 450 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 451 | memcpy(dst_coap_msg_ptr->options_list_ptr->uri_port_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 452 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 453 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 454 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 455 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 456 | case COAP_OPTION_LOCATION_QUERY: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 457 | if(dst_coap_msg_ptr->options_list_ptr->location_query_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 458 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 459 | ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 460 | &dst_coap_msg_ptr->options_list_ptr->location_query_ptr, &dst_coap_msg_ptr->options_list_ptr->location_query_len, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 461 | COAP_OPTION_LOCATION_QUERY, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 462 | if (ret_status >= 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 463 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 464 | i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 465 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 466 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 467 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 468 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 469 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 470 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 471 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 472 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 473 | case COAP_OPTION_URI_PATH: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 474 | if(dst_coap_msg_ptr->uri_path_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 475 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 476 | ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 477 | &dst_coap_msg_ptr->uri_path_ptr, &dst_coap_msg_ptr->uri_path_len, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 478 | COAP_OPTION_URI_PATH, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 479 | if (ret_status >= 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 480 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 481 | i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 482 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 483 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 484 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 485 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 486 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 487 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 488 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 489 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 490 | case COAP_OPTION_OBSERVE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 491 | if((option_len > 2) || dst_coap_msg_ptr->options_list_ptr->observe_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 492 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 493 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 494 | dst_coap_msg_ptr->options_list_ptr->observe = 1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 495 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 496 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 497 | if(option_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 498 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 499 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 500 | dst_coap_msg_ptr->options_list_ptr->observe_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 501 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 502 | dst_coap_msg_ptr->options_list_ptr->observe_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 503 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 504 | if (dst_coap_msg_ptr->options_list_ptr->observe_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 505 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 506 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 507 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 508 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 509 | memcpy(dst_coap_msg_ptr->options_list_ptr->observe_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 510 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 511 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 512 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 513 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 514 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 515 | case COAP_OPTION_URI_QUERY: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 516 | if(dst_coap_msg_ptr->options_list_ptr->uri_query_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 517 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 518 | ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 519 | &dst_coap_msg_ptr->options_list_ptr->uri_query_ptr, &dst_coap_msg_ptr->options_list_ptr->uri_query_len, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 520 | COAP_OPTION_URI_QUERY, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 521 | if (ret_status >= 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 522 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 523 | i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 524 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 525 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 526 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 527 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 528 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 529 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 530 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 531 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 532 | case COAP_OPTION_BLOCK2: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 533 | if((option_len > 4) || dst_coap_msg_ptr->options_list_ptr->block2_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 534 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 535 | dst_coap_msg_ptr->options_list_ptr->block2_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 536 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 537 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 538 | dst_coap_msg_ptr->options_list_ptr->block2_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 539 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 540 | if (dst_coap_msg_ptr->options_list_ptr->block2_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 541 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 542 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 543 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 544 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 545 | memcpy(dst_coap_msg_ptr->options_list_ptr->block2_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 546 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 547 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 548 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 549 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 550 | case COAP_OPTION_BLOCK1: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 551 | if((option_len > 4) || dst_coap_msg_ptr->options_list_ptr->block1_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 552 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 553 | dst_coap_msg_ptr->options_list_ptr->block1_len = option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 554 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 555 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 556 | dst_coap_msg_ptr->options_list_ptr->block1_ptr = sn_coap_malloc(option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 557 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 558 | if (dst_coap_msg_ptr->options_list_ptr->block1_ptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 559 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 560 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 561 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 562 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 563 | memcpy(dst_coap_msg_ptr->options_list_ptr->block1_ptr, *packet_data_pptr, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 564 | (*packet_data_pptr) += option_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 565 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 566 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 567 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 568 | case COAP_OPTION_ACCEPT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 569 | if(dst_coap_msg_ptr->options_list_ptr->accept_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 570 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 571 | ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 572 | &dst_coap_msg_ptr->options_list_ptr->accept_ptr, (uint16_t *)&dst_coap_msg_ptr->options_list_ptr->accept_len, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 573 | COAP_OPTION_ACCEPT, option_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 574 | if (ret_status >= 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 575 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 576 | i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 577 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 578 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 579 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 580 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 581 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 582 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 583 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 584 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 585 | default: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 586 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 587 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 588 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 589 | /* Check for overflow */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 590 | if((*packet_data_pptr - packet_data_start_ptr) > packet_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 591 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 592 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 593 | message_left = packet_len - (*packet_data_pptr - packet_data_start_ptr); //todo: if(*packet_data_pptr < packet_data_start_ptr) message_left = 0; else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 594 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 595 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 596 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 597 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 598 | return 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 599 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 600 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 601 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 602 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 603 | * \fn static int8_t sn_coap_parser_options_parse_multiple_options(uint8_t **packet_data_pptr, uint8_t options_count_left, uint8_t *previous_option_number_ptr, uint8_t **dst_pptr, |
GeofferyOmlette | 0:f6e4e1bbb3fe | 604 | * uint16_t *dst_len_ptr, sn_coap_option_numbers_e option, uint16_t option_number_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 605 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 606 | * \brief Parses CoAP message's Uri-query options |
GeofferyOmlette | 0:f6e4e1bbb3fe | 607 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 608 | * \param **packet_data_pptr is source for Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 609 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 610 | * \param *dst_coap_msg_ptr is destination for parsed CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 611 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 612 | * \param options_count_left tells how many options are unhandled in Packet data |
GeofferyOmlette | 0:f6e4e1bbb3fe | 613 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 614 | * \param *previous_option_number_ptr is pointer to used and returned previous Option number |
GeofferyOmlette | 0:f6e4e1bbb3fe | 615 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 616 | * \return Return value is count of Uri-query optios parsed. In failure case -1 is returned. |
GeofferyOmlette | 0:f6e4e1bbb3fe | 617 | */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 618 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 619 | static int8_t sn_coap_parser_options_parse_multiple_options(uint8_t **packet_data_pptr, uint16_t packet_left_len, uint8_t **dst_pptr, uint16_t *dst_len_ptr, sn_coap_option_numbers_e option, uint16_t option_number_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 620 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 621 | int16_t uri_query_needed_heap = sn_coap_parser_options_count_needed_memory_multiple_option(*packet_data_pptr, packet_left_len, option, option_number_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 622 | uint8_t *temp_parsed_uri_query_ptr = NULL; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 623 | uint8_t returned_option_counter = 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 624 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 625 | if(uri_query_needed_heap == -1) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 626 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 627 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 628 | if(uri_query_needed_heap) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 629 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 630 | *dst_pptr = (uint8_t*) sn_coap_malloc(uri_query_needed_heap); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 631 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 632 | if (*dst_pptr == NULL) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 633 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 634 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 635 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 636 | *dst_len_ptr = uri_query_needed_heap; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 637 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 638 | temp_parsed_uri_query_ptr = *dst_pptr; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 639 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 640 | /* Loop all Uri-Query options */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 641 | while ((temp_parsed_uri_query_ptr - *dst_pptr) < uri_query_needed_heap) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 642 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 643 | /* Check if this is first Uri-Query option */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 644 | if (returned_option_counter > 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 645 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 646 | /* Uri-Query is modified to following format: temp1'\0'temp2'\0'temp3 i.e. */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 647 | /* Uri-Path is modified to following format: temp1\temp2\temp3 i.e. */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 648 | if(option == COAP_OPTION_URI_QUERY || option == COAP_OPTION_LOCATION_QUERY || option == COAP_OPTION_ETAG || option == COAP_OPTION_ACCEPT) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 649 | memset(temp_parsed_uri_query_ptr, '&', 1); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 650 | else if(option == COAP_OPTION_URI_PATH || option == COAP_OPTION_LOCATION_PATH) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 651 | memset(temp_parsed_uri_query_ptr, '/', 1); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 652 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 653 | temp_parsed_uri_query_ptr++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 654 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 655 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 656 | returned_option_counter++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 657 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 658 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 659 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 660 | if(((temp_parsed_uri_query_ptr - *dst_pptr) + option_number_len) > uri_query_needed_heap) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 661 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 662 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 663 | memcpy(temp_parsed_uri_query_ptr, *packet_data_pptr, option_number_len); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 664 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 665 | (*packet_data_pptr) += option_number_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 666 | temp_parsed_uri_query_ptr += option_number_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 667 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 668 | if(((**packet_data_pptr >> COAP_OPTIONS_OPTION_NUMBER_SHIFT) != 0) || (temp_parsed_uri_query_ptr - *dst_pptr) >= uri_query_needed_heap) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 669 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 670 | return returned_option_counter; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 671 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 672 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 673 | option_number_len = (**packet_data_pptr & 0x0F); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 674 | if(option_number_len == 13) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 675 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 676 | option_number_len = *(*packet_data_pptr+1) + 13; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 677 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 678 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 679 | else if(option_number_len == 14) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 680 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 681 | option_number_len = *(*packet_data_pptr+2); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 682 | option_number_len += (*(*packet_data_pptr+1) << 8) + 269; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 683 | (*packet_data_pptr) += 2; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 684 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 685 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 686 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 687 | return returned_option_counter; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 688 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 689 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 690 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 691 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 692 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 693 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 694 | * \fn static uint16_t sn_coap_parser_options_count_needed_memory_multiple_option(uint8_t *packet_data_ptr, uint8_t options_count_left, uint8_t previous_option_number, sn_coap_option_numbers_e option, uint16_t option_number_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 695 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 696 | * \brief Counts needed memory for uri query option |
GeofferyOmlette | 0:f6e4e1bbb3fe | 697 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 698 | * \param *packet_data_ptr is start of source for Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 699 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 700 | * \param options_count_left tells how many options are unhandled in Packet data |
GeofferyOmlette | 0:f6e4e1bbb3fe | 701 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 702 | * \param previous_option_number is previous Option number |
GeofferyOmlette | 0:f6e4e1bbb3fe | 703 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 704 | * \param sn_coap_option_numbers_e option option number to be calculated |
GeofferyOmlette | 0:f6e4e1bbb3fe | 705 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 706 | * \param uint16_t option_number_len length of the first option part |
GeofferyOmlette | 0:f6e4e1bbb3fe | 707 | */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 708 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 709 | static int16_t sn_coap_parser_options_count_needed_memory_multiple_option(uint8_t *packet_data_ptr, uint16_t packet_left_len, sn_coap_option_numbers_e option, uint16_t option_number_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 710 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 711 | uint16_t ret_value = 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 712 | uint16_t i = 1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 713 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 714 | /* Loop all Uri-Query options */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 715 | while (i < packet_left_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 716 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 717 | if(option == COAP_OPTION_LOCATION_PATH && option_number_len > 255) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 718 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 719 | if(option == COAP_OPTION_URI_PATH && option_number_len > 255) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 720 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 721 | if(option == COAP_OPTION_URI_QUERY && option_number_len > 255) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 722 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 723 | if(option == COAP_OPTION_LOCATION_QUERY && option_number_len > 255) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 724 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 725 | if(option == COAP_OPTION_ACCEPT && option_number_len > 2) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 726 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 727 | if(option == COAP_OPTION_ETAG && option_number_len > 8) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 728 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 729 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 730 | i += option_number_len; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 731 | ret_value += option_number_len + 1; /* + 1 is for separator */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 732 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 733 | if((*(packet_data_ptr + i) >> COAP_OPTIONS_OPTION_NUMBER_SHIFT) != 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 734 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 735 | if(ret_value != 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 736 | return (ret_value - 1); /* -1 because last Part path does not include separator */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 737 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 738 | return 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 739 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 740 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 741 | option_number_len = (*(packet_data_ptr + i) & 0x0F); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 742 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 743 | if (option_number_len == 13) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 744 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 745 | i++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 746 | option_number_len = *(packet_data_ptr + i) + 13; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 747 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 748 | else if (option_number_len == 14) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 749 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 750 | option_number_len = *(packet_data_ptr + 2); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 751 | option_number_len += (*(packet_data_ptr + 1) << 8) + 269; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 752 | i += 2; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 753 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 754 | else if (option_number_len == 15) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 755 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 756 | i++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 757 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 758 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 759 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 760 | if(ret_value != 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 761 | return (ret_value - 1); /* -1 because last Part path does not include separator */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 762 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 763 | return 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 764 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 765 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 766 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 767 | * \fn static void sn_coap_parser_payload_parse(uint16_t packet_data_len, uint8_t *packet_data_ptr, uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 768 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 769 | * \brief Parses CoAP message's Payload part from given Packet data |
GeofferyOmlette | 0:f6e4e1bbb3fe | 770 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 771 | * \param packet_data_len is length of given Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 772 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 773 | * \param *packet_data_ptr is start of source for Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 774 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 775 | * \param **packet_data_pptr is source for Packet data to be parsed to CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 776 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 777 | * \param *dst_coap_msg_ptr is destination for parsed CoAP message |
GeofferyOmlette | 0:f6e4e1bbb3fe | 778 | *****************************************************************************/ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 779 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 780 | static int8_t sn_coap_parser_payload_parse(uint16_t packet_data_len, uint8_t *packet_data_start_ptr, uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 781 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 782 | /* If there is payload */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 783 | if((*packet_data_pptr - packet_data_start_ptr) < packet_data_len) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 784 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 785 | if(**packet_data_pptr == 0xff) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 786 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 787 | (*packet_data_pptr)++; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 788 | /* Parse Payload length */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 789 | dst_coap_msg_ptr->payload_len = packet_data_len - (*packet_data_pptr - packet_data_start_ptr); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 790 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 791 | /* The presence of a marker followed by a zero-length payload MUST be processed as a message format error */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 792 | if(dst_coap_msg_ptr->payload_len == 0) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 793 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 794 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 795 | /* Parse Payload by setting CoAP message's payload_ptr to point Payload in Packet data */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 796 | dst_coap_msg_ptr->payload_ptr = *packet_data_pptr; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 797 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 798 | /* No payload marker.. */ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 799 | else |
GeofferyOmlette | 0:f6e4e1bbb3fe | 800 | return -1; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 801 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 802 | return 0; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 803 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 804 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 805 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 806 | /** |
GeofferyOmlette | 0:f6e4e1bbb3fe | 807 | * \fn void sn_coap_packet_debug(sn_coap_hdr_s *coap_packet_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 808 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 809 | * \brief Parses CoAP message and prints parts for debugging |
GeofferyOmlette | 0:f6e4e1bbb3fe | 810 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 811 | * \param *coap_packet_ptr Pointer to the CoAP message to debug |
GeofferyOmlette | 0:f6e4e1bbb3fe | 812 | * |
GeofferyOmlette | 0:f6e4e1bbb3fe | 813 | *****************************************************************************/ |
GeofferyOmlette | 0:f6e4e1bbb3fe | 814 | SN_MEM_ATTR_COAP_PARSER_FUNC |
GeofferyOmlette | 0:f6e4e1bbb3fe | 815 | void sn_coap_packet_debug(sn_coap_hdr_s *coap_packet_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 816 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 817 | #ifdef HAVE_DEBUG |
GeofferyOmlette | 0:f6e4e1bbb3fe | 818 | switch (coap_packet_ptr->msg_type) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 819 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 820 | case COAP_MSG_TYPE_CONFIRMABLE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 821 | printf("con "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 822 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 823 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 824 | case COAP_MSG_TYPE_NON_CONFIRMABLE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 825 | printf("non "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 826 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 827 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 828 | case COAP_MSG_TYPE_ACKNOWLEDGEMENT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 829 | printf("ack "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 830 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 831 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 832 | case COAP_MSG_TYPE_RESET: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 833 | printf("rst "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 834 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 835 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 836 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 837 | switch (coap_packet_ptr->msg_code) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 838 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 839 | case COAP_MSG_CODE_EMPTY: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 840 | printf("NO CODE "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 841 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 842 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 843 | case COAP_MSG_CODE_REQUEST_GET: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 844 | printf("GET "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 845 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 846 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 847 | case COAP_MSG_CODE_REQUEST_POST: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 848 | printf("POST "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 849 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 850 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 851 | case COAP_MSG_CODE_REQUEST_PUT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 852 | printf("PUT "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 853 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 854 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 855 | case COAP_MSG_CODE_REQUEST_DELETE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 856 | printf("DELETE "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 857 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 858 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 859 | case COAP_MSG_CODE_RESPONSE_CREATED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 860 | printf("2.01 Created "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 861 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 862 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 863 | case COAP_MSG_CODE_RESPONSE_DELETED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 864 | printf("2.02 Deleted "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 865 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 866 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 867 | case COAP_MSG_CODE_RESPONSE_VALID: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 868 | printf("2.03 Valid "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 869 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 870 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 871 | case COAP_MSG_CODE_RESPONSE_CHANGED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 872 | printf("2.04 Changed "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 873 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 874 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 875 | case COAP_MSG_CODE_RESPONSE_CONTENT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 876 | printf("2.05 Content "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 877 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 878 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 879 | case COAP_MSG_CODE_RESPONSE_BAD_REQUEST: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 880 | printf("4.00 Bad Request "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 881 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 882 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 883 | case COAP_MSG_CODE_RESPONSE_UNAUTHORIZED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 884 | printf("4.01 Unauthorized "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 885 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 886 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 887 | case COAP_MSG_CODE_RESPONSE_BAD_OPTION: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 888 | printf("4.02 Bad Option "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 889 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 890 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 891 | case COAP_MSG_CODE_RESPONSE_FORBIDDEN: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 892 | printf("4.03 Forbidden "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 893 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 894 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 895 | case COAP_MSG_CODE_RESPONSE_NOT_FOUND: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 896 | printf("4.04 Not Found "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 897 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 898 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 899 | case COAP_MSG_CODE_RESPONSE_METHOD_NOT_ALLOWED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 900 | printf("4.05 Method Not Allowed "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 901 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 902 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 903 | case COAP_MSG_CODE_RESPONSE_NOT_ACCEPTABLE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 904 | printf("4.06 Response Not Acceptable"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 905 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 906 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 907 | case COAP_MSG_CODE_RESPONSE_REQUEST_ENTITY_INCOMPLETE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 908 | printf("4.08 Request Entity Incomplete "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 909 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 910 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 911 | case COAP_MSG_CODE_RESPONSE_PRECONDITION_FAILED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 912 | printf("4.12 Response Precondition Failed"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 913 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 914 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 915 | case COAP_MSG_CODE_RESPONSE_REQUEST_ENTITY_TOO_LARGE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 916 | printf("4.13 Request Entity Too Large "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 917 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 918 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 919 | case COAP_MSG_CODE_RESPONSE_UNSUPPORTED_CONTENT_FORMAT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 920 | printf("4.15 Unsupported Media Type "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 921 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 922 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 923 | case COAP_MSG_CODE_RESPONSE_INTERNAL_SERVER_ERROR: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 924 | printf("5.00 Internal Server Error "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 925 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 926 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 927 | case COAP_MSG_CODE_RESPONSE_NOT_IMPLEMENTED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 928 | printf("5.01 Not Implemented "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 929 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 930 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 931 | case COAP_MSG_CODE_RESPONSE_BAD_GATEWAY: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 932 | printf("5.02 Bad Gateway "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 933 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 934 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 935 | case COAP_MSG_CODE_RESPONSE_SERVICE_UNAVAILABLE: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 936 | printf("5.03 Service Unavailable "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 937 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 938 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 939 | case COAP_MSG_CODE_RESPONSE_GATEWAY_TIMEOUT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 940 | printf("5.04 Gateway Timeout "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 941 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 942 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 943 | case COAP_MSG_CODE_RESPONSE_PROXYING_NOT_SUPPORTED: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 944 | printf("5.05 Proxying Not Supported "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 945 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 946 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 947 | default: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 948 | printf("UNKNOWN CODE "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 949 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 950 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 951 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 952 | printf("mid=%i ", (int)(coap_packet_ptr->msg_id)); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 953 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 954 | if (coap_packet_ptr->uri_path_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 955 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 956 | int i; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 957 | printf("/"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 958 | for (i=0; i < coap_packet_ptr->uri_path_len; i++) printf("%c", (char)(coap_packet_ptr->uri_path_ptr[i])); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 959 | if (coap_packet_ptr->options_list_ptr && coap_packet_ptr->options_list_ptr->uri_query_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 960 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 961 | printf("?"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 962 | for (i=0; i < coap_packet_ptr->options_list_ptr->uri_query_len; i++) printf("%c", (char)(coap_packet_ptr->options_list_ptr->uri_query_ptr[i])); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 963 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 964 | printf(" "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 965 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 966 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 967 | if (coap_packet_ptr->token_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 968 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 969 | int i; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 970 | printf("token=0x"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 971 | for (i=0; i < coap_packet_ptr->token_len; i++) printf("%02x", (unsigned char)(coap_packet_ptr->token_ptr[i])); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 972 | printf(" "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 973 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 974 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 975 | if (coap_packet_ptr->content_type_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 976 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 977 | switch (coap_packet_ptr->content_type_ptr[0]) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 978 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 979 | case COAP_CT_TEXT_PLAIN: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 980 | printf("text/plain "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 981 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 982 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 983 | case COAP_CT_LINK_FORMAT: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 984 | printf("application/link-format "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 985 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 986 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 987 | case COAP_CT_XML: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 988 | printf("application/xml "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 989 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 990 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 991 | case COAP_CT_OCTET_STREAM: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 992 | printf("application/octet-stream "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 993 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 994 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 995 | case COAP_CT_EXI: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 996 | printf("application/exi "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 997 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 998 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 999 | case COAP_CT_JSON: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1000 | printf("application/json "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1001 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1002 | default: |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1003 | printf("uknown type (%i) ", (int)(coap_packet_ptr->content_type_ptr[0])); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1004 | break; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1005 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1006 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1007 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1008 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1009 | if (coap_packet_ptr->options_list_ptr && coap_packet_ptr->options_list_ptr->location_path_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1010 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1011 | printf("Location: /"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1012 | int i; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1013 | for (i=0; i < coap_packet_ptr->options_list_ptr->location_path_len; i++) printf("%c", (char)(coap_packet_ptr->options_list_ptr->location_path_ptr[i])); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1014 | printf(" "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1015 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1016 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1017 | if (coap_packet_ptr->payload_ptr) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1018 | { |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1019 | int i; |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1020 | printf("'"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1021 | for (i=0; i < coap_packet_ptr->payload_len; i++) |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1022 | printf("%c", *(coap_packet_ptr->payload_ptr + i)); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1023 | printf("' "); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1024 | } |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1025 | |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1026 | printf("\n"); |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1027 | #endif |
GeofferyOmlette | 0:f6e4e1bbb3fe | 1028 | } |