sparrow-kit/framework/protocol/sub_device_protocol.c

/*******************************************************
 * File name：sub_device_protocol.c
 * Author:    LIJIAN
 * Versions:  0.1
 * Description: APIs for sub device.
 * History:
 *   1.Date:
 *     Author:
 *     Modification:    
 *********************************************************/


#include "sub_device_protocol.h"
#include "pando_sys.h"

#define DEFAULT_TLV_BLOCK_SIZE 128

/***************** Local types ****************/
struct params_block_indicator
{
    uint16_t tlv_count;     //the count of tlv in TLVs
    uint16_t handled_length;
};

struct property_indicator
{
    int position;
};
/**********************************************/

static struct property_indicator s_current_property;
static struct params_block_indicator s_current_param;
struct sub_device_base_params base_params;	//Basic param of sub device
static uint16_t current_tlv_block_size = 0;	//Current params block size, include count.
static uint16_t tlv_block_buffer_size;      //Size of buffer pre-malloced to contain params block.

static uint16_t get_tlv_count(struct TLVs *params_block);
static uint16_t  get_tlv_type(struct TLV *params_in);
static uint16_t  get_tlv_len(struct TLV *params_in);
static struct TLV *  get_tlv_value(struct TLV *params_in, void *value);
static struct TLV *get_tlv_param(struct TLV *params_in, uint16_t *type, uint16_t *length, void *value);



static void FUNCTION_ATTRIBUTE *copy_return_next(void *dst, void *src,
    unsigned int src_len)
{
    pd_memcpy(dst, src, src_len);
    dst = (char *)dst + src_len;
    return dst;
}

static struct TLVs FUNCTION_ATTRIBUTE *get_next_property(struct pando_property *next_property, struct pando_property *property_body);
static uint8_t FUNCTION_ATTRIBUTE is_tlv_need_length(uint16_t type);
static uint8_t FUNCTION_ATTRIBUTE get_type_length(uint16_t type);

static struct sub_device_buffer * FUNCTION_ATTRIBUTE create_package(
    uint16_t flags, uint16_t payload_type)
{
	struct sub_device_buffer *data_buffer = NULL;
	struct device_header *header = NULL;

	data_buffer = (struct sub_device_buffer *)pd_malloc(sizeof(struct sub_device_buffer));
    pd_memset(data_buffer, 0, sizeof(struct sub_device_buffer));
    
    //only create header
	data_buffer->buffer_length = DEV_HEADER_LEN;
	data_buffer->buffer = (uint8_t *)pd_malloc(data_buffer->buffer_length);
	pd_memset(data_buffer->buffer, 0, data_buffer->buffer_length);

	header = (struct device_header *)data_buffer->buffer;

    if (payload_type == PAYLOAD_TYPE_COMMAND)
    {
        base_params.command_sequence++;
        header->frame_seq = host32_to_net(base_params.command_sequence);
    }
    else if (payload_type == PAYLOAD_TYPE_EVENT)
    {
        base_params.event_sequence++;
        header->frame_seq = host32_to_net(base_params.event_sequence);
    }if (payload_type == PAYLOAD_TYPE_DATA)
    {
        base_params.data_sequence++;
        header->frame_seq = host32_to_net(base_params.data_sequence);
    }
    
	header->flags = host16_to_net(flags);
	header->magic = MAGIC_HEAD_SUB_DEVICE;
	header->payload_type = host16_to_net(payload_type);
		
	return data_buffer;
}


// we must maintain the position of tlv for next get operation
// handled_length means all the tlv has been handled 
static void FUNCTION_ATTRIBUTE cal_current_position(uint16_t type, uint16_t len)
{
    s_current_param.tlv_count--;
    s_current_param.handled_length += len
        + sizeof(type) + sizeof(len) * is_tlv_need_length(type);
    
    if (s_current_param.tlv_count == 0)
    {
        //if is handle data property's params
        if (s_current_property.position != 0)   //mean has already decode with property
        {
            s_current_property.position += s_current_param.handled_length;
        }

        //all tlv param has been handled.
        s_current_param.tlv_count= 0;
        s_current_param.handled_length= 0;
    }
}

static struct TLV FUNCTION_ATTRIBUTE *get_current_tlv(struct TLVs *params)
{
    if (s_current_param.handled_length == 0) //first tlv
    {
        s_current_param.tlv_count = net16_to_host(params->count);        
    }
    
