1 /****************************************************************************** 2 * 3 * Copyright (C) 2009-2013 Broadcom Corporation 4 * 5 * Licensed under the Apache License, Version 2.0 (the "License"); 6 * you may not use this file except in compliance with the License. 7 * You may obtain a copy of the License at: 8 * 9 * http://www.apache.org/licenses/LICENSE-2.0 10 * 11 * Unless required by applicable law or agreed to in writing, software 12 * distributed under the License is distributed on an "AS IS" BASIS, 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14 * See the License for the specific language governing permissions and 15 * limitations under the License. 16 * 17 ******************************************************************************/ 18 19 #include <hardware/bluetooth.h> 20 #include <hardware/bt_gatt.h> 21 #include <stdio.h> 22 #include <stdlib.h> 23 #include <errno.h> 24 #include <string.h> 25 26 #define LOG_TAG "bt_btif_gatt" 27 28 #include "btcore/include/bdaddr.h" 29 #include "bta_api.h" 30 #include "bta_gatt_api.h" 31 #include "bta_jv_api.h" 32 #include "btif_storage.h" 33 #include "btif_config.h" 34 35 #include "btif_common.h" 36 #include "btif_dm.h" 37 #include "btif_util.h" 38 #include "btif_gatt.h" 39 #include "btif_gatt_util.h" 40 #include "gki.h" 41 42 #if BTA_GATT_INCLUDED == TRUE 43 44 #define GATTC_READ_VALUE_TYPE_VALUE 0x0000 /* Attribute value itself */ 45 #define GATTC_READ_VALUE_TYPE_AGG_FORMAT 0x2905 /* Characteristic Aggregate Format*/ 46 47 static unsigned char BASE_UUID[16] = { 48 0xfb, 0x34, 0x9b, 0x5f, 0x80, 0x00, 0x00, 0x80, 49 0x00, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 50 }; 51 52 int uuidType(unsigned char* p_uuid) 53 { 54 int i = 0; 55 int match = 0; 56 int all_zero = 1; 57 58 for(i = 0; i != 16; ++i) 59 { 60 if (i == 12 || i == 13) 61 continue; 62 63 if (p_uuid[i] == BASE_UUID[i]) 64 ++match; 65 66 if (p_uuid[i] != 0) 67 all_zero = 0; 68 } 69 if (all_zero) 70 return 0; 71 if (match == 12) 72 return LEN_UUID_32; 73 if (match == 14) 74 return LEN_UUID_16; 75 return LEN_UUID_128; 76 } 77 78 /******************************************************************************* 79 * BTIF -> BTA conversion functions 80 *******************************************************************************/ 81 82 void btif_to_bta_uuid(tBT_UUID *p_dest, bt_uuid_t *p_src) 83 { 84 char *p_byte = (char*)p_src; 85 int i = 0; 86 87 p_dest->len = uuidType(p_src->uu); 88 89 switch (p_dest->len) 90 { 91 case LEN_UUID_16: 92 p_dest->uu.uuid16 = (p_src->uu[13] << 8) + p_src->uu[12]; 93 break; 94 95 case LEN_UUID_32: 96 p_dest->uu.uuid32 = (p_src->uu[13] << 8) + p_src->uu[12]; 97 p_dest->uu.uuid32 += (p_src->uu[15] << 24) + (p_src->uu[14] << 16); 98 break; 99 100 case LEN_UUID_128: 101 for(i = 0; i != 16; ++i) 102 p_dest->uu.uuid128[i] = p_byte[i]; 103 break; 104 105 default: 106 LOG_ERROR("%s: Unknown UUID length %d!", __FUNCTION__, p_dest->len); 107 break; 108 } 109 } 110 111 void btif_to_bta_gatt_id(tBTA_GATT_ID *p_dest, btgatt_gatt_id_t *p_src) 112 { 113 p_dest->inst_id = p_src->inst_id; 114 btif_to_bta_uuid(&p_dest->uuid, &p_src->uuid); 115 } 116 117 void btif_to_bta_srvc_id(tBTA_GATT_SRVC_ID *p_dest, btgatt_srvc_id_t *p_src) 118 { 119 p_dest->id.inst_id = p_src->id.inst_id; 120 btif_to_bta_uuid(&p_dest->id.uuid, &p_src->id.uuid); 121 p_dest->is_primary = p_src->is_primary; 122 } 123 124 void btif_to_bta_response(tBTA_GATTS_RSP *p_dest, btgatt_response_t* p_src) 125 { 126 p_dest->attr_value.auth_req = p_src->attr_value.auth_req; 127 p_dest->attr_value.handle = p_src->attr_value.handle; 128 p_dest->attr_value.len = p_src->attr_value.len; 129 p_dest->attr_value.offset = p_src->attr_value.offset; 130 memcpy(p_dest->attr_value.value, p_src->attr_value.value, GATT_MAX_ATTR_LEN); 131 } 132 133 void btif_to_bta_uuid_mask(tBTA_DM_BLE_PF_COND_MASK *p_mask, bt_uuid_t *p_src) 134 { 135 char *p_byte = (char*)p_src; 136 int i = 0; 137 138 switch (uuidType(p_src->uu)) 139 { 140 case LEN_UUID_16: 141 p_mask->uuid16_mask = (p_src->uu[13] << 8) + p_src->uu[12]; 142 break; 143 144 case LEN_UUID_32: 145 p_mask->uuid32_mask = (p_src->uu[13] << 8) + p_src->uu[12]; 146 p_mask->uuid32_mask += (p_src->uu[15] << 24) + (p_src->uu[14] << 16); 147 break; 148 149 case LEN_UUID_128: 150 for(i = 0; i != 16; ++i) 151 p_mask->uuid128_mask[i] = p_byte[i]; 152 break; 153 154 default: 155 break; 156 } 157 } 158 159 /******************************************************************************* 160 * BTA -> BTIF conversion functions 161 *******************************************************************************/ 162 163 void bta_to_btif_uuid(bt_uuid_t *p_dest, tBT_UUID *p_src) 164 { 165 int i = 0; 166 167 if (p_src->len == LEN_UUID_16 || p_src->len == LEN_UUID_32) 168 { 169 for(i=0; i != 16; ++i) 170 p_dest->uu[i] = BASE_UUID[i]; 171 } 172 173 switch (p_src->len) 174 { 175 case 0: 176 break; 177 178 case LEN_UUID_16: 179 p_dest->uu[12] = p_src->uu.uuid16 & 0xff; 180 p_dest->uu[13] = (p_src->uu.uuid16 >> 8) & 0xff; 181 break; 182 183 case LEN_UUID_32: 184 p_dest->uu[12] = p_src->uu.uuid16 & 0xff; 185 p_dest->uu[13] = (p_src->uu.uuid16 >> 8) & 0xff; 186 p_dest->uu[14] = (p_src->uu.uuid32 >> 16) & 0xff; 187 p_dest->uu[15] = (p_src->uu.uuid32 >> 24) & 0xff; 188 break; 189 190 case LEN_UUID_128: 191 for(i=0; i != 16; ++i) 192 p_dest->uu[i] = p_src->uu.uuid128[i]; 193 break; 194 195 default: 196 LOG_ERROR("%s: Unknown UUID length %d!", __FUNCTION__, p_src->len); 197 break; 198 } 199 } 200 201 202 void bta_to_btif_gatt_id(btgatt_gatt_id_t *p_dest, tBTA_GATT_ID *p_src) 203 { 204 p_dest->inst_id = p_src->inst_id; 205 bta_to_btif_uuid(&p_dest->uuid, &p_src->uuid); 206 } 207 208 void bta_to_btif_srvc_id(btgatt_srvc_id_t *p_dest, tBTA_GATT_SRVC_ID *p_src) 209 { 210 p_dest->id.inst_id = p_src->id.inst_id; 211 bta_to_btif_uuid(&p_dest->id.uuid, &p_src->id.uuid); 212 p_dest->is_primary = p_src->is_primary; 213 } 214 215 216 /******************************************************************************* 217 * Utility functions 218 *******************************************************************************/ 219 220 uint16_t get_uuid16(tBT_UUID *p_uuid) 221 { 222 if (p_uuid->len == LEN_UUID_16) 223 { 224 return p_uuid->uu.uuid16; 225 } 226 else if (p_uuid->len == LEN_UUID_128) 227 { 228 UINT16 u16; 229 UINT8 *p = &p_uuid->uu.uuid128[LEN_UUID_128 - 4]; 230 STREAM_TO_UINT16(u16, p); 231 return u16; 232 } 233 else /* p_uuid->len == LEN_UUID_32 */ 234 { 235 return(UINT16) p_uuid->uu.uuid32; 236 } 237 } 238 239 uint16_t set_read_value(btgatt_read_params_t *p_dest, tBTA_GATTC_READ *p_src) 240 { 241 uint16_t descr_type = 0; 242 uint16_t len = 0; 243 244 p_dest->status = p_src->status; 245 bta_to_btif_srvc_id(&p_dest->srvc_id, &p_src->srvc_id); 246 bta_to_btif_gatt_id(&p_dest->char_id, &p_src->char_id); 247 bta_to_btif_gatt_id(&p_dest->descr_id, &p_src->descr_type); 248 249 descr_type = get_uuid16(&p_src->descr_type.uuid); 250 251 switch (descr_type) 252 { 253 case GATT_UUID_CHAR_AGG_FORMAT: 254 /* not supported */ 255 p_dest->value_type = GATTC_READ_VALUE_TYPE_AGG_FORMAT; 256 break; 257 258 default: 259 if (( p_src->status == BTA_GATT_OK ) &&(p_src->p_value != NULL)) 260 { 261 LOG_INFO("%s unformat.len = %d ", __FUNCTION__, p_src->p_value->unformat.len); 262 p_dest->value.len = p_src->p_value->unformat.len; 263 if ( p_src->p_value->unformat.len > 0 && p_src->p_value->unformat.p_value != NULL ) 264 { 265 memcpy(p_dest->value.value, p_src->p_value->unformat.p_value, 266 p_src->p_value->unformat.len); 267 } 268 len += p_src->p_value->unformat.len; 269 } 270 else 271 { 272 p_dest->value.len = 0; 273 } 274 275 p_dest->value_type = GATTC_READ_VALUE_TYPE_VALUE; 276 break; 277 } 278 279 return len; 280 } 281 282 /******************************************************************************* 283 * Encrypted link map handling 284 *******************************************************************************/ 285 286 static void btif_gatt_set_encryption_cb (BD_ADDR bd_addr, tBTA_TRANSPORT transport, tBTA_STATUS result); 287 288 static BOOLEAN btif_gatt_is_link_encrypted (BD_ADDR bd_addr) 289 { 290 if (bd_addr == NULL) 291 return FALSE; 292 293 return BTA_JvIsEncrypted(bd_addr); 294 } 295 296 static void btif_gatt_set_encryption_cb (BD_ADDR bd_addr, tBTA_TRANSPORT transport, tBTA_STATUS result) 297 { 298 UNUSED(bd_addr); 299 UNUSED(transport); 300 301 if (result != BTA_SUCCESS && result != BTA_BUSY) 302 { 303 BTIF_TRACE_WARNING("%s() - Encryption failed (%d)", __FUNCTION__, result); 304 } 305 } 306 307 void btif_gatt_check_encrypted_link (BD_ADDR bd_addr, tBTA_GATT_TRANSPORT transport_link) 308 { 309 char buf[100]; 310 311 bt_bdaddr_t bda; 312 bdcpy(bda.address, bd_addr); 313 314 #if (!defined(BLE_DELAY_REQUEST_ENC) || (BLE_DELAY_REQUEST_ENC == FALSE)) 315 if ((btif_storage_get_ble_bonding_key(&bda, BTIF_DM_LE_KEY_PENC, 316 buf, sizeof(tBTM_LE_PENC_KEYS)) == BT_STATUS_SUCCESS) 317 && !btif_gatt_is_link_encrypted(bd_addr)) 318 { 319 BTIF_TRACE_DEBUG ("%s: transport = %d", __func__, transport_link); 320 BTA_DmSetEncryption(bd_addr,transport_link, 321 &btif_gatt_set_encryption_cb, BTM_BLE_SEC_ENCRYPT); 322 } 323 #endif 324 } 325 326 #endif 327 328 void btif_gatt_move_track_adv_data(btgatt_track_adv_info_t *p_dest, 329 btgatt_track_adv_info_t *p_src) 330 { 331 memset(p_dest, 0, sizeof(btgatt_track_adv_info_t)); 332 333 memcpy(p_dest, p_src, sizeof(btgatt_track_adv_info_t)); 334 335 if (p_src->adv_pkt_len > 0) 336 { 337 p_dest->p_adv_pkt_data = GKI_getbuf(p_src->adv_pkt_len); 338 memcpy(p_dest->p_adv_pkt_data, p_src->p_adv_pkt_data, 339 p_src->adv_pkt_len); 340 GKI_freebuf(p_src->p_adv_pkt_data); 341 } 342 343 if (p_src->scan_rsp_len > 0) 344 { 345 p_dest->p_scan_rsp_data = GKI_getbuf(p_src->scan_rsp_len); 346 memcpy(p_dest->p_scan_rsp_data, p_src->p_scan_rsp_data, 347 p_src->scan_rsp_len); 348 GKI_freebuf(p_src->p_scan_rsp_data); 349 } 350 } 351 352
