From ab959d7b4194715870128e616b8e29d4a101e488 Mon Sep 17 00:00:00 2001 From: etobi Date: Tue, 3 Sep 2013 09:48:41 +0200 Subject: Imported Upstream version 1.1.1+rev1207 --- lib/libesg/encapsulation/container.c | 206 +++++++++++++++++++++++++++++++++++ 1 file changed, 206 insertions(+) create mode 100644 lib/libesg/encapsulation/container.c (limited to 'lib/libesg/encapsulation/container.c') diff --git a/lib/libesg/encapsulation/container.c b/lib/libesg/encapsulation/container.c new file mode 100644 index 0000000..15b17bf --- /dev/null +++ b/lib/libesg/encapsulation/container.c @@ -0,0 +1,206 @@ +/* + * ESG parser + * + * Copyright (C) 2006 Stephane Este-Gracias (sestegra@free.fr) + * + * This library is free software; you can redistribute it and/or + * modify it under the terms of the GNU Lesser General Public + * License as published by the Free Software Foundation; either + * version 2.1 of the License, or (at your option) any later version. + * + * This library 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 + * Lesser General Public License for more details. + * + * You should have received a copy of the GNU Lesser General Public + * License along with this library; if not, write to the Free Software + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA + */ + +#include +#include + +#include +#include +#include +#include +#include +#include + +struct esg_container *esg_container_decode(uint8_t *buffer, uint32_t size) { + uint32_t pos; + struct esg_container *container; + struct esg_container_structure *structure; + struct esg_container_structure *last_structure; + uint8_t structure_index; + + if ((buffer == NULL) || (size <= 1)) { + return NULL; + } + + pos = 0; + + container = (struct esg_container *) malloc(sizeof(struct esg_container)); + memset(container, 0, sizeof(struct esg_container)); + + // Container header + container->header = (struct esg_container_header *) malloc(sizeof(struct esg_container_header)); + memset(container->header, 0, sizeof(struct esg_container_header)); + + container->header->num_structures = buffer[pos]; + pos += 1; + + if (size < pos + (container->header->num_structures * 8)) { + esg_container_free(container); + return NULL; + } + + last_structure = NULL; + for (structure_index = 0; structure_index < container->header->num_structures; structure_index++) { + structure = (struct esg_container_structure *) malloc(sizeof(struct esg_container_structure)); + memset(structure, 0, sizeof(struct esg_container_structure)); + structure->_next = NULL; + + if (last_structure == NULL) { + container->header->structure_list = structure; + } else { + last_structure->_next = structure; + } + last_structure = structure; + + structure->type = buffer[pos]; + pos += 1; + + structure->id = buffer[pos]; + pos += 1; + + structure->ptr = (buffer[pos] << 16) | (buffer[pos+1] << 8) | buffer[pos+2]; + pos += 3; + + structure->length = (buffer[pos] << 16) | (buffer[pos+1] << 8) | buffer[pos+2]; + pos += 3; + + if (size < (structure->ptr + structure->length)) { + esg_container_free(container); + return NULL; + } + + // Decode structure + switch (structure->type) { + case 0x01: { + switch (structure->id) { + case 0x00: { + structure->data = (void *) esg_encapsulation_structure_decode(buffer + structure->ptr, structure->length); + break; + } + default: { + esg_container_free(container); + return NULL; + } + } + break; + } + case 0x02: { + switch (structure->id) { + case 0x00: { + structure->data = (void *) esg_string_repository_decode(buffer + structure->ptr, structure->length); + break; + } + default: { + esg_container_free(container); + return NULL; + } + } + break; + } + case 0x03: { + //TODO + break; + } + case 0x04: { + //TODO + break; + } + case 0x05: { + //TODO + break; + } + case 0xE0: { + switch (structure->id) { + case 0x00: { + structure->data = (void *) esg_data_repository_decode(buffer + structure->ptr, structure->length); + break; + } + default: { + esg_container_free(container); + return NULL; + } + } + break; + } + case 0xE1: { + switch (structure->id) { + case 0xFF: { + structure->data = (void *) esg_session_partition_declaration_decode(buffer + structure->ptr, structure->length); + break; + } + default: { + esg_container_free(container); + return NULL; + } + } + break; + } + case 0xE2: { + switch (structure->id) { + case 0x00: { + structure->data = (void *) esg_init_message_decode(buffer + structure->ptr, structure->length); + break; + } + default: { + esg_container_free(container); + return NULL; + } + } + break; + } + default: { + esg_container_free(container); + return NULL; + } + } + } + + // Container structure body + container->structure_body_ptr = pos; + container->structure_body_length = size - pos; + container->structure_body = (uint8_t *) malloc(size - pos); + memcpy(container->structure_body, buffer + pos, size - pos); + + return container; +} + +void esg_container_free(struct esg_container *container) { + struct esg_container_structure *structure; + struct esg_container_structure *next_structure; + + if (container == NULL) { + return; + } + + if (container->header) { + for(structure = container->header->structure_list; structure; structure = next_structure) { + next_structure = structure->_next; + free(structure); + } + + free(container->header); + } + + if (container->structure_body) { + free(container->structure_body); + } + + free(container); +} -- cgit v1.2.3