    return (struct TLV *)((uint8_t *)params + sizeof(struct TLVs) 
        + s_current_param.handled_length);   
}

static void FUNCTION_ATTRIBUTE get_value(struct TLVs *params, void *val)
{
    uint16_t type = 0;
    uint16_t len = 0;

    struct TLV* params_in = get_current_tlv(params);  
    get_tlv_param(params_in, &type, &len, val);
    cal_current_position(type, len);
}

static void FUNCTION_ATTRIBUTE *get_string(struct TLVs *params, uint16_t *len)
{
    uint16_t type = 0;
    void *val = NULL;
    struct TLV* params_in = get_current_tlv(params);
    val = params_in->value;
    *len = get_tlv_len(params_in);
    type = get_tlv_type(params_in);
    cal_current_position(type, *len);

    return val;
}

int FUNCTION_ATTRIBUTE init_sub_device(struct sub_device_base_params params)
{
	base_params.data_sequence = params.data_sequence;
	base_params.event_sequence = params.event_sequence;
	base_params.command_sequence = params.command_sequence;
	return 0;
}

struct TLVs * FUNCTION_ATTRIBUTE create_params_block(void)
{
	struct TLVs *tlv_block = NULL;
    uint8_t need_length;

	current_tlv_block_size = 0;

    tlv_block_buffer_size = DEFAULT_TLV_BLOCK_SIZE;
	tlv_block = (struct TLVs *)pd_malloc(tlv_block_buffer_size);
    
	if (tlv_block == NULL)
	{
		return NULL;
	}
	tlv_block->count = 0;	//init tlv number to 0 when create
	current_tlv_block_size = sizeof(struct TLVs);		//size of block equals sizeof count when no param added.

	return tlv_block;
}

int FUNCTION_ATTRIBUTE add_next_param(struct TLVs *params_block, uint16_t next_type, uint16_t next_length, void *next_value)
{
    uint16_t type;
    uint16_t conver_length;
    uint8_t need_length;
    uint8_t tlv_length;
    uint8_t tmp_value[8];
    uint8_t *tlv_position;
	struct TLVs *new_property_block = NULL;
	uint16_t current_count = net16_to_host(params_block->count);	//count has been changed endian when create params block

    need_length = is_tlv_need_length(next_type);
    if (1 == need_length)
    {
        
    }
    else if (0 == need_length)
    {
        if(next_length != get_type_length(next_type))
        {
        	pd_printf("Param type dismatch with the input length\n");
            return -1;
        }
    }
    else
    {
        return -1;
    }
    
	//extend buffer when default buffer is not enough to add new param
	if (current_tlv_block_size + next_length + sizeof(struct TLV) 
        - (!need_length) * sizeof(next_length) > tlv_block_buffer_size)
    {
        tlv_block_buffer_size = tlv_block_buffer_size + DEFAULT_TLV_BLOCK_SIZE + next_length;
        new_property_block = (struct TLVs *)pd_malloc(tlv_block_buffer_size);
        pd_memcpy(new_property_block, params_block, current_tlv_block_size);
        pd_free(params_block);
        params_block = new_property_block;
    } 

	current_count++;
	tlv_position = (uint8_t *)params_block + current_tlv_block_size;

	//change count into net endian
	params_block->count = host16_to_net(current_count);
	
	//content of tlv need to be copied, otherwise when variable is not aligned.
	type = host16_to_net(next_type);
	pd_memcpy(tlv_position, &type, sizeof(type));
    tlv_position += sizeof(type);

    
	if (need_length)
	{
        conver_length = host16_to_net(next_length);
	    pd_memcpy(tlv_position, &conver_length, sizeof(conver_length));
        tlv_position += sizeof(conver_length);
    }
	

	switch(next_type)
	{
	    case TLV_TYPE_FLOAT64 :
		    *((double *)tmp_value) = host64f_to_net(*((uint64_t *)next_value));
		    pd_memcpy(tlv_position, tmp_value, next_length);
		    break;
    	case TLV_TYPE_FLOAT32 :
    		*((float *)tmp_value) = host32f_to_net(*((float *)next_value));
    		pd_memcpy(tlv_position, tmp_value, next_length);
    			break;
	    case TLV_TYPE_INT16:
		    *((int16_t *)tmp_value) = host16_to_net(*((int16_t *)next_value));
    		pd_memcpy(tlv_position, tmp_value, next_length);
	    	break;
    	case TLV_TYPE_UINT16:
	    	*((uint16_t *)tmp_value) = host16_to_net(*((uint16_t *)next_value));
		    pd_memcpy(tlv_position, tmp_value, next_length);
		    break;
    	case TLV_TYPE_INT32:
	    	*((int32_t *)tmp_value) = host32_to_net(*((int32_t *)next_value));
		    pd_memcpy(tlv_position, tmp_value, next_length);
		    break;
	    case TLV_TYPE_UINT32:
		    *((uint32_t *)tmp_value) = host32_to_net(*((uint32_t *)next_value));
		    pd_memcpy(tlv_position, tmp_value, next_length);
    	    break;
	    case TLV_TYPE_UINT64:
    		*((uint64_t *)tmp_value) = host64_to_net(*((uint64_t *)next_value));
	    	pd_memcpy(tlv_position, tmp_value, next_length);
		    break;
    	case TLV_TYPE_INT64:
	    	*((int64_t *)tmp_value) = host64_to_net(*((int64_t *)next_value));
		    pd_memcpy(tlv_position, tmp_value, next_length);
		    break;
	    default:
	        pd_memcpy(tlv_position, next_value, next_length);
		    break;
	}

	current_tlv_block_size = current_tlv_block_size + next_length 
        + sizeof(struct TLV) - (!need_length) * sizeof(next_length);
    
	return 0;
}


