mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-03-29 04:20:20 +00:00
Code Issues Packages Projects Releases Wiki Activity
btstack/src/ble/att_db_util.c
Milanka Ringwald b11dea2d08 remove printf and unused std libraries
2018-11-12 11:44:23 +01:00

245 lines
9.0 KiB
C
Raw Blame History

/*
* Copyright (C) 2014 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__ "att_db_util.c"
#include <string.h>
#include "ble/att_db_util.h"
#include "ble/att_db.h"
#include "ble/core.h"
#include "btstack_util.h"
#include "btstack_debug.h"
#include "bluetooth.h"
// ATT DB Storage
#ifndef HAVE_MALLOC
#ifdef MAX_ATT_DB_SIZE
static uint8_t att_db_storage[MAX_ATT_DB_SIZE];
#else
#error Neither HAVE_MALLOC nor MAX_ATT_DB_SIZE is defined.
#endif
#endif
static uint8_t * att_db;
static uint16_t att_db_size;
static uint16_t att_db_max_size;
static uint16_t att_db_next_handle;
static void att_db_util_set_end_tag(void){
// end tag
att_db[att_db_size] = 0;
att_db[att_db_size+1] = 0;
}
void att_db_util_init(void){
#ifdef HAVE_MALLOC
att_db = (uint8_t*) malloc(128);
att_db_max_size = 128;
#else
att_db = att_db_storage;
att_db_max_size = sizeof(att_db_storage);
#endif
// store att version
att_db[0] = ATT_DB_VERSION;
att_db_size = 1;
att_db_next_handle = 1;
att_db_util_set_end_tag();
}
/**
* asserts that the requested amount of bytes can be stored in the att_db
* @returns TRUE if space is available
*/
static int att_db_util_assert_space(uint16_t size){
size += 2; // for end tag
if (att_db_size + size <= att_db_max_size) return 1;
#ifdef HAVE_MALLOC
int new_size = att_db_size + att_db_size / 2;
uint8_t * new_db = (uint8_t*) realloc(att_db, new_size);
if (!new_db) {
log_error("att_db: realloc failed");
return 0;
}
att_db = new_db;
att_db_max_size = new_size;
att_set_db(att_db); // Update att_db with the new db
return 1;
#else
log_error("att_db: out of memory");
return 0;
#endif
}
// attribute size in bytes (16), flags(16), handle (16), uuid (16/128), value(...)
// db endds with 0x00 0x00
static void att_db_util_add_attribute_uuid16(uint16_t uuid16, uint16_t flags, uint8_t * data, uint16_t data_len){
int size = 2 + 2 + 2 + 2 + data_len;
if (!att_db_util_assert_space(size)) return;
little_endian_store_16(att_db, att_db_size, size);
att_db_size += 2;
little_endian_store_16(att_db, att_db_size, flags);
att_db_size += 2;
little_endian_store_16(att_db, att_db_size, att_db_next_handle);
att_db_size += 2;
att_db_next_handle++;
little_endian_store_16(att_db, att_db_size, uuid16);
att_db_size += 2;
memcpy(&att_db[att_db_size], data, data_len);
att_db_size += data_len;
att_db_util_set_end_tag();
}
static void att_db_util_add_attribute_uuid128(const uint8_t * uuid128, uint16_t flags, uint8_t * data, uint16_t data_len){
int size = 2 + 2 + 2 + 16 + data_len;
if (!att_db_util_assert_space(size)) return;
flags |= ATT_PROPERTY_UUID128;
little_endian_store_16(att_db, att_db_size, size);
att_db_size += 2;
little_endian_store_16(att_db, att_db_size, flags);
att_db_size += 2;
little_endian_store_16(att_db, att_db_size, att_db_next_handle);
att_db_size += 2;
att_db_next_handle++;
reverse_128(uuid128, &att_db[att_db_size]);
att_db_size += 16;
memcpy(&att_db[att_db_size], data, data_len);
att_db_size += data_len;
att_db_util_set_end_tag();
}
uint16_t att_db_util_add_service_uuid16(uint16_t uuid16){
uint8_t buffer[2];
little_endian_store_16(buffer, 0, uuid16);
uint16_t service_handle = att_db_next_handle;
att_db_util_add_attribute_uuid16(GATT_PRIMARY_SERVICE_UUID, ATT_PROPERTY_READ, buffer, 2);
return service_handle;
}
uint16_t att_db_util_add_service_uuid128(const uint8_t * uuid128){
uint8_t buffer[16];
reverse_128(uuid128, buffer);
uint16_t service_handle = att_db_next_handle;
att_db_util_add_attribute_uuid16(GATT_PRIMARY_SERVICE_UUID, ATT_PROPERTY_READ, buffer, 16);
return service_handle;
}
static void att_db_util_add_client_characteristic_configuration(uint16_t flags){
uint8_t buffer[2];
// drop permission for read (0xc00), keep write permissions (0x0011)
flags = (flags & 0x1f311) | ATT_PROPERTY_READ | ATT_PROPERTY_WRITE | ATT_PROPERTY_DYNAMIC;
little_endian_store_16(buffer, 0, 0);
att_db_util_add_attribute_uuid16(GATT_CLIENT_CHARACTERISTICS_CONFIGURATION, flags, buffer, 2);
}
static uint16_t att_db_util_encode_permissions(uint16_t properties, uint8_t read_permission, uint8_t write_permission){
// drop Broadcast (0x01), Notify (0x10), Indicate (0x20) - not used for flags
uint16_t flags = properties & 0xfffce;
// if encryption requested, set encryption key size to 16
if ((read_permission > ATT_SECURITY_NONE) || (write_permission > ATT_SECURITY_NONE)){
flags |= 0xf000;
}
// encode read/write security levels
if (read_permission & 1){
flags |= ATT_PROPERTY_READ_PERMISSION_BIT_0;
}
if (read_permission & 2){
flags |= ATT_PROPERTY_READ_PERMISSION_BIT_1;
}
if (write_permission & 1){
flags |= ATT_PROPERTY_WRITE_PERMISSION_BIT_0;
}
if (write_permission & 2){
flags |= ATT_PROPERTY_WRITE_PERMISSION_BIT_1;
}
return flags;
}
uint16_t att_db_util_add_characteristic_uuid16(uint16_t uuid16, uint16_t properties, uint8_t read_permission, uint8_t write_permission, uint8_t * data, uint16_t data_len){
uint8_t buffer[5];
buffer[0] = properties;
little_endian_store_16(buffer, 1, att_db_next_handle + 1);
little_endian_store_16(buffer, 3, uuid16);
att_db_util_add_attribute_uuid16(GATT_CHARACTERISTICS_UUID, ATT_PROPERTY_READ, buffer, sizeof(buffer));
uint16_t flags = att_db_util_encode_permissions(properties, read_permission, write_permission);
uint16_t value_handle = att_db_next_handle;
att_db_util_add_attribute_uuid16(uuid16, flags, data, data_len);
if (properties & (ATT_PROPERTY_NOTIFY | ATT_PROPERTY_INDICATE)){
att_db_util_add_client_characteristic_configuration(flags);
}
return value_handle;
}
uint16_t att_db_util_add_characteristic_uuid128(const uint8_t * uuid128, uint16_t properties, uint8_t read_permission, uint8_t write_permission, uint8_t * data, uint16_t data_len){
uint8_t buffer[19];
buffer[0] = properties;
little_endian_store_16(buffer, 1, att_db_next_handle + 1);
reverse_128(uuid128, &buffer[3]);
att_db_util_add_attribute_uuid16(GATT_CHARACTERISTICS_UUID, ATT_PROPERTY_READ, buffer, sizeof(buffer));
uint16_t flags = att_db_util_encode_permissions(properties, read_permission, write_permission);
uint16_t value_handle = att_db_next_handle;
att_db_util_add_attribute_uuid128(uuid128, flags, data, data_len);
if (properties & (ATT_PROPERTY_NOTIFY | ATT_PROPERTY_INDICATE)){
att_db_util_add_client_characteristic_configuration(flags);
}
return value_handle;
}
uint16_t att_db_util_add_descriptor_uuid16(uint16_t uuid16, uint16_t properties, uint8_t read_permission, uint8_t write_permission, uint8_t * data, uint16_t data_len){
uint16_t descriptor_handler = att_db_next_handle;
uint16_t flags = att_db_util_encode_permissions(properties, read_permission, write_permission);
att_db_util_add_attribute_uuid16(uuid16, flags, data, data_len);
return descriptor_handler;
}
uint16_t att_db_util_add_descriptor_uuid128(const uint8_t * uuid128, uint16_t properties, uint8_t read_permission, uint8_t write_permission, uint8_t * data, uint16_t data_len){
uint16_t descriptor_handler = att_db_next_handle;
uint16_t flags = att_db_util_encode_permissions(properties, read_permission, write_permission);
att_db_util_add_attribute_uuid128(uuid128, flags, data, data_len);
return descriptor_handler;
}
uint8_t * att_db_util_get_address(void){
return att_db;
}
uint16_t att_db_util_get_size(void){
return att_db_size + 2; // end tag
}
Reference in New Issue View Git Blame Copy Permalink