mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-03-30 16:20:24 +00:00
obex_message_builder: extract functionality
This commit is contained in:
parent
ad62ff3d7f
commit
7c00601704
196
src/classic/obex_message_builder.c
Normal file
196
src/classic/obex_message_builder.c
Normal file
@ -0,0 +1,196 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (C) 2019 BlueKitchen GmbH
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the name of the copyright holders nor the names of
|
||||||
|
* contributors may be used to endorse or promote products derived
|
||||||
|
* from this software without specific prior written permission.
|
||||||
|
* 4. Any redistribution, use, or modification is done solely for
|
||||||
|
* personal benefit and not for any commercial purpose or for
|
||||||
|
* monetary gain.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
||||||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
||||||
|
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||||
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
||||||
|
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||||
|
* SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
* Please inquire about commercial licensing options at
|
||||||
|
* contact@bluekitchen-gmbh.com
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define __BTSTACK_FILE__ "obex_message_builder.c"
|
||||||
|
|
||||||
|
#include "btstack_config.h"
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
|
||||||
|
#include "btstack_util.h"
|
||||||
|
#include "btstack_debug.h"
|
||||||
|
#include "classic/obex.h"
|
||||||
|
#include "classic/obex_message_builder.h"
|
||||||
|
|
||||||
|
static uint8_t obex_message_builder_packet_init(uint8_t * buffer, uint16_t buffer_len, uint8_t opcode){
|
||||||
|
if (buffer_len < 3) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
|
||||||
|
buffer[0] = opcode;
|
||||||
|
big_endian_store_16(buffer, 1, 3);
|
||||||
|
return ERROR_CODE_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t obex_message_builder_packet_append(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t len){
|
||||||
|
uint16_t pos = big_endian_read_16(buffer, 1);
|
||||||
|
if (buffer_len < pos + len) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
|
||||||
|
memcpy(&buffer[pos], data, len);
|
||||||
|
pos += len;
|
||||||
|
big_endian_store_16(buffer, 1, pos);
|
||||||
|
return ERROR_CODE_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t obex_message_builder_header_add_variable(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, const uint8_t * header_data, uint16_t header_data_length){
|
||||||
|
uint8_t header[3];
|
||||||
|
header[0] = header_type;
|
||||||
|
big_endian_store_16(header, 1, sizeof(header) + header_data_length);
|
||||||
|
|
||||||
|
uint8_t status = obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
|
||||||
|
return obex_message_builder_packet_append(buffer, buffer_len, header_data, header_data_length);
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t obex_message_builder_header_add_byte(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, uint8_t value){
|
||||||
|
uint8_t header[2];
|
||||||
|
header[0] = header_type;
|
||||||
|
header[1] = value;
|
||||||
|
return obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t obex_message_builder_header_add_word(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, uint32_t value){
|
||||||
|
uint8_t header[5];
|
||||||
|
header[0] = header_type;
|
||||||
|
big_endian_store_32(header, 1, value);
|
||||||
|
return obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint8_t obex_message_builder_header_add_connection_id(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
||||||
|
// add connection_id header if set, must be first header if used
|
||||||
|
if (obex_connection_id == OBEX_CONNECTION_ID_INVALID) return ERROR_CODE_PARAMETER_OUT_OF_MANDATORY_RANGE;
|
||||||
|
return obex_message_builder_header_add_word(buffer, buffer_len, OBEX_HEADER_CONNECTION_ID, obex_connection_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_request_create_connect(uint8_t * buffer, uint16_t buffer_len, uint8_t obex_version_number, uint8_t flags, uint16_t maximum_obex_packet_length){
|
||||||
|
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_CONNECT);
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
|
||||||
|
uint8_t fields[4];
|
||||||
|
fields[0] = obex_version_number;
|
||||||
|
fields[1] = flags;
|
||||||
|
big_endian_store_16(fields, 2, maximum_obex_packet_length);
|
||||||
|
return obex_message_builder_packet_append(buffer, buffer_len, &fields[0], sizeof(fields));
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_request_create_get(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
||||||
|
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_GET | OBEX_OPCODE_FINAL_BIT_MASK);
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_request_create_put(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
||||||
|
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_PUT | OBEX_OPCODE_FINAL_BIT_MASK);
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
|
||||||
|
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_request_create_set_path(uint8_t * buffer, uint16_t buffer_len, uint8_t flags, uint32_t obex_connection_id){
|
||||||
|
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_SETPATH);
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
|
||||||
|
uint8_t fields[2];
|
||||||
|
fields[0] = flags;
|
||||||
|
fields[1] = 0; // reserved
|
||||||
|
status = obex_message_builder_packet_append(buffer, buffer_len, &fields[0], sizeof(fields));
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_request_create_abort(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
||||||
|
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_ABORT);
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_request_create_disconnect(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
||||||
|
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_DISCONNECT);
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_header_add_srm_enable(uint8_t * buffer, uint16_t buffer_len){
|
||||||
|
return obex_message_builder_header_add_byte(buffer, buffer_len, OBEX_HEADER_SINGLE_RESPONSE_MODE, OBEX_SRM_ENABLE);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_header_add_target(uint8_t * buffer, uint16_t buffer_len, const uint8_t * target, uint16_t length){
|
||||||
|
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_TARGET, target, length);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_header_add_application_parameters(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t length){
|
||||||
|
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_APPLICATION_PARAMETERS, data, length);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_add_header_challenge_response(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t length){
|
||||||
|
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_AUTHENTICATION_RESPONSE, data, length);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_add_body_static(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint32_t length){
|
||||||
|
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_END_OF_BODY, data, length);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_header_add_name(uint8_t * buffer, uint16_t buffer_len, const char * name){
|
||||||
|
int len = strlen(name);
|
||||||
|
if (len) {
|
||||||
|
// empty string does not have trailing \0
|
||||||
|
len++;
|
||||||
|
}
|
||||||
|
if (buffer_len < (1 + 2 + len*2) ) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
|
||||||
|
|
||||||
|
uint16_t pos = big_endian_read_16(buffer, 1);
|
||||||
|
buffer[pos++] = OBEX_HEADER_NAME;
|
||||||
|
big_endian_store_16(buffer, pos, 1 + 2 + len*2);
|
||||||
|
pos += 2;
|
||||||
|
int i;
|
||||||
|
// @note name[len] == 0
|
||||||
|
for (i = 0 ; i < len ; i++){
|
||||||
|
buffer[pos++] = 0;
|
||||||
|
buffer[pos++] = *name++;
|
||||||
|
}
|
||||||
|
big_endian_store_16(buffer, 1, pos);
|
||||||
|
return ERROR_CODE_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t obex_message_builder_header_add_type(uint8_t * buffer, uint16_t buffer_len, const char * type){
|
||||||
|
uint8_t header[3];
|
||||||
|
header[0] = OBEX_HEADER_TYPE;
|
||||||
|
int len_incl_zero = strlen(type) + 1;
|
||||||
|
big_endian_store_16(header, 1, 1 + 2 + len_incl_zero);
|
||||||
|
|
||||||
|
uint8_t status = obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
||||||
|
if (status != ERROR_CODE_SUCCESS) return status;
|
||||||
|
return obex_message_builder_packet_append(buffer, buffer_len, (const uint8_t*)type, len_incl_zero);
|
||||||
|
}
|
213
src/classic/obex_message_builder.h
Normal file
213
src/classic/obex_message_builder.h
Normal file
@ -0,0 +1,213 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (C) 2019 BlueKitchen GmbH
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the name of the copyright holders nor the names of
|
||||||
|
* contributors may be used to endorse or promote products derived
|
||||||
|
* from this software without specific prior written permission.
|
||||||
|
* 4. Any redistribution, use, or modification is done solely for
|
||||||
|
* personal benefit and not for any commercial purpose or for
|
||||||
|
* monetary gain.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
||||||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
||||||
|
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||||
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
||||||
|
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||||
|
* SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
* Please inquire about commercial licensing options at
|
||||||
|
* contact@bluekitchen-gmbh.com
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __OBEX_MESSAGE_BUILDER_H
|
||||||
|
|
||||||
|
#if defined __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include "btstack_defines.h"
|
||||||
|
|
||||||
|
//------------------------------------------------------------------------------------------------------------
|
||||||
|
// obex_message_builder.h
|
||||||
|
//
|
||||||
|
//
|
||||||
|
//
|
||||||
|
|
||||||
|
/* API_START */
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Start Connect request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param obex_version_number
|
||||||
|
* @param flags
|
||||||
|
* @param maximum_obex_packet_length
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_request_create_connect(uint8_t * buffer, uint16_t buffer_len, uint8_t obex_version_number, uint8_t flags, uint16_t maximum_obex_packet_length);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Start Disconnect request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param connection_id
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_request_create_disconnect(uint8_t * buffer, uint16_t buffer_len, uint32_t connection_id);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Create Get request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param connection_id
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_request_create_get(uint8_t * buffer, uint16_t buffer_len, uint32_t connection_id);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Create Put request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param connection_id
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_request_create_put(uint8_t * buffer, uint16_t buffer_len, uint32_t connection_id);
|
||||||
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Create Abort request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param connection_id
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_request_create_abort(uint8_t * buffer, uint16_t buffer_len, uint32_t connection_id);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Start Set Path request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param connection_id
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_request_create_set_path(uint8_t * buffer, uint16_t buffer_len, uint8_t flags, uint32_t connection_id);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add SRM Enable
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_srm_enable(uint8_t * buffer, uint16_t buffer_len);
|
||||||
|
|
||||||
|
// /**
|
||||||
|
// * @brief Add header with single byte value (8 bit)
|
||||||
|
// * @param buffer
|
||||||
|
// * @param buffer_len
|
||||||
|
// * @param header_type
|
||||||
|
// * @param value
|
||||||
|
// */
|
||||||
|
// uint8_t obex_message_builder_header_add_byte(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, uint8_t value);
|
||||||
|
|
||||||
|
// /**
|
||||||
|
// * @brief Add header with word value (32 bit)
|
||||||
|
// * @param buffer
|
||||||
|
// * @param buffer_len
|
||||||
|
// * @param header_type
|
||||||
|
// * @param value
|
||||||
|
// */
|
||||||
|
// uint8_t obex_message_builder_header_add_word(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, uint32_t value);
|
||||||
|
|
||||||
|
// /**
|
||||||
|
// * @brief Add header with variable size
|
||||||
|
// * @param buffer
|
||||||
|
// * @param buffer_len
|
||||||
|
// * @param header_type
|
||||||
|
// * @param header_data
|
||||||
|
// * @param header_data_length
|
||||||
|
// */
|
||||||
|
// uint8_t obex_message_builder_header_add_variable(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, const uint8_t * header_data, uint16_t header_data_length);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add name header to current request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param name
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_name(uint8_t * buffer, uint16_t buffer_len, const char * name);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add target header to current request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param target
|
||||||
|
* @param lenght of target
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_target(uint8_t * buffer, uint16_t buffer_len, const uint8_t * target, uint16_t length);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add type header to current request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param type
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_type(uint8_t * buffer, uint16_t buffer_len, const char * type);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add count header to current request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param count
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_count(uint8_t * buffer, uint16_t buffer_len, uint32_t count);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add application parameters header to current request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param data
|
||||||
|
* @param lenght of application parameters
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_application_parameters(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t length);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add application parameters header to current request
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param data
|
||||||
|
* @param lenght of challenge response
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_header_add_challenge_response(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t length);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Add body
|
||||||
|
* @param buffer
|
||||||
|
* @param buffer_len
|
||||||
|
* @param data
|
||||||
|
* @param lenght
|
||||||
|
*/
|
||||||
|
uint8_t obex_message_builder_static_add_body(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint32_t length);
|
||||||
|
// int obex_message_builder_add_body_dynamic(uint8_t * buffer, uint16_t buffer_len, uint32_t length, void (*data_callback)(uint32_t offset, uint8_t * buffer, uint32_t len));
|
||||||
|
|
||||||
|
|
||||||
|
/* API_END */
|
||||||
|
|
||||||
|
#if defined __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
@ -10,12 +10,14 @@ LDFLAGS += -lCppUTest -lCppUTestExt
|
|||||||
|
|
||||||
VPATH += ${BTSTACK_ROOT}/src/ble
|
VPATH += ${BTSTACK_ROOT}/src/ble
|
||||||
VPATH += ${BTSTACK_ROOT}/src
|
VPATH += ${BTSTACK_ROOT}/src
|
||||||
|
VPATH += ${BTSTACK_ROOT}/src/classic
|
||||||
VPATH += ${BTSTACK_ROOT}/platform/posix
|
VPATH += ${BTSTACK_ROOT}/platform/posix
|
||||||
|
|
||||||
COMMON = \
|
COMMON = \
|
||||||
btstack_util.c \
|
btstack_util.c \
|
||||||
hci_dump.c \
|
hci_dump.c \
|
||||||
|
obex_message_builder.c \
|
||||||
|
|
||||||
COMMON_OBJ = $(COMMON:.c=.o)
|
COMMON_OBJ = $(COMMON:.c=.o)
|
||||||
|
|
||||||
all: obex_message_builder_test
|
all: obex_message_builder_test
|
||||||
|
@ -4,154 +4,7 @@
|
|||||||
#include "btstack_util.h"
|
#include "btstack_util.h"
|
||||||
#include "btstack_debug.h"
|
#include "btstack_debug.h"
|
||||||
#include "classic/obex.h"
|
#include "classic/obex.h"
|
||||||
|
#include "classic/obex_message_builder.h"
|
||||||
static uint8_t obex_message_builder_packet_init(uint8_t * buffer, uint16_t buffer_len, uint8_t opcode){
|
|
||||||
if (buffer_len < 3) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
|
|
||||||
buffer[0] = opcode;
|
|
||||||
big_endian_store_16(buffer, 1, 3);
|
|
||||||
return ERROR_CODE_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t obex_message_builder_packet_append(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t len){
|
|
||||||
uint16_t pos = big_endian_read_16(buffer, 1);
|
|
||||||
if (buffer_len < pos + len) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
|
|
||||||
memcpy(&buffer[pos], data, len);
|
|
||||||
pos += len;
|
|
||||||
big_endian_store_16(buffer, 1, pos);
|
|
||||||
return ERROR_CODE_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t obex_message_builder_header_add_variable(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, const uint8_t * header_data, uint16_t header_data_length){
|
|
||||||
uint8_t header[3];
|
|
||||||
header[0] = header_type;
|
|
||||||
big_endian_store_16(header, 1, sizeof(header) + header_data_length);
|
|
||||||
|
|
||||||
uint8_t status = obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
|
|
||||||
return obex_message_builder_packet_append(buffer, buffer_len, header_data, header_data_length);
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t obex_message_builder_header_add_byte(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, uint8_t value){
|
|
||||||
uint8_t header[2];
|
|
||||||
header[0] = header_type;
|
|
||||||
header[1] = value;
|
|
||||||
return obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t obex_message_builder_header_add_word(uint8_t * buffer, uint16_t buffer_len, uint8_t header_type, uint32_t value){
|
|
||||||
uint8_t header[5];
|
|
||||||
header[0] = header_type;
|
|
||||||
big_endian_store_32(header, 1, value);
|
|
||||||
return obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t obex_message_builder_header_add_connection_id(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
|
||||||
// add connection_id header if set, must be first header if used
|
|
||||||
if (obex_connection_id == OBEX_CONNECTION_ID_INVALID) return ERROR_CODE_PARAMETER_OUT_OF_MANDATORY_RANGE;
|
|
||||||
return obex_message_builder_header_add_word(buffer, buffer_len, OBEX_HEADER_CONNECTION_ID, obex_connection_id);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_request_create_connect(uint8_t * buffer, uint16_t buffer_len, uint8_t obex_version_number, uint8_t flags, uint16_t maximum_obex_packet_length){
|
|
||||||
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_CONNECT);
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
|
|
||||||
uint8_t fields[4];
|
|
||||||
fields[0] = obex_version_number;
|
|
||||||
fields[1] = flags;
|
|
||||||
big_endian_store_16(fields, 2, maximum_obex_packet_length);
|
|
||||||
return obex_message_builder_packet_append(buffer, buffer_len, &fields[0], sizeof(fields));
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_request_create_get(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
|
||||||
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_GET | OBEX_OPCODE_FINAL_BIT_MASK);
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_request_create_put(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
|
||||||
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_PUT | OBEX_OPCODE_FINAL_BIT_MASK);
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
|
|
||||||
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_request_create_set_path(uint8_t * buffer, uint16_t buffer_len, uint8_t flags, uint32_t obex_connection_id){
|
|
||||||
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_SETPATH);
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
|
|
||||||
uint8_t fields[2];
|
|
||||||
fields[0] = flags;
|
|
||||||
fields[1] = 0; // reserved
|
|
||||||
status = obex_message_builder_packet_append(buffer, buffer_len, &fields[0], sizeof(fields));
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_request_create_abort(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
|
||||||
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_ABORT);
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_request_create_disconnect(uint8_t * buffer, uint16_t buffer_len, uint32_t obex_connection_id){
|
|
||||||
uint8_t status = obex_message_builder_packet_init(buffer, buffer_len, OBEX_OPCODE_DISCONNECT);
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
return obex_message_builder_header_add_connection_id(buffer, buffer_len, obex_connection_id);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_header_add_srm_enable(uint8_t * buffer, uint16_t buffer_len){
|
|
||||||
return obex_message_builder_header_add_byte(buffer, buffer_len, OBEX_HEADER_SINGLE_RESPONSE_MODE, OBEX_SRM_ENABLE);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_add_header_target(uint8_t * buffer, uint16_t buffer_len, const uint8_t * target, uint16_t length){
|
|
||||||
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_TARGET, target, length);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_add_header_application_parameters(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t length){
|
|
||||||
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_APPLICATION_PARAMETERS, data, length);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_add_header_challenge_response(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint16_t length){
|
|
||||||
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_AUTHENTICATION_RESPONSE, data, length);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_add_body_static(uint8_t * buffer, uint16_t buffer_len, const uint8_t * data, uint32_t length){
|
|
||||||
return obex_message_builder_header_add_variable(buffer, buffer_len, OBEX_HEADER_END_OF_BODY, data, length);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_header_add_name(uint8_t * buffer, uint16_t buffer_len, const char * name){
|
|
||||||
int len = strlen(name);
|
|
||||||
if (len) {
|
|
||||||
// empty string does not have trailing \0
|
|
||||||
len++;
|
|
||||||
}
|
|
||||||
if (buffer_len < (1 + 2 + len*2) ) return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
|
|
||||||
|
|
||||||
uint16_t pos = big_endian_read_16(buffer, 1);
|
|
||||||
buffer[pos++] = OBEX_HEADER_NAME;
|
|
||||||
big_endian_store_16(buffer, pos, 1 + 2 + len*2);
|
|
||||||
pos += 2;
|
|
||||||
int i;
|
|
||||||
// @note name[len] == 0
|
|
||||||
for (i = 0 ; i < len ; i++){
|
|
||||||
buffer[pos++] = 0;
|
|
||||||
buffer[pos++] = *name++;
|
|
||||||
}
|
|
||||||
big_endian_store_16(buffer, 1, pos);
|
|
||||||
return ERROR_CODE_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t obex_message_builder_header_add_type(uint8_t * buffer, uint16_t buffer_len, const char * type){
|
|
||||||
uint8_t header[3];
|
|
||||||
header[0] = OBEX_HEADER_TYPE;
|
|
||||||
int len_incl_zero = strlen(type) + 1;
|
|
||||||
big_endian_store_16(header, 1, 1 + 2 + len_incl_zero);
|
|
||||||
|
|
||||||
uint8_t status = obex_message_builder_packet_append(buffer, buffer_len, &header[0], sizeof(header));
|
|
||||||
if (status != ERROR_CODE_SUCCESS) return status;
|
|
||||||
return obex_message_builder_packet_append(buffer, buffer_len, (const uint8_t*)type, len_incl_zero);
|
|
||||||
}
|
|
||||||
|
|
||||||
static const uint8_t service_uuid[] = {0xbb, 0x58, 0x2b, 0x40, 0x42, 0xc, 0x11, 0xdb, 0xb0, 0xde, 0x8, 0x0, 0x20, 0xc, 0x9a, 0x66};
|
static const uint8_t service_uuid[] = {0xbb, 0x58, 0x2b, 0x40, 0x42, 0xc, 0x11, 0xdb, 0xb0, 0xde, 0x8, 0x0, 0x20, 0xc, 0x9a, 0x66};
|
||||||
static const uint8_t application_parameters[] = {0x29, 4, 0, 0, 0xFF, 0xFF};
|
static const uint8_t application_parameters[] = {0x29, 4, 0, 0, 0xFF, 0xFF};
|
||||||
@ -290,17 +143,14 @@ TEST(OBEX_MESSAGE_BUILDER, CreateConnectWithHeaderTarget){
|
|||||||
status = obex_message_builder_request_create_connect(actual_message, actual_message_len, obex_version_number, flags, maximum_obex_packet_length);
|
status = obex_message_builder_request_create_connect(actual_message, actual_message_len, obex_version_number, flags, maximum_obex_packet_length);
|
||||||
validate_success(expected_message, expected_message[2]);
|
validate_success(expected_message, expected_message[2]);
|
||||||
|
|
||||||
status = obex_message_builder_add_header_target(actual_message, actual_message_len, service_uuid, sizeof(service_uuid));
|
status = obex_message_builder_header_add_target(actual_message, actual_message_len, service_uuid, sizeof(service_uuid));
|
||||||
expected_message[2] += header_len;
|
expected_message[2] += header_len;
|
||||||
validate_success(expected_message, expected_message[2]);
|
validate_success(expected_message, expected_message[2]);
|
||||||
}
|
}
|
||||||
|
|
||||||
TEST(OBEX_MESSAGE_BUILDER, CreateConnectWithHeaderApplicationParameters){
|
TEST(OBEX_MESSAGE_BUILDER, CreateConnectWithHeaderApplicationParameters){
|
||||||
uint8_t expected_message[] = {OBEX_OPCODE_CONNECT, 0, 0, obex_version_number, flags, 0, 0,
|
uint8_t expected_message[] = {OBEX_OPCODE_CONNECT, 0, 0, obex_version_number, flags, 0, 0,
|
||||||
// service UUID
|
|
||||||
OBEX_HEADER_APPLICATION_PARAMETERS, 0,0, 0,0,0,0,0,0
|
OBEX_HEADER_APPLICATION_PARAMETERS, 0,0, 0,0,0,0,0,0
|
||||||
// OBEX_HEADER_AUTHENTICATION_RESPONSE, 0,0
|
|
||||||
// OBEX_HEADER_END_OF_BODY, 0,0
|
|
||||||
};
|
};
|
||||||
int header_len = 3 + sizeof(application_parameters);
|
int header_len = 3 + sizeof(application_parameters);
|
||||||
expected_message[2] = 7;
|
expected_message[2] = 7;
|
||||||
@ -311,7 +161,7 @@ TEST(OBEX_MESSAGE_BUILDER, CreateConnectWithHeaderApplicationParameters){
|
|||||||
status = obex_message_builder_request_create_connect(actual_message, actual_message_len, obex_version_number, flags, maximum_obex_packet_length);
|
status = obex_message_builder_request_create_connect(actual_message, actual_message_len, obex_version_number, flags, maximum_obex_packet_length);
|
||||||
validate_success(expected_message, expected_message[2]);
|
validate_success(expected_message, expected_message[2]);
|
||||||
|
|
||||||
status = obex_message_builder_add_header_application_parameters(actual_message, actual_message_len, &application_parameters[0], sizeof(application_parameters));
|
status = obex_message_builder_header_add_application_parameters(actual_message, actual_message_len, &application_parameters[0], sizeof(application_parameters));
|
||||||
expected_message[2] += header_len;
|
expected_message[2] += header_len;
|
||||||
validate_success(expected_message, expected_message[2]);
|
validate_success(expected_message, expected_message[2]);
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user