void FUNCTION_ATTRIBUTE delete_device_package(struct sub_device_buffer *device_buffer)
{
    if (device_buffer != NULL)
    {
        if (device_buffer->buffer != NULL)
        {
            pd_free(device_buffer->buffer);
            device_buffer->buffer = NULL;
        }
    }

    pd_free(device_buffer);
	device_buffer = NULL;
}

void FUNCTION_ATTRIBUTE delete_params_block(struct TLVs *params_block)
{
    if (params_block != NULL)
    {
	    pd_free(params_block);
	    params_block = NULL;

    }
}

struct sub_device_buffer * FUNCTION_ATTRIBUTE
    create_data_package(uint16_t flags)
{
    return create_package(flags, PAYLOAD_TYPE_DATA);
}

struct sub_device_buffer * FUNCTION_ATTRIBUTE
    create_event_package(uint16_t flags)
{
    return create_package(flags, PAYLOAD_TYPE_EVENT);
}

struct sub_device_buffer * FUNCTION_ATTRIBUTE
    create_command_package(uint16_t flags)
{
    return create_package(flags, PAYLOAD_TYPE_COMMAND);
}

struct TLVs * FUNCTION_ATTRIBUTE get_sub_device_command(
    struct sub_device_buffer *device_buffer, struct pando_command *command_body)
{
	struct pando_command *tmp_body = (struct pando_command *)(device_buffer->buffer + DEV_HEADER_LEN);

	struct device_header *head = (struct device_header *)device_buffer->buffer;
	base_params.command_sequence = net32_to_host(head->frame_seq);
    command_body->sub_device_id = net16_to_host(tmp_body->sub_device_id);

	command_body->command_num = net16_to_host(tmp_body->command_num);
	command_body->priority = net16_to_host(tmp_body->priority);
	command_body->params->count = net16_to_host(tmp_body->params->count);
	
	return (struct TLVs *)(device_buffer->buffer + DEV_HEADER_LEN 
        + sizeof(struct pando_command) - sizeof(struct TLVs));
}

uint16_t FUNCTION_ATTRIBUTE
get_tlv_count(struct TLVs *params_block)
{
    uint16_t count = 0;

    if (params_block == NULL)
    {
        return -1;
    }
    pd_memcpy((void*)(&count), (void*)(&(params_block->count)), sizeof(count));
    return count;
}

uint16_t FUNCTION_ATTRIBUTE get_tlv_type(struct TLV *params_in)
{
    uint16_t type = 0;
    pd_memcpy((void*)(&type), (void*)(&(params_in->type)), sizeof(params_in->type));
    type = net16_to_host(type);
    return type;
}


uint16_t FUNCTION_ATTRIBUTE get_tlv_len(struct TLV *params_in)
{
    uint8_t need_length;
    uint16_t type = 0;
    uint16_t length = 0;
    void *value_pos = NULL;

    if (params_in == NULL)
    {
        return -1;
    }
    
    pd_memcpy((void*)(&type), (void*)(&(params_in->type)), sizeof(params_in->type));
    type = net16_to_host(type);
    
    need_length = is_tlv_need_length(type);
    if (need_length == 1)
    {        
        pd_memcpy((void*)(&length), (void*)(&(params_in->length)), sizeof(params_in->length));
        length = net16_to_host(length);
    }
    else
    {
        length = get_type_length(type);
    }

    return length;
}

