Ken Todotani / Mbed 2 deprecated BTstackLE

BLE demo for mbed Ported RunningElectronics's SBDBT firmware for BLE. It can communicate with iOS

Dependencies:   FatFileSystem mbed

Fork of BTstack by Norimasa Okamoto

BTstack/att.c@6:cf06ba884429, 2013-02-20 (annotated)

Committer:
todotani
Date:
Wed Feb 20 14:18:38 2013 +0000
Revision:
6:cf06ba884429
Parent:
1:6078e430af82 
Change tick timer to 1ms. Change attribute 0xFFF1 as read of DigitalIn p5

Who changed what in which revision?

UserRevisionLine numberNew contents of line
todotani 1:6078e430af82 1 /*
todotani 1:6078e430af82 2 * Copyright (C) 2011-2012 by Matthias Ringwald
todotani 1:6078e430af82 3 *
todotani 1:6078e430af82 4 * Redistribution and use in source and binary forms, with or without
todotani 1:6078e430af82 5 * modification, are permitted provided that the following conditions
todotani 1:6078e430af82 6 * are met:
todotani 1:6078e430af82 7 *
todotani 1:6078e430af82 8 * 1. Redistributions of source code must retain the above copyright
todotani 1:6078e430af82 9 * notice, this list of conditions and the following disclaimer.
todotani 1:6078e430af82 10 * 2. Redistributions in binary form must reproduce the above copyright
todotani 1:6078e430af82 11 * notice, this list of conditions and the following disclaimer in the
todotani 1:6078e430af82 12 * documentation and/or other materials provided with the distribution.
todotani 1:6078e430af82 13 * 3. Neither the name of the copyright holders nor the names of
todotani 1:6078e430af82 14 * contributors may be used to endorse or promote products derived
todotani 1:6078e430af82 15 * from this software without specific prior written permission.
todotani 1:6078e430af82 16 * 4. Any redistribution, use, or modification is done solely for
todotani 1:6078e430af82 17 * personal benefit and not for any commercial purpose or for
todotani 1:6078e430af82 18 * monetary gain.
todotani 1:6078e430af82 19 *
todotani 1:6078e430af82 20 * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS
todotani 1:6078e430af82 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
todotani 1:6078e430af82 22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
todotani 1:6078e430af82 23 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
todotani 1:6078e430af82 24 * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
todotani 1:6078e430af82 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
todotani 1:6078e430af82 26 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
todotani 1:6078e430af82 27 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
todotani 1:6078e430af82 28 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
todotani 1:6078e430af82 29 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
todotani 1:6078e430af82 30 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
todotani 1:6078e430af82 31 * SUCH DAMAGE.
todotani 1:6078e430af82 32 *
todotani 1:6078e430af82 33 * Please inquire about commercial licensing options at btstack@ringwald.ch
todotani 1:6078e430af82 34 *
todotani 1:6078e430af82 35 */
todotani 1:6078e430af82 36
todotani 1:6078e430af82 37 #include <stdio.h>
todotani 1:6078e430af82 38 #include <string.h>
todotani 1:6078e430af82 39
todotani 1:6078e430af82 40 #include "att.h"
todotani 6:cf06ba884429 41 #include "debug.h"
todotani 1:6078e430af82 42
todotani 1:6078e430af82 43 // from src/utils.
todotani 1:6078e430af82 44 #define READ_BT_16( buffer, pos) ( ((uint16_t) buffer[pos]) | (((uint16_t)buffer[pos+1]) << 8))
todotani 1:6078e430af82 45
todotani 1:6078e430af82 46 // Buetooth Base UUID 00000000-0000-1000-8000-00805F9B34FB in little endian
todotani 1:6078e430af82 47 static const uint8_t bluetooth_base_uuid[] = { 0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80, 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
todotani 1:6078e430af82 48
todotani 1:6078e430af82 49 static void bt_store_16(uint8_t *buffer, uint16_t pos, uint16_t value){
todotani 1:6078e430af82 50 buffer[pos++] = value;
todotani 1:6078e430af82 51 buffer[pos++] = value >> 8;
todotani 1:6078e430af82 52 }
todotani 1:6078e430af82 53
todotani 1:6078e430af82 54 static void hexdump2(void const *data, int size){
todotani 1:6078e430af82 55 int i;
todotani 1:6078e430af82 56 for (i=0; i<size;i++){
todotani 6:cf06ba884429 57 log_info("%02X ", ((uint8_t *)data)[i]);
todotani 1:6078e430af82 58 }
todotani 6:cf06ba884429 59 log_info("\n");
todotani 1:6078e430af82 60 }
todotani 1:6078e430af82 61
todotani 1:6078e430af82 62 static void printUUID128(const uint8_t * uuid){
todotani 1:6078e430af82 63 int i;
todotani 1:6078e430af82 64 for (i=15; i >= 0 ; i--){
todotani 6:cf06ba884429 65 log_info("%02X", uuid[i]);
todotani 1:6078e430af82 66 switch (i){
todotani 1:6078e430af82 67 case 4:
todotani 1:6078e430af82 68 case 6:
todotani 1:6078e430af82 69 case 8:
todotani 1:6078e430af82 70 case 10:
todotani 6:cf06ba884429 71 log_info("-");
todotani 1:6078e430af82 72 break;
todotani 1:6078e430af82 73 default:
todotani 1:6078e430af82 74 break;
todotani 1:6078e430af82 75 }
todotani 1:6078e430af82 76 }
todotani 1:6078e430af82 77 }
todotani 1:6078e430af82 78
todotani 1:6078e430af82 79 static int is_Bluetooth_Base_UUID(uint8_t const *uuid){
todotani 1:6078e430af82 80 if (memcmp(&uuid[0], &bluetooth_base_uuid[0], 12)) return 0;
todotani 1:6078e430af82 81 if (memcmp(&uuid[14], &bluetooth_base_uuid[14], 2)) return 0;
todotani 1:6078e430af82 82 return 1;
todotani 1:6078e430af82 83
todotani 1:6078e430af82 84 }
todotani 1:6078e430af82 85
todotani 1:6078e430af82 86 // ATT Database
todotani 1:6078e430af82 87 static uint8_t const * att_db = NULL;
todotani 1:6078e430af82 88 static att_read_callback_t att_read_callback = NULL;
todotani 1:6078e430af82 89 static att_write_callback_t att_write_callback = NULL;
todotani 1:6078e430af82 90
todotani 1:6078e430af82 91 // new java-style iterator
todotani 1:6078e430af82 92 typedef struct att_iterator {
todotani 1:6078e430af82 93 // private
todotani 1:6078e430af82 94 uint8_t const * att_ptr;
todotani 1:6078e430af82 95 // public
todotani 1:6078e430af82 96 uint16_t size;
todotani 1:6078e430af82 97 uint16_t flags;
todotani 1:6078e430af82 98 uint16_t handle;
todotani 1:6078e430af82 99 uint8_t const * uuid;
todotani 1:6078e430af82 100 uint16_t value_len;
todotani 1:6078e430af82 101 uint8_t const * value;
todotani 1:6078e430af82 102 } att_iterator_t;
todotani 1:6078e430af82 103
todotani 1:6078e430af82 104 void att_iterator_init(att_iterator_t *it){
todotani 1:6078e430af82 105 it->att_ptr = att_db;
todotani 1:6078e430af82 106 }
todotani 1:6078e430af82 107
todotani 1:6078e430af82 108 int att_iterator_has_next(att_iterator_t *it){
todotani 1:6078e430af82 109 return it->att_ptr != NULL;
todotani 1:6078e430af82 110 }
todotani 1:6078e430af82 111
todotani 1:6078e430af82 112 void att_iterator_fetch_next(att_iterator_t *it){
todotani 1:6078e430af82 113 it->size = READ_BT_16(it->att_ptr, 0);
todotani 1:6078e430af82 114 if (it->size == 0){
todotani 1:6078e430af82 115 it->flags = 0;
todotani 1:6078e430af82 116 it->handle = 0;
todotani 1:6078e430af82 117 it->uuid = NULL;
todotani 1:6078e430af82 118 it->value_len = 0;
todotani 1:6078e430af82 119 it->value = NULL;
todotani 1:6078e430af82 120 it->att_ptr = NULL;
todotani 1:6078e430af82 121 return;
todotani 1:6078e430af82 122 }
todotani 1:6078e430af82 123 it->flags = READ_BT_16(it->att_ptr, 2);
todotani 1:6078e430af82 124 it->handle = READ_BT_16(it->att_ptr, 4);
todotani 1:6078e430af82 125 it->uuid = &it->att_ptr[6];
todotani 1:6078e430af82 126 // handle 128 bit UUIDs
todotani 1:6078e430af82 127 if (it->flags & ATT_PROPERTY_UUID128){
todotani 1:6078e430af82 128 it->value_len = it->size - 22;
todotani 1:6078e430af82 129 it->value = &it->att_ptr[22];
todotani 1:6078e430af82 130 } else {
todotani 1:6078e430af82 131 it->value_len = it->size - 8;
todotani 1:6078e430af82 132 it->value = &it->att_ptr[8];
todotani 1:6078e430af82 133 }
todotani 1:6078e430af82 134 // advance AFTER setting values
todotani 1:6078e430af82 135 it->att_ptr += it->size;
todotani 1:6078e430af82 136 }
todotani 1:6078e430af82 137
todotani 1:6078e430af82 138 int att_iterator_match_uuid16(att_iterator_t *it, uint16_t uuid){
todotani 1:6078e430af82 139 if (it->handle == 0) return 0;
todotani 1:6078e430af82 140 if (it->flags & ATT_PROPERTY_UUID128){
todotani 1:6078e430af82 141 if (!is_Bluetooth_Base_UUID(it->uuid)) return 0;
todotani 1:6078e430af82 142 return READ_BT_16(it->uuid, 12) == uuid;
todotani 1:6078e430af82 143 }
todotani 1:6078e430af82 144 return READ_BT_16(it->uuid, 0) == uuid;
todotani 1:6078e430af82 145 }
todotani 1:6078e430af82 146
todotani 1:6078e430af82 147 int att_iterator_match_uuid(att_iterator_t *it, uint8_t *uuid, uint16_t uuid_len){
todotani 1:6078e430af82 148 if (it->handle == 0) return 0;
todotani 1:6078e430af82 149 // input: UUID16
todotani 1:6078e430af82 150 if (uuid_len == 2) {
todotani 1:6078e430af82 151 return att_iterator_match_uuid16(it, READ_BT_16(uuid, 0));
todotani 1:6078e430af82 152 }
todotani 1:6078e430af82 153 // input and db: UUID128
todotani 1:6078e430af82 154 if (it->flags & ATT_PROPERTY_UUID128){
todotani 1:6078e430af82 155 return memcmp(it->uuid, uuid, 16) == 0;
todotani 1:6078e430af82 156 }
todotani 1:6078e430af82 157 // input: UUID128, db: UUID16
todotani 1:6078e430af82 158 if (!is_Bluetooth_Base_UUID(uuid)) return 0;
todotani 1:6078e430af82 159 return READ_BT_16(uuid, 12) == READ_BT_16(it->uuid, 0);
todotani 1:6078e430af82 160 }
todotani 1:6078e430af82 161
todotani 1:6078e430af82 162
todotani 1:6078e430af82 163 int att_find_handle(att_iterator_t *it, uint16_t handle){
todotani 1:6078e430af82 164 att_iterator_init(it);
todotani 1:6078e430af82 165 while (att_iterator_has_next(it)){
todotani 1:6078e430af82 166 att_iterator_fetch_next(it);
todotani 1:6078e430af82 167 if (it->handle != handle) continue;
todotani 1:6078e430af82 168 return 1;
todotani 1:6078e430af82 169 }
todotani 1:6078e430af82 170 return 0;
todotani 1:6078e430af82 171 }
todotani 1:6078e430af82 172
todotani 1:6078e430af82 173 static void att_update_value_len(att_iterator_t *it){
todotani 1:6078e430af82 174 if ((it->flags & ATT_PROPERTY_DYNAMIC) == 0 || !att_read_callback) return;
todotani 1:6078e430af82 175 it->value_len = (*att_read_callback)(it->handle, 0, NULL, 0);
todotani 1:6078e430af82 176 return;
todotani 1:6078e430af82 177 }
todotani 1:6078e430af82 178
todotani 1:6078e430af82 179 static int att_copy_value(att_iterator_t *it, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){
todotani 1:6078e430af82 180
todotani 1:6078e430af82 181 // DYNAMIC
todotani 1:6078e430af82 182 if ((it->flags & ATT_PROPERTY_DYNAMIC) && att_read_callback) {
todotani 1:6078e430af82 183 return (*att_read_callback)(it->handle, offset, buffer, buffer_size);
todotani 1:6078e430af82 184 }
todotani 1:6078e430af82 185
todotani 1:6078e430af82 186 // STATIC
todotani 1:6078e430af82 187 uint16_t bytes_to_copy = it->value_len;
todotani 1:6078e430af82 188 if (bytes_to_copy > buffer_size){
todotani 1:6078e430af82 189 bytes_to_copy = buffer_size;
todotani 1:6078e430af82 190 }
todotani 1:6078e430af82 191 memcpy(buffer, it->value, bytes_to_copy);
todotani 1:6078e430af82 192 return bytes_to_copy;
todotani 1:6078e430af82 193 }
todotani 1:6078e430af82 194
todotani 1:6078e430af82 195 void att_set_db(uint8_t const * db){
todotani 1:6078e430af82 196 att_db = db;
todotani 1:6078e430af82 197 }
todotani 1:6078e430af82 198
todotani 1:6078e430af82 199 void att_set_read_callback(att_read_callback_t callback){
todotani 1:6078e430af82 200 att_read_callback = callback;
todotani 1:6078e430af82 201 }
todotani 1:6078e430af82 202
todotani 1:6078e430af82 203 void att_set_write_callback(att_write_callback_t callback){
todotani 1:6078e430af82 204 att_write_callback = callback;
todotani 1:6078e430af82 205 }
todotani 1:6078e430af82 206
todotani 1:6078e430af82 207 void att_dump_attributes(void){
todotani 1:6078e430af82 208 att_iterator_t it;
todotani 1:6078e430af82 209 att_iterator_init(&it);
todotani 1:6078e430af82 210 while (att_iterator_has_next(&it)){
todotani 1:6078e430af82 211 att_iterator_fetch_next(&it);
todotani 1:6078e430af82 212 if (it.handle == 0) {
todotani 6:cf06ba884429 213 log_info("Handle: END\n");
todotani 1:6078e430af82 214 return;
todotani 1:6078e430af82 215 }
todotani 6:cf06ba884429 216 log_info("Handle: 0x%04x, flags: 0x%04x, uuid: ", it.handle, it.flags);
todotani 1:6078e430af82 217 if (it.flags & ATT_PROPERTY_UUID128){
todotani 1:6078e430af82 218 printUUID128(it.uuid);
todotani 1:6078e430af82 219 } else {
todotani 6:cf06ba884429 220 log_info("%04x", READ_BT_16(it.uuid, 0));
todotani 1:6078e430af82 221 }
todotani 6:cf06ba884429 222 log_info(", value_len: %u, value: ", it.value_len);
todotani 1:6078e430af82 223 hexdump2(it.value, it.value_len);
todotani 1:6078e430af82 224 }
todotani 1:6078e430af82 225 }
todotani 1:6078e430af82 226
todotani 1:6078e430af82 227 static uint16_t setup_error(uint8_t * response_buffer, uint16_t request, uint16_t handle, uint8_t error_code){
todotani 1:6078e430af82 228 response_buffer[0] = ATT_ERROR_RESPONSE;
todotani 1:6078e430af82 229 response_buffer[1] = request;
todotani 1:6078e430af82 230 bt_store_16(response_buffer, 2, handle);
todotani 1:6078e430af82 231 response_buffer[4] = error_code;
todotani 1:6078e430af82 232 return 5;
todotani 1:6078e430af82 233 }
todotani 1:6078e430af82 234
todotani 1:6078e430af82 235 static uint16_t setup_error_atribute_not_found(uint8_t * response_buffer, uint16_t request, uint16_t start_handle){
todotani 1:6078e430af82 236 return setup_error(response_buffer, request, start_handle, ATT_ERROR_ATTRIBUTE_NOT_FOUND);
todotani 1:6078e430af82 237 }
todotani 1:6078e430af82 238
todotani 1:6078e430af82 239 static uint16_t setup_error_invalid_handle(uint8_t * response_buffer, uint16_t request, uint16_t handle){
todotani 1:6078e430af82 240 return setup_error(response_buffer, request, handle, ATT_ERROR_ATTRIBUTE_INVALID);
todotani 1:6078e430af82 241 }
todotani 1:6078e430af82 242
todotani 1:6078e430af82 243 static uint16_t setup_error_invalid_offset(uint8_t * response_buffer, uint16_t request, uint16_t handle){
todotani 1:6078e430af82 244 return setup_error(response_buffer, request, handle, ATT_ERROR_INVALID_OFFSET);
todotani 1:6078e430af82 245 }
todotani 1:6078e430af82 246
todotani 1:6078e430af82 247 //
todotani 1:6078e430af82 248 // MARK: ATT_EXCHANGE_MTU_REQUEST
todotani 1:6078e430af82 249 //
todotani 1:6078e430af82 250 static uint16_t handle_exchange_mtu_request(att_connection_t * att_connection, uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 251 uint8_t * response_buffer){
todotani 1:6078e430af82 252
todotani 1:6078e430af82 253 uint16_t client_rx_mtu = READ_BT_16(request_buffer, 1);
todotani 1:6078e430af82 254 if (client_rx_mtu < att_connection->mtu){
todotani 1:6078e430af82 255 att_connection->mtu = client_rx_mtu;
todotani 1:6078e430af82 256 }
todotani 1:6078e430af82 257
todotani 1:6078e430af82 258 response_buffer[0] = ATT_EXCHANGE_MTU_RESPONSE;
todotani 1:6078e430af82 259 bt_store_16(response_buffer, 1, att_connection->mtu);
todotani 1:6078e430af82 260 return 3;
todotani 1:6078e430af82 261 }
todotani 1:6078e430af82 262
todotani 1:6078e430af82 263
todotani 1:6078e430af82 264 //
todotani 1:6078e430af82 265 // MARK: ATT_FIND_INFORMATION_REQUEST
todotani 1:6078e430af82 266 //
todotani 1:6078e430af82 267 // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID
todotani 1:6078e430af82 268 //
todotani 1:6078e430af82 269 static uint16_t handle_find_information_request2(uint8_t * response_buffer, uint16_t response_buffer_size,
todotani 1:6078e430af82 270 uint16_t start_handle, uint16_t end_handle){
todotani 1:6078e430af82 271
todotani 6:cf06ba884429 272 log_info("ATT_FIND_INFORMATION_REQUEST: from %04X to %04X\n", start_handle, end_handle);
todotani 1:6078e430af82 273
todotani 1:6078e430af82 274 uint16_t offset = 1;
todotani 1:6078e430af82 275 uint16_t pair_len = 0;
todotani 1:6078e430af82 276
todotani 1:6078e430af82 277 att_iterator_t it;
todotani 1:6078e430af82 278 att_iterator_init(&it);
todotani 1:6078e430af82 279 while (att_iterator_has_next(&it)){
todotani 1:6078e430af82 280 att_iterator_fetch_next(&it);
todotani 1:6078e430af82 281 if (!it.handle) break;
todotani 1:6078e430af82 282 if (it.handle > end_handle) break;
todotani 1:6078e430af82 283 if (it.handle < start_handle) continue;
todotani 1:6078e430af82 284
todotani 1:6078e430af82 285 att_update_value_len(&it);
todotani 1:6078e430af82 286
todotani 6:cf06ba884429 287 // log_debug("Handle 0x%04x\n", it.handle);
todotani 1:6078e430af82 288
todotani 1:6078e430af82 289 // check if value has same len as last one
todotani 1:6078e430af82 290 uint16_t this_pair_len = 2 + it.value_len;
todotani 1:6078e430af82 291 if (offset > 1){
todotani 1:6078e430af82 292 if (pair_len != this_pair_len) {
todotani 1:6078e430af82 293 break;
todotani 1:6078e430af82 294 }
todotani 1:6078e430af82 295 }
todotani 1:6078e430af82 296
todotani 1:6078e430af82 297 // first
todotani 1:6078e430af82 298 if (offset == 1) {
todotani 1:6078e430af82 299 pair_len = this_pair_len;
todotani 1:6078e430af82 300 if (it.value_len == 2) {
todotani 1:6078e430af82 301 response_buffer[offset] = 0x01; // format
todotani 1:6078e430af82 302 } else {
todotani 1:6078e430af82 303 response_buffer[offset] = 0x02;
todotani 1:6078e430af82 304 }
todotani 1:6078e430af82 305 offset++;
todotani 1:6078e430af82 306 }
todotani 1:6078e430af82 307
todotani 1:6078e430af82 308 // space?
todotani 1:6078e430af82 309 if (offset + pair_len > response_buffer_size) {
todotani 1:6078e430af82 310 if (offset > 2) break;
todotani 1:6078e430af82 311 it.value_len = response_buffer_size - 4;
todotani 1:6078e430af82 312 }
todotani 1:6078e430af82 313
todotani 1:6078e430af82 314 // store
todotani 1:6078e430af82 315 bt_store_16(response_buffer, offset, it.handle);
todotani 1:6078e430af82 316 offset += 2;
todotani 1:6078e430af82 317 uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len);
todotani 1:6078e430af82 318 offset += bytes_copied;
todotani 1:6078e430af82 319 }
todotani 1:6078e430af82 320
todotani 1:6078e430af82 321 if (offset == 1){
todotani 1:6078e430af82 322 return setup_error_atribute_not_found(response_buffer, ATT_FIND_INFORMATION_REQUEST, start_handle);
todotani 1:6078e430af82 323 }
todotani 1:6078e430af82 324
todotani 1:6078e430af82 325 response_buffer[0] = ATT_FIND_INFORMATION_REPLY;
todotani 1:6078e430af82 326 return offset;
todotani 1:6078e430af82 327 }
todotani 1:6078e430af82 328
todotani 1:6078e430af82 329 static uint16_t handle_find_information_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 330 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 331 return handle_find_information_request2(response_buffer, response_buffer_size, READ_BT_16(request_buffer, 1), READ_BT_16(request_buffer, 3));
todotani 1:6078e430af82 332 }
todotani 1:6078e430af82 333
todotani 1:6078e430af82 334 //
todotani 1:6078e430af82 335 // MARK: ATT_FIND_BY_TYPE_VALUE
todotani 1:6078e430af82 336 //
todotani 1:6078e430af82 337 // "Only attributes with attribute handles between and including the Starting Handle parameter
todotani 1:6078e430af82 338 // and the Ending Handle parameter that match the requested attri- bute type and the attribute
todotani 1:6078e430af82 339 // value that have sufficient permissions to allow reading will be returned" -> (1)
todotani 1:6078e430af82 340 //
todotani 1:6078e430af82 341 // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID
todotani 1:6078e430af82 342 //
todotani 1:6078e430af82 343 // NOTE: doesn't handle DYNAMIC values
todotani 1:6078e430af82 344 // NOTE: only supports 16 bit UUIDs
todotani 1:6078e430af82 345 //
todotani 1:6078e430af82 346 static uint16_t handle_find_by_type_value_request2(uint8_t * response_buffer, uint16_t response_buffer_size,
todotani 1:6078e430af82 347 uint16_t start_handle, uint16_t end_handle,
todotani 1:6078e430af82 348 uint16_t attribute_type, uint16_t attribute_len, uint8_t* attribute_value){
todotani 1:6078e430af82 349
todotani 6:cf06ba884429 350 log_info("ATT_FIND_BY_TYPE_VALUE_REQUEST: from %04X to %04X, type %04X, value: ", start_handle, end_handle, attribute_type);
todotani 1:6078e430af82 351 hexdump2(attribute_value, attribute_len);
todotani 1:6078e430af82 352
todotani 1:6078e430af82 353 uint16_t offset = 1;
todotani 1:6078e430af82 354 uint16_t in_group = 0;
todotani 1:6078e430af82 355 uint16_t prev_handle = 0;
todotani 1:6078e430af82 356
todotani 1:6078e430af82 357 att_iterator_t it;
todotani 1:6078e430af82 358 att_iterator_init(&it);
todotani 1:6078e430af82 359 while (att_iterator_has_next(&it)){
todotani 1:6078e430af82 360 att_iterator_fetch_next(&it);
todotani 1:6078e430af82 361
todotani 1:6078e430af82 362 if (it.handle && it.handle < start_handle) continue;
todotani 1:6078e430af82 363 if (it.handle > end_handle) break; // (1)
todotani 1:6078e430af82 364
todotani 1:6078e430af82 365 // close current tag, if within a group and a new service definition starts or we reach end of att db
todotani 1:6078e430af82 366 if (in_group &&
todotani 1:6078e430af82 367 (it.handle == 0 || att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID))){
todotani 1:6078e430af82 368
todotani 6:cf06ba884429 369 log_info("End of group, handle 0x%04x\n", prev_handle);
todotani 1:6078e430af82 370 bt_store_16(response_buffer, offset, prev_handle);
todotani 1:6078e430af82 371 offset += 2;
todotani 1:6078e430af82 372 in_group = 0;
todotani 1:6078e430af82 373
todotani 1:6078e430af82 374 // check if space for another handle pair available
todotani 1:6078e430af82 375 if (offset + 4 > response_buffer_size){
todotani 1:6078e430af82 376 break;
todotani 1:6078e430af82 377 }
todotani 1:6078e430af82 378 }
todotani 1:6078e430af82 379
todotani 1:6078e430af82 380 // keep track of previous handle
todotani 1:6078e430af82 381 prev_handle = it.handle;
todotani 1:6078e430af82 382
todotani 1:6078e430af82 383 // does current attribute match
todotani 1:6078e430af82 384 if (it.handle && att_iterator_match_uuid16(&it, attribute_type) && attribute_len == it.value_len && memcmp(attribute_value, it.value, it.value_len) == 0){
todotani 6:cf06ba884429 385 log_info("Begin of group, handle 0x%04x\n", it.handle);
todotani 1:6078e430af82 386 bt_store_16(response_buffer, offset, it.handle);
todotani 1:6078e430af82 387 offset += 2;
todotani 1:6078e430af82 388 in_group = 1;
todotani 1:6078e430af82 389 }
todotani 1:6078e430af82 390 }
todotani 1:6078e430af82 391
todotani 1:6078e430af82 392 if (offset == 1){
todotani 1:6078e430af82 393 return setup_error_atribute_not_found(response_buffer, ATT_FIND_BY_TYPE_VALUE_REQUEST, start_handle);
todotani 1:6078e430af82 394 }
todotani 1:6078e430af82 395
todotani 1:6078e430af82 396 response_buffer[0] = ATT_FIND_BY_TYPE_VALUE_RESPONSE;
todotani 1:6078e430af82 397 return offset;
todotani 1:6078e430af82 398 }
todotani 1:6078e430af82 399
todotani 1:6078e430af82 400 static uint16_t handle_find_by_type_value_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 401 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 402 int attribute_len = request_len - 7;
todotani 1:6078e430af82 403 return handle_find_by_type_value_request2(response_buffer, response_buffer_size, READ_BT_16(request_buffer, 1),
todotani 1:6078e430af82 404 READ_BT_16(request_buffer, 3), READ_BT_16(request_buffer, 5), attribute_len, &request_buffer[7]);
todotani 1:6078e430af82 405 }
todotani 1:6078e430af82 406
todotani 1:6078e430af82 407 //
todotani 1:6078e430af82 408 // MARK: ATT_READ_BY_TYPE_REQUEST
todotani 1:6078e430af82 409 //
todotani 1:6078e430af82 410 static uint16_t handle_read_by_type_request2(uint8_t * response_buffer, uint16_t response_buffer_size,
todotani 1:6078e430af82 411 uint16_t start_handle, uint16_t end_handle,
todotani 1:6078e430af82 412 uint16_t attribute_type_len, uint8_t * attribute_type){
todotani 1:6078e430af82 413
todotani 6:cf06ba884429 414 log_info("ATT_READ_BY_TYPE_REQUEST: from %04X to %04X, type: ", start_handle, end_handle);
todotani 1:6078e430af82 415 hexdump2(attribute_type, attribute_type_len);
todotani 1:6078e430af82 416
todotani 1:6078e430af82 417 uint16_t offset = 1;
todotani 1:6078e430af82 418 uint16_t pair_len = 0;
todotani 1:6078e430af82 419
todotani 1:6078e430af82 420 att_iterator_t it;
todotani 1:6078e430af82 421 att_iterator_init(&it);
todotani 1:6078e430af82 422 while (att_iterator_has_next(&it)){
todotani 1:6078e430af82 423 att_iterator_fetch_next(&it);
todotani 1:6078e430af82 424
todotani 1:6078e430af82 425 if (!it.handle) break;
todotani 1:6078e430af82 426 if (it.handle < start_handle) continue;
todotani 1:6078e430af82 427 if (it.handle > end_handle) break; // (1)
todotani 1:6078e430af82 428
todotani 1:6078e430af82 429 // does current attribute match
todotani 1:6078e430af82 430 if (!att_iterator_match_uuid(&it, attribute_type, attribute_type_len)) continue;
todotani 1:6078e430af82 431
todotani 1:6078e430af82 432 att_update_value_len(&it);
todotani 1:6078e430af82 433
todotani 1:6078e430af82 434 // check if value has same len as last one
todotani 1:6078e430af82 435 uint16_t this_pair_len = 2 + it.value_len;
todotani 1:6078e430af82 436 if (offset > 1){
todotani 1:6078e430af82 437 if (pair_len != this_pair_len) {
todotani 1:6078e430af82 438 break;
todotani 1:6078e430af82 439 }
todotani 1:6078e430af82 440 }
todotani 1:6078e430af82 441
todotani 1:6078e430af82 442 // first
todotani 1:6078e430af82 443 if (offset == 1) {
todotani 1:6078e430af82 444 pair_len = this_pair_len;
todotani 1:6078e430af82 445 response_buffer[offset] = pair_len;
todotani 1:6078e430af82 446 offset++;
todotani 1:6078e430af82 447 }
todotani 1:6078e430af82 448
todotani 1:6078e430af82 449 // space?
todotani 1:6078e430af82 450 if (offset + pair_len > response_buffer_size) {
todotani 1:6078e430af82 451 if (offset > 2) break;
todotani 1:6078e430af82 452 it.value_len = response_buffer_size - 4;
todotani 1:6078e430af82 453 }
todotani 1:6078e430af82 454
todotani 1:6078e430af82 455 // store
todotani 1:6078e430af82 456 bt_store_16(response_buffer, offset, it.handle);
todotani 1:6078e430af82 457 offset += 2;
todotani 1:6078e430af82 458 uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len);
todotani 1:6078e430af82 459 offset += bytes_copied;
todotani 1:6078e430af82 460 }
todotani 1:6078e430af82 461
todotani 1:6078e430af82 462 if (offset == 1){
todotani 1:6078e430af82 463 return setup_error_atribute_not_found(response_buffer, ATT_READ_BY_TYPE_REQUEST, start_handle);
todotani 1:6078e430af82 464 }
todotani 1:6078e430af82 465
todotani 1:6078e430af82 466 response_buffer[0] = ATT_READ_BY_TYPE_RESPONSE;
todotani 1:6078e430af82 467 return offset;
todotani 1:6078e430af82 468 }
todotani 1:6078e430af82 469
todotani 1:6078e430af82 470 static uint16_t handle_read_by_type_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 471 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 472 int attribute_type_len;
todotani 1:6078e430af82 473 if (request_len <= 7){
todotani 1:6078e430af82 474 attribute_type_len = 2;
todotani 1:6078e430af82 475 } else {
todotani 1:6078e430af82 476 attribute_type_len = 16;
todotani 1:6078e430af82 477 }
todotani 1:6078e430af82 478 return handle_read_by_type_request2(response_buffer, response_buffer_size, READ_BT_16(request_buffer, 1), READ_BT_16(request_buffer, 3), attribute_type_len, &request_buffer[5]);
todotani 1:6078e430af82 479 }
todotani 1:6078e430af82 480
todotani 1:6078e430af82 481 //
todotani 1:6078e430af82 482 // MARK: ATT_READ_BY_TYPE_REQUEST
todotani 1:6078e430af82 483 //
todotani 1:6078e430af82 484 static uint16_t handle_read_request2(uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t handle){
todotani 1:6078e430af82 485
todotani 6:cf06ba884429 486 log_info("ATT_READ_REQUEST: handle %04x\n", handle);
todotani 1:6078e430af82 487
todotani 1:6078e430af82 488 att_iterator_t it;
todotani 1:6078e430af82 489 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 490 if (!ok){
todotani 1:6078e430af82 491 return setup_error_atribute_not_found(response_buffer, ATT_READ_REQUEST, handle);
todotani 1:6078e430af82 492 }
todotani 6:cf06ba884429 493
todotani 1:6078e430af82 494 att_update_value_len(&it);
todotani 1:6078e430af82 495
todotani 1:6078e430af82 496 uint16_t offset = 1;
todotani 1:6078e430af82 497 // limit data
todotani 1:6078e430af82 498 if (offset + it.value_len > response_buffer_size) {
todotani 1:6078e430af82 499 it.value_len = response_buffer_size - 1;
todotani 1:6078e430af82 500 }
todotani 1:6078e430af82 501
todotani 1:6078e430af82 502 // store
todotani 1:6078e430af82 503 uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len);
todotani 1:6078e430af82 504 offset += bytes_copied;
todotani 1:6078e430af82 505
todotani 1:6078e430af82 506 response_buffer[0] = ATT_READ_RESPONSE;
todotani 1:6078e430af82 507 return offset;
todotani 1:6078e430af82 508 }
todotani 1:6078e430af82 509
todotani 1:6078e430af82 510 static uint16_t handle_read_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 511 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 512 return handle_read_request2(response_buffer, response_buffer_size, READ_BT_16(request_buffer, 1));
todotani 1:6078e430af82 513 }
todotani 1:6078e430af82 514
todotani 1:6078e430af82 515 //
todotani 1:6078e430af82 516 // MARK: ATT_READ_BLOB_REQUEST 0x0c
todotani 1:6078e430af82 517 //
todotani 1:6078e430af82 518 static uint16_t handle_read_blob_request2(uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t handle, uint16_t value_offset){
todotani 6:cf06ba884429 519 log_info("ATT_READ_BLOB_REQUEST: handle %04x, offset %u\n", handle, value_offset);
todotani 1:6078e430af82 520
todotani 1:6078e430af82 521 att_iterator_t it;
todotani 1:6078e430af82 522 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 523 if (!ok){
todotani 1:6078e430af82 524 return setup_error_atribute_not_found(response_buffer, ATT_READ_BLOB_REQUEST, handle);
todotani 1:6078e430af82 525 }
todotani 1:6078e430af82 526
todotani 1:6078e430af82 527 att_update_value_len(&it);
todotani 1:6078e430af82 528
todotani 1:6078e430af82 529 if (value_offset >= it.value_len){
todotani 1:6078e430af82 530 return setup_error_invalid_offset(response_buffer, ATT_READ_BLOB_REQUEST, handle);
todotani 1:6078e430af82 531 }
todotani 1:6078e430af82 532
todotani 1:6078e430af82 533 // limit data
todotani 1:6078e430af82 534 uint16_t offset = 1;
todotani 1:6078e430af82 535 if (offset + it.value_len - value_offset > response_buffer_size) {
todotani 1:6078e430af82 536 it.value_len = response_buffer_size - 1 + value_offset;
todotani 1:6078e430af82 537 }
todotani 1:6078e430af82 538
todotani 1:6078e430af82 539 // store
todotani 1:6078e430af82 540 uint16_t bytes_copied = att_copy_value(&it, value_offset, response_buffer + offset, it.value_len - value_offset);
todotani 1:6078e430af82 541 offset += bytes_copied;
todotani 1:6078e430af82 542
todotani 1:6078e430af82 543 response_buffer[0] = ATT_READ_BLOB_RESPONSE;
todotani 1:6078e430af82 544 return offset;
todotani 1:6078e430af82 545 }
todotani 1:6078e430af82 546
todotani 1:6078e430af82 547 uint16_t handle_read_blob_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 548 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 549 return handle_read_blob_request2(response_buffer, response_buffer_size, READ_BT_16(request_buffer, 1), READ_BT_16(request_buffer, 3));
todotani 1:6078e430af82 550 }
todotani 1:6078e430af82 551
todotani 1:6078e430af82 552 //
todotani 1:6078e430af82 553 // MARK: ATT_READ_MULTIPLE_REQUEST 0x0e
todotani 1:6078e430af82 554 //
todotani 1:6078e430af82 555 static uint16_t handle_read_multiple_request2(uint8_t * response_buffer, uint16_t response_buffer_size, uint16_t num_handles, uint16_t * handles){
todotani 6:cf06ba884429 556 log_info("ATT_READ_MULTIPLE_REQUEST: num handles %u\n", num_handles);
todotani 1:6078e430af82 557
todotani 1:6078e430af82 558 uint16_t offset = 1;
todotani 1:6078e430af82 559
todotani 1:6078e430af82 560 int i;
todotani 1:6078e430af82 561 for (i=0;i<num_handles;i++){
todotani 1:6078e430af82 562 uint16_t handle = handles[i];
todotani 1:6078e430af82 563
todotani 1:6078e430af82 564 if (handle == 0){
todotani 1:6078e430af82 565 return setup_error_invalid_handle(response_buffer, ATT_READ_MULTIPLE_REQUEST, handle);
todotani 1:6078e430af82 566 }
todotani 1:6078e430af82 567
todotani 1:6078e430af82 568 att_iterator_t it;
todotani 1:6078e430af82 569
todotani 1:6078e430af82 570 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 571 if (!ok){
todotani 1:6078e430af82 572 return setup_error_invalid_handle(response_buffer, ATT_READ_MULTIPLE_REQUEST, handle);
todotani 1:6078e430af82 573 }
todotani 1:6078e430af82 574
todotani 1:6078e430af82 575 att_update_value_len(&it);
todotani 1:6078e430af82 576
todotani 1:6078e430af82 577 // limit data
todotani 1:6078e430af82 578 if (offset + it.value_len > response_buffer_size) {
todotani 1:6078e430af82 579 it.value_len = response_buffer_size - 1;
todotani 1:6078e430af82 580 }
todotani 1:6078e430af82 581
todotani 1:6078e430af82 582 // store
todotani 1:6078e430af82 583 uint16_t bytes_copied = att_copy_value(&it, 0, response_buffer + offset, it.value_len);
todotani 1:6078e430af82 584 offset += bytes_copied;
todotani 1:6078e430af82 585 }
todotani 1:6078e430af82 586
todotani 1:6078e430af82 587 response_buffer[0] = ATT_READ_MULTIPLE_RESPONSE;
todotani 1:6078e430af82 588 return offset;
todotani 1:6078e430af82 589 }
todotani 1:6078e430af82 590 uint16_t handle_read_multiple_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 591 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 592 int num_handles = (request_len - 1) >> 1;
todotani 1:6078e430af82 593 return handle_read_multiple_request2(response_buffer, response_buffer_size, num_handles, (uint16_t*) &request_buffer[1]);
todotani 1:6078e430af82 594 }
todotani 1:6078e430af82 595
todotani 1:6078e430af82 596 //
todotani 1:6078e430af82 597 // MARK: ATT_READ_BY_GROUP_TYPE_REQUEST 0x10
todotani 1:6078e430af82 598 //
todotani 1:6078e430af82 599 // TODO: handle other types then GATT_PRIMARY_SERVICE_UUID and GATT_SECONDARY_SERVICE_UUID
todotani 1:6078e430af82 600 //
todotani 1:6078e430af82 601 // NOTE: doesn't handle DYNAMIC values
todotani 1:6078e430af82 602 //
todotani 1:6078e430af82 603 static uint16_t handle_read_by_group_type_request2(uint8_t * response_buffer, uint16_t response_buffer_size,
todotani 1:6078e430af82 604 uint16_t start_handle, uint16_t end_handle,
todotani 1:6078e430af82 605 uint16_t attribute_type_len, uint8_t * attribute_type){
todotani 1:6078e430af82 606
todotani 6:cf06ba884429 607 log_info("ATT_READ_BY_GROUP_TYPE_REQUEST: from %04X to %04X, buffer size %u, type: ", start_handle, end_handle, response_buffer_size);
todotani 1:6078e430af82 608 hexdump2(attribute_type, attribute_type_len);
todotani 1:6078e430af82 609
todotani 1:6078e430af82 610 uint16_t offset = 1;
todotani 1:6078e430af82 611 uint16_t pair_len = 0;
todotani 1:6078e430af82 612 uint16_t in_group = 0;
todotani 1:6078e430af82 613 uint16_t group_start_handle = 0;
todotani 1:6078e430af82 614 uint8_t const * group_start_value = NULL;
todotani 1:6078e430af82 615 uint16_t prev_handle = 0;
todotani 1:6078e430af82 616
todotani 1:6078e430af82 617 att_iterator_t it;
todotani 1:6078e430af82 618 att_iterator_init(&it);
todotani 1:6078e430af82 619 while (att_iterator_has_next(&it)){
todotani 1:6078e430af82 620 att_iterator_fetch_next(&it);
todotani 1:6078e430af82 621
todotani 1:6078e430af82 622 if (it.handle && it.handle < start_handle) continue;
todotani 1:6078e430af82 623 if (it.handle > end_handle) break; // (1)
todotani 1:6078e430af82 624
todotani 1:6078e430af82 625 // close current tag, if within a group and a new service definition starts or we reach end of att db
todotani 1:6078e430af82 626 if (in_group &&
todotani 1:6078e430af82 627 (it.handle == 0 || att_iterator_match_uuid16(&it, GATT_PRIMARY_SERVICE_UUID) || att_iterator_match_uuid16(&it, GATT_SECONDARY_SERVICE_UUID))){
todotani 1:6078e430af82 628 // TODO: check if handle is included in start/end range
todotani 6:cf06ba884429 629 // log_debug("End of group, handle 0x%04x, val_len: %u\n", prev_handle, pair_len - 4);
todotani 1:6078e430af82 630
todotani 1:6078e430af82 631 bt_store_16(response_buffer, offset, group_start_handle);
todotani 1:6078e430af82 632 offset += 2;
todotani 1:6078e430af82 633 bt_store_16(response_buffer, offset, prev_handle);
todotani 1:6078e430af82 634 offset += 2;
todotani 1:6078e430af82 635 memcpy(response_buffer + offset, group_start_value, pair_len - 4);
todotani 1:6078e430af82 636 offset += pair_len - 4;
todotani 1:6078e430af82 637 in_group = 0;
todotani 1:6078e430af82 638
todotani 1:6078e430af82 639 // check if space for another handle pair available
todotani 1:6078e430af82 640 if (offset + pair_len > response_buffer_size){
todotani 1:6078e430af82 641 break;
todotani 1:6078e430af82 642 }
todotani 1:6078e430af82 643 }
todotani 1:6078e430af82 644
todotani 1:6078e430af82 645 // keep track of previous handle
todotani 1:6078e430af82 646 prev_handle = it.handle;
todotani 1:6078e430af82 647
todotani 1:6078e430af82 648 // does current attribute match
todotani 6:cf06ba884429 649 // log_debug("compare: %04x == %04x\n", *(uint16_t*) context->attribute_type, *(uint16_t*) uuid);
todotani 1:6078e430af82 650 if (it.handle && att_iterator_match_uuid(&it, attribute_type, attribute_type_len)) {
todotani 1:6078e430af82 651
todotani 1:6078e430af82 652 // check if value has same len as last one
todotani 1:6078e430af82 653 uint16_t this_pair_len = 4 + it.value_len;
todotani 1:6078e430af82 654 if (offset > 1){
todotani 1:6078e430af82 655 if (this_pair_len != pair_len) {
todotani 1:6078e430af82 656 break;
todotani 1:6078e430af82 657 }
todotani 1:6078e430af82 658 }
todotani 1:6078e430af82 659
todotani 6:cf06ba884429 660 // log_debug("Begin of group, handle 0x%04x\n", it.handle);
todotani 1:6078e430af82 661
todotani 1:6078e430af82 662 // first
todotani 1:6078e430af82 663 if (offset == 1) {
todotani 1:6078e430af82 664 pair_len = this_pair_len;
todotani 1:6078e430af82 665 response_buffer[offset] = this_pair_len;
todotani 1:6078e430af82 666 offset++;
todotani 1:6078e430af82 667 }
todotani 1:6078e430af82 668
todotani 1:6078e430af82 669 group_start_handle = it.handle;
todotani 1:6078e430af82 670 group_start_value = it.value;
todotani 1:6078e430af82 671 in_group = 1;
todotani 1:6078e430af82 672 }
todotani 1:6078e430af82 673 }
todotani 1:6078e430af82 674
todotani 1:6078e430af82 675 if (offset == 1){
todotani 1:6078e430af82 676 return setup_error_atribute_not_found(response_buffer, ATT_READ_BY_GROUP_TYPE_REQUEST, start_handle);
todotani 1:6078e430af82 677 }
todotani 1:6078e430af82 678
todotani 1:6078e430af82 679 response_buffer[0] = ATT_READ_BY_GROUP_TYPE_RESPONSE;
todotani 1:6078e430af82 680 return offset;
todotani 1:6078e430af82 681 }
todotani 1:6078e430af82 682 uint16_t handle_read_by_group_type_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 683 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 684 int attribute_type_len;
todotani 1:6078e430af82 685 if (request_len <= 7){
todotani 1:6078e430af82 686 attribute_type_len = 2;
todotani 1:6078e430af82 687 } else {
todotani 1:6078e430af82 688 attribute_type_len = 16;
todotani 1:6078e430af82 689 }
todotani 1:6078e430af82 690 return handle_read_by_group_type_request2(response_buffer, response_buffer_size, READ_BT_16(request_buffer, 1), READ_BT_16(request_buffer, 3), attribute_type_len, &request_buffer[5]);
todotani 1:6078e430af82 691 }
todotani 1:6078e430af82 692
todotani 1:6078e430af82 693 //
todotani 1:6078e430af82 694 // MARK: ATT_WRITE_REQUEST 0x12
todotani 1:6078e430af82 695 static uint16_t handle_write_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 696 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 697 uint16_t handle = READ_BT_16(request_buffer, 1);
todotani 1:6078e430af82 698 if (!att_write_callback) {
todotani 1:6078e430af82 699 // TODO: Use "Write Not Permitted"
todotani 1:6078e430af82 700 return setup_error_atribute_not_found(response_buffer, ATT_WRITE_REQUEST, handle);
todotani 1:6078e430af82 701 }
todotani 1:6078e430af82 702 att_iterator_t it;
todotani 1:6078e430af82 703 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 704 if (!ok) {
todotani 1:6078e430af82 705 return setup_error_atribute_not_found(response_buffer, ATT_WRITE_REQUEST, handle);
todotani 1:6078e430af82 706 }
todotani 1:6078e430af82 707 if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) {
todotani 1:6078e430af82 708 // TODO: Use "Write Not Permitted"
todotani 1:6078e430af82 709 return setup_error_atribute_not_found(response_buffer, ATT_WRITE_REQUEST, handle);
todotani 1:6078e430af82 710 }
todotani 1:6078e430af82 711 (*att_write_callback)(handle, ATT_TRANSACTION_MODE_NONE, 0, request_buffer + 3, request_len - 3, NULL);
todotani 1:6078e430af82 712 response_buffer[0] = ATT_WRITE_RESPONSE;
todotani 1:6078e430af82 713 return 1;
todotani 1:6078e430af82 714 }
todotani 1:6078e430af82 715
todotani 1:6078e430af82 716 //
todotani 1:6078e430af82 717 // MARK: ATT_PREPARE_WRITE_REQUEST 0x16
todotani 1:6078e430af82 718 static uint16_t handle_prepare_write_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 719 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 720 uint16_t handle = READ_BT_16(request_buffer, 1);
todotani 1:6078e430af82 721 if (!att_write_callback) {
todotani 1:6078e430af82 722 // TODO: Use "Write Not Permitted"
todotani 1:6078e430af82 723 return setup_error_atribute_not_found(response_buffer, ATT_PREPARE_WRITE_REQUEST, handle);
todotani 1:6078e430af82 724 }
todotani 1:6078e430af82 725 att_iterator_t it;
todotani 1:6078e430af82 726 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 727 if (!ok) {
todotani 1:6078e430af82 728 return setup_error_atribute_not_found(response_buffer, ATT_WRITE_REQUEST, handle);
todotani 1:6078e430af82 729 }
todotani 1:6078e430af82 730 if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) {
todotani 1:6078e430af82 731 // TODO: Use "Write Not Permitted"
todotani 1:6078e430af82 732 return setup_error_atribute_not_found(response_buffer, ATT_WRITE_REQUEST, handle);
todotani 1:6078e430af82 733 }
todotani 1:6078e430af82 734 (*att_write_callback)(handle, ATT_TRANSACTION_MODE_ACTIVE, 0, request_buffer + 3, request_len - 3, NULL);
todotani 1:6078e430af82 735
todotani 1:6078e430af82 736 // response: echo request
todotani 1:6078e430af82 737 memcpy(response_buffer, request_buffer, request_len);
todotani 1:6078e430af82 738 response_buffer[0] = ATT_PREPARE_WRITE_RESPONSE;
todotani 1:6078e430af82 739 return request_len;
todotani 1:6078e430af82 740 }
todotani 1:6078e430af82 741
todotani 1:6078e430af82 742 // MARK: ATT_EXECUTE_WRITE_REQUEST 0x18
todotani 1:6078e430af82 743 static uint16_t handle_execute_write_request(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 744 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 745 if (!att_write_callback) {
todotani 1:6078e430af82 746 // TODO: Use "Write Not Permitted"
todotani 1:6078e430af82 747 return setup_error_atribute_not_found(response_buffer, ATT_EXECUTE_WRITE_REQUEST, 0);
todotani 1:6078e430af82 748 }
todotani 1:6078e430af82 749 if (request_buffer[1]) {
todotani 1:6078e430af82 750 (*att_write_callback)(0, ATT_TRANSACTION_MODE_EXECUTE, 0, request_buffer + 3, request_len - 3, NULL);
todotani 1:6078e430af82 751 } else {
todotani 1:6078e430af82 752 (*att_write_callback)(0, ATT_TRANSACTION_MODE_CANCEL, 0, request_buffer + 3, request_len - 3, NULL);
todotani 1:6078e430af82 753 }
todotani 1:6078e430af82 754 response_buffer[0] = ATT_EXECUTE_WRITE_RESPONSE;
todotani 1:6078e430af82 755 return 1;
todotani 1:6078e430af82 756 }
todotani 1:6078e430af82 757
todotani 1:6078e430af82 758 // MARK: ATT_WRITE_COMMAND 0x52
todotani 1:6078e430af82 759 static void handle_write_command(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 760 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 761 if (!att_write_callback) return;
todotani 1:6078e430af82 762 uint16_t handle = READ_BT_16(request_buffer, 1);
todotani 1:6078e430af82 763 att_iterator_t it;
todotani 1:6078e430af82 764 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 765 if (!ok) return;
todotani 1:6078e430af82 766 if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) return;
todotani 1:6078e430af82 767 (*att_write_callback)(handle, ATT_TRANSACTION_MODE_NONE, 0, request_buffer + 3, request_len - 3, NULL);
todotani 1:6078e430af82 768 }
todotani 1:6078e430af82 769
todotani 1:6078e430af82 770 // MARK: ATT_SIGNED_WRITE_COMAND 0xD2
todotani 1:6078e430af82 771 static void handle_signed_write_command(uint8_t * request_buffer, uint16_t request_len,
todotani 1:6078e430af82 772 uint8_t * response_buffer, uint16_t response_buffer_size){
todotani 1:6078e430af82 773
todotani 1:6078e430af82 774 if (request_len < 15) return;
todotani 1:6078e430af82 775 if (!att_write_callback) return;
todotani 1:6078e430af82 776 uint16_t handle = READ_BT_16(request_buffer, 1);
todotani 1:6078e430af82 777 att_iterator_t it;
todotani 1:6078e430af82 778 int ok = att_find_handle(&it, handle);
todotani 1:6078e430af82 779 if (!ok) return;
todotani 1:6078e430af82 780 if ((it.flags & ATT_PROPERTY_DYNAMIC) == 0) return;
todotani 1:6078e430af82 781 (*att_write_callback)(handle, ATT_TRANSACTION_MODE_NONE, 0, request_buffer + 3, request_len - 3 - 12, (signature_t *) request_buffer + request_len - 12);
todotani 1:6078e430af82 782 }
todotani 1:6078e430af82 783
todotani 1:6078e430af82 784 // MARK: helper for ATT_HANDLE_VALUE_NOTIFICATION and ATT_HANDLE_VALUE_INDICATION
todotani 1:6078e430af82 785 static uint16_t prepare_handle_value(att_connection_t * att_connection,
todotani 1:6078e430af82 786 uint16_t handle,
todotani 1:6078e430af82 787 uint8_t *value,
todotani 1:6078e430af82 788 uint16_t value_len,
todotani 1:6078e430af82 789 uint8_t * response_buffer){
todotani 1:6078e430af82 790 bt_store_16(response_buffer, 1, handle);
todotani 1:6078e430af82 791 if (value_len > att_connection->mtu - 3){
todotani 1:6078e430af82 792 value_len = att_connection->mtu - 3;
todotani 1:6078e430af82 793 }
todotani 1:6078e430af82 794 memcpy(&response_buffer[3], value, value_len);
todotani 1:6078e430af82 795 return value_len + 3;
todotani 1:6078e430af82 796 }
todotani 1:6078e430af82 797
todotani 1:6078e430af82 798 // MARK: ATT_HANDLE_VALUE_NOTIFICATION 0x1b
todotani 1:6078e430af82 799 uint16_t att_prepare_handle_value_notification(att_connection_t * att_connection,
todotani 1:6078e430af82 800 uint16_t handle,
todotani 1:6078e430af82 801 uint8_t *value,
todotani 1:6078e430af82 802 uint16_t value_len,
todotani 1:6078e430af82 803 uint8_t * response_buffer){
todotani 1:6078e430af82 804
todotani 1:6078e430af82 805 response_buffer[0] = ATT_HANDLE_VALUE_NOTIFICATION;
todotani 1:6078e430af82 806 return prepare_handle_value(att_connection, handle, value, value_len, response_buffer);
todotani 1:6078e430af82 807 }
todotani 1:6078e430af82 808
todotani 1:6078e430af82 809 // MARK: ATT_HANDLE_VALUE_INDICATION 0x1d
todotani 1:6078e430af82 810 uint16_t att_prepare_handle_value_indication(att_connection_t * att_connection,
todotani 1:6078e430af82 811 uint16_t handle,
todotani 1:6078e430af82 812 uint8_t *value,
todotani 1:6078e430af82 813 uint16_t value_len,
todotani 1:6078e430af82 814 uint8_t * response_buffer){
todotani 1:6078e430af82 815
todotani 1:6078e430af82 816 response_buffer[0] = ATT_HANDLE_VALUE_INDICATION;
todotani 1:6078e430af82 817 return prepare_handle_value(att_connection, handle, value, value_len, response_buffer);
todotani 1:6078e430af82 818 }
todotani 1:6078e430af82 819
todotani 1:6078e430af82 820 // MARK: Dispatcher
todotani 1:6078e430af82 821 uint16_t att_handle_request(att_connection_t * att_connection,
todotani 1:6078e430af82 822 uint8_t * request_buffer,
todotani 1:6078e430af82 823 uint16_t request_len,
todotani 1:6078e430af82 824 uint8_t * response_buffer){
todotani 1:6078e430af82 825 uint16_t response_len = 0;
todotani 1:6078e430af82 826 uint16_t response_buffer_size = att_connection->mtu;
todotani 1:6078e430af82 827
todotani 1:6078e430af82 828 switch (request_buffer[0]){
todotani 1:6078e430af82 829 case ATT_EXCHANGE_MTU_REQUEST:
todotani 1:6078e430af82 830 response_len = handle_exchange_mtu_request(att_connection, request_buffer, request_len, response_buffer);
todotani 1:6078e430af82 831 break;
todotani 1:6078e430af82 832 case ATT_FIND_INFORMATION_REQUEST:
todotani 1:6078e430af82 833 response_len = handle_find_information_request(request_buffer, request_len,response_buffer, response_buffer_size);
todotani 1:6078e430af82 834 break;
todotani 1:6078e430af82 835 case ATT_FIND_BY_TYPE_VALUE_REQUEST:
todotani 1:6078e430af82 836 response_len = handle_find_by_type_value_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 837 break;
todotani 1:6078e430af82 838 case ATT_READ_BY_TYPE_REQUEST:
todotani 1:6078e430af82 839 response_len = handle_read_by_type_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 840 break;
todotani 1:6078e430af82 841 case ATT_READ_REQUEST:
todotani 1:6078e430af82 842 response_len = handle_read_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 843 break;
todotani 1:6078e430af82 844 case ATT_READ_BLOB_REQUEST:
todotani 1:6078e430af82 845 response_len = handle_read_blob_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 846 break;
todotani 1:6078e430af82 847 case ATT_READ_MULTIPLE_REQUEST:
todotani 1:6078e430af82 848 response_len = handle_read_multiple_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 849 break;
todotani 1:6078e430af82 850 case ATT_READ_BY_GROUP_TYPE_REQUEST:
todotani 1:6078e430af82 851 response_len = handle_read_by_group_type_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 852 break;
todotani 1:6078e430af82 853 case ATT_WRITE_REQUEST:
todotani 1:6078e430af82 854 response_len = handle_write_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 855 break;
todotani 1:6078e430af82 856 case ATT_PREPARE_WRITE_REQUEST:
todotani 1:6078e430af82 857 response_len = handle_prepare_write_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 858 break;
todotani 1:6078e430af82 859 case ATT_EXECUTE_WRITE_REQUEST:
todotani 1:6078e430af82 860 response_len = handle_execute_write_request(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 861 break;
todotani 1:6078e430af82 862 case ATT_WRITE_COMMAND:
todotani 1:6078e430af82 863 handle_write_command(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 864 break;
todotani 1:6078e430af82 865 case ATT_SIGNED_WRITE_COMAND:
todotani 1:6078e430af82 866 handle_signed_write_command(request_buffer, request_len, response_buffer, response_buffer_size);
todotani 1:6078e430af82 867 break;
todotani 1:6078e430af82 868 default:
todotani 6:cf06ba884429 869 log_info("Unhandled ATT Command: %02X, DATA: ", request_buffer[0]);
todotani 1:6078e430af82 870 hexdump2(&request_buffer[9], request_len-9);
todotani 1:6078e430af82 871 break;
todotani 1:6078e430af82 872 }
todotani 1:6078e430af82 873 return response_len;
todotani 1:6078e430af82 874 }
todotani 1:6078e430af82 875
todotani 1:6078e430af82 876 #if 0
todotani 1:6078e430af82 877
todotani 1:6078e430af82 878 // test profile
todotani 1:6078e430af82 879 #include "profile.h"
todotani 1:6078e430af82 880
todotani 1:6078e430af82 881 int main(){
todotani 1:6078e430af82 882 int acl_buffer_size;
todotani 1:6078e430af82 883 uint8_t acl_buffer[27];
todotani 1:6078e430af82 884 att_set_db(profile_data);
todotani 1:6078e430af82 885 att_dump_attributes();
todotani 1:6078e430af82 886
todotani 1:6078e430af82 887 uint8_t uuid_1[] = { 0x00, 0x18};
todotani 1:6078e430af82 888 acl_buffer_size = handle_find_by_type_value_request2(acl_buffer, 19, 0, 0xffff, 0x2800, 2, (uint8_t *) &uuid_1);
todotani 1:6078e430af82 889 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 890
todotani 1:6078e430af82 891 uint8_t uuid_3[] = { 0x00, 0x2a};
todotani 1:6078e430af82 892 acl_buffer_size = handle_read_by_type_request2(acl_buffer, 19, 0, 0xffff, 2, (uint8_t *) &uuid_3);
todotani 1:6078e430af82 893 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 894
todotani 1:6078e430af82 895 acl_buffer_size = handle_find_by_type_value_request2(acl_buffer, 19, 0, 0xffff, 0x2800, 2, (uint8_t *) &uuid_1);
todotani 1:6078e430af82 896 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 897
todotani 1:6078e430af82 898 uint8_t uuid_4[] = { 0x00, 0x28};
todotani 1:6078e430af82 899 acl_buffer_size = handle_read_by_group_type_request2(acl_buffer, 20, 0, 0xffff, 2, (uint8_t *) &uuid_4);
todotani 1:6078e430af82 900 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 901
todotani 1:6078e430af82 902 acl_buffer_size = handle_find_information_request2(acl_buffer, 20, 0, 0xffff);
todotani 1:6078e430af82 903 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 904 acl_buffer_size = handle_find_information_request2(acl_buffer, 20, 3, 0xffff);
todotani 1:6078e430af82 905 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 906 acl_buffer_size = handle_find_information_request2(acl_buffer, 20, 5, 0xffff);
todotani 1:6078e430af82 907 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 908
todotani 1:6078e430af82 909 acl_buffer_size = handle_read_request2(acl_buffer, 19, 0x0003);
todotani 1:6078e430af82 910 hexdump2(acl_buffer, acl_buffer_size);
todotani 1:6078e430af82 911
todotani 1:6078e430af82 912 return 0;
todotani 1:6078e430af82 913 }
todotani 1:6078e430af82 914 #endif