doubango/tinyNET/src/stun/tnet_stun_attr.c
c732d49e
 #if HAVE_CRT
 #define _CRTDBG_MAP_ALLOC 
 #include <stdlib.h> 
 #include <crtdbg.h>
 #endif //HAVE_CRT
 /*
 * Copyright (C) 2017, University of the Basque Country (UPV/EHU)
 * Contact for licensing options: <licensing-mcpttclient(at)mcopenplatform(dot)com>
 *
 * The original file was part of Open Source Doubango Framework
 * Copyright (C) 2010-2011 Mamadou Diop.
 * Copyright (C) 2012 Doubango Telecom <http://doubango.org>
 *
 * This file is part of Open Source Doubango Framework.
 *
 * DOUBANGO is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * DOUBANGO is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with DOUBANGO.
 *
 */
 #include "stun/tnet_stun_attr.h"
 #include "stun/tnet_stun_utils.h"
 
 #include "tnet_endianness.h"
 
 #include "tsk_string.h"
 #include "tsk_memory.h"
 #include "tsk_debug.h"
 
 #define kWithoutPadding		tsk_false
 #define kWithPadding		tsk_true
 
 #if !defined(PRINT_DESTROYED_MSG)
 #	define PRINT_DESTROYED_MSG	0
 #endif
 
 #define ALIGN_ON_32BITS(size_in_octes) if (((size_in_octes) & 3)) (size_in_octes) += (4 - ((size_in_octes) & 3));
 #define ALIGN_ON_32BITS_AND_SET_PADDING_ZEROS(p_buffer, size_in_octes) \
 	if (((size_in_octes) & 3)) { \
 		int c = (4 - ((size_in_octes) & 3)); \
 		memset(p_buffer, 0, c); \
 		(size_in_octes) += c; \
 		}
 
 #define IS_ADDRESS_XOR(e_type) \
 	(e_type == tnet_stun_attr_type_xor_mapped_address || e_type == tnet_stun_attr_type_xor_peer_address || e_type == tnet_stun_attr_type_xor_relayed_address)
 #define IS_VDATA_UINT8(e_type) \
 	(e_type == tnet_stun_attr_type_requested_transport)
 #define IS_VDATA_UINT16(e_type) \
 	(e_type == tnet_stun_attr_type_channel_number)
 #define IS_VDATA_UINT32(e_type) \
 	(e_type == tnet_stun_attr_type_fingerprint || e_type == tnet_stun_attr_type_lifetime || e_type == tnet_stun_attr_type_ice_priority || e_type == tnet_stun_attr_type_connection_id)
 #define IS_VDATA_UINT64(e_type) \
 	(e_type == tnet_stun_attr_type_ice_controlled || e_type == tnet_stun_attr_type_ice_controlling)
 
 static int _tnet_stun_attr_cmp(const tsk_object_t *_att1, const tsk_object_t *_att2)
 {
 	const tnet_stun_attr_t *pc_att1 = (const tnet_stun_attr_t *)_att1;
 	const tnet_stun_attr_t *pc_att2 = (const tnet_stun_attr_t *)_att2;
 
 	return (int)(pc_att1 - pc_att2);
 }
 
 static int _tnet_stun_attr_get_size_in_octetunits(const tnet_stun_attr_t* pc_self, tsk_bool_t with_padding, tsk_size_t* p_size)
 {
 	if (!pc_self || !p_size) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	switch (pc_self->hdr.e_type) {
 	case tnet_stun_attr_type_mapped_address:
 	case tnet_stun_attr_type_alternate_server:
 	case tnet_stun_attr_type_xor_mapped_address:
 	case tnet_stun_attr_type_xor_peer_address:
 	case tnet_stun_attr_type_xor_relayed_address: {
 		extern const tsk_object_def_t *tnet_stun_attr_address_def_t;
 		const tnet_stun_attr_address_t* _pc_self = (const tnet_stun_attr_address_t*)pc_self;
 		if (pc_self->__def__ != tnet_stun_attr_address_def_t) {
 			TSK_DEBUG_ERROR("Invalid base type");
 			return -2;
 		}
 		*p_size = (kStunAttrHdrSizeInOctets + 1/*Ignored*/ + 1/*Family*/ + 2/*Port*/ + ((_pc_self->e_family == tnet_stun_address_family_ipv6) ? 16 : 4));
 		if (with_padding) {
 			ALIGN_ON_32BITS(*p_size);
 		}
 		return 0;
 	}
 	case tnet_stun_attr_type_data:
 	case tnet_stun_attr_type_unknown_attrs:
 	case tnet_stun_attr_type_dont_fragment:
 	case tnet_stun_attr_type_software:
 	case tnet_stun_attr_type_nonce:
 	case tnet_stun_attr_type_realm:
 	case tnet_stun_attr_type_username:
 	case tnet_stun_attr_type_password:
 	case tnet_stun_attr_type_channel_number:
 	case tnet_stun_attr_type_message_integrity:
 	case tnet_stun_attr_type_fingerprint:
 	case tnet_stun_attr_type_lifetime:
 	case tnet_stun_attr_type_requested_transport:
 	case tnet_stun_attr_type_ice_use_candidate:
 	case tnet_stun_attr_type_ice_priority:
 	case tnet_stun_attr_type_ice_controlled:
 	case tnet_stun_attr_type_ice_controlling:
 	case tnet_stun_attr_type_connection_id: {
 		extern const tsk_object_def_t *tnet_stun_attr_vdata_def_t;
 		const tnet_stun_attr_vdata_t* _pc_self = (const tnet_stun_attr_vdata_t*)pc_self;
 		if (pc_self->__def__ != tnet_stun_attr_vdata_def_t) {
 			TSK_DEBUG_ERROR("Invalid base type");
 			return -2;
 		}
 		*p_size = (kStunAttrHdrSizeInOctets + _pc_self->u_data_size);
 		if (with_padding) {
 			ALIGN_ON_32BITS(*p_size);
 		}
 		return 0;
 	}
 	case tnet_stun_attr_type_error_code: {
 		const tnet_stun_attr_error_code_t* _pc_self = (const tnet_stun_attr_error_code_t*)pc_self;
 		*p_size = (kStunAttrHdrSizeInOctets + 4 + (tsk_size_t)tsk_strlen(_pc_self->p_reason_phrase));
 		if (with_padding) {
 			ALIGN_ON_32BITS(*p_size);
 		}
 		return 0;
 	}
 	default: {
 		TSK_DEBUG_WARN("Attribute type=%d is unknown. Don't be surprised if something goes wrong.", pc_self->hdr.e_type);
 		*p_size = (kStunAttrHdrSizeInOctets + pc_self->hdr.u_length);
 		if (with_padding) {
 			ALIGN_ON_32BITS(*p_size);
 		}
 		return 0;
 	}
 	}
 }
 
 static int _tnet_stun_attr_write(const tnet_stun_transac_id_t* pc_transac_id, const tnet_stun_attr_t* pc_self, uint8_t* p_buff_ptr, tsk_size_t n_buff_size, tsk_bool_t with_padding, tsk_size_t *p_written)
 {
 	tsk_size_t n_min_req_size;
 	int ret;
 	if (!pc_self || !p_buff_ptr || !n_buff_size || !p_written) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	if ((ret = _tnet_stun_attr_get_size_in_octetunits(pc_self, with_padding, &n_min_req_size))) {
 		return ret;
 	}
 	if (n_min_req_size > n_buff_size) {
 		TSK_DEBUG_ERROR("Buffer too short %u<%u", n_buff_size, n_min_req_size);
 		return -2;
 	}
 
 	*((uint16_t*)&p_buff_ptr[0]) = tnet_htons((unsigned short)pc_self->hdr.e_type);
 	// *((uint16_t*)&p_buff_ptr[2]) = tnet_htons((unsigned short)pc_self->hdr.u_length);
 	*p_written = kStunAttrHdrSizeInOctets;
 
 	switch (pc_self->hdr.e_type) {
 	case tnet_stun_attr_type_mapped_address:
 	case tnet_stun_attr_type_alternate_server:
 	case tnet_stun_attr_type_xor_mapped_address:
 	case tnet_stun_attr_type_xor_peer_address:
 	case tnet_stun_attr_type_xor_relayed_address: {
 		tsk_size_t u_addr_size;
 		extern const tsk_object_def_t *tnet_stun_attr_address_def_t;
 		const tnet_stun_attr_address_t* _pc_self = (const tnet_stun_attr_address_t*)pc_self;
 		tsk_bool_t b_xor = IS_ADDRESS_XOR(pc_self->hdr.e_type);
 		if (pc_self->__def__ != tnet_stun_attr_address_def_t) {
 			TSK_DEBUG_ERROR("Invalid base type");
 			return -2;
 		}
 		p_buff_ptr[*p_written] = 0x00; // Reserved
 		p_buff_ptr[*p_written + 1] = _pc_self->e_family;
 		u_addr_size = (_pc_self->e_family == tnet_stun_address_family_ipv6 ? 16 : 4);
 		if (b_xor) {
 			tsk_size_t u;
 			*((uint16_t*)&p_buff_ptr[*p_written + 2]) = tnet_htons(_pc_self->u_port ^ kStunMagicCookieShort);
 			*((uint32_t*)&p_buff_ptr[*p_written + 4]) = (uint32_t)tnet_htonl(tnet_ntohl(*((uint32_t*)&_pc_self->address[0])) ^ kStunMagicCookieLong);
 			for (u = 4; u < u_addr_size; u += 4) {
 				if (pc_transac_id) {
 					*((uint32_t*)&p_buff_ptr[*p_written + 4 + u]) = (uint32_t)tnet_htonl(tnet_ntohl(*((uint32_t*)&_pc_self->address[u])) ^ tnet_ntohl(*((uint32_t*)(*pc_transac_id + u - 4))));
 				}
 				else {
 					*((uint32_t*)&p_buff_ptr[*p_written + 4 + u]) = (uint32_t)tnet_htonl(tnet_ntohl(*((uint32_t*)&_pc_self->address[u])) ^ 0);
 				}
 			}
 		}
 		else {
 			*((uint16_t*)&p_buff_ptr[*p_written + 2]) = tnet_htons(_pc_self->u_port);
 			memcpy(&p_buff_ptr[*p_written + 4], _pc_self->address, u_addr_size);
 		}
 
 		*p_written += 4 + u_addr_size;
 		*((uint16_t*)&p_buff_ptr[2]) = tnet_htons((unsigned short)*p_written - kStunAttrHdrSizeInOctets);
 		if (with_padding) {
 			ALIGN_ON_32BITS_AND_SET_PADDING_ZEROS(&p_buff_ptr[*p_written], *p_written);
 		}
 		return 0;
 	}
 
 	case tnet_stun_attr_type_data:
 	case tnet_stun_attr_type_unknown_attrs:
 	case tnet_stun_attr_type_dont_fragment:
 	case tnet_stun_attr_type_software:
 	case tnet_stun_attr_type_nonce:
 	case tnet_stun_attr_type_realm:
 	case tnet_stun_attr_type_username:
 	case tnet_stun_attr_type_password:
 	case tnet_stun_attr_type_channel_number:
 	case tnet_stun_attr_type_message_integrity:
 	case tnet_stun_attr_type_fingerprint:
 	case tnet_stun_attr_type_lifetime:
 	case tnet_stun_attr_type_requested_transport:
 	case tnet_stun_attr_type_ice_use_candidate:
 	case tnet_stun_attr_type_ice_priority:
 	case tnet_stun_attr_type_ice_controlled:
 	case tnet_stun_attr_type_ice_controlling:
 	case tnet_stun_attr_type_connection_id: {
 		extern const tsk_object_def_t *tnet_stun_attr_vdata_def_t;
 		const tnet_stun_attr_vdata_t* _pc_self = (const tnet_stun_attr_vdata_t*)pc_self;
 		if (pc_self->__def__ != tnet_stun_attr_vdata_def_t) {
 			TSK_DEBUG_ERROR("Invalid base type");
 			return -2;
 		}
 		if (_pc_self->p_data_ptr && _pc_self->u_data_size) {
 			if (IS_VDATA_UINT16(pc_self->hdr.e_type) && _pc_self->u_data_size == 2) {
 				*((uint16_t*)&p_buff_ptr[*p_written]) = tnet_htons_2(&_pc_self->p_data_ptr[0]);
 			}
 			else if (IS_VDATA_UINT32(pc_self->hdr.e_type) && _pc_self->u_data_size == 4) {
 				*((uint32_t*)&p_buff_ptr[*p_written]) = (uint32_t)tnet_htonl_2(&_pc_self->p_data_ptr[0]);
 			}
 			else if (IS_VDATA_UINT64(pc_self->hdr.e_type) && _pc_self->u_data_size == 8) {
 				*((uint32_t*)&p_buff_ptr[*p_written]) = (uint32_t)tnet_htonl_2(&_pc_self->p_data_ptr[0]);
 				*((uint32_t*)&p_buff_ptr[*p_written + 4]) = (uint32_t)tnet_htonl_2(&_pc_self->p_data_ptr[4]);
 			}
 			else if (pc_self->hdr.e_type == tnet_stun_attr_type_unknown_attrs && _pc_self->u_data_size && !(_pc_self->u_data_size & 1)) {
 				uint16_t u;
 				for (u = 0; u < _pc_self->u_data_size; u += 2) {
 					*((uint16_t*)&p_buff_ptr[*p_written + u]) = tnet_htons_2(&_pc_self->p_data_ptr[u]);
 				}
 			}
 			else {
 				memcpy(&p_buff_ptr[*p_written], _pc_self->p_data_ptr, _pc_self->u_data_size);
 			}
 			*p_written += _pc_self->u_data_size;
 		}
 		if (with_padding) {
 			ALIGN_ON_32BITS_AND_SET_PADDING_ZEROS(&p_buff_ptr[*p_written], *p_written);
 		}
 		*((uint16_t*)&p_buff_ptr[2]) = tnet_htons((unsigned short)*p_written - kStunAttrHdrSizeInOctets);
 		return 0;
 	}
 	case tnet_stun_attr_type_error_code: {
 		const tnet_stun_attr_error_code_t* _pc_self = (const tnet_stun_attr_error_code_t*)pc_self;
 		*((uint32_t*)&p_buff_ptr[*p_written]) = (uint32_t)tnet_htonl(((_pc_self->u_class & 0x07) << 8) | _pc_self->u_number);
 		if (_pc_self->p_reason_phrase) {
 			memcpy(&p_buff_ptr[*p_written + 4], _pc_self->p_reason_phrase, tsk_strlen(_pc_self->p_reason_phrase));
 		}
 		*p_written += 4 + tsk_strlen(_pc_self->p_reason_phrase);
 		if (with_padding) {
 			ALIGN_ON_32BITS_AND_SET_PADDING_ZEROS(&p_buff_ptr[*p_written], *p_written);
 		}
 		*((uint16_t*)&p_buff_ptr[2]) = tnet_htons((unsigned short)*p_written - kStunAttrHdrSizeInOctets);
 		return 0;
 	}
 	default: {
 		TSK_DEBUG_ERROR("Attribute type=%d is unknown.", pc_self->hdr.e_type);
 		return -2;
 	}
 	}
 }
 
 int tnet_stun_attr_init(tnet_stun_attr_t* p_self, tnet_stun_attr_type_t e_type, uint16_t u_length)
 {
 	if (!p_self) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	p_self->hdr.e_type = e_type;
 	p_self->hdr.u_length = u_length;
 	return 0;
 }
 
 int tnet_stun_attr_get_size_in_octetunits_without_padding(const tnet_stun_attr_t* pc_self, tsk_size_t* p_size)
 {
 	return _tnet_stun_attr_get_size_in_octetunits(pc_self, kWithoutPadding, p_size);
 }
 
 int tnet_stun_attr_get_size_in_octetunits_with_padding(const tnet_stun_attr_t* pc_self, tsk_size_t* p_size)
 {
 	return _tnet_stun_attr_get_size_in_octetunits(pc_self, kWithPadding, p_size);
 }
 
 int tnet_stun_attr_write_without_padding(const tnet_stun_transac_id_t* pc_transac_id, const tnet_stun_attr_t* pc_self, uint8_t* p_buff_ptr, tsk_size_t n_buff_size, tsk_size_t *p_written)
 {
 	return _tnet_stun_attr_write(pc_transac_id, pc_self, p_buff_ptr, n_buff_size, kWithoutPadding, p_written);
 }
 
 int tnet_stun_attr_write_with_padding(const tnet_stun_transac_id_t* pc_transac_id, const tnet_stun_attr_t* pc_self, uint8_t* p_buff_ptr, tsk_size_t n_buff_size, tsk_size_t *p_written)
 {
 	return _tnet_stun_attr_write(pc_transac_id, pc_self, p_buff_ptr, n_buff_size, kWithPadding, p_written);
 }
 
 int tnet_stun_attr_read(const tnet_stun_transac_id_t* pc_transac_id, const uint8_t* pc_buff_ptr, tsk_size_t n_buff_size, tsk_size_t *p_consumed_octets, tnet_stun_attr_t** pp_attr)
 {
 	tnet_stun_attr_type_t Type;
 	uint16_t Length, PadLength;
 	int ret = -1;
 	static const void* kNullBuffPtr = tsk_null;
 	if (!pc_buff_ptr || !n_buff_size || !pp_attr || !p_consumed_octets) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	if (n_buff_size < kStunAttrHdrSizeInOctets) {
 		TSK_DEBUG_ERROR("Buffer too short(%u)", n_buff_size);
 		return -2;
 	}
 
 	Type = tnet_ntohs_2(&pc_buff_ptr[0]);
 	Length = tnet_ntohs_2(&pc_buff_ptr[2]);
 	if (Length > n_buff_size) {
 		TSK_DEBUG_ERROR("Buffer too short(%u). Length=%u", n_buff_size, Length);
 		return -3;
 	}
 
 	PadLength = (Length & 0x03) ? (4 - (Length & 0x03)) : 0;
 
 	*pp_attr = tsk_null;
 	*p_consumed_octets = kStunAttrHdrSizeInOctets + Length + PadLength;
 
 	switch (Type) {
 	case tnet_stun_attr_type_mapped_address:
 	case tnet_stun_attr_type_alternate_server:
 	case tnet_stun_attr_type_xor_mapped_address:
 	case tnet_stun_attr_type_xor_peer_address:
 	case tnet_stun_attr_type_xor_relayed_address: {
 		// First 8bits must be ignored
 		tnet_stun_address_family_t e_family = pc_buff_ptr[5];
 		uint16_t u_port = tnet_ntohs_2(&pc_buff_ptr[6]);
 		tnet_stun_attr_address_t* p_attr;
 		tsk_bool_t b_xor = IS_ADDRESS_XOR(Type);
 		uint16_t u, u_addr_size = (e_family == tnet_stun_address_family_ipv6) ? 16 : 4;
 
 		if (b_xor) {
 			u_port ^= kStunMagicCookieShort;
 		}
 		if ((ret = tnet_stun_attr_address_create(Type, e_family, u_port, (const tnet_stun_addr_t*)kNullBuffPtr, &p_attr))) {
 			return ret;
 		}
 		if (b_xor) {
 			*((uint32_t*)&p_attr->address[0]) = (uint32_t)tnet_htonl(tnet_ntohl_2(&pc_buff_ptr[8]) ^ kStunMagicCookieLong);
 			for (u = 4; u < u_addr_size; u += 4) {
 				if (pc_transac_id) {
 					*((uint32_t*)&p_attr->address[u]) = (uint32_t)tnet_htonl(tnet_ntohl_2(&pc_buff_ptr[8 + u]) ^ tnet_ntohl_2(((uint32_t*)(*pc_transac_id + u - 4))));
 				}
 				else {
 					*((uint32_t*)&p_attr->address[u]) = (uint32_t)tnet_htonl(tnet_ntohl_2(&pc_buff_ptr[8 + u]) ^ 0);
 				}
 			}
 		}
 		else {
 			memcpy(p_attr->address, &pc_buff_ptr[8], u_addr_size);
 		}
 		*pp_attr = TNET_STUN_ATTR(p_attr);
 		break;
 	}
 
 	case tnet_stun_attr_type_error_code: {
 		// First 21bits must be ignored
 		uint8_t Class = pc_buff_ptr[6] & 0x07;
 		uint8_t Number = pc_buff_ptr[7] & 0xff;
 		tnet_stun_attr_error_code_t* p_attr;
 		if ((ret = tnet_stun_attr_error_code_create(Class, Number, &pc_buff_ptr[8], (Length - 4), &p_attr))) {
 			return ret;
 		}
 		*pp_attr = TNET_STUN_ATTR(p_attr);
 		break;
 	}
 
 	case tnet_stun_attr_type_data:
 	case tnet_stun_attr_type_unknown_attrs:
 	case tnet_stun_attr_type_dont_fragment:
 	case tnet_stun_attr_type_software:
 	case tnet_stun_attr_type_nonce:
 	case tnet_stun_attr_type_realm:
 	case tnet_stun_attr_type_username:
 	case tnet_stun_attr_type_password:
 	case tnet_stun_attr_type_channel_number:
 	case tnet_stun_attr_type_message_integrity:
 	case tnet_stun_attr_type_fingerprint:
 	case tnet_stun_attr_type_lifetime:
 	case tnet_stun_attr_type_requested_transport:
 	case tnet_stun_attr_type_ice_use_candidate:
 	case tnet_stun_attr_type_ice_priority:
 	case tnet_stun_attr_type_ice_controlled:
 	case tnet_stun_attr_type_ice_controlling:
 	case tnet_stun_attr_type_connection_id:
 	default: {
 		tnet_stun_attr_vdata_t* p_attr;
 		if (IS_VDATA_UINT16(Type) && Length == 2) {
 			uint16_t u16 = tnet_ntohs_2(&pc_buff_ptr[4]);
 			if ((ret = tnet_stun_attr_vdata_create(Type, (uint8_t*)&u16, 2, &p_attr))) {
 				return ret;
 			}
 		}
 		else if (IS_VDATA_UINT32(Type) && Length == 4) {
 			uint32_t u32 = (uint32_t)tnet_ntohl_2(&pc_buff_ptr[4]);
 			if ((ret = tnet_stun_attr_vdata_create(Type, (uint8_t*)&u32, 4, &p_attr))) {
 				return ret;
 			}
 		}
 		else if (IS_VDATA_UINT64(Type) && Length == 8) {
 			uint64_t u64 = ((uint64_t)tnet_ntohl_2(&pc_buff_ptr[4])) << 32;
 			u64 |= tnet_ntohl_2(&pc_buff_ptr[8]);
 			if ((ret = tnet_stun_attr_vdata_create(Type, (uint8_t*)&u64, 8, &p_attr))) {
 				return ret;
 			}
 		}
 		else if (Type == tnet_stun_attr_type_unknown_attrs && Length && !(Length & 1)) {
 			uint16_t u;
 			#if HAVE_CRT //Debug memory
 				uint8_t *_p_data_ptr =malloc(Length);
 			#else
 				uint8_t *_p_data_ptr = tsk_malloc(Length);	
 			#endif //HAVE_CRT
 			
 			if (!_p_data_ptr) {
 				TSK_DEBUG_ERROR("Failed to allocate buffer with size = %u", Length);
 				return -4;
 			}
 			memcpy(_p_data_ptr, &pc_buff_ptr[4], Length);
 			for (u = 0; u < Length; u += 2) {
 				*((uint16_t*)&_p_data_ptr[u]) = tnet_htons_2(&_p_data_ptr[u]);
 			}
 			if ((ret = tnet_stun_attr_vdata_create(Type, _p_data_ptr, Length, &p_attr))) {
 				TSK_FREE(_p_data_ptr);
 				return ret;
 			}
 			TSK_FREE(_p_data_ptr);
 		}
 		else {
 			if ((ret = tnet_stun_attr_vdata_create(Type, &pc_buff_ptr[4], Length, &p_attr))) {
 				return ret;
 			}
 		}
 		*pp_attr = TNET_STUN_ATTR(p_attr);
 		break;
 	}
 	}
 	return ret;
 }
 
 // ============== VDATA (USERNAME, MESSAGE-INTEGRITY, ...) ================ //
 int tnet_stun_attr_vdata_create(tnet_stun_attr_type_t e_type, const uint8_t* pc_data_ptr, uint16_t u_data_size, tnet_stun_attr_vdata_t** pp_attr)
 {
 	int ret = -1;
 	uint16_t u_length = pc_data_ptr ? u_data_size : 0;
 	tnet_stun_attr_vdata_t* p_attr = tsk_null;
 	extern const tsk_object_def_t *tnet_stun_attr_vdata_def_t;
 	if (!pp_attr) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 
 	if (!(p_attr = tsk_object_new(tnet_stun_attr_vdata_def_t))) {
 		ret = -2;
 		goto bail;
 	}
 	if ((ret = tnet_stun_attr_init(TNET_STUN_ATTR(p_attr), e_type, u_length))) {
 		goto bail;
 	}
 	if (u_length) {
 		#if HAVE_CRT //Debug memory
 		if (!(p_attr->p_data_ptr =malloc(u_length + 1))) {
 	#else
 		if (!(p_attr->p_data_ptr = tsk_malloc(u_length + 1))) {
 	#endif //HAVE_CRT
 		
 			ret = -3;
 			goto bail;
 		}
 		memcpy(p_attr->p_data_ptr, pc_data_ptr, u_length);
 		p_attr->u_data_size = u_length;
 		p_attr->p_data_ptr[u_length] = '\0';
 	}
 	*pp_attr = p_attr;
 
 bail:
 	if (ret) {
 		TSK_OBJECT_SAFE_FREE(p_attr);
 	}
 	return ret;
 }
 
 int tnet_stun_attr_vdata_update(tnet_stun_attr_vdata_t* p_self, const uint8_t* pc_data_ptr, uint16_t u_data_size)
 {
 	uint16_t _u_data_size = (pc_data_ptr && u_data_size) ? u_data_size : 0;
 	if (!p_self) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	if (_u_data_size) {
 		if (!(p_self->p_data_ptr = tsk_realloc(p_self->p_data_ptr, _u_data_size + 1))) {
 			p_self->u_data_size = 0;
 			((tnet_stun_attr_t*)p_self)->hdr.u_length = 0;
 			return -3;
 		}
 		memcpy(p_self->p_data_ptr, pc_data_ptr, _u_data_size);
 		p_self->p_data_ptr[_u_data_size] = '\0';
 	}
 	else {
 		TSK_FREE(p_self->p_data_ptr);
 	}
 	p_self->u_data_size = _u_data_size;
 	((tnet_stun_attr_t*)p_self)->hdr.u_length = p_self->u_data_size;
 	return 0;
 }
 
 static tsk_object_t* tnet_stun_attr_vdata_ctor(tsk_object_t * self, va_list * app)
 {
 	tnet_stun_attr_vdata_t *p_vdata = (tnet_stun_attr_vdata_t *)self;
 	if (p_vdata) {
 	}
 	return self;
 }
 static tsk_object_t* tnet_stun_attr_vdata_dtor(tsk_object_t * self)
 {
 	tnet_stun_attr_vdata_t *p_vdata = (tnet_stun_attr_vdata_t *)self;
 	if (p_vdata) {
 #if PRINT_DESTROYED_MSG
 		TSK_DEBUG_INFO("*** STUN Attribute(VDATA) destroyed ***");
 #endif
 		TSK_FREE(p_vdata->p_data_ptr);
 	}
 	return self;
 }
 static const tsk_object_def_t tnet_stun_attr_vdata_def_s = {
 	sizeof(tnet_stun_attr_vdata_t),
 	tnet_stun_attr_vdata_ctor,
 	tnet_stun_attr_vdata_dtor,
 	_tnet_stun_attr_cmp,
 };
 const tsk_object_def_t *tnet_stun_attr_vdata_def_t = &tnet_stun_attr_vdata_def_s;
 
 
 // ============== ADDRESS ================ //
 int tnet_stun_attr_address_create(tnet_stun_attr_type_t e_type, tnet_stun_address_family_t e_family, uint16_t u_port, const tnet_stun_addr_t* pc_addr, tnet_stun_attr_address_t** pp_attr)
 {
 	int ret = -1;
 	extern const tsk_object_def_t *tnet_stun_attr_address_def_t;
 	tnet_stun_attr_address_t* p_attr = tsk_null;
 	uint16_t u_length = (e_family == tnet_stun_address_family_ipv6) ? 16 : 4;
 	if (!pp_attr) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	if (!(p_attr = tsk_object_new(tnet_stun_attr_address_def_t))) {
 		ret = -2;
 		goto bail;
 	}
 	if ((ret = tnet_stun_attr_init(TNET_STUN_ATTR(p_attr), e_type, u_length))) {
 		goto bail;
 	}
 	p_attr->e_family = e_family;
 	p_attr->u_port = u_port;
 	if (pc_addr) {
 		memcpy(p_attr->address, *pc_addr, u_length);
 	}
 	*pp_attr = p_attr;
 
 bail:
 	if (ret) {
 		TSK_OBJECT_SAFE_FREE(p_attr);
 	}
 	return ret;
 }
 
 static tsk_object_t* tnet_stun_attr_address_ctor(tsk_object_t * self, va_list * app)
 {
 	tnet_stun_attr_address_t *p_addr = (tnet_stun_attr_address_t *)self;
 	if (p_addr) {
 	}
 	return self;
 }
 static tsk_object_t* tnet_stun_attr_address_dtor(tsk_object_t * self)
 {
 	tnet_stun_attr_address_t *p_addr = (tnet_stun_attr_address_t *)self;
 	if (p_addr) {
 #if PRINT_DESTROYED_MSG
 		TSK_DEBUG_INFO("*** STUN Attribute(ADDRESS) destroyed ***");
 #endif
 	}
 	return self;
 }
 static const tsk_object_def_t tnet_stun_attr_address_def_s = {
 	sizeof(tnet_stun_attr_address_t),
 	tnet_stun_attr_address_ctor,
 	tnet_stun_attr_address_dtor,
 	_tnet_stun_attr_cmp,
 };
 const tsk_object_def_t *tnet_stun_attr_address_def_t = &tnet_stun_attr_address_def_s;
 
 
 
 // ================ 15.6.  ERROR-CODE ========== //
 int tnet_stun_attr_error_code_create(uint8_t u_class, uint8_t u_number, const void* pc_reason_phrase, uint16_t u_reason_phrase, struct tnet_stun_attr_error_code_s** pp_attr)
 {
 	int ret = -1;
 	extern const tsk_object_def_t *tnet_stun_attr_error_code_def_t;
 	tnet_stun_attr_error_code_t* p_attr = tsk_null;
 	uint16_t u_length = (uint16_t)(4 + tsk_strlen(pc_reason_phrase));
 	if (!pp_attr) {
 		TSK_DEBUG_ERROR("Invalid parameter");
 		return -1;
 	}
 	if (!(p_attr = tsk_object_new(tnet_stun_attr_error_code_def_t))) {
 		ret = -2;
 		goto bail;
 	}
 	if ((ret = tnet_stun_attr_init(TNET_STUN_ATTR(p_attr), tnet_stun_attr_type_error_code, u_length))) {
 		goto bail;
 	}
 	p_attr->u_class = u_class;
 	p_attr->u_number = u_number;
 	if (pc_reason_phrase && u_reason_phrase) {
 		if (!(p_attr->p_reason_phrase = tsk_strndup(pc_reason_phrase, u_reason_phrase))) {
 			ret = -3;
 			goto bail;
 		}
 	}
 	*pp_attr = p_attr;
 
 bail:
 	if (ret) {
 		TSK_OBJECT_SAFE_FREE(p_attr);
 	}
 	return ret;
 }
 
 static tsk_object_t* tnet_stun_attr_error_code_ctor(tsk_object_t * self, va_list * app)
 {
 	tnet_stun_attr_error_code_t *p_ec = (tnet_stun_attr_error_code_t *)self;
 	if (p_ec) {
 	}
 	return self;
 }
 static tsk_object_t* tnet_stun_attr_error_code_dtor(tsk_object_t * self)
 {
 	tnet_stun_attr_error_code_t *p_ec = (tnet_stun_attr_error_code_t *)self;
 	if (p_ec) {
 #if PRINT_DESTROYED_MSG
 		TSK_DEBUG_INFO("*** STUN Attribute(ERROR-CODE) destroyed ***");
 #endif
 		TSK_FREE(p_ec->p_reason_phrase);
 	}
 	return self;
 }
 static const tsk_object_def_t tnet_stun_attr_error_code_def_s = {
 	sizeof(tnet_stun_attr_error_code_t),
 	tnet_stun_attr_error_code_ctor,
 	tnet_stun_attr_error_code_dtor,
 	_tnet_stun_attr_cmp,
 };
 const tsk_object_def_t *tnet_stun_attr_error_code_def_t = &tnet_stun_attr_error_code_def_s;