struct TLV * FUNCTION_ATTRIBUTE get_tlv_value(struct TLV *params_in, void *value)
{
    uint8_t need_length;
    void *value_pos = NULL;
    uint16_t type_p;
    uint16_t length_p;
    uint16_t *type = &type_p;
    uint16_t *length = &length_p;

    pd_memcpy((void*)type, (void*)(&(params_in->type)), sizeof(params_in->type));
    *type = net16_to_host(*type);
    
    need_length = is_tlv_need_length(*type);
    if (need_length == 1)
    {        
        pd_memcpy((void*)length, (void*)(&(params_in->length)), sizeof(params_in->length));
        *length = net16_to_host(*length);
        pd_memcpy((void*)value, (void*)(params_in->value), *length);
    }
    else
    {
        *length = get_type_length(*type);
        value_pos = (uint8_t *)params_in + sizeof(params_in->type);
        pd_memcpy(value, value_pos, *length);
        switch (*type)
        {
            case TLV_TYPE_FLOAT64:
                net64f_to_host(*(double *)value);
                break;
            case TLV_TYPE_UINT64:
            case TLV_TYPE_INT64:
                net64_to_host(*(uint64_t *)value);
                break;
            case TLV_TYPE_FLOAT32:
                net32f_to_host(*(float *)value);
                break;
            case TLV_TYPE_UINT32:
            case TLV_TYPE_INT32:
                net32_to_host(*(uint32_t *)value);
                break;
            case TLV_TYPE_INT8:
            case TLV_TYPE_UINT8:
            case TLV_TYPE_BOOL:
                break;
            case TLV_TYPE_INT16:
            case TLV_TYPE_UINT16:
                net16_to_host(*(uint16_t *)value);
                break;
            default:
                break;
        }//switch            
    }//need_length == 0
    
	return (struct TLV *)((uint8_t *)params_in + *length + sizeof(struct TLV) 
        - (!need_length) * sizeof(*length));    
}


struct TLV * FUNCTION_ATTRIBUTE get_tlv_param(struct TLV *params_in, uint16_t *type,
    uint16_t *length, void *value)

{
    uint8_t need_length;
    void *value_pos = NULL;

    pd_memcpy((void*)type, (void*)(&(params_in->type)), sizeof(params_in->type));
    *type = net16_to_host(*type);
    
    need_length = is_tlv_need_length(*type);
    if (need_length == 1)
    {        
        pd_memcpy((void*)length, (void*)(&(params_in->length)), sizeof(params_in->length));
        *length = net16_to_host(*length);
        pd_memcpy((void*)value, (void*)(params_in->value), *length);
    }
    else
    {
        *length = get_type_length(*type);
        value_pos = (uint8_t *)params_in + sizeof(params_in->type);
        pd_memcpy((void*)value, (void*)value_pos, *length);
        switch (*type)
        {
            case TLV_TYPE_FLOAT64:
                net64f_to_host(*(double *)value);
                break;
            case TLV_TYPE_UINT64:
            case TLV_TYPE_INT64:
                net64_to_host(*(uint64_t *)value);
                break;
            case TLV_TYPE_FLOAT32:
                net32f_to_host(*(float *)value);
                break;
            case TLV_TYPE_UINT32:
            case TLV_TYPE_INT32:
                net32_to_host(*(uint32_t *)value);
                break;
            case TLV_TYPE_INT8:
            case TLV_TYPE_UINT8:
            case TLV_TYPE_BOOL:
                break;
            case TLV_TYPE_INT16:
            case TLV_TYPE_UINT16:
                net16_to_host(*(uint16_t *)value);
                break;
            default:
                break;
        }//switch            
    }//need_length == 0
    
	return (struct TLV *)((uint8_t *)params_in + *length + sizeof(struct TLV) 
        - (!need_length) * sizeof(*length));
}

/*******************************************************
 * Description: 
 * param
 * return:
 *********************************************************/ 
struct TLVs * FUNCTION_ATTRIBUTE get_sub_device_property(
    struct sub_device_buffer *device_buffer, 
    struct pando_property *property_body)
{
    struct pando_property *tmp_body = NULL;
    struct device_header *head = NULL;

