#if HAVE_CRT
#define _CRTDBG_MAP_ALLOC
#include <stdlib.h>
#include <crtdbg.h>
#endif //HAVE_CRT
/*
* Copyright (C) 2020, University of the Basque Country (UPV/EHU)
*
* Contact for licensing options: <licensing-mcpttclient(at)mcopenplatform(dot)com>
*
* This file is part of MCOP MCPTT Client
*
* This 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.
*
* This 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 this program; if not, write to the Free Software Foundation, Inc.,
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
*/
#include "tinymcptt/packet/tmcptt_mcptt_packet.h"
#include "tinymcptt/packet/tmcptt_mcptt_packet_specific.h"
#include "tinymcptt/packet/tmcptt_mcptt_packet_granted.h"
#include "tnet_endianness.h"
#include "tsk_memory.h"
#include "tsk_debug.h"
static tsk_object_t* tmcptt_mcptt_packet_granted_ctor(tsk_object_t * self, va_list * app)
{
tmcptt_mcptt_packet_granted_t *granted_pkt = (tmcptt_mcptt_packet_granted_t *)self;
if(granted_pkt){
granted_pkt->duration = tsk_null;
granted_pkt->ssrc_granted_participant = tsk_null; //Only in off-network
granted_pkt->floor_priority = tsk_null;
granted_pkt->user_id = tsk_null; //Only in off-network
granted_pkt->queue_size = tsk_null; //Only in off-network
granted_pkt->queued_participants = tsk_null; //Only in off-network
granted_pkt->track_info = tsk_null; //Only when non-controlling is included
granted_pkt->floor_indicator = tsk_null;
}
return self;
}
static tsk_object_t* tmcptt_mcptt_packet_granted_dtor(tsk_object_t * self)
{
tmcptt_mcptt_packet_granted_t *granted_pkt = (tmcptt_mcptt_packet_granted_t *)self;
if(granted_pkt){
}
return self;
}
static const tsk_object_def_t tmcptt_mcptt_packet_granted_def_s =
{
sizeof(tmcptt_mcptt_packet_granted_t),
tmcptt_mcptt_packet_granted_ctor,
tmcptt_mcptt_packet_granted_dtor,
tsk_null,
};
const tsk_object_def_t *tmcptt_mcptt_packet_granted_def_t = &tmcptt_mcptt_packet_granted_def_s;
tmcptt_mcptt_packet_granted_t* tmcptt_mcptt_packet_granted_create_null()
{
tmcptt_mcptt_packet_granted_t* granted_pkt;
granted_pkt = (tmcptt_mcptt_packet_granted_t*)tsk_object_new(tmcptt_mcptt_packet_granted_def_t);
return granted_pkt;
}
tmcptt_mcptt_packet_granted_t* tmcptt_mcptt_packet_granted_deserialize(const void* data, tsk_size_t _size)
{
tmcptt_mcptt_packet_granted_t* granted_pkt = tsk_null;
const uint8_t* pdata = (const uint8_t*)data;
int32_t size = (int32_t)_size;
tsk_size_t field_size = 0;
uint16_t participants = 0;
int i = 0;
if (pdata == tsk_null) {
TSK_DEBUG_ERROR("Incorrect packet data");
goto bail;
}
if(!(granted_pkt = tmcptt_mcptt_packet_granted_create_null())){
TSK_DEBUG_ERROR("Failed to create object");
goto bail;
}
while (pdata != tsk_null && size > 0) {
switch (pdata[0]) {
case FID_DURATION_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_DURATION:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_BINARY_16_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect buffer size");
return tsk_null;
}
granted_pkt->duration = tmcptt_mcptt_packet_specific_binary_16_deserialize(pdata[0], pdata, size);
if (granted_pkt->duration == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_binary_16_get_size(granted_pkt->duration);
break;
case FID_FLOOR_PRIORITY_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_FLOOR_PRIORITY:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_BINARY_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->floor_priority = tmcptt_mcptt_packet_specific_binary_deserialize(pdata[0], pdata, size);
if (granted_pkt->floor_priority == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_binary_get_size(granted_pkt->floor_priority);
break;
case FID_USER_ID_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_USER_ID:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_TXT_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->user_id = tmcptt_mcptt_packet_specific_txt_deserialize(pdata[0], pdata, size);
if (granted_pkt->user_id == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_txt_get_size(granted_pkt->user_id);
break;
case FID_QUEUE_SIZE_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_QUEUE_SIZE:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_BINARY_16_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->queue_size = tmcptt_mcptt_packet_specific_binary_16_deserialize(pdata[0], pdata, size);
if (granted_pkt->queue_size == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_binary_16_get_size(granted_pkt->queue_size);
pdata += field_size;
size -= field_size;
participants = granted_pkt->queue_size->f_value;
if (participants > 0)
#if HAVE_CRT //Debug memory
granted_pkt->queued_participants = (tmcptt_mcptt_packet_queued_participant_t*)malloc(participants * sizeof(tmcptt_mcptt_packet_queued_participant_t));
#else
granted_pkt->queued_participants = (tmcptt_mcptt_packet_queued_participant_t*)tsk_malloc(participants * sizeof(tmcptt_mcptt_packet_queued_participant_t));
#endif //HAVE_CRT
for (i = 0; i < participants; i++) {
for (i = 0; i < 3; i++) {
switch (pdata[0]) {
case FID_QUEUED_USER_ID_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_QUEUED_USER_ID:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_TXT_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->queued_participants[i].queued_user_id = tmcptt_mcptt_packet_specific_txt_deserialize(pdata[0], pdata, size);
if (granted_pkt->queued_participants[i].queued_user_id == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_txt_get_size(granted_pkt->queued_participants[i].queued_user_id);
break;
case FID_QUEUE_INFO_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_QUEUE_INFO:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_BINARY_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->queued_participants[i].queue_info = tmcptt_mcptt_packet_specific_binary_deserialize(pdata[0], pdata, size);
if (granted_pkt->queued_participants[i].queue_info == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_binary_get_size(granted_pkt->queued_participants[i].queue_info);
break;
default:
if (granted_pkt->queued_participants[i].ssrc_queued_participant == tsk_null) {
uint32_t ssrc_net = 0;
if (size < sizeof(uint32_t)) {
TSK_DEBUG_ERROR("Incorrect buffer size");
return tsk_null;
}
memcpy(&ssrc_net, pdata, sizeof(uint32_t));
/*
//Old version SSRC
#if HAVE_CRT //Debug memory
granted_pkt->queued_participants[i].ssrc_queued_participant = (tmcptt_mcptt_packet_ssrc_t*)malloc(sizeof(tmcptt_mcptt_packet_ssrc_t));
#else
granted_pkt->queued_participants[i].ssrc_queued_participant = (tmcptt_mcptt_packet_ssrc_t*)tsk_malloc(sizeof(tmcptt_mcptt_packet_ssrc_t));
#endif //HAVE_CRT
(*granted_pkt->queued_participants[i].ssrc_queued_participant) = tnet_ntohl(ssrc_net);
field_size = sizeof(uint32_t);
*/
granted_pkt->queued_participants[i].ssrc_queued_participant = tmcptt_mcptt_packet_specific_ssrc_create_null();
//length is 4 bytes because the date is a uint32_t
granted_pkt->queued_participants[i].ssrc_queued_participant->f_length=4;
granted_pkt->queued_participants[i].ssrc_queued_participant->f_value= tnet_ntohl(ssrc_net);
field_size = sizeof(uint32_t);
} else {
TSK_DEBUG_ERROR("Field not supported");
return tsk_null;
}
}
pdata += field_size;
size -= field_size;
}
}
if (i == participants) {
pdata -= field_size;
pdata += field_size;
}
break;
case FID_TRACK_INFO_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_TRACK_INFO:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_BINARY_TXT_REF_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->track_info = tmcptt_mcptt_packet_specific_binary_txt_ref_deserialize(pdata[0], pdata, size);
if (granted_pkt->track_info == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_binary_txt_ref_get_size(granted_pkt->track_info);
break;
case FID_FLOOR_INDICATOR_OLD:
TSK_DEBUG_WARN("Use version 13.0 of Floor control specific fields");
case FID_FLOOR_INDICATOR:
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_BINARY_16_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect field size");
return tsk_null;
}
granted_pkt->floor_indicator = tmcptt_mcptt_packet_specific_binary_16_deserialize(pdata[0], pdata, size);
if (granted_pkt->floor_indicator == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_binary_16_get_size(granted_pkt->floor_indicator);
break;
case FID_SSRC:
//TODO New change, Now the SSRC use the code 014.
if (size < TMCPTT_MCPTT_PACKET_SPECIFIC_SRCC_MIN_SIZE) {
TSK_DEBUG_ERROR("Incorrect buffer size");
return tsk_null;
}
granted_pkt->ssrc_granted_participant = tmcptt_mcptt_packet_specific_ssrc_deserialize(pdata[0], pdata, size);
if (granted_pkt->ssrc_granted_participant == tsk_null) {
TSK_DEBUG_ERROR("Error deserializing field");
return tsk_null;
}
field_size = tmcptt_mcptt_packet_specific_ssrc_get_size(granted_pkt->ssrc_granted_participant);
break;
default:
if (granted_pkt->ssrc_granted_participant == tsk_null)
{
uint32_t ssrc_net = 0;
/* Possibly SSRC included (off-network) */
if (size < sizeof(uint32_t)) {
TSK_DEBUG_ERROR("Incorrect buffer size");
return tsk_null;
}
memcpy(&ssrc_net, pdata, sizeof(uint32_t));
granted_pkt->ssrc_granted_participant = tmcptt_mcptt_packet_specific_ssrc_create_null();
//length is 4 bytes because the date is a uint32_t
granted_pkt->ssrc_granted_participant->f_length=4;
granted_pkt->ssrc_granted_participant->f_value= tnet_ntohl(ssrc_net);
field_size = sizeof(uint32_t);
}
else
{
TSK_DEBUG_ERROR("Field not supported");
return tsk_null;
}
}
pdata += field_size;
size -= field_size;
}
bail:
return granted_pkt;
}
int tmcptt_mcptt_packet_granted_serialize_to(const tmcptt_mcptt_packet_granted_t* self, void* data, tsk_size_t size)
{
int ret = 0;
uint8_t* pdata = (uint8_t*)data;
tsk_size_t field_size = 0;
uint32_t net_l_value = 0;
int i = 0;
if (!self || !data || size < tmcptt_mcptt_packet_granted_get_size(self)){
return -1;
}
if (self->duration) {
tmcptt_mcptt_packet_specific_binary_16_serialize_to(self->duration, pdata, size);
field_size = tmcptt_mcptt_packet_specific_binary_16_get_size(self->duration);
pdata += field_size;
size -= field_size;
}
if (self->ssrc_granted_participant) {
field_size = sizeof(uint32_t);
net_l_value = tnet_htonl(self->ssrc_granted_participant->f_value);
memcpy(pdata, &net_l_value, sizeof(uint32_t));
pdata += field_size;
size -= field_size;
}
if (self->floor_priority) {
tmcptt_mcptt_packet_specific_binary_serialize_to(self->floor_priority, pdata, size);
field_size = tmcptt_mcptt_packet_specific_binary_get_size(self->floor_priority);
pdata += field_size;
size -= field_size;
}
if (self->user_id) {
tmcptt_mcptt_packet_specific_txt_serialize_to(self->user_id, pdata, size);
field_size = tmcptt_mcptt_packet_specific_txt_get_size(self->user_id);
pdata += field_size;
size -= field_size;
}
if (self->queue_size) {
tmcptt_mcptt_packet_specific_binary_16_serialize_to(self->queue_size, pdata, size);
field_size = tmcptt_mcptt_packet_specific_binary_16_get_size(self->queue_size);
pdata += field_size;
size -= field_size;
}
if (self->queued_participants) {
for (i = 0; i < self->queue_size->f_value; i++)
{
if (self->queued_participants[i].queued_user_id != tsk_null) {
tmcptt_mcptt_packet_specific_txt_serialize_to(self->queued_participants[i].queued_user_id, pdata, size);
field_size = tmcptt_mcptt_packet_specific_txt_get_size(self->queued_participants[i].queued_user_id);
pdata += field_size;
size -= field_size;
}
if (self->queued_participants[i].queue_info != tsk_null) {
tmcptt_mcptt_packet_specific_binary_serialize_to(self->queued_participants[i].queue_info, pdata, size);
field_size = tmcptt_mcptt_packet_specific_binary_get_size(self->queued_participants[i].queue_info);
pdata += field_size;
size -= field_size;
}
if (self->queued_participants[i].ssrc_queued_participant != tsk_null) {
field_size = sizeof(uint32_t);
net_l_value = tnet_htonl(self->queued_participants[i].ssrc_queued_participant->f_value);
memcpy(pdata, &net_l_value, sizeof(uint32_t));
pdata += field_size;
size -= field_size;
}
}
}
if (self->track_info) {
tmcptt_mcptt_packet_specific_binary_txt_ref_serialize_to(self->track_info, pdata, size);
field_size = tmcptt_mcptt_packet_specific_binary_txt_ref_get_size(self->track_info);
pdata += field_size;
size -= field_size;
}
if (self->floor_indicator) {
tmcptt_mcptt_packet_specific_binary_16_serialize_to(self->floor_indicator, pdata, size);
field_size = tmcptt_mcptt_packet_specific_binary_16_get_size(self->floor_indicator);
pdata += field_size;
size -= field_size;
}
return ret;
}
tsk_size_t tmcptt_mcptt_packet_granted_get_size(const tmcptt_mcptt_packet_granted_t* self)
{
tsk_size_t size = 0;
int i = 0;
if(!self){
TSK_DEBUG_ERROR("Invalid parameter");
return 0;
}
if(self->duration)
size += tmcptt_mcptt_packet_specific_binary_16_get_size(self->duration);
if(self->ssrc_granted_participant)
size += sizeof(uint32_t);
if(self->floor_priority)
size += tmcptt_mcptt_packet_specific_binary_get_size(self->floor_priority);
if (self->user_id)
size += tmcptt_mcptt_packet_specific_txt_get_size(self->user_id);
if (self->queue_size)
size += tmcptt_mcptt_packet_specific_binary_16_get_size(self->queue_size);
if (self->queued_participants) {
for (i = 0; i < self->queue_size->f_value; i++)
{
if (self->queued_participants[i].queued_user_id)
size += tmcptt_mcptt_packet_specific_txt_get_size(self->queued_participants[i].queued_user_id);
if (self->queued_participants[i].queue_info)
size += tmcptt_mcptt_packet_specific_binary_get_size(self->queued_participants[i].queue_info);
if (self->queued_participants[i].ssrc_queued_participant)
size += sizeof(uint32_t);
}
}
if (self->track_info)
size += tmcptt_mcptt_packet_specific_binary_txt_ref_get_size(self->track_info);
if (self->floor_indicator)
size += tmcptt_mcptt_packet_specific_binary_16_get_size(self->floor_indicator);
return size;
}