hello
Dependents: nespresso_demo nespresso_endpoint EnvoyNespressoEndpointColorDetectorV2
Fork of nsdl by
Diff: sn_coap_parser.c
- Revision:
- 0:f6e4e1bbb3fe
diff -r 000000000000 -r f6e4e1bbb3fe sn_coap_parser.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/sn_coap_parser.c Wed Jun 04 15:38:26 2014 +0000 @@ -0,0 +1,1028 @@ +/** + *\file sn_coap_parser.c + * + * \brief CoAP Header parser + * + * Functionality: Parses CoAP Header + * + * Created on: Jun 30, 2011 + * Author: tero + * + * \note Supports draft-ietf-core-coap-12 + */ + +/* * * * * * * * * * * * * * */ +/* * * * INCLUDE FILES * * * */ +/* * * * * * * * * * * * * * */ + +#include <stdio.h> +#include <string.h> /* For memset() and memcpy() */ + +#include "nsdl_types.h" +#include "sn_nsdl.h" +#include "sn_coap_header.h" +#include "sn_coap_protocol.h" +#include "sn_coap_header_internal.h" +#include "sn_coap_protocol_internal.h" + +/* * * * * * * * * * * * * * * * * * * * */ +/* * * * LOCAL FUNCTION PROTOTYPES * * * */ +/* * * * * * * * * * * * * * * * * * * * */ + +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); +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); +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); +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); +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); + +/* * * * * * * * * * * * * * * * * */ +/* * * * GLOBAL DECLARATIONS * * * */ +/* * * * * * * * * * * * * * * * * */ + + +SN_MEM_ATTR_COAP_PARSER_FUNC +sn_coap_hdr_s *sn_coap_parser(uint16_t packet_data_len, uint8_t *packet_data_ptr, coap_version_e *coap_version_ptr) +{ + uint8_t *data_temp_ptr = packet_data_ptr; + sn_coap_hdr_s *parsed_and_returned_coap_msg_ptr = NULL; + + /* * * * Check given pointer * * * */ + if (packet_data_ptr == NULL || packet_data_len < 4) + return NULL; + + /* * * * Allocate memory for parsed and returned CoAP message and initialize allocated memory with with zero values * * * */ + parsed_and_returned_coap_msg_ptr = sn_coap_malloc(sizeof(sn_coap_hdr_s)); + + if (parsed_and_returned_coap_msg_ptr == NULL) + return NULL; + + memset(parsed_and_returned_coap_msg_ptr, 0x00, sizeof(sn_coap_hdr_s)); + + + /* * * * Header parsing, move pointer over the header... * * * */ + sn_coap_parser_header_parse(&data_temp_ptr, parsed_and_returned_coap_msg_ptr, coap_version_ptr); + + + /* * * * Options parsing, move pointer over the options... * * * */ + if (sn_coap_parser_options_parse(&data_temp_ptr, parsed_and_returned_coap_msg_ptr, packet_data_ptr, packet_data_len) != 0) + { + /* Release memory of CoAP message */ + sn_coap_parser_release_allocated_coap_msg_mem(parsed_and_returned_coap_msg_ptr); + return NULL; + } + + /* * * * Payload parsing * * * */ + if(sn_coap_parser_payload_parse(packet_data_len, packet_data_ptr, &data_temp_ptr, parsed_and_returned_coap_msg_ptr) == -1) + { + /* Release memory of CoAP message */ + sn_coap_parser_release_allocated_coap_msg_mem(parsed_and_returned_coap_msg_ptr); + return NULL; + } + /* * * * Return parsed CoAP message * * * * */ + return parsed_and_returned_coap_msg_ptr; +} + + +SN_MEM_ATTR_COAP_PARSER_FUNC +void sn_coap_parser_release_allocated_coap_msg_mem(sn_coap_hdr_s *freed_coap_msg_ptr) +{ + if (freed_coap_msg_ptr != NULL) + { + if (freed_coap_msg_ptr->uri_path_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->uri_path_ptr); + } + + if (freed_coap_msg_ptr->token_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->token_ptr); + } + + if (freed_coap_msg_ptr->content_type_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->content_type_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr != NULL) + { + if (freed_coap_msg_ptr->options_list_ptr->max_age_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->max_age_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->proxy_uri_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->proxy_uri_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->etag_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->etag_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->uri_host_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->uri_host_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->location_path_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->location_path_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->uri_port_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->uri_port_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->location_query_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->location_query_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->observe_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->observe_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->uri_query_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->uri_query_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->block2_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->block2_ptr); + } + + if (freed_coap_msg_ptr->options_list_ptr->block1_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->block1_ptr); + } + if (freed_coap_msg_ptr->options_list_ptr->accept_ptr != NULL) + { + sn_coap_free(freed_coap_msg_ptr->options_list_ptr->accept_ptr); + } + + sn_coap_free(freed_coap_msg_ptr->options_list_ptr); + } + + sn_coap_free(freed_coap_msg_ptr); + } +} + +/** + * \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) + * + * \brief Parses CoAP message's Header part from given Packet data + * + * \param **packet_data_ptr is source for Packet data to be parsed to CoAP message + * + * \param *dst_coap_msg_ptr is destination for parsed CoAP message + * + * \param *coap_version_ptr is destination for parsed CoAP specification version + */ +SN_MEM_ATTR_COAP_PARSER_FUNC +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) +{ + /* Parse CoAP Version and message type*/ + *coap_version_ptr = (coap_version_e)(**packet_data_pptr & COAP_HEADER_VERSION_MASK); + dst_coap_msg_ptr->msg_type = (sn_coap_msg_type_e)(**packet_data_pptr & COAP_HEADER_MSG_TYPE_MASK); + (*packet_data_pptr) += 1; + + /* Parse Message code */ + dst_coap_msg_ptr->msg_code = (sn_coap_msg_code_e)**packet_data_pptr; + (*packet_data_pptr) += 1; + + /* Parse Message ID */ + dst_coap_msg_ptr->msg_id = *(*packet_data_pptr+1); + dst_coap_msg_ptr->msg_id += **packet_data_pptr << COAP_HEADER_MSG_ID_MSB_SHIFT; + (*packet_data_pptr) += 2; + +} + +/** + * \fn static uint8_t sn_coap_parser_options_parse(uint8_t **packet_data_pptr, sn_coap_hdr_s *dst_coap_msg_ptr) + * + * \brief Parses CoAP message's Options part from given Packet data + * + * \param **packet_data_pptr is source of Packet data to be parsed to CoAP message + * \param *dst_coap_msg_ptr is destination for parsed CoAP message + * + * \return Return value is 0 in ok case and -1 in failure case + */ +SN_MEM_ATTR_COAP_PARSER_FUNC +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) +{ + uint8_t previous_option_number = 0; + uint8_t i = 0; + int8_t ret_status = 0; + uint16_t message_left = 0; + + + /* Parse token, if exists */ + dst_coap_msg_ptr->token_len = *packet_data_start_ptr & COAP_HEADER_TOKEN_LENGTH_MASK; + + if(dst_coap_msg_ptr->token_len) + { + if((dst_coap_msg_ptr->token_len > 8) || dst_coap_msg_ptr->token_ptr) + return -1; + + dst_coap_msg_ptr->token_ptr = sn_coap_malloc(dst_coap_msg_ptr->token_len); + + if (dst_coap_msg_ptr->token_ptr == NULL) + { + return -1; + } + + memcpy(dst_coap_msg_ptr->token_ptr, *packet_data_pptr, dst_coap_msg_ptr->token_len); + (*packet_data_pptr) += dst_coap_msg_ptr->token_len; + } + + message_left = packet_len - ((*packet_data_pptr) - packet_data_start_ptr); + + /* Loop all Options */ + while((**packet_data_pptr != 0xff) && message_left) + { + + /* Get option length WITHOUT extensions */ + uint16_t option_len = (**packet_data_pptr & 0x0F); + + /* Option number length 15 is reserved for the future use - ERROR */ + if(option_len == 15) + return -1; + + /* Resolve option delta */ + uint16_t option_number = (**packet_data_pptr >> COAP_OPTIONS_OPTION_NUMBER_SHIFT); + + if(option_number == 13) + { + option_number = *(*packet_data_pptr+1) + 13; + (*packet_data_pptr)++; + } + else if(option_number == 14) + { + option_number = *(*packet_data_pptr+2); + option_number += (*(*packet_data_pptr+1) << 8) + 269; + (*packet_data_pptr) += 2; + } + /* Option number 15 reserved for payload marker. This is handled as a error! */ + else if(option_number == 15) + return -1; + + /* Add previous option to option delta and get option number */ + option_number += previous_option_number; + + /* Add possible option length extension to resolve full length of the option */ + if(option_len == 13) + { + option_len = *(*packet_data_pptr+1) + 13; + (*packet_data_pptr)++; + } + else if(option_len == 14) + { + option_len = *(*packet_data_pptr+2); + option_len += (*(*packet_data_pptr+1) << 8) + 269; + (*packet_data_pptr) += 2; + } + + + /* * * Parse option itself * * */ + /* Some options are handled independently in own functions */ + previous_option_number = option_number; + + /* Allocate options_list_ptr if needed */ + switch (option_number) + { + case COAP_OPTION_MAX_AGE: + case COAP_OPTION_PROXY_URI: + case COAP_OPTION_ETAG: + case COAP_OPTION_URI_HOST: + case COAP_OPTION_LOCATION_PATH: + case COAP_OPTION_URI_PORT: + case COAP_OPTION_LOCATION_QUERY: + case COAP_OPTION_OBSERVE: + case COAP_OPTION_URI_QUERY: + case COAP_OPTION_BLOCK2: + case COAP_OPTION_BLOCK1: + case COAP_OPTION_ACCEPT: + if (dst_coap_msg_ptr->options_list_ptr == NULL) + { + dst_coap_msg_ptr->options_list_ptr = sn_coap_malloc(sizeof(sn_coap_options_list_s)); + if(NULL == dst_coap_msg_ptr->options_list_ptr) + { + return -1; + } + memset(dst_coap_msg_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s)); + } + break; + } + + /* Parse option */ + switch (option_number) + { + case COAP_OPTION_CONTENT_FORMAT: + if((option_len > 2) || (dst_coap_msg_ptr->content_type_ptr)) + return -1; + dst_coap_msg_ptr->content_type_len = option_len; + (*packet_data_pptr)++; + + if(option_len) + { + dst_coap_msg_ptr->content_type_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->content_type_ptr == NULL) + { + return -1; + } + + memcpy(dst_coap_msg_ptr->content_type_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + } + break; + + case COAP_OPTION_MAX_AGE: + if((option_len > 4) || dst_coap_msg_ptr->options_list_ptr->max_age_ptr) + return -1; + dst_coap_msg_ptr->options_list_ptr->max_age_len = option_len; + (*packet_data_pptr)++; + + if(option_len) + { + dst_coap_msg_ptr->options_list_ptr->max_age_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->max_age_ptr == NULL) + { + return -1; + } + + memcpy(dst_coap_msg_ptr->options_list_ptr->max_age_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + } + break; + + case COAP_OPTION_PROXY_URI: + if ((option_len > 1034) || (option_len < 1) || dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr) + return -1; + dst_coap_msg_ptr->options_list_ptr->proxy_uri_len = option_len; + (*packet_data_pptr)++; + + dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr == NULL) + { + return -1; + } + memcpy(dst_coap_msg_ptr->options_list_ptr->proxy_uri_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + + break; + + case COAP_OPTION_ETAG: + if(dst_coap_msg_ptr->options_list_ptr->etag_ptr) + return -1; + /* This is managed independently because User gives this option in one character table */ + + ret_status = sn_coap_parser_options_parse_multiple_options (packet_data_pptr, + message_left, + &dst_coap_msg_ptr->options_list_ptr->etag_ptr, + (uint16_t*)&dst_coap_msg_ptr->options_list_ptr->etag_len, + COAP_OPTION_LOCATION_PATH, option_len); + if (ret_status >= 0) + { + i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ + } + else + { + return -1; + } + break; + + case COAP_OPTION_URI_HOST: + if((option_len > 255) || (option_len < 1) || dst_coap_msg_ptr->options_list_ptr->uri_host_ptr) + return -1; + dst_coap_msg_ptr->options_list_ptr->uri_host_len = option_len; + (*packet_data_pptr)++; + + dst_coap_msg_ptr->options_list_ptr->uri_host_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->uri_host_ptr == NULL) + { + return -1; + } + memcpy(dst_coap_msg_ptr->options_list_ptr->uri_host_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + + break; + + case COAP_OPTION_LOCATION_PATH: + if(dst_coap_msg_ptr->options_list_ptr->location_path_ptr) + return -1; + /* This is managed independently because User gives this option in one character table */ + ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, + &dst_coap_msg_ptr->options_list_ptr->location_path_ptr, &dst_coap_msg_ptr->options_list_ptr->location_path_len, + COAP_OPTION_LOCATION_PATH, option_len); + if (ret_status >= 0) + { + i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ + } + else + { + return -1; + } + + break; + + + case COAP_OPTION_URI_PORT: + if((option_len > 2) || dst_coap_msg_ptr->options_list_ptr->uri_port_ptr) + return -1; + dst_coap_msg_ptr->options_list_ptr->uri_port_len = option_len; + (*packet_data_pptr)++; + + if(option_len) + { + dst_coap_msg_ptr->options_list_ptr->uri_port_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->uri_port_ptr == NULL) + { + return -1; + } + memcpy(dst_coap_msg_ptr->options_list_ptr->uri_port_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + } + break; + + case COAP_OPTION_LOCATION_QUERY: + if(dst_coap_msg_ptr->options_list_ptr->location_query_ptr) + return -1; + ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, + &dst_coap_msg_ptr->options_list_ptr->location_query_ptr, &dst_coap_msg_ptr->options_list_ptr->location_query_len, + COAP_OPTION_LOCATION_QUERY, option_len); + if (ret_status >= 0) + { + i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ + } + else + { + return -1; + } + + break; + + case COAP_OPTION_URI_PATH: + if(dst_coap_msg_ptr->uri_path_ptr) + return -1; + ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, + &dst_coap_msg_ptr->uri_path_ptr, &dst_coap_msg_ptr->uri_path_len, + COAP_OPTION_URI_PATH, option_len); + if (ret_status >= 0) + { + i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ + } + else + { + return -1; + } + + break; + + case COAP_OPTION_OBSERVE: + if((option_len > 2) || dst_coap_msg_ptr->options_list_ptr->observe_ptr) + return -1; + + dst_coap_msg_ptr->options_list_ptr->observe = 1; + (*packet_data_pptr)++; + + if(option_len) + { + + dst_coap_msg_ptr->options_list_ptr->observe_len = option_len; + + dst_coap_msg_ptr->options_list_ptr->observe_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->observe_ptr == NULL) + { + return -1; + } + + memcpy(dst_coap_msg_ptr->options_list_ptr->observe_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + } + + break; + + case COAP_OPTION_URI_QUERY: + if(dst_coap_msg_ptr->options_list_ptr->uri_query_ptr) + return -1; + ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, + &dst_coap_msg_ptr->options_list_ptr->uri_query_ptr, &dst_coap_msg_ptr->options_list_ptr->uri_query_len, + COAP_OPTION_URI_QUERY, option_len); + if (ret_status >= 0) + { + i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ + } + else + { + return -1; + } + + break; + + case COAP_OPTION_BLOCK2: + if((option_len > 4) || dst_coap_msg_ptr->options_list_ptr->block2_ptr) + return -1; + dst_coap_msg_ptr->options_list_ptr->block2_len = option_len; + (*packet_data_pptr)++; + + dst_coap_msg_ptr->options_list_ptr->block2_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->block2_ptr == NULL) + { + return -1; + } + + memcpy(dst_coap_msg_ptr->options_list_ptr->block2_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + + break; + + case COAP_OPTION_BLOCK1: + if((option_len > 4) || dst_coap_msg_ptr->options_list_ptr->block1_ptr) + return -1; + dst_coap_msg_ptr->options_list_ptr->block1_len = option_len; + (*packet_data_pptr)++; + + dst_coap_msg_ptr->options_list_ptr->block1_ptr = sn_coap_malloc(option_len); + + if (dst_coap_msg_ptr->options_list_ptr->block1_ptr == NULL) + { + return -1; + } + + memcpy(dst_coap_msg_ptr->options_list_ptr->block1_ptr, *packet_data_pptr, option_len); + (*packet_data_pptr) += option_len; + + break; + + case COAP_OPTION_ACCEPT: + if(dst_coap_msg_ptr->options_list_ptr->accept_ptr) + return -1; + ret_status = sn_coap_parser_options_parse_multiple_options(packet_data_pptr, message_left, + &dst_coap_msg_ptr->options_list_ptr->accept_ptr, (uint16_t *)&dst_coap_msg_ptr->options_list_ptr->accept_len, + COAP_OPTION_ACCEPT, option_len); + if (ret_status >= 0) + { + i += (ret_status - 1); /* i += is because possible several Options are handled by sn_coap_parser_options_parse_multiple_options() */ + } + else + { + return -1; + } + + break; + + default: + return -1; + } + + /* Check for overflow */ + if((*packet_data_pptr - packet_data_start_ptr) > packet_len) + return -1; + + message_left = packet_len - (*packet_data_pptr - packet_data_start_ptr); //todo: if(*packet_data_pptr < packet_data_start_ptr) message_left = 0; else + + + } + + return 0; +} + + +/** + * \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, + * uint16_t *dst_len_ptr, sn_coap_option_numbers_e option, uint16_t option_number_len) + * + * \brief Parses CoAP message's Uri-query options + * + * \param **packet_data_pptr is source for Packet data to be parsed to CoAP message + * + * \param *dst_coap_msg_ptr is destination for parsed CoAP message + * + * \param options_count_left tells how many options are unhandled in Packet data + * + * \param *previous_option_number_ptr is pointer to used and returned previous Option number + * + * \return Return value is count of Uri-query optios parsed. In failure case -1 is returned. +*/ +SN_MEM_ATTR_COAP_PARSER_FUNC +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) +{ + 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); + uint8_t *temp_parsed_uri_query_ptr = NULL; + uint8_t returned_option_counter = 0; + + if(uri_query_needed_heap == -1) + return -1; + + if(uri_query_needed_heap) + { + *dst_pptr = (uint8_t*) sn_coap_malloc(uri_query_needed_heap); + + if (*dst_pptr == NULL) + return -1; + } + + *dst_len_ptr = uri_query_needed_heap; + + temp_parsed_uri_query_ptr = *dst_pptr; + + /* Loop all Uri-Query options */ + while ((temp_parsed_uri_query_ptr - *dst_pptr) < uri_query_needed_heap) + { + /* Check if this is first Uri-Query option */ + if (returned_option_counter > 0) + { + /* Uri-Query is modified to following format: temp1'\0'temp2'\0'temp3 i.e. */ + /* Uri-Path is modified to following format: temp1\temp2\temp3 i.e. */ + if(option == COAP_OPTION_URI_QUERY || option == COAP_OPTION_LOCATION_QUERY || option == COAP_OPTION_ETAG || option == COAP_OPTION_ACCEPT) + memset(temp_parsed_uri_query_ptr, '&', 1); + else if(option == COAP_OPTION_URI_PATH || option == COAP_OPTION_LOCATION_PATH) + memset(temp_parsed_uri_query_ptr, '/', 1); + + temp_parsed_uri_query_ptr++; + } + + returned_option_counter++; + + (*packet_data_pptr)++; + + if(((temp_parsed_uri_query_ptr - *dst_pptr) + option_number_len) > uri_query_needed_heap) + return -1; + + memcpy(temp_parsed_uri_query_ptr, *packet_data_pptr, option_number_len); + + (*packet_data_pptr) += option_number_len; + temp_parsed_uri_query_ptr += option_number_len; + + if(((**packet_data_pptr >> COAP_OPTIONS_OPTION_NUMBER_SHIFT) != 0) || (temp_parsed_uri_query_ptr - *dst_pptr) >= uri_query_needed_heap) + { + return returned_option_counter; + } + + option_number_len = (**packet_data_pptr & 0x0F); + if(option_number_len == 13) + { + option_number_len = *(*packet_data_pptr+1) + 13; + (*packet_data_pptr)++; + } + else if(option_number_len == 14) + { + option_number_len = *(*packet_data_pptr+2); + option_number_len += (*(*packet_data_pptr+1) << 8) + 269; + (*packet_data_pptr) += 2; + } + } + + return returned_option_counter; +} + + + + +/** + * \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) + * + * \brief Counts needed memory for uri query option + * + * \param *packet_data_ptr is start of source for Packet data to be parsed to CoAP message + * + * \param options_count_left tells how many options are unhandled in Packet data + * + * \param previous_option_number is previous Option number + * + * \param sn_coap_option_numbers_e option option number to be calculated + * + * \param uint16_t option_number_len length of the first option part + */ +SN_MEM_ATTR_COAP_PARSER_FUNC +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) +{ + uint16_t ret_value = 0; + uint16_t i = 1; + + /* Loop all Uri-Query options */ + while (i < packet_left_len) + { + if(option == COAP_OPTION_LOCATION_PATH && option_number_len > 255) + return -1; + if(option == COAP_OPTION_URI_PATH && option_number_len > 255) + return -1; + if(option == COAP_OPTION_URI_QUERY && option_number_len > 255) + return -1; + if(option == COAP_OPTION_LOCATION_QUERY && option_number_len > 255) + return -1; + if(option == COAP_OPTION_ACCEPT && option_number_len > 2) + return -1; + if(option == COAP_OPTION_ETAG && option_number_len > 8) + return -1; + + i += option_number_len; + ret_value += option_number_len + 1; /* + 1 is for separator */ + + if((*(packet_data_ptr + i) >> COAP_OPTIONS_OPTION_NUMBER_SHIFT) != 0) + { + if(ret_value != 0) + return (ret_value - 1); /* -1 because last Part path does not include separator */ + else + return 0; + } + + option_number_len = (*(packet_data_ptr + i) & 0x0F); + + if (option_number_len == 13) + { + i++; + option_number_len = *(packet_data_ptr + i) + 13; + } + else if (option_number_len == 14) + { + option_number_len = *(packet_data_ptr + 2); + option_number_len += (*(packet_data_ptr + 1) << 8) + 269; + i += 2; + } + else if (option_number_len == 15) + return -1; + i++; + + } + + if(ret_value != 0) + return (ret_value - 1); /* -1 because last Part path does not include separator */ + else + return 0; +} + +/** + * \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) + * + * \brief Parses CoAP message's Payload part from given Packet data + * + * \param packet_data_len is length of given Packet data to be parsed to CoAP message + * + * \param *packet_data_ptr is start of source for Packet data to be parsed to CoAP message + * + * \param **packet_data_pptr is source for Packet data to be parsed to CoAP message + * + * \param *dst_coap_msg_ptr is destination for parsed CoAP message + *****************************************************************************/ +SN_MEM_ATTR_COAP_PARSER_FUNC +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) +{ + /* If there is payload */ + if((*packet_data_pptr - packet_data_start_ptr) < packet_data_len) + { + if(**packet_data_pptr == 0xff) + { + (*packet_data_pptr)++; + /* Parse Payload length */ + dst_coap_msg_ptr->payload_len = packet_data_len - (*packet_data_pptr - packet_data_start_ptr); + + /* The presence of a marker followed by a zero-length payload MUST be processed as a message format error */ + if(dst_coap_msg_ptr->payload_len == 0) + return -1; + + /* Parse Payload by setting CoAP message's payload_ptr to point Payload in Packet data */ + dst_coap_msg_ptr->payload_ptr = *packet_data_pptr; + } + /* No payload marker.. */ + else + return -1; + } + return 0; +} + + +/** + * \fn void sn_coap_packet_debug(sn_coap_hdr_s *coap_packet_ptr) + * + * \brief Parses CoAP message and prints parts for debugging + * + * \param *coap_packet_ptr Pointer to the CoAP message to debug + * + *****************************************************************************/ +SN_MEM_ATTR_COAP_PARSER_FUNC +void sn_coap_packet_debug(sn_coap_hdr_s *coap_packet_ptr) +{ +#ifdef HAVE_DEBUG + switch (coap_packet_ptr->msg_type) + { + case COAP_MSG_TYPE_CONFIRMABLE: + printf("con "); + break; + + case COAP_MSG_TYPE_NON_CONFIRMABLE: + printf("non "); + break; + + case COAP_MSG_TYPE_ACKNOWLEDGEMENT: + printf("ack "); + break; + + case COAP_MSG_TYPE_RESET: + printf("rst "); + break; + } + + switch (coap_packet_ptr->msg_code) + { + case COAP_MSG_CODE_EMPTY: + printf("NO CODE "); + break; + + case COAP_MSG_CODE_REQUEST_GET: + printf("GET "); + break; + + case COAP_MSG_CODE_REQUEST_POST: + printf("POST "); + break; + + case COAP_MSG_CODE_REQUEST_PUT: + printf("PUT "); + break; + + case COAP_MSG_CODE_REQUEST_DELETE: + printf("DELETE "); + break; + + case COAP_MSG_CODE_RESPONSE_CREATED: + printf("2.01 Created "); + break; + + case COAP_MSG_CODE_RESPONSE_DELETED: + printf("2.02 Deleted "); + break; + + case COAP_MSG_CODE_RESPONSE_VALID: + printf("2.03 Valid "); + break; + + case COAP_MSG_CODE_RESPONSE_CHANGED: + printf("2.04 Changed "); + break; + + case COAP_MSG_CODE_RESPONSE_CONTENT: + printf("2.05 Content "); + break; + + case COAP_MSG_CODE_RESPONSE_BAD_REQUEST: + printf("4.00 Bad Request "); + break; + + case COAP_MSG_CODE_RESPONSE_UNAUTHORIZED: + printf("4.01 Unauthorized "); + break; + + case COAP_MSG_CODE_RESPONSE_BAD_OPTION: + printf("4.02 Bad Option "); + break; + + case COAP_MSG_CODE_RESPONSE_FORBIDDEN: + printf("4.03 Forbidden "); + break; + + case COAP_MSG_CODE_RESPONSE_NOT_FOUND: + printf("4.04 Not Found "); + break; + + case COAP_MSG_CODE_RESPONSE_METHOD_NOT_ALLOWED: + printf("4.05 Method Not Allowed "); + break; + + case COAP_MSG_CODE_RESPONSE_NOT_ACCEPTABLE: + printf("4.06 Response Not Acceptable"); + break; + + case COAP_MSG_CODE_RESPONSE_REQUEST_ENTITY_INCOMPLETE: + printf("4.08 Request Entity Incomplete "); + break; + + case COAP_MSG_CODE_RESPONSE_PRECONDITION_FAILED: + printf("4.12 Response Precondition Failed"); + break; + + case COAP_MSG_CODE_RESPONSE_REQUEST_ENTITY_TOO_LARGE: + printf("4.13 Request Entity Too Large "); + break; + + case COAP_MSG_CODE_RESPONSE_UNSUPPORTED_CONTENT_FORMAT: + printf("4.15 Unsupported Media Type "); + break; + + case COAP_MSG_CODE_RESPONSE_INTERNAL_SERVER_ERROR: + printf("5.00 Internal Server Error "); + break; + + case COAP_MSG_CODE_RESPONSE_NOT_IMPLEMENTED: + printf("5.01 Not Implemented "); + break; + + case COAP_MSG_CODE_RESPONSE_BAD_GATEWAY: + printf("5.02 Bad Gateway "); + break; + + case COAP_MSG_CODE_RESPONSE_SERVICE_UNAVAILABLE: + printf("5.03 Service Unavailable "); + break; + + case COAP_MSG_CODE_RESPONSE_GATEWAY_TIMEOUT: + printf("5.04 Gateway Timeout "); + break; + + case COAP_MSG_CODE_RESPONSE_PROXYING_NOT_SUPPORTED: + printf("5.05 Proxying Not Supported "); + break; + + default: + printf("UNKNOWN CODE "); + break; + } + + printf("mid=%i ", (int)(coap_packet_ptr->msg_id)); + + if (coap_packet_ptr->uri_path_ptr) + { + int i; + printf("/"); + for (i=0; i < coap_packet_ptr->uri_path_len; i++) printf("%c", (char)(coap_packet_ptr->uri_path_ptr[i])); + if (coap_packet_ptr->options_list_ptr && coap_packet_ptr->options_list_ptr->uri_query_ptr) + { + printf("?"); + 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])); + } + printf(" "); + } + + if (coap_packet_ptr->token_ptr) + { + int i; + printf("token=0x"); + for (i=0; i < coap_packet_ptr->token_len; i++) printf("%02x", (unsigned char)(coap_packet_ptr->token_ptr[i])); + printf(" "); + } + + if (coap_packet_ptr->content_type_ptr) + { + switch (coap_packet_ptr->content_type_ptr[0]) + { + case COAP_CT_TEXT_PLAIN: + printf("text/plain "); + break; + + case COAP_CT_LINK_FORMAT: + printf("application/link-format "); + break; + + case COAP_CT_XML: + printf("application/xml "); + break; + + case COAP_CT_OCTET_STREAM: + printf("application/octet-stream "); + break; + + case COAP_CT_EXI: + printf("application/exi "); + break; + + case COAP_CT_JSON: + printf("application/json "); + break; + default: + printf("uknown type (%i) ", (int)(coap_packet_ptr->content_type_ptr[0])); + break; + + } + } + + if (coap_packet_ptr->options_list_ptr && coap_packet_ptr->options_list_ptr->location_path_ptr) + { + printf("Location: /"); + int i; + 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])); + printf(" "); + } + + if (coap_packet_ptr->payload_ptr) + { + int i; + printf("'"); + for (i=0; i < coap_packet_ptr->payload_len; i++) + printf("%c", *(coap_packet_ptr->payload_ptr + i)); + printf("' "); + } + + printf("\n"); +#endif +}