    //reach the end of buffer
    if (s_current_property.position == device_buffer->buffer_length
        || s_current_property.position > device_buffer->buffer_length)
    {
        s_current_property.position = 0;
        return NULL;
    }
    
    if (s_current_property.position == 0)
    {
        //first property, need handle header length
        s_current_property.position += DEV_HEADER_LEN;
        head = (struct device_header *)device_buffer->buffer;
	    base_params.data_sequence = net32_to_host(head->frame_seq);
    }    

    tmp_body = (struct pando_property *)(device_buffer->buffer
            + s_current_property.position);

    s_current_property.position += sizeof(struct pando_property);
    
	return get_next_property(tmp_body, property_body);
}

uint16_t FUNCTION_ATTRIBUTE get_sub_device_payloadtype(struct sub_device_buffer *package)
{
    struct device_header *head;
 
    if (package == NULL)
	{
		return -1;
	}
    
    head = (struct device_header *)package->buffer;

    return net16_to_host(head->payload_type);
}

uint8_t FUNCTION_ATTRIBUTE is_tlv_need_length(uint16_t type)
{
    switch (type)
    {
        case TLV_TYPE_FLOAT64:
        case TLV_TYPE_FLOAT32:
        case TLV_TYPE_INT8:
        case TLV_TYPE_INT16:
        case TLV_TYPE_INT32:
        case TLV_TYPE_INT64:
        case TLV_TYPE_UINT8:
        case TLV_TYPE_UINT16:
        case TLV_TYPE_UINT32:
        case TLV_TYPE_UINT64:
        case TLV_TYPE_BOOL:
            return 0;
            break;
        case TLV_TYPE_BYTES:
        case TLV_TYPE_URI:
            return 1;
            break;
            
        default:
        	pd_printf("Unknow data type.\n");
            return -1;
            break;
    }
    
    return -1;
}

uint8_t FUNCTION_ATTRIBUTE get_type_length(uint16_t type)
{
    switch (type)
    {
        case TLV_TYPE_FLOAT64:
        case TLV_TYPE_UINT64:
        case TLV_TYPE_INT64:
            return 8;
            break;
        case TLV_TYPE_FLOAT32:
        case TLV_TYPE_UINT32:
        case TLV_TYPE_INT32:
            return 4;
            break;
        case TLV_TYPE_INT8:
        case TLV_TYPE_UINT8:
        case TLV_TYPE_BOOL:
            return 1;
        case TLV_TYPE_INT16:
        case TLV_TYPE_UINT16:
            return 2;
            break;
        case TLV_TYPE_BYTES:
        case TLV_TYPE_URI:
            return 0;
            break;
            
        default:
        	pd_printf("Unknow data type.\n");
            return -1;
            break;
    }
    
    return -1;
}

/* malloc a new block to save old buffer and new property, and update the package length */
int FUNCTION_ATTRIBUTE add_next_property(struct sub_device_buffer *data_package, uint16_t property_num, struct TLVs *next_data_params)
{
    uint8_t *old_buffer = NULL;
    uint8_t *position = NULL;
    uint16_t old_len = 0;
    uint16_t subdevice_id;
    
    if (data_package == NULL)
    {
        return -1;
    }    

    old_buffer = data_package->buffer;
    old_len = data_package->buffer_length;

    /* append payload length */
    data_package->buffer_length += (sizeof(struct pando_property) 
        + current_tlv_block_size - sizeof(struct TLVs));    
    data_package->buffer = (uint8_t *)pd_malloc(data_package->buffer_length);
    pd_memset(data_package->buffer, 0, data_package->buffer_length);

    /* copy old content and new property */
    position = copy_return_next(data_package->buffer, old_buffer, old_len);    

    subdevice_id = 0;
    position = copy_return_next(position, &subdevice_id, sizeof(subdevice_id));
    
    property_num = host16_to_net(property_num);
    position = copy_return_next(position, &property_num, sizeof(property_num));
    
    pd_memcpy(position, next_data_params, current_tlv_block_size);  
    pd_free(old_buffer);

    return 0;
}

int FUNCTION_ATTRIBUTE add_command(struct sub_device_buffer *command_package,
    uint16_t command_num, uint16_t priority, struct TLVs *command_params)
{
    uint8_t *old_buffer = NULL;
    uint8_t *position = NULL;
    uint16_t old_len = 0;
    uint16_t subdevice_id;
    
    if (command_package == NULL)
    {
        return -1;
    }    

    old_buffer = command_package->buffer;
    old_len = command_package->buffer_length;

    /* append payload length */
    command_package->buffer_length += (sizeof(struct pando_property) 
        + current_tlv_block_size - sizeof(struct TLVs));    
    command_package->buffer = (uint8_t *)pd_malloc(command_package->buffer_length);
    pd_memset(command_package->buffer, 0, command_package->buffer_length);

    /* copy old content and new property */
    position = copy_return_next(command_package->buffer, old_buffer, old_len);    

    subdevice_id = 0;
    position = copy_return_next(position, &subdevice_id, sizeof(subdevice_id));
    
    command_num = host16_to_net(command_num);
    position = copy_return_next(position, &command_num, sizeof(command_num));

    priority = host16_to_net(priority);
    position = copy_return_next(position, &priority, sizeof(priority));
    pd_memcpy(position, command_params, current_tlv_block_size);  
    pd_free(old_buffer);

    return 0;
}

int FUNCTION_ATTRIBUTE add_event(struct sub_device_buffer *event_package,
    uint16_t event_num, uint16_t priority, struct TLVs *event_params)
{
    uint8_t *old_buffer = NULL;
    uint8_t *position = NULL;
    uint16_t old_len = 0;
    uint16_t subdevice_id;
    
    if (event_package == NULL)
    {
        return -1;
    }    

    old_buffer = event_package->buffer;
    old_len = event_package->buffer_length;

    /* append payload length */
    event_package->buffer_length += (sizeof(struct pando_property) 
        + current_tlv_block_size - sizeof(struct TLVs));    
    event_package->buffer = (uint8_t *)pd_malloc(event_package->buffer_length);
    pd_memset(event_package->buffer, 0, event_package->buffer_length);

    /* copy old content and new property */
    position = copy_return_next(event_package->buffer, old_buffer, old_len);    

    subdevice_id = 0;
    position = copy_return_next(position, &subdevice_id, sizeof(subdevice_id));
    
    event_num= host16_to_net(event_num);
    position = copy_return_next(position, &event_num, sizeof(event_num));

    priority = host16_to_net(priority);
    position = copy_return_next(position, &priority, sizeof(priority));
    pd_memcpy(position, event_params, current_tlv_block_size);  
    pd_free(old_buffer);

    return 0;

}

int FUNCTION_ATTRIBUTE finish_package(struct sub_device_buffer *package_buf)
{
    struct device_header *header;

    header = (struct device_header *)package_buf->buffer;
    header->payload_len = host16_to_net(package_buf->buffer_length
        - DEV_HEADER_LEN);
    header->crc = (header->payload_len) >> 8;

    if (header->payload_type == PAYLOAD_TYPE_DATA)
    {
        header->frame_seq = host32_to_net(base_params.data_sequence);
    }
    else if (header->payload_type == PAYLOAD_TYPE_COMMAND)
    {
        header->frame_seq = host32_to_net(base_params.command_sequence);
    }
    else if (header->payload_type == PAYLOAD_TYPE_EVENT)
    {
        header->frame_seq = host32_to_net(base_params.event_sequence);
    }
    
    return 0;
}


struct TLVs * FUNCTION_ATTRIBUTE get_next_property(
    struct pando_property *next_property, struct pando_property *property_body)
{
    property_body->sub_device_id = net16_to_host(next_property->sub_device_id);
    property_body->property_num = net16_to_host(next_property->property_num);
    property_body->params->count = net16_to_host(next_property->params->count);


    return (struct TLVs *)((uint8_t *)next_property 
        + sizeof(struct pando_property)
        - sizeof(struct TLVs));
}

int FUNCTION_ATTRIBUTE is_device_file_command(struct sub_device_buffer *device_buffer)
{
    struct device_header *header = (struct device_header *)device_buffer->buffer;

    if (header->flags == 1)
    {
        return 1;
    }
    else
    {
        return 0;
    }
}


/*
    Temp region
*/
uint8_t FUNCTION_ATTRIBUTE get_next_uint8(struct TLVs *params)
{
    uint8_t val = 0;
    get_value(params, &val);
    return val;
}

uint16_t FUNCTION_ATTRIBUTE get_next_uint16(struct TLVs *params)
{
    uint16_t val = 0;
    get_value(params, &val);    
    return val;

}

uint32_t FUNCTION_ATTRIBUTE get_next_uint32(struct TLVs *params)
{
    uint32_t val = 0;
    get_value(params, &val);    
    return val;

}

uint64_t FUNCTION_ATTRIBUTE get_next_uint64(struct TLVs *params)
{
    uint64_t val = 0;
    get_value(params, &val);    
    return val;

}

int8_t FUNCTION_ATTRIBUTE get_next_int8(struct TLVs *params)
{
    int8_t val = 0;
    get_value(params, &val);    
    return val;
}

int16_t FUNCTION_ATTRIBUTE get_next_int16(struct TLVs *params)
{
    int16_t val = 0;
    get_value(params, &val);    
    return val;

}

int32_t FUNCTION_ATTRIBUTE get_next_int32(struct TLVs *params)
{
    int32_t val = 0;
    get_value(params, &val);    
    return val;

}

int64_t FUNCTION_ATTRIBUTE get_next_int64(struct TLVs *params)
{
    int64_t val = 0;
    get_value(params, &val);    
    return val;

}

float FUNCTION_ATTRIBUTE get_next_float32(struct TLVs *params)
{
    float val = 0;
    get_value(params, &val);    
    return val;

}

double FUNCTION_ATTRIBUTE get_next_float64(struct TLVs *params)
{
    double val = 0;
    get_value(params, &val);    
    return val;

}

uint8_t FUNCTION_ATTRIBUTE get_next_bool(struct TLVs *params)
{
    uint8_t val = 0;
    get_value(params, &val);    
    return val;

}

void FUNCTION_ATTRIBUTE *get_next_uri(struct TLVs *params, uint16_t *length)
{
    return get_string(params,length);
}

void FUNCTION_ATTRIBUTE *get_next_bytes(struct TLVs *params, uint16_t *length)
{
    return get_string(params,length);
}


int  FUNCTION_ATTRIBUTE
add_next_uint8(struct TLVs *params, uint8_t next_value)
{
    return add_next_param(params, TLV_TYPE_UINT8, get_type_length(TLV_TYPE_INT8), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_uint16(struct TLVs *params, uint16_t next_value)
{
    return add_next_param(params, TLV_TYPE_UINT16, get_type_length(TLV_TYPE_UINT16), &next_value);
}

int  FUNCTION_ATTRIBUTE
add_next_uint32(struct TLVs *params, uint32_t next_value)
{
    return add_next_param(params, TLV_TYPE_UINT32, get_type_length(TLV_TYPE_UINT32), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_uint64(struct TLVs *params, uint64_t next_value)
{
    return add_next_param(params, TLV_TYPE_UINT64, get_type_length(TLV_TYPE_UINT64), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_int8(struct TLVs *params, int8_t next_value)
{
    return add_next_param(params, TLV_TYPE_INT8, get_type_length(TLV_TYPE_INT8), &next_value);
}

int  FUNCTION_ATTRIBUTE
add_next_int16(struct TLVs *params, int16_t next_value)
{
    return add_next_param(params, TLV_TYPE_INT16, get_type_length(TLV_TYPE_INT16), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_int32(struct TLVs *params, int32_t next_value)
{
    return add_next_param(params, TLV_TYPE_INT32, get_type_length(TLV_TYPE_INT32), &next_value);
}

int  FUNCTION_ATTRIBUTE
add_next_int64(struct TLVs *params, int64_t next_value)
{
    return add_next_param(params, TLV_TYPE_INT64, get_type_length(TLV_TYPE_INT64), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_float32(struct TLVs *params, float next_value)
{
    return add_next_param(params, TLV_TYPE_FLOAT32, get_type_length(TLV_TYPE_FLOAT32), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_float64(struct TLVs *params, double next_value)
{
    return add_next_param(params, TLV_TYPE_FLOAT64, get_type_length(TLV_TYPE_FLOAT64), &next_value);
}

int FUNCTION_ATTRIBUTE
add_next_bool(struct TLVs *params, uint8_t next_value)
{
    return add_next_param(params, TLV_TYPE_BOOL, get_type_length(TLV_TYPE_BOOL), &next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_uri(struct TLVs *params, uint16_t length, void *next_value)
{
    return add_next_param(params, TLV_TYPE_URI, length, next_value);
}

int   FUNCTION_ATTRIBUTE
add_next_bytes(struct TLVs *params, uint16_t length, void *next_value)
{
    return add_next_param(params, TLV_TYPE_BYTES, length, next_value);
}