1 /****************************************************************************** 2 * 3 * Copyright (C) 2008-2014 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 /****************************************************************************** 20 * 21 * This file contains functions for BLE GAP. 22 * 23 ******************************************************************************/ 24 25 #define LOG_TAG "bt_btm_ble" 26 27 #include <string.h> 28 #include <stdio.h> 29 #include <stddef.h> 30 31 #include "bt_types.h" 32 #include "bt_utils.h" 33 #include "btm_ble_api.h" 34 #include "btm_int.h" 35 #include "btu.h" 36 #include "device/include/controller.h" 37 #include "gap_api.h" 38 #include "hcimsgs.h" 39 40 #if BLE_INCLUDED == TRUE 41 42 #include "btm_ble_int.h" 43 #include "gatt_int.h" 44 #include "gattdefs.h" 45 #include "l2c_int.h" 46 #include "osi/include/log.h" 47 48 #define BTM_BLE_NAME_SHORT 0x01 49 #define BTM_BLE_NAME_CMPL 0x02 50 51 #define BTM_BLE_FILTER_TARGET_UNKNOWN 0xff 52 #define BTM_BLE_POLICY_UNKNOWN 0xff 53 54 #define BTM_EXT_BLE_RMT_NAME_TIMEOUT_MS (30 * 1000) 55 #define MIN_ADV_LENGTH 2 56 #define BTM_VSC_CHIP_CAPABILITY_RSP_LEN_L_RELEASE 9 57 58 59 extern fixed_queue_t *btu_general_alarm_queue; 60 61 static tBTM_BLE_VSC_CB cmn_ble_vsc_cb; 62 63 #if BLE_VND_INCLUDED == TRUE 64 static tBTM_BLE_CTRL_FEATURES_CBACK *p_ctrl_le_feature_rd_cmpl_cback = NULL; 65 #endif 66 67 /******************************************************************************* 68 ** Local functions 69 *******************************************************************************/ 70 static void btm_ble_update_adv_flag(UINT8 flag); 71 static void btm_ble_process_adv_pkt_cont(BD_ADDR bda, UINT8 addr_type, UINT8 evt_type, UINT8 *p); 72 UINT8 *btm_ble_build_adv_data(tBTM_BLE_AD_MASK *p_data_mask, UINT8 **p_dst, 73 tBTM_BLE_ADV_DATA *p_data); 74 static UINT8 btm_set_conn_mode_adv_init_addr(tBTM_BLE_INQ_CB *p_cb, 75 BD_ADDR_PTR p_peer_addr_ptr, 76 tBLE_ADDR_TYPE *p_peer_addr_type, 77 tBLE_ADDR_TYPE *p_own_addr_type); 78 static void btm_ble_stop_observe(void); 79 static void btm_ble_fast_adv_timer_timeout(void *data); 80 static void btm_ble_start_slow_adv(void); 81 static void btm_ble_inquiry_timer_gap_limited_discovery_timeout(void *data); 82 static void btm_ble_inquiry_timer_timeout(void *data); 83 static void btm_ble_observer_timer_timeout(void *data); 84 85 86 #define BTM_BLE_INQ_RESULT 0x01 87 #define BTM_BLE_OBS_RESULT 0x02 88 #define BTM_BLE_SEL_CONN_RESULT 0x04 89 90 /* LE states combo bit to check */ 91 const UINT8 btm_le_state_combo_tbl[BTM_BLE_STATE_MAX][BTM_BLE_STATE_MAX][2] = 92 { 93 {/* single state support */ 94 {HCI_SUPP_LE_STATES_CONN_ADV_MASK, HCI_SUPP_LE_STATES_CONN_ADV_OFF}, /* conn_adv */ 95 {HCI_SUPP_LE_STATES_INIT_MASK, HCI_SUPP_LE_STATES_INIT_OFF}, /* init */ 96 {HCI_SUPP_LE_STATES_INIT_MASK, HCI_SUPP_LE_STATES_INIT_OFF}, /* master */ 97 {HCI_SUPP_LE_STATES_SLAVE_MASK, HCI_SUPP_LE_STATES_SLAVE_OFF}, /* slave */ 98 {0, 0}, /* todo: lo du dir adv, not covered ? */ 99 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_OFF}, /* hi duty dir adv */ 100 {HCI_SUPP_LE_STATES_NON_CONN_ADV_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_OFF}, /* non connectable adv */ 101 {HCI_SUPP_LE_STATES_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_OFF}, /* passive scan */ 102 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_OFF}, /* active scan */ 103 {HCI_SUPP_LE_STATES_SCAN_ADV_MASK, HCI_SUPP_LE_STATESSCAN_ADV_OFF} /* scanable adv */ 104 }, 105 { /* conn_adv =0 */ 106 {0, 0}, /* conn_adv */ 107 {HCI_SUPP_LE_STATES_CONN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_CONN_ADV_INIT_OFF}, /* init: 32 */ 108 {HCI_SUPP_LE_STATES_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_CONN_ADV_MASTER_OFF}, /* master: 35 */ 109 {HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_OFF}, /* slave: 38,*/ 110 {0, 0}, /* lo du dir adv */ 111 {0, 0}, /* hi duty dir adv */ 112 {0, 0}, /* non connectable adv */ 113 {HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_OFF}, /* passive scan */ 114 {HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_OFF}, /* active scan */ 115 {0, 0} /* scanable adv */ 116 }, 117 { /* init */ 118 {HCI_SUPP_LE_STATES_CONN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_CONN_ADV_INIT_OFF}, /* conn_adv: 32 */ 119 {0, 0}, /* init */ 120 {HCI_SUPP_LE_STATES_INIT_MASTER_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_OFF}, /* master 28 */ 121 {HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_OFF}, /* slave 41 */ 122 {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_OFF} ,/* lo du dir adv 34 */ 123 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_OFF}, /* hi duty dir adv 33 */ 124 {HCI_SUPP_LE_STATES_NON_CONN_INIT_MASK, HCI_SUPP_LE_STATES_NON_CONN_INIT_OFF}, /* non connectable adv */ 125 {HCI_SUPP_LE_STATES_PASS_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_INIT_OFF}, /* passive scan */ 126 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_OFF}, /* active scan */ 127 {HCI_SUPP_LE_STATES_SCAN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_INIT_OFF} /* scanable adv */ 128 129 }, 130 { /* master */ 131 {HCI_SUPP_LE_STATES_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_CONN_ADV_MASTER_OFF}, /* conn_adv: 35 */ 132 {HCI_SUPP_LE_STATES_INIT_MASTER_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_OFF}, /* init 28 */ 133 {HCI_SUPP_LE_STATES_INIT_MASTER_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_OFF}, /* master 28 */ 134 {HCI_SUPP_LE_STATES_CONN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_CONN_ADV_INIT_OFF}, /* slave: 32 */ 135 {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_OFF}, /* lo duty cycle adv 37 */ 136 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_OFF}, /* hi duty cycle adv 36 */ 137 {HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_OFF}, /* non connectable adv */ 138 {HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_OFF}, /* passive scan */ 139 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_OFF}, /* active scan */ 140 {HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_OFF} /* scanable adv */ 141 142 }, 143 { /* slave */ 144 {HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_OFF}, /* conn_adv: 38,*/ 145 {HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_OFF}, /* init 41 */ 146 {HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_MASK, HCI_SUPP_LE_STATES_INIT_MASTER_SLAVE_OFF}, /* master 41 */ 147 {HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_CONN_ADV_SLAVE_OFF}, /* slave: 38,*/ 148 {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_OFF}, /* lo duty cycle adv 40 */ 149 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_OFF}, /* hi duty cycle adv 39 */ 150 {HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_OFF}, /* non connectable adv */ 151 {HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_OFF}, /* passive scan */ 152 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_OFF}, /* active scan */ 153 {HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_OFF} /* scanable adv */ 154 155 }, 156 { /* lo duty cycle adv */ 157 {0, 0}, /* conn_adv: 38,*/ 158 {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_INIT_OFF} ,/* init 34 */ 159 {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_MASTER_OFF}, /* master 37 */ 160 {HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_LO_DUTY_DIR_ADV_SLAVE_OFF}, /* slave: 40 */ 161 {0, 0}, /* lo duty cycle adv 40 */ 162 {0, 0}, /* hi duty cycle adv 39 */ 163 {0, 0}, /* non connectable adv */ 164 {0, 0}, /* TODO: passive scan, not covered? */ 165 {0, 0}, /* TODO: active scan, not covered? */ 166 {0, 0} /* scanable adv */ 167 }, 168 { /* hi duty cycle adv */ 169 {0, 0}, /* conn_adv: 38,*/ 170 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_INIT_OFF}, /* init 33 */ 171 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_MASTER_OFF}, /* master 36 */ 172 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_SLAVE_OFF}, /* slave: 39*/ 173 {0, 0}, /* lo duty cycle adv 40 */ 174 {0, 0}, /* hi duty cycle adv 39 */ 175 {0, 0}, /* non connectable adv */ 176 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_OFF}, /* passive scan */ 177 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_OFF}, /* active scan */ 178 {0, 0} /* scanable adv */ 179 }, 180 { /* non connectable adv */ 181 {0, 0}, /* conn_adv: */ 182 {HCI_SUPP_LE_STATES_NON_CONN_INIT_MASK, HCI_SUPP_LE_STATES_NON_CONN_INIT_OFF}, /* init */ 183 {HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_MASTER_OFF}, /* master */ 184 {HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_SLAVE_OFF}, /* slave: */ 185 {0, 0}, /* lo duty cycle adv */ 186 {0, 0}, /* hi duty cycle adv */ 187 {0, 0}, /* non connectable adv */ 188 {HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_OFF}, /* passive scan */ 189 {HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_OFF}, /* active scan */ 190 {0, 0} /* scanable adv */ 191 }, 192 { /* passive scan */ 193 {HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_PASS_SCAN_OFF}, /* conn_adv: */ 194 {HCI_SUPP_LE_STATES_PASS_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_INIT_OFF}, /* init */ 195 {HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_MASTER_OFF}, /* master */ 196 {HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_PASS_SCAN_SLAVE_OFF}, /* slave: */ 197 {0, 0}, /* lo duty cycle adv */ 198 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_PASS_SCAN_OFF}, /* hi duty cycle adv */ 199 {HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_PASS_SCAN_OFF}, /* non connectable adv */ 200 {0, 0}, /* passive scan */ 201 {0, 0}, /* active scan */ 202 {HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_OFF} /* scanable adv */ 203 }, 204 { /* active scan */ 205 {HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_CONN_ADV_ACTIVE_SCAN_OFF}, /* conn_adv: */ 206 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_INIT_OFF}, /* init */ 207 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_MASTER_OFF}, /* master */ 208 {HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_MASK, HCI_SUPP_LE_STATES_ACTIVE_SCAN_SLAVE_OFF}, /* slave: */ 209 {0, 0}, /* lo duty cycle adv */ 210 {HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_HI_DUTY_DIR_ADV_ACTIVE_SCAN_OFF}, /* hi duty cycle adv */ 211 {HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_NON_CONN_ADV_ACTIVE_SCAN_OFF}, /* non connectable adv */ 212 {0, 0}, /* TODO: passive scan */ 213 {0, 0}, /* TODO: active scan */ 214 {HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_OFF} /* scanable adv */ 215 }, 216 { /* scanable adv */ 217 {0, 0}, /* conn_adv: */ 218 {HCI_SUPP_LE_STATES_SCAN_ADV_INIT_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_INIT_OFF}, /* init */ 219 {HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_MASTER_OFF}, /* master */ 220 {HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_SLAVE_OFF}, /* slave: */ 221 {0, 0}, /* lo duty cycle adv */ 222 {0, 0}, /* hi duty cycle adv */ 223 {0, 0}, /* non connectable adv */ 224 {HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_PASS_SCAN_OFF}, /* passive scan */ 225 {HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_MASK, HCI_SUPP_LE_STATES_SCAN_ADV_ACTIVE_SCAN_OFF}, /* active scan */ 226 {0, 0} /* scanable adv */ 227 } 228 229 }; 230 /* check LE combo state supported */ 231 #define BTM_LE_STATES_SUPPORTED(x, y, z) ((x)[(z)] & (y)) 232 233 /******************************************************************************* 234 ** 235 ** Function BTM_BleUpdateAdvWhitelist 236 ** 237 ** Description Add or remove device from advertising white list 238 ** 239 ** Returns void 240 ** 241 *******************************************************************************/ 242 BOOLEAN BTM_BleUpdateAdvWhitelist(BOOLEAN add_remove, BD_ADDR remote_bda) 243 { 244 UNUSED(add_remove); 245 UNUSED(remote_bda); 246 247 return FALSE; 248 } 249 250 /******************************************************************************* 251 ** 252 ** Function BTM_BleUpdateAdvFilterPolicy 253 ** 254 ** Description This function update the filter policy of advertiser. 255 ** 256 ** Parameter adv_policy: advertising filter policy 257 ** 258 ** Return void 259 *******************************************************************************/ 260 void BTM_BleUpdateAdvFilterPolicy(tBTM_BLE_AFP adv_policy) 261 { 262 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 263 tBLE_ADDR_TYPE init_addr_type = BLE_ADDR_PUBLIC; 264 BD_ADDR p_addr_ptr= {0}; 265 UINT8 adv_mode = p_cb->adv_mode; 266 267 BTM_TRACE_EVENT ("BTM_BleUpdateAdvFilterPolicy"); 268 269 if (!controller_get_interface()->supports_ble()) 270 return; 271 272 if (p_cb->afp != adv_policy) 273 { 274 p_cb->afp = adv_policy; 275 276 /* if adv active, stop and restart */ 277 btm_ble_stop_adv (); 278 279 if (p_cb->connectable_mode & BTM_BLE_CONNECTABLE) 280 p_cb->evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type, 281 &p_cb->adv_addr_type); 282 283 btsnd_hcic_ble_write_adv_params ((UINT16)(p_cb->adv_interval_min ? p_cb->adv_interval_min : 284 BTM_BLE_GAP_ADV_SLOW_INT), 285 (UINT16)(p_cb->adv_interval_max ? p_cb->adv_interval_max : 286 BTM_BLE_GAP_ADV_SLOW_INT), 287 p_cb->evt_type, 288 p_cb->adv_addr_type, 289 init_addr_type, 290 p_addr_ptr, 291 p_cb->adv_chnl_map, 292 p_cb->afp); 293 294 if (adv_mode == BTM_BLE_ADV_ENABLE) 295 btm_ble_start_adv (); 296 297 } 298 } 299 300 /******************************************************************************* 301 ** 302 ** Function btm_ble_send_extended_scan_params 303 ** 304 ** Description This function sends out the extended scan parameters command to the controller 305 ** 306 ** Parameters scan_type - Scan type 307 ** scan_int - Scan interval 308 ** scan_win - Scan window 309 ** addr_type_own - Own address type 310 ** scan_filter_policy - Scan filter policy 311 ** 312 ** Returns TRUE or FALSE 313 ** 314 *******************************************************************************/ 315 BOOLEAN btm_ble_send_extended_scan_params(UINT8 scan_type, UINT32 scan_int, 316 UINT32 scan_win, UINT8 addr_type_own, 317 UINT8 scan_filter_policy) 318 { 319 UINT8 scan_param[HCIC_PARAM_SIZE_BLE_WRITE_EXTENDED_SCAN_PARAM]; 320 UINT8 *pp_scan = scan_param; 321 322 memset(scan_param, 0, HCIC_PARAM_SIZE_BLE_WRITE_EXTENDED_SCAN_PARAM); 323 324 UINT8_TO_STREAM(pp_scan, scan_type); 325 UINT32_TO_STREAM(pp_scan, scan_int); 326 UINT32_TO_STREAM(pp_scan, scan_win); 327 UINT8_TO_STREAM(pp_scan, addr_type_own); 328 UINT8_TO_STREAM(pp_scan, scan_filter_policy); 329 330 BTM_TRACE_DEBUG("%s, %d, %d", __func__, scan_int, scan_win); 331 if ((BTM_VendorSpecificCommand(HCI_BLE_EXTENDED_SCAN_PARAMS_OCF, 332 HCIC_PARAM_SIZE_BLE_WRITE_EXTENDED_SCAN_PARAM, scan_param, NULL)) != BTM_SUCCESS) 333 { 334 BTM_TRACE_ERROR("%s error sending extended scan parameters", __func__); 335 return FALSE; 336 } 337 return TRUE; 338 } 339 340 /******************************************************************************* 341 ** 342 ** Function BTM_BleObserve 343 ** 344 ** Description This procedure keep the device listening for advertising 345 ** events from a broadcast device. 346 ** 347 ** Parameters start: start or stop observe. 348 ** white_list: use white list in observer mode or not. 349 ** 350 ** Returns void 351 ** 352 *******************************************************************************/ 353 tBTM_STATUS BTM_BleObserve(BOOLEAN start, UINT8 duration, 354 tBTM_INQ_RESULTS_CB *p_results_cb, tBTM_CMPL_CB *p_cmpl_cb) 355 { 356 tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var; 357 tBTM_STATUS status = BTM_WRONG_MODE; 358 359 UINT32 scan_interval = !p_inq->scan_interval ? BTM_BLE_GAP_DISC_SCAN_INT : p_inq->scan_interval; 360 UINT32 scan_window = !p_inq->scan_window ? BTM_BLE_GAP_DISC_SCAN_WIN : p_inq->scan_window; 361 362 BTM_TRACE_EVENT ("%s : scan_type:%d, %d, %d", __func__, btm_cb.btm_inq_vars.scan_type, 363 p_inq->scan_interval, p_inq->scan_window); 364 365 if (!controller_get_interface()->supports_ble()) 366 return BTM_ILLEGAL_VALUE; 367 368 if (start) 369 { 370 /* shared inquiry database, do not allow observe if any inquiry is active */ 371 if (BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity)) 372 { 373 BTM_TRACE_ERROR("%s Observe Already Active", __func__); 374 return status; 375 } 376 377 btm_cb.ble_ctr_cb.p_obs_results_cb = p_results_cb; 378 btm_cb.ble_ctr_cb.p_obs_cmpl_cb = p_cmpl_cb; 379 status = BTM_CMD_STARTED; 380 381 /* scan is not started */ 382 if (!BTM_BLE_IS_SCAN_ACTIVE(btm_cb.ble_ctr_cb.scan_activity)) 383 { 384 /* allow config of scan type */ 385 p_inq->scan_type = (p_inq->scan_type == BTM_BLE_SCAN_MODE_NONE) ? 386 BTM_BLE_SCAN_MODE_ACTI: p_inq->scan_type; 387 /* assume observe always not using white list */ 388 #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) 389 /* enable resolving list */ 390 btm_ble_enable_resolving_list_for_platform(BTM_BLE_RL_SCAN); 391 #endif 392 393 if (cmn_ble_vsc_cb.extended_scan_support == 0) 394 { 395 btsnd_hcic_ble_set_scan_params(p_inq->scan_type, (UINT16)scan_interval, 396 (UINT16)scan_window, 397 btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type, 398 BTM_BLE_DEFAULT_SFP); 399 } 400 else 401 { 402 btm_ble_send_extended_scan_params(p_inq->scan_type, scan_interval, scan_window, 403 btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type, 404 BTM_BLE_DEFAULT_SFP); 405 } 406 407 p_inq->scan_duplicate_filter = BTM_BLE_DUPLICATE_DISABLE; 408 status = btm_ble_start_scan(); 409 } 410 411 if (status == BTM_CMD_STARTED) 412 { 413 btm_cb.ble_ctr_cb.scan_activity |= BTM_LE_OBSERVE_ACTIVE; 414 if (duration != 0) { 415 /* start observer timer */ 416 period_ms_t duration_ms = duration * 1000; 417 alarm_set_on_queue(btm_cb.ble_ctr_cb.observer_timer, 418 duration_ms, btm_ble_observer_timer_timeout, 419 NULL, btu_general_alarm_queue); 420 } 421 } 422 } 423 else if (BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity)) 424 { 425 status = BTM_CMD_STARTED; 426 btm_ble_stop_observe(); 427 } 428 else 429 { 430 BTM_TRACE_ERROR("%s Observe not active", __func__); 431 } 432 433 return status; 434 435 } 436 437 /******************************************************************************* 438 ** 439 ** Function BTM_BleBroadcast 440 ** 441 ** Description This function is to start or stop broadcasting. 442 ** 443 ** Parameters start: start or stop broadcasting. 444 ** 445 ** Returns status. 446 ** 447 *******************************************************************************/ 448 tBTM_STATUS BTM_BleBroadcast(BOOLEAN start) 449 { 450 tBTM_STATUS status = BTM_NO_RESOURCES; 451 tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb; 452 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 453 UINT8 evt_type = p_cb->scan_rsp ? BTM_BLE_DISCOVER_EVT: BTM_BLE_NON_CONNECT_EVT; 454 455 if (!controller_get_interface()->supports_ble()) 456 return BTM_ILLEGAL_VALUE; 457 458 #ifdef BTM_BLE_PC_ADV_TEST_MODE 459 if (BTM_BLE_PC_ADV_TEST_MODE) 460 { 461 evt_type = p_cb->scan_rsp ? BTM_BLE_CONNECT_EVT: BTM_BLE_NON_CONNECT_EVT; 462 } 463 #endif 464 465 if (start && p_cb->adv_mode == BTM_BLE_ADV_DISABLE) 466 { 467 /* update adv params */ 468 if (!btsnd_hcic_ble_write_adv_params ((UINT16)(p_cb->adv_interval_min ? p_cb->adv_interval_min : 469 BTM_BLE_GAP_ADV_INT), 470 (UINT16)(p_cb->adv_interval_max ? p_cb->adv_interval_max : 471 BTM_BLE_GAP_ADV_INT), 472 evt_type, 473 p_addr_cb->own_addr_type, 474 p_cb->direct_bda.type, 475 p_cb->direct_bda.bda, 476 p_cb->adv_chnl_map, 477 p_cb->afp)) 478 479 status = BTM_NO_RESOURCES; 480 else 481 p_cb->evt_type = evt_type; 482 483 status = btm_ble_start_adv (); 484 } 485 else if (!start) 486 { 487 status = btm_ble_stop_adv(); 488 #if BLE_PRIVACY_SPT == TRUE 489 btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE); 490 #endif 491 } 492 else 493 { 494 status = BTM_WRONG_MODE; 495 BTM_TRACE_ERROR("Can not %s Broadcast, device %s in Broadcast mode", 496 (start ? "Start" : "Stop"), (start ? "already" :"not")); 497 } 498 return status; 499 } 500 501 #if BLE_VND_INCLUDED == TRUE 502 /******************************************************************************* 503 ** 504 ** Function btm_vsc_brcm_features_complete 505 ** 506 ** Description Command Complete callback for HCI_BLE_VENDOR_CAP_OCF 507 ** 508 ** Returns void 509 ** 510 *******************************************************************************/ 511 static void btm_ble_vendor_capability_vsc_cmpl_cback (tBTM_VSC_CMPL *p_vcs_cplt_params) 512 { 513 UINT8 status = 0xFF; 514 UINT8 *p; 515 516 BTM_TRACE_DEBUG("%s", __func__); 517 518 /* Check status of command complete event */ 519 if ((p_vcs_cplt_params->opcode == HCI_BLE_VENDOR_CAP_OCF) && 520 (p_vcs_cplt_params->param_len > 0)) 521 { 522 p = p_vcs_cplt_params->p_param_buf; 523 STREAM_TO_UINT8(status, p); 524 } 525 526 if (status == HCI_SUCCESS) 527 { 528 STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.adv_inst_max, p); 529 STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.rpa_offloading, p); 530 STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.tot_scan_results_strg, p); 531 STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.max_irk_list_sz, p); 532 STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.filter_support, p); 533 STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.max_filter, p); 534 STREAM_TO_UINT8(btm_cb.cmn_ble_vsc_cb.energy_support, p); 535 536 if (p_vcs_cplt_params->param_len > BTM_VSC_CHIP_CAPABILITY_RSP_LEN_L_RELEASE) 537 { 538 STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.version_supported, p); 539 } 540 else 541 { 542 btm_cb.cmn_ble_vsc_cb.version_supported = BTM_VSC_CHIP_CAPABILITY_L_VERSION; 543 } 544 545 if (btm_cb.cmn_ble_vsc_cb.version_supported >= BTM_VSC_CHIP_CAPABILITY_M_VERSION) 546 { 547 STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.total_trackable_advertisers, p); 548 STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.extended_scan_support, p); 549 STREAM_TO_UINT16(btm_cb.cmn_ble_vsc_cb.debug_logging_supported, p); 550 } 551 btm_cb.cmn_ble_vsc_cb.values_read = TRUE; 552 } 553 554 BTM_TRACE_DEBUG("%s: stat=%d, irk=%d, ADV ins:%d, rpa=%d, ener=%d, ext_scan=%d", 555 __func__, status, btm_cb.cmn_ble_vsc_cb.max_irk_list_sz, 556 btm_cb.cmn_ble_vsc_cb.adv_inst_max, btm_cb.cmn_ble_vsc_cb.rpa_offloading, 557 btm_cb.cmn_ble_vsc_cb.energy_support, btm_cb.cmn_ble_vsc_cb.extended_scan_support); 558 559 if (BTM_BleMaxMultiAdvInstanceCount() > 0) 560 btm_ble_multi_adv_init(); 561 562 if (btm_cb.cmn_ble_vsc_cb.max_filter > 0) 563 btm_ble_adv_filter_init(); 564 565 #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) 566 /* VS capability included and non-4.2 device */ 567 if (btm_cb.cmn_ble_vsc_cb.max_irk_list_sz > 0 && 568 controller_get_interface()->get_ble_resolving_list_max_size() == 0) 569 btm_ble_resolving_list_init(btm_cb.cmn_ble_vsc_cb.max_irk_list_sz); 570 #endif /* (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) */ 571 572 if (btm_cb.cmn_ble_vsc_cb.tot_scan_results_strg > 0) 573 btm_ble_batchscan_init(); 574 575 if (p_ctrl_le_feature_rd_cmpl_cback != NULL) 576 p_ctrl_le_feature_rd_cmpl_cback(status); 577 } 578 #endif /* BLE_VND_INCLUDED == TRUE */ 579 580 /******************************************************************************* 581 ** 582 ** Function BTM_BleGetVendorCapabilities 583 ** 584 ** Description This function reads local LE features 585 ** 586 ** Parameters p_cmn_vsc_cb : Locala LE capability structure 587 ** 588 ** Returns void 589 ** 590 *******************************************************************************/ 591 extern void BTM_BleGetVendorCapabilities(tBTM_BLE_VSC_CB *p_cmn_vsc_cb) 592 { 593 BTM_TRACE_DEBUG("BTM_BleGetVendorCapabilities"); 594 595 if (NULL != p_cmn_vsc_cb) 596 { 597 *p_cmn_vsc_cb = btm_cb.cmn_ble_vsc_cb; 598 } 599 } 600 601 /****************************************************************************** 602 ** 603 ** Function BTM_BleReadControllerFeatures 604 ** 605 ** Description Reads BLE specific controller features 606 ** 607 ** Parameters: tBTM_BLE_CTRL_FEATURES_CBACK : Callback to notify when features are read 608 ** 609 ** Returns void 610 ** 611 *******************************************************************************/ 612 extern void BTM_BleReadControllerFeatures(tBTM_BLE_CTRL_FEATURES_CBACK *p_vsc_cback) 613 { 614 if (TRUE == btm_cb.cmn_ble_vsc_cb.values_read) 615 return; 616 617 #if BLE_VND_INCLUDED == TRUE 618 BTM_TRACE_DEBUG("BTM_BleReadControllerFeatures"); 619 620 p_ctrl_le_feature_rd_cmpl_cback = p_vsc_cback; 621 if ( BTM_VendorSpecificCommand (HCI_BLE_VENDOR_CAP_OCF, 622 0, 623 NULL, 624 btm_ble_vendor_capability_vsc_cmpl_cback) 625 != BTM_CMD_STARTED) 626 { 627 BTM_TRACE_ERROR("LE Get_Vendor Capabilities Command Failed."); 628 } 629 #else 630 UNUSED(p_vsc_cback); 631 #endif 632 return ; 633 } 634 635 /******************************************************************************* 636 ** 637 ** Function BTM_BleEnableMixedPrivacyMode 638 ** 639 ** Description This function is called to enabled Mixed mode if privacy 1.2 640 ** is applicable in controller. 641 ** 642 ** Parameters mixed_on: mixed mode to be used or not. 643 ** 644 ** Returns void 645 ** 646 *******************************************************************************/ 647 void BTM_BleEnableMixedPrivacyMode(BOOLEAN mixed_on) 648 { 649 650 #if BLE_PRIVACY_SPT == TRUE 651 btm_cb.ble_ctr_cb.mixed_mode = mixed_on; 652 653 /* TODO: send VSC to enabled mixed mode */ 654 #endif 655 } 656 657 /******************************************************************************* 658 ** 659 ** Function BTM_BleConfigPrivacy 660 ** 661 ** Description This function is called to enable or disable the privacy in 662 ** LE channel of the local device. 663 ** 664 ** Parameters privacy_mode: privacy mode on or off. 665 ** 666 ** Returns BOOLEAN privacy mode set success; otherwise failed. 667 ** 668 *******************************************************************************/ 669 BOOLEAN BTM_BleConfigPrivacy(BOOLEAN privacy_mode) 670 { 671 #if BLE_PRIVACY_SPT == TRUE 672 tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb; 673 674 BTM_TRACE_EVENT ("%s", __func__); 675 676 /* if LE is not supported, return error */ 677 if (!controller_get_interface()->supports_ble()) 678 return FALSE; 679 680 uint8_t addr_resolution = 0; 681 if(!privacy_mode)/* if privacy disabled, always use public address */ 682 { 683 p_cb->addr_mgnt_cb.own_addr_type = BLE_ADDR_PUBLIC; 684 p_cb->privacy_mode = BTM_PRIVACY_NONE; 685 } 686 else /* privacy is turned on*/ 687 { 688 /* always set host random address, used when privacy 1.1 or priavcy 1.2 is disabled */ 689 p_cb->addr_mgnt_cb.own_addr_type = BLE_ADDR_RANDOM; 690 btm_gen_resolvable_private_addr((void *)btm_gen_resolve_paddr_low); 691 692 if (BTM_BleMaxMultiAdvInstanceCount() > 0) 693 btm_ble_multi_adv_enb_privacy(privacy_mode); 694 695 /* 4.2 controller only allow privacy 1.2 or mixed mode, resolvable private address in controller */ 696 if (controller_get_interface()->supports_ble_privacy()) 697 { 698 addr_resolution = 1; 699 /* check vendor specific capability */ 700 p_cb->privacy_mode = btm_cb.ble_ctr_cb.mixed_mode ? BTM_PRIVACY_MIXED : BTM_PRIVACY_1_2; 701 } 702 else /* 4.1/4.0 controller */ 703 p_cb->privacy_mode = BTM_PRIVACY_1_1; 704 } 705 706 GAP_BleAttrDBUpdate (GATT_UUID_GAP_CENTRAL_ADDR_RESOL, (tGAP_BLE_ATTR_VALUE *)&addr_resolution); 707 708 return TRUE; 709 #else 710 return FALSE; 711 #endif 712 } 713 714 /******************************************************************************* 715 ** 716 ** Function BTM_BleMaxMultiAdvInstanceCount 717 ** 718 ** Description Returns max number of multi adv instances supported by controller 719 ** 720 ** Returns Max multi adv instance count 721 ** 722 *******************************************************************************/ 723 extern UINT8 BTM_BleMaxMultiAdvInstanceCount(void) 724 { 725 return btm_cb.cmn_ble_vsc_cb.adv_inst_max < BTM_BLE_MULTI_ADV_MAX ? 726 btm_cb.cmn_ble_vsc_cb.adv_inst_max : BTM_BLE_MULTI_ADV_MAX; 727 } 728 729 #if BLE_PRIVACY_SPT == TRUE 730 /******************************************************************************* 731 ** 732 ** Function btm_ble_resolve_random_addr_on_adv 733 ** 734 ** Description resolve random address complete callback. 735 ** 736 ** Returns void 737 ** 738 *******************************************************************************/ 739 static void btm_ble_resolve_random_addr_on_adv(void * p_rec, void *p) 740 { 741 tBTM_SEC_DEV_REC *match_rec = (tBTM_SEC_DEV_REC *) p_rec; 742 UINT8 addr_type = BLE_ADDR_RANDOM; 743 BD_ADDR bda; 744 UINT8 *pp = (UINT8 *)p + 1; 745 UINT8 evt_type; 746 747 BTM_TRACE_EVENT ("btm_ble_resolve_random_addr_on_adv "); 748 749 STREAM_TO_UINT8 (evt_type, pp); 750 STREAM_TO_UINT8 (addr_type, pp); 751 STREAM_TO_BDADDR (bda, pp); 752 753 if (match_rec) 754 { 755 BTM_TRACE_DEBUG("Random match"); 756 match_rec->ble.active_addr_type = BTM_BLE_ADDR_RRA; 757 memcpy(match_rec->ble.cur_rand_addr, bda, BD_ADDR_LEN); 758 759 if (btm_ble_init_pseudo_addr(match_rec, bda)) 760 { 761 memcpy(bda, match_rec->bd_addr, BD_ADDR_LEN); 762 } else { 763 // Assign the original address to be the current report address 764 memcpy(bda, match_rec->ble.pseudo_addr, BD_ADDR_LEN); 765 } 766 } 767 768 btm_ble_process_adv_pkt_cont(bda, addr_type, evt_type, pp); 769 770 return; 771 } 772 #endif 773 774 /******************************************************************************* 775 ** 776 ** Function BTM_BleLocalPrivacyEnabled 777 ** 778 ** Description Checks if local device supports private address 779 ** 780 ** Returns Return TRUE if local privacy is enabled else FALSE 781 ** 782 *******************************************************************************/ 783 BOOLEAN BTM_BleLocalPrivacyEnabled(void) 784 { 785 #if BLE_PRIVACY_SPT == TRUE 786 return (btm_cb.ble_ctr_cb.privacy_mode != BTM_PRIVACY_NONE); 787 #else 788 return false; 789 #endif 790 } 791 792 /******************************************************************************* 793 ** 794 ** Function BTM_BleSetBgConnType 795 ** 796 ** Description This function is called to set BLE connectable mode for a 797 ** peripheral device. 798 ** 799 ** Parameters bg_conn_type: it can be auto connection, or selective connection. 800 ** p_select_cback: callback function when selective connection procedure 801 ** is being used. 802 ** 803 ** Returns void 804 ** 805 *******************************************************************************/ 806 BOOLEAN BTM_BleSetBgConnType(tBTM_BLE_CONN_TYPE bg_conn_type, 807 tBTM_BLE_SEL_CBACK *p_select_cback) 808 { 809 BOOLEAN started = TRUE; 810 811 BTM_TRACE_EVENT ("BTM_BleSetBgConnType "); 812 if (!controller_get_interface()->supports_ble()) 813 return FALSE; 814 815 if (btm_cb.ble_ctr_cb.bg_conn_type != bg_conn_type) 816 { 817 switch (bg_conn_type) 818 { 819 case BTM_BLE_CONN_AUTO: 820 btm_ble_start_auto_conn(TRUE); 821 break; 822 823 case BTM_BLE_CONN_SELECTIVE: 824 if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_AUTO) 825 { 826 btm_ble_start_auto_conn(FALSE); 827 } 828 btm_ble_start_select_conn(TRUE, p_select_cback); 829 break; 830 831 case BTM_BLE_CONN_NONE: 832 if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_AUTO) 833 { 834 btm_ble_start_auto_conn(FALSE); 835 } 836 else if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE) 837 { 838 btm_ble_start_select_conn(FALSE, NULL); 839 } 840 started = TRUE; 841 break; 842 843 default: 844 BTM_TRACE_ERROR("invalid bg connection type : %d ", bg_conn_type); 845 started = FALSE; 846 break; 847 } 848 849 if (started) 850 btm_cb.ble_ctr_cb.bg_conn_type = bg_conn_type; 851 } 852 return started; 853 } 854 855 /******************************************************************************* 856 ** 857 ** Function BTM_BleClearBgConnDev 858 ** 859 ** Description This function is called to clear the whitelist, 860 ** end any pending whitelist connections, 861 * and reset the local bg device list. 862 ** 863 ** Parameters void 864 ** 865 ** Returns void 866 ** 867 *******************************************************************************/ 868 void BTM_BleClearBgConnDev(void) 869 { 870 btm_ble_start_auto_conn(FALSE); 871 btm_ble_clear_white_list(); 872 gatt_reset_bgdev_list(); 873 } 874 875 /******************************************************************************* 876 ** 877 ** Function BTM_BleUpdateBgConnDev 878 ** 879 ** Description This function is called to add or remove a device into/from 880 ** background connection procedure. The background connection 881 * procedure is decided by the background connection type, it can be 882 * auto connection, or selective connection. 883 ** 884 ** Parameters add_remove: TRUE to add; FALSE to remove. 885 ** remote_bda: device address to add/remove. 886 ** 887 ** Returns void 888 ** 889 *******************************************************************************/ 890 BOOLEAN BTM_BleUpdateBgConnDev(BOOLEAN add_remove, BD_ADDR remote_bda) 891 { 892 BTM_TRACE_EVENT("%s() add=%d", __func__, add_remove); 893 return btm_update_dev_to_white_list(add_remove, remote_bda); 894 } 895 896 /******************************************************************************* 897 ** 898 ** Function BTM_BleSetConnectableMode 899 ** 900 ** Description This function is called to set BLE connectable mode for a 901 ** peripheral device. 902 ** 903 ** Parameters conn_mode: directed connectable mode, or non-directed.It can 904 ** be BTM_BLE_CONNECT_EVT, BTM_BLE_CONNECT_DIR_EVT or 905 ** BTM_BLE_CONNECT_LO_DUTY_DIR_EVT 906 ** 907 ** Returns BTM_ILLEGAL_VALUE if controller does not support BLE. 908 ** BTM_SUCCESS is status set successfully; otherwise failure. 909 ** 910 *******************************************************************************/ 911 tBTM_STATUS BTM_BleSetConnectableMode(tBTM_BLE_CONN_MODE connectable_mode) 912 { 913 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 914 915 BTM_TRACE_EVENT ("%s connectable_mode = %d ", __func__, connectable_mode); 916 if (!controller_get_interface()->supports_ble()) 917 return BTM_ILLEGAL_VALUE; 918 919 p_cb->directed_conn = connectable_mode; 920 return btm_ble_set_connectability( p_cb->connectable_mode); 921 } 922 923 #if BLE_PRIVACY_SPT == TRUE 924 static bool is_resolving_list_bit_set(void *data, void *context) 925 { 926 tBTM_SEC_DEV_REC *p_dev_rec = data; 927 928 if ((p_dev_rec->ble.in_controller_list & BTM_RESOLVING_LIST_BIT) != 0) 929 return false; 930 931 return true; 932 } 933 #endif 934 935 /******************************************************************************* 936 ** 937 ** Function btm_set_conn_mode_adv_init_addr 938 ** 939 ** Description set initator address type and local address type based on adv 940 ** mode. 941 ** 942 ** 943 *******************************************************************************/ 944 static UINT8 btm_set_conn_mode_adv_init_addr(tBTM_BLE_INQ_CB *p_cb, 945 BD_ADDR_PTR p_peer_addr_ptr, 946 tBLE_ADDR_TYPE *p_peer_addr_type, 947 tBLE_ADDR_TYPE *p_own_addr_type) 948 { 949 UINT8 evt_type; 950 #if BLE_PRIVACY_SPT == TRUE 951 tBTM_SEC_DEV_REC *p_dev_rec; 952 #endif 953 954 evt_type = (p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE) ? \ 955 ((p_cb->scan_rsp) ? BTM_BLE_DISCOVER_EVT : BTM_BLE_NON_CONNECT_EVT )\ 956 : BTM_BLE_CONNECT_EVT; 957 958 if (evt_type == BTM_BLE_CONNECT_EVT) 959 { 960 evt_type = p_cb->directed_conn; 961 962 if ( p_cb->directed_conn == BTM_BLE_CONNECT_DIR_EVT || 963 p_cb->directed_conn == BTM_BLE_CONNECT_LO_DUTY_DIR_EVT) 964 { 965 966 #if BLE_PRIVACY_SPT == TRUE 967 /* for privacy 1.2, convert peer address as static, own address set as ID addr */ 968 if (btm_cb.ble_ctr_cb.privacy_mode == BTM_PRIVACY_1_2 || 969 btm_cb.ble_ctr_cb.privacy_mode == BTM_PRIVACY_MIXED) 970 { 971 /* only do so for bonded device */ 972 if ((p_dev_rec = btm_find_or_alloc_dev (p_cb->direct_bda.bda)) != NULL && 973 p_dev_rec->ble.in_controller_list & BTM_RESOLVING_LIST_BIT) 974 { 975 btm_ble_enable_resolving_list(BTM_BLE_RL_ADV); 976 memcpy(p_peer_addr_ptr, p_dev_rec->ble.static_addr, BD_ADDR_LEN); 977 *p_peer_addr_type = p_dev_rec->ble.static_addr_type; 978 *p_own_addr_type = BLE_ADDR_RANDOM_ID; 979 return evt_type; 980 } 981 /* otherwise fall though as normal directed adv */ 982 else 983 { 984 btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE); 985 } 986 } 987 #endif 988 /* direct adv mode does not have privacy, if privacy is not enabled */ 989 *p_peer_addr_type = p_cb->direct_bda.type; 990 memcpy(p_peer_addr_ptr, p_cb->direct_bda.bda, BD_ADDR_LEN); 991 return evt_type; 992 } 993 } 994 995 /* undirect adv mode or non-connectable mode*/ 996 #if BLE_PRIVACY_SPT == TRUE 997 /* when privacy 1.2 privacy only mode is used, or mixed mode */ 998 if ((btm_cb.ble_ctr_cb.privacy_mode == BTM_PRIVACY_1_2 && p_cb->afp != AP_SCAN_CONN_ALL) || 999 btm_cb.ble_ctr_cb.privacy_mode == BTM_PRIVACY_MIXED) 1000 { 1001 list_node_t *n = list_foreach(btm_cb.sec_dev_rec, is_resolving_list_bit_set, NULL); 1002 if (n) { 1003 /* if enhanced privacy is required, set Identity address and matching IRK peer */ 1004 tBTM_SEC_DEV_REC *p_dev_rec = list_node(n); 1005 memcpy(p_peer_addr_ptr, p_dev_rec->ble.static_addr, BD_ADDR_LEN); 1006 *p_peer_addr_type = p_dev_rec->ble.static_addr_type; 1007 1008 *p_own_addr_type = BLE_ADDR_RANDOM_ID; 1009 } else { 1010 /* resolving list is empty, not enabled */ 1011 *p_own_addr_type = BLE_ADDR_RANDOM; 1012 } 1013 } 1014 /* privacy 1.1, or privacy 1.2, general discoverable/connectable mode, disable privacy in */ 1015 /* controller fall back to host based privacy */ 1016 else if (btm_cb.ble_ctr_cb.privacy_mode != BTM_PRIVACY_NONE) 1017 { 1018 *p_own_addr_type = BLE_ADDR_RANDOM; 1019 } 1020 #endif 1021 1022 /* if no privacy,do not set any peer address,*/ 1023 /* local address type go by global privacy setting */ 1024 return evt_type; 1025 } 1026 1027 /******************************************************************************* 1028 ** 1029 ** Function BTM_BleSetAdvParams 1030 ** 1031 ** Description This function is called to set advertising parameters. 1032 ** 1033 ** Parameters adv_int_min: minimum advertising interval 1034 ** adv_int_max: maximum advertising interval 1035 ** p_dir_bda: connectable direct initiator's LE device address 1036 ** chnl_map: advertising channel map. 1037 ** 1038 ** Returns void 1039 ** 1040 *******************************************************************************/ 1041 tBTM_STATUS BTM_BleSetAdvParams(UINT16 adv_int_min, UINT16 adv_int_max, 1042 tBLE_BD_ADDR *p_dir_bda, 1043 tBTM_BLE_ADV_CHNL_MAP chnl_map) 1044 { 1045 tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb; 1046 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 1047 tBTM_STATUS status = BTM_SUCCESS; 1048 BD_ADDR p_addr_ptr = {0}; 1049 tBLE_ADDR_TYPE init_addr_type = BLE_ADDR_PUBLIC; 1050 tBLE_ADDR_TYPE own_addr_type = p_addr_cb->own_addr_type; 1051 UINT8 adv_mode = p_cb->adv_mode; 1052 1053 BTM_TRACE_EVENT ("BTM_BleSetAdvParams"); 1054 1055 if (!controller_get_interface()->supports_ble()) 1056 return BTM_ILLEGAL_VALUE; 1057 1058 if (!BTM_BLE_ISVALID_PARAM(adv_int_min, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX) || 1059 !BTM_BLE_ISVALID_PARAM(adv_int_max, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX)) 1060 { 1061 return BTM_ILLEGAL_VALUE; 1062 } 1063 1064 p_cb->adv_interval_min = adv_int_min; 1065 p_cb->adv_interval_max = adv_int_max; 1066 p_cb->adv_chnl_map = chnl_map; 1067 1068 if (p_dir_bda) 1069 { 1070 memcpy(&p_cb->direct_bda, p_dir_bda, sizeof(tBLE_BD_ADDR)); 1071 } 1072 1073 BTM_TRACE_EVENT ("update params for an active adv"); 1074 1075 btm_ble_stop_adv(); 1076 1077 p_cb->evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type, 1078 &own_addr_type); 1079 1080 /* update adv params */ 1081 btsnd_hcic_ble_write_adv_params (p_cb->adv_interval_min, 1082 p_cb->adv_interval_max, 1083 p_cb->evt_type, 1084 own_addr_type, 1085 init_addr_type, 1086 p_addr_ptr, 1087 p_cb->adv_chnl_map, 1088 p_cb->afp); 1089 1090 if (adv_mode == BTM_BLE_ADV_ENABLE) 1091 btm_ble_start_adv(); 1092 1093 return status; 1094 } 1095 1096 /******************************************************************************* 1097 ** 1098 ** Function BTM_BleReadAdvParams 1099 ** 1100 ** Description This function is called to set advertising parameters. 1101 ** 1102 ** Parameters adv_int_min: minimum advertising interval 1103 ** adv_int_max: maximum advertising interval 1104 ** p_dir_bda: connectable direct initiator's LE device address 1105 ** chnl_map: advertising channel map. 1106 ** 1107 ** Returns void 1108 ** 1109 *******************************************************************************/ 1110 void BTM_BleReadAdvParams (UINT16 *adv_int_min, UINT16 *adv_int_max, 1111 tBLE_BD_ADDR *p_dir_bda, tBTM_BLE_ADV_CHNL_MAP *p_chnl_map) 1112 { 1113 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 1114 1115 BTM_TRACE_EVENT ("BTM_BleReadAdvParams "); 1116 if (!controller_get_interface()->supports_ble()) 1117 return ; 1118 1119 *adv_int_min = p_cb->adv_interval_min; 1120 *adv_int_max = p_cb->adv_interval_max; 1121 *p_chnl_map = p_cb->adv_chnl_map; 1122 1123 if (p_dir_bda != NULL) 1124 { 1125 memcpy(p_dir_bda, &p_cb->direct_bda, sizeof(tBLE_BD_ADDR)); 1126 } 1127 } 1128 1129 /******************************************************************************* 1130 ** 1131 ** Function BTM_BleSetScanParams 1132 ** 1133 ** Description This function is called to set scan parameters. 1134 ** 1135 ** Parameters client_if - Client IF 1136 ** scan_interval - Scan interval 1137 ** scan_window - Scan window 1138 ** scan_mode - Scan mode 1139 ** scan_setup_status_cback - Scan param setup status callback 1140 ** 1141 ** Returns void 1142 ** 1143 *******************************************************************************/ 1144 void BTM_BleSetScanParams(tGATT_IF client_if, UINT32 scan_interval, UINT32 scan_window, 1145 tBLE_SCAN_MODE scan_mode, 1146 tBLE_SCAN_PARAM_SETUP_CBACK scan_setup_status_cback) 1147 { 1148 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 1149 UINT32 max_scan_interval; 1150 UINT32 max_scan_window; 1151 1152 BTM_TRACE_EVENT ("%s", __func__); 1153 if (!controller_get_interface()->supports_ble()) 1154 return; 1155 1156 /* If not supporting extended scan support, use the older range for checking */ 1157 if (btm_cb.cmn_ble_vsc_cb.extended_scan_support == 0) 1158 { 1159 max_scan_interval = BTM_BLE_SCAN_INT_MAX; 1160 max_scan_window = BTM_BLE_SCAN_WIN_MAX; 1161 } 1162 else 1163 { 1164 /* If supporting extended scan support, use the new extended range for checking */ 1165 max_scan_interval = BTM_BLE_EXT_SCAN_INT_MAX; 1166 max_scan_window = BTM_BLE_EXT_SCAN_WIN_MAX; 1167 } 1168 1169 if (BTM_BLE_ISVALID_PARAM(scan_interval, BTM_BLE_SCAN_INT_MIN, max_scan_interval) && 1170 BTM_BLE_ISVALID_PARAM(scan_window, BTM_BLE_SCAN_WIN_MIN, max_scan_window) && 1171 (scan_mode == BTM_BLE_SCAN_MODE_ACTI || scan_mode == BTM_BLE_SCAN_MODE_PASS)) 1172 { 1173 p_cb->scan_type = scan_mode; 1174 p_cb->scan_interval = scan_interval; 1175 p_cb->scan_window = scan_window; 1176 1177 if (scan_setup_status_cback != NULL) 1178 scan_setup_status_cback(client_if, BTM_SUCCESS); 1179 } 1180 else 1181 { 1182 if (scan_setup_status_cback != NULL) 1183 scan_setup_status_cback(client_if, BTM_ILLEGAL_VALUE); 1184 1185 BTM_TRACE_ERROR("Illegal params: scan_interval = %d scan_window = %d", 1186 scan_interval, scan_window); 1187 } 1188 1189 } 1190 1191 /******************************************************************************* 1192 ** 1193 ** Function BTM_BleWriteScanRsp 1194 ** 1195 ** Description This function is called to write LE scan response. 1196 ** 1197 ** Parameters: p_scan_rsp: scan response information. 1198 ** 1199 ** Returns void 1200 ** 1201 *******************************************************************************/ 1202 tBTM_STATUS BTM_BleWriteScanRsp(tBTM_BLE_AD_MASK data_mask, tBTM_BLE_ADV_DATA *p_data) 1203 { 1204 tBTM_STATUS status = BTM_NO_RESOURCES; 1205 UINT8 rsp_data[BTM_BLE_AD_DATA_LEN], 1206 *p = rsp_data; 1207 1208 BTM_TRACE_EVENT ("%s: data_mask:%08x", __func__, data_mask); 1209 if (!controller_get_interface()->supports_ble()) 1210 return BTM_ILLEGAL_VALUE; 1211 1212 memset(rsp_data, 0, BTM_BLE_AD_DATA_LEN); 1213 btm_ble_build_adv_data(&data_mask, &p, p_data); 1214 1215 if (btsnd_hcic_ble_set_scan_rsp_data((UINT8)(p - rsp_data), rsp_data)) 1216 { 1217 status = BTM_SUCCESS; 1218 1219 if (data_mask != 0) 1220 btm_cb.ble_ctr_cb.inq_var.scan_rsp = TRUE; 1221 else 1222 btm_cb.ble_ctr_cb.inq_var.scan_rsp = FALSE; 1223 } 1224 else 1225 status = BTM_ILLEGAL_VALUE; 1226 1227 return status; 1228 } 1229 1230 /******************************************************************************* 1231 ** 1232 ** Function BTM_BleWriteAdvData 1233 ** 1234 ** Description This function is called to write advertising data. 1235 ** 1236 ** Parameters: None. 1237 ** 1238 ** Returns void 1239 ** 1240 *******************************************************************************/ 1241 tBTM_STATUS BTM_BleWriteAdvData(tBTM_BLE_AD_MASK data_mask, tBTM_BLE_ADV_DATA *p_data) 1242 { 1243 tBTM_BLE_LOCAL_ADV_DATA *p_cb_data = &btm_cb.ble_ctr_cb.inq_var.adv_data; 1244 UINT8 *p; 1245 tBTM_BLE_AD_MASK mask = data_mask; 1246 1247 BTM_TRACE_EVENT ("BTM_BleWriteAdvData "); 1248 1249 if (!controller_get_interface()->supports_ble()) 1250 return BTM_ILLEGAL_VALUE; 1251 1252 memset(p_cb_data, 0, sizeof(tBTM_BLE_LOCAL_ADV_DATA)); 1253 p = p_cb_data->ad_data; 1254 p_cb_data->data_mask = data_mask; 1255 1256 p_cb_data->p_flags = btm_ble_build_adv_data(&mask, &p, p_data); 1257 1258 p_cb_data->p_pad = p; 1259 1260 if (mask != 0) 1261 { 1262 BTM_TRACE_ERROR("Partial data write into ADV"); 1263 } 1264 1265 p_cb_data->data_mask &= ~mask; 1266 1267 if (btsnd_hcic_ble_set_adv_data((UINT8)(p_cb_data->p_pad - p_cb_data->ad_data), 1268 p_cb_data->ad_data)) 1269 return BTM_SUCCESS; 1270 else 1271 return BTM_NO_RESOURCES; 1272 1273 } 1274 1275 /******************************************************************************* 1276 ** 1277 ** Function BTM_CheckAdvData 1278 ** 1279 ** Description This function is called to get ADV data for a specific type. 1280 ** 1281 ** Parameters p_adv - pointer of ADV data 1282 ** type - finding ADV data type 1283 ** p_length - return the length of ADV data not including type 1284 ** 1285 ** Returns pointer of ADV data 1286 ** 1287 *******************************************************************************/ 1288 UINT8 *BTM_CheckAdvData( UINT8 *p_adv, UINT8 type, UINT8 *p_length) 1289 { 1290 UINT8 *p = p_adv; 1291 UINT8 length; 1292 UINT8 adv_type; 1293 BTM_TRACE_API("%s: type=0x%02x", __func__, type); 1294 1295 STREAM_TO_UINT8(length, p); 1296 1297 while ( length && (p - p_adv <= BTM_BLE_CACHE_ADV_DATA_MAX)) 1298 { 1299 STREAM_TO_UINT8(adv_type, p); 1300 1301 if ( adv_type == type ) 1302 { 1303 /* length doesn't include itself */ 1304 *p_length = length - 1; /* minus the length of type */ 1305 return p; 1306 } 1307 p += length - 1; /* skip the length of data */ 1308 STREAM_TO_UINT8(length, p); 1309 } 1310 1311 *p_length = 0; 1312 return NULL; 1313 } 1314 1315 /******************************************************************************* 1316 ** 1317 ** Function BTM__BLEReadDiscoverability 1318 ** 1319 ** Description This function is called to read the current LE discoverability 1320 ** mode of the device. 1321 ** 1322 ** Returns BTM_BLE_NON_DISCOVERABLE ,BTM_BLE_LIMITED_DISCOVERABLE or 1323 ** BTM_BLE_GENRAL_DISCOVERABLE 1324 ** 1325 *******************************************************************************/ 1326 UINT16 BTM_BleReadDiscoverability() 1327 { 1328 BTM_TRACE_API("%s", __FUNCTION__); 1329 1330 return (btm_cb.ble_ctr_cb.inq_var.discoverable_mode); 1331 } 1332 1333 /******************************************************************************* 1334 ** 1335 ** Function BTM__BLEReadConnectability 1336 ** 1337 ** Description This function is called to read the current LE connectibility 1338 ** mode of the device. 1339 ** 1340 ** Returns BTM_BLE_NON_CONNECTABLE or BTM_BLE_CONNECTABLE 1341 ** 1342 *******************************************************************************/ 1343 UINT16 BTM_BleReadConnectability() 1344 { 1345 BTM_TRACE_API ("%s", __FUNCTION__); 1346 1347 return (btm_cb.ble_ctr_cb.inq_var.connectable_mode); 1348 } 1349 1350 /******************************************************************************* 1351 ** 1352 ** Function btm_ble_build_adv_data 1353 ** 1354 ** Description This function is called build the adv data and rsp data. 1355 *******************************************************************************/ 1356 UINT8 *btm_ble_build_adv_data(tBTM_BLE_AD_MASK *p_data_mask, UINT8 **p_dst, 1357 tBTM_BLE_ADV_DATA *p_data) 1358 { 1359 UINT32 data_mask = *p_data_mask; 1360 UINT8 *p = *p_dst, 1361 *p_flag = NULL; 1362 UINT16 len = BTM_BLE_AD_DATA_LEN, cp_len = 0; 1363 UINT8 i = 0; 1364 tBTM_BLE_PROP_ELEM *p_elem; 1365 1366 BTM_TRACE_EVENT (" btm_ble_build_adv_data"); 1367 1368 /* build the adv data structure and build the data string */ 1369 if (data_mask) 1370 { 1371 /* flags */ 1372 if (data_mask & BTM_BLE_AD_BIT_FLAGS) 1373 { 1374 *p++ = MIN_ADV_LENGTH; 1375 *p++ = BTM_BLE_AD_TYPE_FLAG; 1376 p_flag = p; 1377 if (p_data) 1378 *p++ = p_data->flag; 1379 else 1380 *p++ = 0; 1381 1382 len -= 3; 1383 1384 data_mask &= ~BTM_BLE_AD_BIT_FLAGS; 1385 } 1386 /* appearance data */ 1387 if (len > 3 && data_mask & BTM_BLE_AD_BIT_APPEARANCE) 1388 { 1389 *p++ = 3; /* length */ 1390 *p++ = BTM_BLE_AD_TYPE_APPEARANCE; 1391 UINT16_TO_STREAM(p, p_data->appearance); 1392 len -= 4; 1393 1394 data_mask &= ~BTM_BLE_AD_BIT_APPEARANCE; 1395 } 1396 /* device name */ 1397 #if BTM_MAX_LOC_BD_NAME_LEN > 0 1398 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_DEV_NAME) 1399 { 1400 if (strlen(btm_cb.cfg.bd_name) > (UINT16)(len - MIN_ADV_LENGTH)) 1401 { 1402 *p++ = len - MIN_ADV_LENGTH + 1; 1403 *p++ = BTM_BLE_AD_TYPE_NAME_SHORT; 1404 ARRAY_TO_STREAM(p, btm_cb.cfg.bd_name, len - MIN_ADV_LENGTH); 1405 } 1406 else 1407 { 1408 cp_len = (UINT16)strlen(btm_cb.cfg.bd_name); 1409 *p++ = cp_len + 1; 1410 *p++ = BTM_BLE_AD_TYPE_NAME_CMPL; 1411 ARRAY_TO_STREAM(p, btm_cb.cfg.bd_name, cp_len); 1412 } 1413 len -= (cp_len + MIN_ADV_LENGTH); 1414 data_mask &= ~BTM_BLE_AD_BIT_DEV_NAME; 1415 } 1416 #endif 1417 /* manufacturer data */ 1418 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_MANU && 1419 p_data && p_data->manu.len != 0) 1420 { 1421 if (p_data->manu.len > (len - MIN_ADV_LENGTH)) 1422 cp_len = len - MIN_ADV_LENGTH; 1423 else 1424 cp_len = p_data->manu.len; 1425 1426 *p++ = cp_len + 1; 1427 *p++ = BTM_BLE_AD_TYPE_MANU; 1428 ARRAY_TO_STREAM(p, p_data->manu.val, cp_len); 1429 1430 len -= (cp_len + MIN_ADV_LENGTH); 1431 data_mask &= ~BTM_BLE_AD_BIT_MANU; 1432 } 1433 /* TX power */ 1434 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_TX_PWR) 1435 { 1436 *p++ = MIN_ADV_LENGTH; 1437 *p++ = BTM_BLE_AD_TYPE_TX_PWR; 1438 if (p_data->tx_power > BTM_BLE_ADV_TX_POWER_MAX) 1439 p_data->tx_power = BTM_BLE_ADV_TX_POWER_MAX; 1440 *p++ = btm_ble_map_adv_tx_power(p_data->tx_power); 1441 len -= 3; 1442 data_mask &= ~BTM_BLE_AD_BIT_TX_PWR; 1443 } 1444 /* 16 bits services */ 1445 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE && 1446 p_data && p_data->services.num_service != 0) 1447 { 1448 if (p_data->services.num_service * LEN_UUID_16 > (len - MIN_ADV_LENGTH)) 1449 { 1450 cp_len = (len - MIN_ADV_LENGTH)/LEN_UUID_16; 1451 *p ++ = 1 + cp_len * LEN_UUID_16; 1452 *p++ = BTM_BLE_AD_TYPE_16SRV_PART; 1453 } 1454 else 1455 { 1456 cp_len = p_data->services.num_service; 1457 *p++ = 1 + cp_len * LEN_UUID_16; 1458 *p++ = BTM_BLE_AD_TYPE_16SRV_CMPL; 1459 } 1460 for (i = 0; i < cp_len; i ++) 1461 { 1462 UINT16_TO_STREAM(p, *(p_data->services.uuid + i)); 1463 } 1464 1465 len -= (cp_len * MIN_ADV_LENGTH + MIN_ADV_LENGTH); 1466 data_mask &= ~BTM_BLE_AD_BIT_SERVICE; 1467 } 1468 /* 32 bits service uuid */ 1469 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE_32 && 1470 p_data && p_data->service_32b.num_service != 0) 1471 { 1472 if ((p_data->service_32b.num_service * LEN_UUID_32) > (len - MIN_ADV_LENGTH)) 1473 { 1474 cp_len = (len - MIN_ADV_LENGTH)/LEN_UUID_32; 1475 *p ++ = 1 + cp_len * LEN_UUID_32; 1476 *p++ = BTM_BLE_AD_TYPE_32SRV_PART; 1477 } 1478 else 1479 { 1480 cp_len = p_data->service_32b.num_service; 1481 *p++ = 1 + cp_len * LEN_UUID_32; 1482 *p++ = BTM_BLE_AD_TYPE_32SRV_CMPL; 1483 } 1484 for (i = 0; i < cp_len; i ++) 1485 { 1486 UINT32_TO_STREAM(p, *(p_data->service_32b.uuid + i)); 1487 } 1488 1489 len -= (cp_len * LEN_UUID_32 + MIN_ADV_LENGTH); 1490 data_mask &= ~BTM_BLE_AD_BIT_SERVICE_32; 1491 } 1492 /* 128 bits services */ 1493 if (len >= (MAX_UUID_SIZE + 2) && data_mask & BTM_BLE_AD_BIT_SERVICE_128 && 1494 p_data && p_data->services_128b.num_service) 1495 { 1496 *p ++ = 1 + MAX_UUID_SIZE; 1497 if (!p_data->services_128b.list_cmpl) 1498 *p++ = BTM_BLE_AD_TYPE_128SRV_PART; 1499 else 1500 *p++ = BTM_BLE_AD_TYPE_128SRV_CMPL; 1501 1502 ARRAY_TO_STREAM(p, p_data->services_128b.uuid128, MAX_UUID_SIZE); 1503 1504 len -= (MAX_UUID_SIZE + MIN_ADV_LENGTH); 1505 data_mask &= ~BTM_BLE_AD_BIT_SERVICE_128; 1506 } 1507 /* 32 bits Service Solicitation UUIDs */ 1508 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE_32SOL && 1509 p_data->sol_service_32b.num_service != 0) 1510 { 1511 if ((p_data->sol_service_32b.num_service * LEN_UUID_32) > (len - MIN_ADV_LENGTH)) 1512 { 1513 cp_len = (len - MIN_ADV_LENGTH)/LEN_UUID_32; 1514 *p ++ = 1 + cp_len * LEN_UUID_32; 1515 } 1516 else 1517 { 1518 cp_len = p_data->sol_service_32b.num_service; 1519 *p++ = 1 + cp_len * LEN_UUID_32; 1520 } 1521 1522 *p++ = BTM_BLE_AD_TYPE_32SOL_SRV_UUID; 1523 for (i = 0; i < cp_len; i ++) 1524 { 1525 UINT32_TO_STREAM(p, *(p_data->sol_service_32b.uuid + i)); 1526 } 1527 1528 len -= (cp_len * LEN_UUID_32 + MIN_ADV_LENGTH); 1529 data_mask &= ~BTM_BLE_AD_BIT_SERVICE_32SOL; 1530 } 1531 /* 128 bits Solicitation services UUID */ 1532 if (len >= (MAX_UUID_SIZE + MIN_ADV_LENGTH) && data_mask & BTM_BLE_AD_BIT_SERVICE_128SOL && 1533 p_data && p_data->sol_service_128b.num_service) 1534 { 1535 *p ++ = 1 + MAX_UUID_SIZE; 1536 *p++ = BTM_BLE_AD_TYPE_128SOL_SRV_UUID; 1537 ARRAY_TO_STREAM(p, p_data->sol_service_128b.uuid128, MAX_UUID_SIZE); 1538 len -= (MAX_UUID_SIZE + MIN_ADV_LENGTH); 1539 data_mask &= ~BTM_BLE_AD_BIT_SERVICE_128SOL; 1540 } 1541 /* 16bits/32bits/128bits Service Data */ 1542 if (len > MIN_ADV_LENGTH && data_mask & BTM_BLE_AD_BIT_SERVICE_DATA && 1543 p_data && p_data->service_data.len != 0) 1544 { 1545 if (len > (p_data->service_data.service_uuid.len + MIN_ADV_LENGTH)) 1546 { 1547 if (p_data->service_data.len > (len - MIN_ADV_LENGTH)) 1548 cp_len = len - MIN_ADV_LENGTH- p_data->service_data.service_uuid.len; 1549 else 1550 cp_len = p_data->service_data.len; 1551 1552 *p++ = cp_len + 1 + p_data->service_data.service_uuid.len; 1553 if (p_data->service_data.service_uuid.len == LEN_UUID_16) 1554 { 1555 *p++ = BTM_BLE_AD_TYPE_SERVICE_DATA; 1556 UINT16_TO_STREAM(p, p_data->service_data.service_uuid.uu.uuid16); 1557 } 1558 else if (p_data->service_data.service_uuid.len == LEN_UUID_32) 1559 { 1560 *p++ = BTM_BLE_AD_TYPE_32SERVICE_DATA; 1561 UINT32_TO_STREAM(p, p_data->service_data.service_uuid.uu.uuid32); 1562 } 1563 else 1564 { 1565 *p++ = BTM_BLE_AD_TYPE_128SERVICE_DATA; 1566 ARRAY_TO_STREAM(p, p_data->service_data.service_uuid.uu.uuid128, 1567 LEN_UUID_128); 1568 } 1569 1570 ARRAY_TO_STREAM(p, p_data->service_data.val, cp_len); 1571 1572 len -= (cp_len + MIN_ADV_LENGTH + p_data->service_data.service_uuid.len); 1573 data_mask &= ~BTM_BLE_AD_BIT_SERVICE_DATA; 1574 } 1575 else 1576 { 1577 BTM_TRACE_WARNING("service data does not fit"); 1578 } 1579 } 1580 1581 if (len >= 6 && data_mask & BTM_BLE_AD_BIT_INT_RANGE && 1582 p_data) 1583 { 1584 *p++ = 5; 1585 *p++ = BTM_BLE_AD_TYPE_INT_RANGE; 1586 UINT16_TO_STREAM(p, p_data->int_range.low); 1587 UINT16_TO_STREAM(p, p_data->int_range.hi); 1588 len -= 6; 1589 data_mask &= ~BTM_BLE_AD_BIT_INT_RANGE; 1590 } 1591 if (data_mask & BTM_BLE_AD_BIT_PROPRIETARY && p_data) 1592 { 1593 for (i = 0; i < p_data->proprietary.num_elem; ++i) 1594 { 1595 p_elem = &p_data->proprietary.elem[i]; 1596 1597 if (len >= (MIN_ADV_LENGTH + p_elem->len))/* len byte(1) + ATTR type(1) + Uuid len(2) 1598 + value length */ 1599 { 1600 *p ++ = p_elem->len + 1; /* Uuid len + value length */ 1601 *p ++ = p_elem->adv_type; 1602 ARRAY_TO_STREAM(p, p_elem->val, p_elem->len); 1603 1604 len -= (MIN_ADV_LENGTH + p_elem->len); 1605 } 1606 else 1607 { 1608 BTM_TRACE_WARNING("data exceed max adv packet length"); 1609 break; 1610 } 1611 } 1612 data_mask &= ~BTM_BLE_AD_BIT_PROPRIETARY; 1613 } 1614 } 1615 1616 *p_data_mask = data_mask; 1617 *p_dst = p; 1618 1619 return p_flag; 1620 } 1621 /******************************************************************************* 1622 ** 1623 ** Function btm_ble_select_adv_interval 1624 ** 1625 ** Description select adv interval based on device mode 1626 ** 1627 ** Returns void 1628 ** 1629 *******************************************************************************/ 1630 void btm_ble_select_adv_interval(tBTM_BLE_INQ_CB *p_cb, UINT8 evt_type, UINT16 *p_adv_int_min, UINT16 *p_adv_int_max) 1631 { 1632 if (p_cb->adv_interval_min && p_cb->adv_interval_max) 1633 { 1634 *p_adv_int_min = p_cb->adv_interval_min; 1635 *p_adv_int_max = p_cb->adv_interval_max; 1636 } 1637 else 1638 { 1639 switch (evt_type) 1640 { 1641 case BTM_BLE_CONNECT_EVT: 1642 case BTM_BLE_CONNECT_LO_DUTY_DIR_EVT: 1643 *p_adv_int_min = *p_adv_int_max = BTM_BLE_GAP_ADV_FAST_INT_1; 1644 break; 1645 1646 case BTM_BLE_NON_CONNECT_EVT: 1647 case BTM_BLE_DISCOVER_EVT: 1648 *p_adv_int_min = *p_adv_int_max = BTM_BLE_GAP_ADV_FAST_INT_2; 1649 break; 1650 1651 /* connectable directed event */ 1652 case BTM_BLE_CONNECT_DIR_EVT: 1653 *p_adv_int_min = BTM_BLE_GAP_ADV_DIR_MIN_INT; 1654 *p_adv_int_max = BTM_BLE_GAP_ADV_DIR_MAX_INT; 1655 break; 1656 1657 default: 1658 *p_adv_int_min = *p_adv_int_max = BTM_BLE_GAP_ADV_SLOW_INT; 1659 break; 1660 } 1661 } 1662 return; 1663 } 1664 1665 /******************************************************************************* 1666 ** 1667 ** Function btm_ble_update_dmt_flag_bits 1668 ** 1669 ** Description Obtain updated adv flag value based on connect and discoverability mode. 1670 ** Also, setup DMT support value in the flag based on whether the controller 1671 ** supports both LE and BR/EDR. 1672 ** 1673 ** Parameters: flag_value (Input / Output) - flag value 1674 ** connect_mode (Input) - Connect mode value 1675 ** disc_mode (Input) - discoverability mode 1676 ** 1677 ** Returns void 1678 ** 1679 *******************************************************************************/ 1680 void btm_ble_update_dmt_flag_bits(UINT8 *adv_flag_value, const UINT16 connect_mode, 1681 const UINT16 disc_mode) 1682 { 1683 /* BR/EDR non-discoverable , non-connectable */ 1684 if ((disc_mode & BTM_DISCOVERABLE_MASK) == 0 && 1685 (connect_mode & BTM_CONNECTABLE_MASK) == 0) 1686 *adv_flag_value |= BTM_BLE_BREDR_NOT_SPT; 1687 else 1688 *adv_flag_value &= ~BTM_BLE_BREDR_NOT_SPT; 1689 1690 /* if local controller support, mark both controller and host support in flag */ 1691 if (controller_get_interface()->supports_simultaneous_le_bredr()) 1692 *adv_flag_value |= (BTM_BLE_DMT_CONTROLLER_SPT|BTM_BLE_DMT_HOST_SPT); 1693 else 1694 *adv_flag_value &= ~(BTM_BLE_DMT_CONTROLLER_SPT|BTM_BLE_DMT_HOST_SPT); 1695 } 1696 1697 /******************************************************************************* 1698 ** 1699 ** Function btm_ble_set_adv_flag 1700 ** 1701 ** Description Set adv flag in adv data. 1702 ** 1703 ** Parameters: connect_mode (Input)- Connect mode value 1704 ** disc_mode (Input) - discoverability mode 1705 ** 1706 ** Returns void 1707 ** 1708 *******************************************************************************/ 1709 void btm_ble_set_adv_flag(UINT16 connect_mode, UINT16 disc_mode) 1710 { 1711 UINT8 flag = 0, old_flag = 0; 1712 tBTM_BLE_LOCAL_ADV_DATA *p_adv_data = &btm_cb.ble_ctr_cb.inq_var.adv_data; 1713 1714 if (p_adv_data->p_flags != NULL) 1715 flag = old_flag = *(p_adv_data->p_flags); 1716 1717 btm_ble_update_dmt_flag_bits (&flag, connect_mode, disc_mode); 1718 1719 LOG_DEBUG(LOG_TAG, "disc_mode %04x", disc_mode); 1720 /* update discoverable flag */ 1721 if (disc_mode & BTM_BLE_LIMITED_DISCOVERABLE) 1722 { 1723 flag &= ~BTM_BLE_GEN_DISC_FLAG; 1724 flag |= BTM_BLE_LIMIT_DISC_FLAG; 1725 } 1726 else if (disc_mode & BTM_BLE_GENERAL_DISCOVERABLE) 1727 { 1728 flag |= BTM_BLE_GEN_DISC_FLAG; 1729 flag &= ~BTM_BLE_LIMIT_DISC_FLAG; 1730 } 1731 else /* remove all discoverable flags */ 1732 { 1733 flag &= ~(BTM_BLE_LIMIT_DISC_FLAG|BTM_BLE_GEN_DISC_FLAG); 1734 } 1735 1736 if (flag != old_flag) 1737 { 1738 btm_ble_update_adv_flag(flag); 1739 } 1740 } 1741 /******************************************************************************* 1742 ** 1743 ** Function btm_ble_set_discoverability 1744 ** 1745 ** Description This function is called to set BLE discoverable mode. 1746 ** 1747 ** Parameters: combined_mode: discoverability mode. 1748 ** 1749 ** Returns BTM_SUCCESS is status set successfully; otherwise failure. 1750 ** 1751 *******************************************************************************/ 1752 tBTM_STATUS btm_ble_set_discoverability(UINT16 combined_mode) 1753 { 1754 tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb; 1755 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 1756 UINT16 mode = (combined_mode & BTM_BLE_DISCOVERABLE_MASK); 1757 UINT8 new_mode = BTM_BLE_ADV_ENABLE; 1758 UINT8 evt_type; 1759 tBTM_STATUS status = BTM_SUCCESS; 1760 BD_ADDR p_addr_ptr= {0}; 1761 tBLE_ADDR_TYPE init_addr_type = BLE_ADDR_PUBLIC, 1762 own_addr_type = p_addr_cb->own_addr_type; 1763 UINT16 adv_int_min, adv_int_max; 1764 1765 BTM_TRACE_EVENT ("%s mode=0x%0x combined_mode=0x%x", __FUNCTION__, mode, combined_mode); 1766 1767 /*** Check mode parameter ***/ 1768 if (mode > BTM_BLE_MAX_DISCOVERABLE) 1769 return(BTM_ILLEGAL_VALUE); 1770 1771 p_cb->discoverable_mode = mode; 1772 1773 evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type, &own_addr_type); 1774 1775 if (p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE && mode == BTM_BLE_NON_DISCOVERABLE) 1776 new_mode = BTM_BLE_ADV_DISABLE; 1777 1778 btm_ble_select_adv_interval(p_cb, evt_type, &adv_int_min, &adv_int_max); 1779 1780 alarm_cancel(p_cb->fast_adv_timer); 1781 1782 /* update adv params if start advertising */ 1783 BTM_TRACE_EVENT ("evt_type=0x%x p-cb->evt_type=0x%x ", evt_type, p_cb->evt_type); 1784 1785 if (new_mode == BTM_BLE_ADV_ENABLE) 1786 { 1787 btm_ble_set_adv_flag (btm_cb.btm_inq_vars.connectable_mode, combined_mode); 1788 1789 if (evt_type != p_cb->evt_type ||p_cb->adv_addr_type != own_addr_type 1790 || !p_cb->fast_adv_on) 1791 { 1792 btm_ble_stop_adv(); 1793 1794 /* update adv params */ 1795 if (!btsnd_hcic_ble_write_adv_params (adv_int_min, 1796 adv_int_max, 1797 evt_type, 1798 own_addr_type, 1799 init_addr_type, 1800 p_addr_ptr, 1801 p_cb->adv_chnl_map, 1802 p_cb->afp)) 1803 { 1804 status = BTM_NO_RESOURCES; 1805 } 1806 else 1807 { 1808 p_cb->evt_type = evt_type; 1809 p_cb->adv_addr_type = own_addr_type; 1810 } 1811 } 1812 } 1813 1814 if (status == BTM_SUCCESS && p_cb->adv_mode != new_mode) 1815 { 1816 if (new_mode == BTM_BLE_ADV_ENABLE) 1817 status = btm_ble_start_adv(); 1818 else 1819 status = btm_ble_stop_adv(); 1820 } 1821 1822 if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE) 1823 { 1824 p_cb->fast_adv_on = TRUE; 1825 /* start initial GAP mode adv timer */ 1826 alarm_set_on_queue(p_cb->fast_adv_timer, 1827 BTM_BLE_GAP_FAST_ADV_TIMEOUT_MS, 1828 btm_ble_fast_adv_timer_timeout, NULL, 1829 btu_general_alarm_queue); 1830 } 1831 else 1832 { 1833 #if BLE_PRIVACY_SPT == TRUE 1834 btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE); 1835 #endif 1836 } 1837 1838 /* set up stop advertising timer */ 1839 if (status == BTM_SUCCESS && mode == BTM_BLE_LIMITED_DISCOVERABLE) 1840 { 1841 BTM_TRACE_EVENT("start timer for limited disc mode duration=%d ms", 1842 BTM_BLE_GAP_LIM_TIMEOUT_MS); 1843 /* start Tgap(lim_timeout) */ 1844 alarm_set_on_queue(p_cb->inquiry_timer, BTM_BLE_GAP_LIM_TIMEOUT_MS, 1845 btm_ble_inquiry_timer_gap_limited_discovery_timeout, 1846 NULL, btu_general_alarm_queue); 1847 } 1848 return status; 1849 } 1850 1851 /******************************************************************************* 1852 ** 1853 ** Function btm_ble_set_connectability 1854 ** 1855 ** Description This function is called to set BLE connectability mode. 1856 ** 1857 ** Parameters: combined_mode: connectability mode. 1858 ** 1859 ** Returns BTM_SUCCESS is status set successfully; otherwise failure. 1860 ** 1861 *******************************************************************************/ 1862 tBTM_STATUS btm_ble_set_connectability(UINT16 combined_mode) 1863 { 1864 tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb; 1865 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 1866 UINT16 mode = (combined_mode & BTM_BLE_CONNECTABLE_MASK); 1867 UINT8 new_mode = BTM_BLE_ADV_ENABLE; 1868 UINT8 evt_type; 1869 tBTM_STATUS status = BTM_SUCCESS; 1870 BD_ADDR p_addr_ptr = {0}; 1871 tBLE_ADDR_TYPE peer_addr_type = BLE_ADDR_PUBLIC, 1872 own_addr_type = p_addr_cb->own_addr_type; 1873 UINT16 adv_int_min, adv_int_max; 1874 1875 BTM_TRACE_EVENT ("%s mode=0x%0x combined_mode=0x%x", __FUNCTION__, mode, combined_mode); 1876 1877 /*** Check mode parameter ***/ 1878 if (mode > BTM_BLE_MAX_CONNECTABLE) 1879 return(BTM_ILLEGAL_VALUE); 1880 1881 p_cb->connectable_mode = mode; 1882 1883 evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &peer_addr_type, &own_addr_type); 1884 1885 if (mode == BTM_BLE_NON_CONNECTABLE && p_cb->discoverable_mode == BTM_BLE_NON_DISCOVERABLE) 1886 new_mode = BTM_BLE_ADV_DISABLE; 1887 1888 btm_ble_select_adv_interval(p_cb, evt_type, &adv_int_min, &adv_int_max); 1889 1890 alarm_cancel(p_cb->fast_adv_timer); 1891 /* update adv params if needed */ 1892 if (new_mode == BTM_BLE_ADV_ENABLE) 1893 { 1894 btm_ble_set_adv_flag (combined_mode, btm_cb.btm_inq_vars.discoverable_mode); 1895 if (p_cb->evt_type != evt_type || p_cb->adv_addr_type != p_addr_cb->own_addr_type 1896 || !p_cb->fast_adv_on) 1897 { 1898 btm_ble_stop_adv(); 1899 1900 if (!btsnd_hcic_ble_write_adv_params (adv_int_min, 1901 adv_int_max, 1902 evt_type, 1903 own_addr_type, 1904 peer_addr_type, 1905 p_addr_ptr, 1906 p_cb->adv_chnl_map, 1907 p_cb->afp)) 1908 { 1909 status = BTM_NO_RESOURCES; 1910 } 1911 else 1912 { 1913 p_cb->evt_type = evt_type; 1914 p_cb->adv_addr_type = own_addr_type; 1915 } 1916 } 1917 } 1918 1919 /* update advertising mode */ 1920 if (status == BTM_SUCCESS && new_mode != p_cb->adv_mode) 1921 { 1922 if (new_mode == BTM_BLE_ADV_ENABLE) 1923 status = btm_ble_start_adv(); 1924 else 1925 status = btm_ble_stop_adv(); 1926 } 1927 1928 if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE) 1929 { 1930 p_cb->fast_adv_on = TRUE; 1931 /* start initial GAP mode adv timer */ 1932 alarm_set_on_queue(p_cb->fast_adv_timer, 1933 BTM_BLE_GAP_FAST_ADV_TIMEOUT_MS, 1934 btm_ble_fast_adv_timer_timeout, NULL, 1935 btu_general_alarm_queue); 1936 } 1937 else 1938 { 1939 #if BLE_PRIVACY_SPT == TRUE 1940 btm_ble_disable_resolving_list(BTM_BLE_RL_ADV, TRUE); 1941 #endif 1942 } 1943 return status; 1944 } 1945 1946 /******************************************************************************* 1947 ** 1948 ** Function btm_ble_start_inquiry 1949 ** 1950 ** Description This function is called to start BLE inquiry procedure. 1951 ** If the duration is zero, the periodic inquiry mode is cancelled. 1952 ** 1953 ** Parameters: mode - GENERAL or LIMITED inquiry 1954 ** p_inq_params - pointer to the BLE inquiry parameter. 1955 ** p_results_cb - callback returning pointer to results (tBTM_INQ_RESULTS) 1956 ** p_cmpl_cb - callback indicating the end of an inquiry 1957 ** 1958 ** 1959 ** 1960 ** Returns BTM_CMD_STARTED if successfully started 1961 ** BTM_NO_RESOURCES if could not allocate a message buffer 1962 ** BTM_BUSY - if an inquiry is already active 1963 ** 1964 *******************************************************************************/ 1965 tBTM_STATUS btm_ble_start_inquiry (UINT8 mode, UINT8 duration) 1966 { 1967 tBTM_STATUS status = BTM_CMD_STARTED; 1968 tBTM_BLE_CB *p_ble_cb = &btm_cb.ble_ctr_cb; 1969 tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars; 1970 1971 BTM_TRACE_DEBUG("btm_ble_start_inquiry: mode = %02x inq_active = 0x%02x", mode, btm_cb.btm_inq_vars.inq_active); 1972 1973 /* if selective connection is active, or inquiry is already active, reject it */ 1974 if (BTM_BLE_IS_INQ_ACTIVE(p_ble_cb->scan_activity) || 1975 BTM_BLE_IS_SEL_CONN_ACTIVE (p_ble_cb->scan_activity)) 1976 { 1977 BTM_TRACE_ERROR("LE Inquiry is active, can not start inquiry"); 1978 return(BTM_BUSY); 1979 } 1980 1981 if (!BTM_BLE_IS_SCAN_ACTIVE(p_ble_cb->scan_activity)) 1982 { 1983 btsnd_hcic_ble_set_scan_params(BTM_BLE_SCAN_MODE_ACTI, 1984 BTM_BLE_LOW_LATENCY_SCAN_INT, 1985 BTM_BLE_LOW_LATENCY_SCAN_WIN, 1986 btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type, 1987 SP_ADV_ALL); 1988 #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) 1989 /* enable IRK list */ 1990 btm_ble_enable_resolving_list_for_platform(BTM_BLE_RL_SCAN); 1991 #endif 1992 p_ble_cb->inq_var.scan_duplicate_filter = BTM_BLE_DUPLICATE_DISABLE; 1993 status = btm_ble_start_scan(); 1994 } 1995 else if ((p_ble_cb->inq_var.scan_interval != BTM_BLE_LOW_LATENCY_SCAN_INT) || 1996 (p_ble_cb->inq_var.scan_window != BTM_BLE_LOW_LATENCY_SCAN_WIN)) { 1997 BTM_TRACE_DEBUG("%s, restart LE scan with low latency scan params", __FUNCTION__); 1998 btsnd_hcic_ble_set_scan_enable(BTM_BLE_SCAN_DISABLE, BTM_BLE_DUPLICATE_ENABLE); 1999 btsnd_hcic_ble_set_scan_params(BTM_BLE_SCAN_MODE_ACTI, 2000 BTM_BLE_LOW_LATENCY_SCAN_INT, 2001 BTM_BLE_LOW_LATENCY_SCAN_WIN, 2002 btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type, 2003 SP_ADV_ALL); 2004 btsnd_hcic_ble_set_scan_enable(BTM_BLE_SCAN_ENABLE, BTM_BLE_DUPLICATE_DISABLE); 2005 } 2006 2007 if (status == BTM_CMD_STARTED) 2008 { 2009 p_inq->inq_active |= mode; 2010 p_ble_cb->scan_activity |= mode; 2011 2012 BTM_TRACE_DEBUG("btm_ble_start_inquiry inq_active = 0x%02x", p_inq->inq_active); 2013 2014 if (duration != 0) { 2015 /* start inquiry timer */ 2016 period_ms_t duration_ms = duration * 1000; 2017 alarm_set_on_queue(p_ble_cb->inq_var.inquiry_timer, 2018 duration_ms, btm_ble_inquiry_timer_timeout, 2019 NULL, btu_general_alarm_queue); 2020 } 2021 } 2022 2023 return status; 2024 2025 } 2026 2027 /******************************************************************************* 2028 ** 2029 ** Function btm_ble_read_remote_name_cmpl 2030 ** 2031 ** Description This function is called when BLE remote name is received. 2032 ** 2033 ** Returns void 2034 ** 2035 *******************************************************************************/ 2036 void btm_ble_read_remote_name_cmpl(BOOLEAN status, BD_ADDR bda, UINT16 length, char *p_name) 2037 { 2038 UINT8 hci_status = HCI_SUCCESS; 2039 BD_NAME bd_name; 2040 2041 memset(bd_name, 0, (BD_NAME_LEN + 1)); 2042 if (length > BD_NAME_LEN) 2043 { 2044 length = BD_NAME_LEN; 2045 } 2046 memcpy((UINT8*)bd_name, p_name, length); 2047 2048 if ((!status) || (length==0)) 2049 { 2050 hci_status = HCI_ERR_HOST_TIMEOUT; 2051 } 2052 2053 btm_process_remote_name(bda, bd_name, length +1, hci_status); 2054 btm_sec_rmt_name_request_complete (bda, (UINT8 *)p_name, hci_status); 2055 } 2056 2057 /******************************************************************************* 2058 ** 2059 ** Function btm_ble_read_remote_name 2060 ** 2061 ** Description This function read remote LE device name using GATT read 2062 ** procedure. 2063 ** 2064 ** Parameters: None. 2065 ** 2066 ** Returns void 2067 ** 2068 *******************************************************************************/ 2069 tBTM_STATUS btm_ble_read_remote_name(BD_ADDR remote_bda, tBTM_INQ_INFO *p_cur, tBTM_CMPL_CB *p_cb) 2070 { 2071 tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars; 2072 2073 if (!controller_get_interface()->supports_ble()) 2074 return BTM_ERR_PROCESSING; 2075 2076 if (p_cur && 2077 p_cur->results.ble_evt_type != BTM_BLE_EVT_CONN_ADV && 2078 p_cur->results.ble_evt_type != BTM_BLE_EVT_CONN_DIR_ADV) 2079 { 2080 BTM_TRACE_DEBUG("name request to non-connectable device failed."); 2081 return BTM_ERR_PROCESSING; 2082 } 2083 2084 /* read remote device name using GATT procedure */ 2085 if (p_inq->remname_active) 2086 return BTM_BUSY; 2087 2088 if (!GAP_BleReadPeerDevName(remote_bda, btm_ble_read_remote_name_cmpl)) 2089 return BTM_BUSY; 2090 2091 p_inq->p_remname_cmpl_cb = p_cb; 2092 p_inq->remname_active = TRUE; 2093 2094 memcpy(p_inq->remname_bda, remote_bda, BD_ADDR_LEN); 2095 2096 alarm_set_on_queue(p_inq->remote_name_timer, 2097 BTM_EXT_BLE_RMT_NAME_TIMEOUT_MS, 2098 btm_inq_remote_name_timer_timeout, NULL, 2099 btu_general_alarm_queue); 2100 2101 return BTM_CMD_STARTED; 2102 } 2103 2104 /******************************************************************************* 2105 ** 2106 ** Function btm_ble_cancel_remote_name 2107 ** 2108 ** Description This function cancel read remote LE device name. 2109 ** 2110 ** Parameters: None. 2111 ** 2112 ** Returns void 2113 ** 2114 *******************************************************************************/ 2115 BOOLEAN btm_ble_cancel_remote_name(BD_ADDR remote_bda) 2116 { 2117 tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars; 2118 BOOLEAN status; 2119 2120 status = GAP_BleCancelReadPeerDevName(remote_bda); 2121 2122 p_inq->remname_active = FALSE; 2123 memset(p_inq->remname_bda, 0, BD_ADDR_LEN); 2124 alarm_cancel(p_inq->remote_name_timer); 2125 2126 return status; 2127 } 2128 2129 /******************************************************************************* 2130 ** 2131 ** Function btm_ble_update_adv_flag 2132 ** 2133 ** Description This function update the limited discoverable flag in the adv 2134 ** data. 2135 ** 2136 ** Parameters: None. 2137 ** 2138 ** Returns void 2139 ** 2140 *******************************************************************************/ 2141 static void btm_ble_update_adv_flag(UINT8 flag) 2142 { 2143 tBTM_BLE_LOCAL_ADV_DATA *p_adv_data = &btm_cb.ble_ctr_cb.inq_var.adv_data; 2144 UINT8 *p; 2145 2146 BTM_TRACE_DEBUG ("btm_ble_update_adv_flag new=0x%x", flag); 2147 2148 if (p_adv_data->p_flags != NULL) 2149 { 2150 BTM_TRACE_DEBUG ("btm_ble_update_adv_flag old=0x%x", *p_adv_data->p_flags); 2151 *p_adv_data->p_flags = flag; 2152 } 2153 else /* no FLAGS in ADV data*/ 2154 { 2155 p = (p_adv_data->p_pad == NULL) ? p_adv_data->ad_data : p_adv_data->p_pad; 2156 /* need 3 bytes space to stuff in the flags, if not */ 2157 /* erase all written data, just for flags */ 2158 if ((BTM_BLE_AD_DATA_LEN - (p - p_adv_data->ad_data)) < 3) 2159 { 2160 p = p_adv_data->p_pad = p_adv_data->ad_data; 2161 memset(p_adv_data->ad_data, 0, BTM_BLE_AD_DATA_LEN); 2162 } 2163 2164 *p++ = 2; 2165 *p++ = BTM_BLE_AD_TYPE_FLAG; 2166 p_adv_data->p_flags = p; 2167 *p++ = flag; 2168 p_adv_data->p_pad = p; 2169 } 2170 2171 if (btsnd_hcic_ble_set_adv_data((UINT8)(p_adv_data->p_pad - p_adv_data->ad_data), 2172 p_adv_data->ad_data)) 2173 p_adv_data->data_mask |= BTM_BLE_AD_BIT_FLAGS; 2174 2175 } 2176 2177 #if 0 2178 /******************************************************************************* 2179 ** 2180 ** Function btm_ble_parse_adv_data 2181 ** 2182 ** Description This function parse the adv data into a structure. 2183 ** 2184 ** Returns pointer to entry, or NULL if not found 2185 ** 2186 *******************************************************************************/ 2187 static void btm_ble_parse_adv_data(tBTM_INQ_INFO *p_info, UINT8 *p_data, 2188 UINT8 len, tBTM_BLE_INQ_DATA *p_adv_data, UINT8 *p_buf) 2189 { 2190 UINT8 *p_cur = p_data; 2191 UINT8 ad_len, ad_type, ad_flag; 2192 2193 BTM_TRACE_EVENT (" btm_ble_parse_adv_data"); 2194 2195 while (len > 0) 2196 { 2197 BTM_TRACE_DEBUG("btm_ble_parse_adv_data: len = %d", len); 2198 if ((ad_len = *p_cur ++) == 0) 2199 break; 2200 2201 ad_type = *p_cur ++; 2202 2203 BTM_TRACE_DEBUG(" ad_type = %02x ad_len = %d", ad_type, ad_len); 2204 2205 switch (ad_type) 2206 { 2207 case BTM_BLE_AD_TYPE_NAME_SHORT: 2208 2209 case BTM_BLE_AD_TYPE_NAME_CMPL: 2210 p_adv_data->ad_mask |= BTM_BLE_AD_BIT_DEV_NAME; 2211 if (p_info) 2212 { 2213 p_info->remote_name_type =(ad_type == BTM_BLE_AD_TYPE_NAME_SHORT) ? 2214 BTM_BLE_NAME_SHORT: BTM_BLE_NAME_CMPL; 2215 memcpy(p_info->remote_name, p_cur, ad_len -1); 2216 p_info->remote_name[ad_len] = 0; 2217 p_adv_data->p_remote_name = p_info->remote_name; 2218 p_info->remote_name_len = p_adv_data->remote_name_len = ad_len - 1; 2219 BTM_TRACE_DEBUG("BTM_BLE_AD_TYPE_NAME name = %s",p_adv_data->p_remote_name); 2220 } 2221 p_cur += (ad_len -1); 2222 2223 break; 2224 2225 case BTM_BLE_AD_TYPE_FLAG: 2226 p_adv_data->ad_mask |= BTM_BLE_AD_BIT_FLAGS; 2227 ad_flag = *p_cur ++; 2228 p_adv_data->flag = (UINT8)(ad_flag & BTM_BLE_ADV_FLAG_MASK) ; 2229 BTM_TRACE_DEBUG("BTM_BLE_AD_TYPE_FLAG flag = %s | %s | %s", 2230 (p_adv_data->flag & BTM_BLE_LIMIT_DISC_FLAG)? "LE_LIMIT_DISC" : "", 2231 (p_adv_data->flag & BTM_BLE_GEN_DISC_FLAG)? "LE_GENERAL_DISC" : "", 2232 (p_adv_data->flag & BTM_BLE_BREDR_NOT_SPT)? "LE Only device" : ""); 2233 break; 2234 2235 case BTM_BLE_AD_TYPE_TX_PWR: 2236 p_adv_data->ad_mask |= BTM_BLE_AD_BIT_TX_PWR; 2237 p_adv_data->tx_power_level = (INT8)*p_cur ++; 2238 BTM_TRACE_DEBUG("BTM_BLE_AD_TYPE_TX_PWR tx_level = %d", p_adv_data->tx_power_level); 2239 break; 2240 2241 case BTM_BLE_AD_TYPE_MANU: 2242 2243 case BTM_BLE_AD_TYPE_16SRV_PART: 2244 case BTM_BLE_AD_TYPE_16SRV_CMPL: 2245 p_adv_data->ad_mask |= BTM_BLE_AD_BIT_SERVICE; 2246 /* need allocate memory to store UUID list */ 2247 p_adv_data->service.num_service = (ad_len - 1)/2; 2248 BTM_TRACE_DEBUG("service UUID list, num = %d", p_adv_data->service.num_service); 2249 p_cur += (ad_len - 1); 2250 break; 2251 2252 case BTM_BLE_AD_TYPE_SOL_SRV_UUID: 2253 p_adv_data->ad_mask |= BTM_BLE_AD_BIT_SERVICE_SOL; 2254 /* need allocate memory to store UUID list */ 2255 p_adv_data->service.num_service = (ad_len - 1)/2; 2256 BTM_TRACE_DEBUG("service UUID list, num = %d", p_adv_data->service.num_service); 2257 p_cur += (ad_len - 1); 2258 break; 2259 2260 case BTM_BLE_AD_TYPE_128SOL_SRV_UUID: 2261 p_adv_data->ad_mask |= BTM_BLE_AD_BIT_SERVICE_128SOL; 2262 /* need allocate memory to store UUID list */ 2263 p_adv_data->service.num_service = (ad_len - 1)/16; 2264 BTM_TRACE_DEBUG("service UUID list, num = %d", p_adv_data->service.num_service); 2265 p_cur += (ad_len - 1); 2266 break; 2267 2268 case BTM_BLE_AD_TYPE_APPEARANCE: 2269 case BTM_BLE_AD_TYPE_PUBLIC_TARGET: 2270 case BTM_BLE_AD_TYPE_RANDOM_TARGET: 2271 default: 2272 break; 2273 } 2274 len -= (ad_len + 1); 2275 } 2276 } 2277 #endif 2278 2279 /******************************************************************************* 2280 ** 2281 ** Function btm_ble_cache_adv_data 2282 ** 2283 ** Description Update advertising cache data. 2284 ** 2285 ** Returns void 2286 ** 2287 *******************************************************************************/ 2288 void btm_ble_cache_adv_data(tBTM_INQ_RESULTS *p_cur, UINT8 data_len, UINT8 *p, UINT8 evt_type) 2289 { 2290 tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var; 2291 UINT8 *p_cache; 2292 UINT8 length; 2293 UNUSED(p_cur); 2294 2295 /* cache adv report/scan response data */ 2296 if (evt_type != BTM_BLE_SCAN_RSP_EVT) 2297 { 2298 p_le_inq_cb->adv_len = 0; 2299 memset(p_le_inq_cb->adv_data_cache, 0, BTM_BLE_CACHE_ADV_DATA_MAX); 2300 } 2301 2302 if (data_len > 0) 2303 { 2304 p_cache = &p_le_inq_cb->adv_data_cache[p_le_inq_cb->adv_len]; 2305 STREAM_TO_UINT8(length, p); 2306 while ( length && ((p_le_inq_cb->adv_len + length + 1) <= BTM_BLE_CACHE_ADV_DATA_MAX)) 2307 { 2308 /* copy from the length byte & data into cache */ 2309 memcpy(p_cache, p-1, length+1); 2310 /* advance the cache pointer past data */ 2311 p_cache += length+1; 2312 /* increment cache length */ 2313 p_le_inq_cb->adv_len += length+1; 2314 /* skip the length of data */ 2315 p += length; 2316 STREAM_TO_UINT8(length, p); 2317 } 2318 } 2319 2320 /* parse service UUID from adv packet and save it in inq db eir_uuid */ 2321 /* TODO */ 2322 } 2323 2324 /******************************************************************************* 2325 ** 2326 ** Function btm_ble_is_discoverable 2327 ** 2328 ** Description check ADV flag to make sure device is discoverable and match 2329 ** the search condition 2330 ** 2331 ** Parameters 2332 ** 2333 ** Returns void 2334 ** 2335 *******************************************************************************/ 2336 UINT8 btm_ble_is_discoverable(BD_ADDR bda, UINT8 evt_type, UINT8 *p) 2337 { 2338 UINT8 *p_flag, flag = 0, rt = 0; 2339 UINT8 data_len; 2340 tBTM_INQ_PARMS *p_cond = &btm_cb.btm_inq_vars.inqparms; 2341 tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var; 2342 2343 UNUSED(p); 2344 2345 /* for observer, always "discoverable */ 2346 if (BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity)) 2347 rt |= BTM_BLE_OBS_RESULT; 2348 2349 if (BTM_BLE_IS_SEL_CONN_ACTIVE(btm_cb.ble_ctr_cb.scan_activity) && 2350 (evt_type == BTM_BLE_CONNECT_EVT || evt_type == BTM_BLE_CONNECT_DIR_EVT)) 2351 rt |= BTM_BLE_SEL_CONN_RESULT; 2352 2353 /* does not match filter condition */ 2354 if (p_cond->filter_cond_type == BTM_FILTER_COND_BD_ADDR && 2355 memcmp(bda, p_cond->filter_cond.bdaddr_cond, BD_ADDR_LEN) != 0) 2356 { 2357 BTM_TRACE_DEBUG("BD ADDR does not meet filter condition"); 2358 return rt; 2359 } 2360 2361 if (p_le_inq_cb->adv_len != 0) 2362 { 2363 if ((p_flag = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, 2364 BTM_BLE_AD_TYPE_FLAG, &data_len)) != NULL) 2365 { 2366 flag = * p_flag; 2367 2368 if ((btm_cb.btm_inq_vars.inq_active & BTM_BLE_GENERAL_INQUIRY) && 2369 (flag & (BTM_BLE_LIMIT_DISC_FLAG|BTM_BLE_GEN_DISC_FLAG)) != 0) 2370 { 2371 BTM_TRACE_DEBUG("Find Generable Discoverable device"); 2372 rt |= BTM_BLE_INQ_RESULT; 2373 } 2374 2375 else if (btm_cb.btm_inq_vars.inq_active & BTM_BLE_LIMITED_INQUIRY && 2376 (flag & BTM_BLE_LIMIT_DISC_FLAG) != 0) 2377 { 2378 BTM_TRACE_DEBUG("Find limited discoverable device"); 2379 rt |= BTM_BLE_INQ_RESULT; 2380 } 2381 } 2382 } 2383 return rt; 2384 } 2385 2386 static void btm_ble_appearance_to_cod(UINT16 appearance, UINT8 *dev_class) 2387 { 2388 dev_class[0] = 0; 2389 2390 switch (appearance) 2391 { 2392 case BTM_BLE_APPEARANCE_GENERIC_PHONE: 2393 dev_class[1] = BTM_COD_MAJOR_PHONE; 2394 dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED; 2395 break; 2396 case BTM_BLE_APPEARANCE_GENERIC_COMPUTER: 2397 dev_class[1] = BTM_COD_MAJOR_COMPUTER; 2398 dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED; 2399 break; 2400 case BTM_BLE_APPEARANCE_GENERIC_REMOTE: 2401 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2402 dev_class[2] = BTM_COD_MINOR_REMOTE_CONTROL; 2403 break; 2404 case BTM_BLE_APPEARANCE_GENERIC_THERMOMETER: 2405 case BTM_BLE_APPEARANCE_THERMOMETER_EAR: 2406 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2407 dev_class[2] = BTM_COD_MINOR_THERMOMETER; 2408 break; 2409 case BTM_BLE_APPEARANCE_GENERIC_HEART_RATE: 2410 case BTM_BLE_APPEARANCE_HEART_RATE_BELT: 2411 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2412 dev_class[2] = BTM_COD_MINOR_HEART_PULSE_MONITOR; 2413 break; 2414 case BTM_BLE_APPEARANCE_GENERIC_BLOOD_PRESSURE: 2415 case BTM_BLE_APPEARANCE_BLOOD_PRESSURE_ARM: 2416 case BTM_BLE_APPEARANCE_BLOOD_PRESSURE_WRIST: 2417 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2418 dev_class[2] = BTM_COD_MINOR_BLOOD_MONITOR; 2419 break; 2420 case BTM_BLE_APPEARANCE_GENERIC_PULSE_OXIMETER: 2421 case BTM_BLE_APPEARANCE_PULSE_OXIMETER_FINGERTIP: 2422 case BTM_BLE_APPEARANCE_PULSE_OXIMETER_WRIST: 2423 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2424 dev_class[2] = BTM_COD_MINOR_PULSE_OXIMETER; 2425 break; 2426 case BTM_BLE_APPEARANCE_GENERIC_GLUCOSE: 2427 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2428 dev_class[2] = BTM_COD_MINOR_GLUCOSE_METER; 2429 break; 2430 case BTM_BLE_APPEARANCE_GENERIC_WEIGHT: 2431 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2432 dev_class[2] = BTM_COD_MINOR_WEIGHING_SCALE; 2433 break; 2434 case BTM_BLE_APPEARANCE_GENERIC_WALKING: 2435 case BTM_BLE_APPEARANCE_WALKING_IN_SHOE: 2436 case BTM_BLE_APPEARANCE_WALKING_ON_SHOE: 2437 case BTM_BLE_APPEARANCE_WALKING_ON_HIP: 2438 dev_class[1] = BTM_COD_MAJOR_HEALTH; 2439 dev_class[2] = BTM_COD_MINOR_STEP_COUNTER; 2440 break; 2441 case BTM_BLE_APPEARANCE_GENERIC_WATCH: 2442 case BTM_BLE_APPEARANCE_SPORTS_WATCH: 2443 dev_class[1] = BTM_COD_MAJOR_WEARABLE; 2444 dev_class[2] = BTM_COD_MINOR_WRIST_WATCH; 2445 break; 2446 case BTM_BLE_APPEARANCE_GENERIC_EYEGLASSES: 2447 dev_class[1] = BTM_COD_MAJOR_WEARABLE; 2448 dev_class[2] = BTM_COD_MINOR_GLASSES; 2449 break; 2450 case BTM_BLE_APPEARANCE_GENERIC_DISPLAY: 2451 dev_class[1] = BTM_COD_MAJOR_IMAGING; 2452 dev_class[2] = BTM_COD_MINOR_DISPLAY; 2453 break; 2454 case BTM_BLE_APPEARANCE_GENERIC_MEDIA_PLAYER: 2455 dev_class[1] = BTM_COD_MAJOR_AUDIO; 2456 dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED; 2457 break; 2458 case BTM_BLE_APPEARANCE_GENERIC_BARCODE_SCANNER: 2459 case BTM_BLE_APPEARANCE_HID_BARCODE_SCANNER: 2460 case BTM_BLE_APPEARANCE_GENERIC_HID: 2461 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2462 dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED; 2463 break; 2464 case BTM_BLE_APPEARANCE_HID_KEYBOARD: 2465 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2466 dev_class[2] = BTM_COD_MINOR_KEYBOARD; 2467 break; 2468 case BTM_BLE_APPEARANCE_HID_MOUSE: 2469 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2470 dev_class[2] = BTM_COD_MINOR_POINTING; 2471 break; 2472 case BTM_BLE_APPEARANCE_HID_JOYSTICK: 2473 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2474 dev_class[2] = BTM_COD_MINOR_JOYSTICK; 2475 break; 2476 case BTM_BLE_APPEARANCE_HID_GAMEPAD: 2477 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2478 dev_class[2] = BTM_COD_MINOR_GAMEPAD; 2479 break; 2480 case BTM_BLE_APPEARANCE_HID_DIGITIZER_TABLET: 2481 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2482 dev_class[2] = BTM_COD_MINOR_DIGITIZING_TABLET; 2483 break; 2484 case BTM_BLE_APPEARANCE_HID_CARD_READER: 2485 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2486 dev_class[2] = BTM_COD_MINOR_CARD_READER; 2487 break; 2488 case BTM_BLE_APPEARANCE_HID_DIGITAL_PEN: 2489 dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2490 dev_class[2] = BTM_COD_MINOR_DIGITAL_PAN; 2491 break; 2492 case BTM_BLE_APPEARANCE_UKNOWN: 2493 case BTM_BLE_APPEARANCE_GENERIC_CLOCK: 2494 case BTM_BLE_APPEARANCE_GENERIC_TAG: 2495 case BTM_BLE_APPEARANCE_GENERIC_KEYRING: 2496 case BTM_BLE_APPEARANCE_GENERIC_CYCLING: 2497 case BTM_BLE_APPEARANCE_CYCLING_COMPUTER: 2498 case BTM_BLE_APPEARANCE_CYCLING_SPEED: 2499 case BTM_BLE_APPEARANCE_CYCLING_CADENCE: 2500 case BTM_BLE_APPEARANCE_CYCLING_POWER: 2501 case BTM_BLE_APPEARANCE_CYCLING_SPEED_CADENCE: 2502 case BTM_BLE_APPEARANCE_GENERIC_OUTDOOR_SPORTS: 2503 case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION: 2504 case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION_AND_NAV: 2505 case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION_POD: 2506 case BTM_BLE_APPEARANCE_OUTDOOR_SPORTS_LOCATION_POD_AND_NAV: 2507 default: 2508 dev_class[1] = BTM_COD_MAJOR_UNCLASSIFIED; 2509 dev_class[2] = BTM_COD_MINOR_UNCLASSIFIED; 2510 }; 2511 } 2512 2513 /******************************************************************************* 2514 ** 2515 ** Function btm_ble_update_inq_result 2516 ** 2517 ** Description Update adv packet information into inquiry result. 2518 ** 2519 ** Parameters 2520 ** 2521 ** Returns void 2522 ** 2523 *******************************************************************************/ 2524 BOOLEAN btm_ble_update_inq_result(tINQ_DB_ENT *p_i, UINT8 addr_type, UINT8 evt_type, UINT8 *p) 2525 { 2526 BOOLEAN to_report = TRUE; 2527 tBTM_INQ_RESULTS *p_cur = &p_i->inq_info.results; 2528 UINT8 len; 2529 UINT8 *p_flag; 2530 tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars; 2531 UINT8 data_len, rssi; 2532 tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var; 2533 UINT8 *p1; 2534 UINT8 *p_uuid16; 2535 2536 STREAM_TO_UINT8 (data_len, p); 2537 2538 if (data_len > BTM_BLE_ADV_DATA_LEN_MAX) 2539 { 2540 BTM_TRACE_WARNING("EIR data too long %d. discard", data_len); 2541 return FALSE; 2542 } 2543 btm_ble_cache_adv_data(p_cur, data_len, p, evt_type); 2544 2545 p1 = (p + data_len); 2546 STREAM_TO_UINT8 (rssi, p1); 2547 2548 /* Save the info */ 2549 p_cur->inq_result_type = BTM_INQ_RESULT_BLE; 2550 p_cur->ble_addr_type = addr_type; 2551 p_cur->rssi = rssi; 2552 2553 /* active scan, always wait until get scan_rsp to report the result */ 2554 if ((btm_cb.ble_ctr_cb.inq_var.scan_type == BTM_BLE_SCAN_MODE_ACTI && 2555 (evt_type == BTM_BLE_CONNECT_EVT || evt_type == BTM_BLE_DISCOVER_EVT))) 2556 { 2557 BTM_TRACE_DEBUG("btm_ble_update_inq_result scan_rsp=false, to_report=false,\ 2558 scan_type_active=%d", btm_cb.ble_ctr_cb.inq_var.scan_type); 2559 p_i->scan_rsp = FALSE; 2560 to_report = FALSE; 2561 } 2562 else 2563 p_i->scan_rsp = TRUE; 2564 2565 if (p_i->inq_count != p_inq->inq_counter) 2566 p_cur->device_type = BT_DEVICE_TYPE_BLE; 2567 else 2568 p_cur->device_type |= BT_DEVICE_TYPE_BLE; 2569 2570 if (evt_type != BTM_BLE_SCAN_RSP_EVT) 2571 p_cur->ble_evt_type = evt_type; 2572 2573 p_i->inq_count = p_inq->inq_counter; /* Mark entry for current inquiry */ 2574 2575 if (p_le_inq_cb->adv_len != 0) 2576 { 2577 if ((p_flag = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, BTM_BLE_AD_TYPE_FLAG, &len)) != NULL) 2578 p_cur->flag = * p_flag; 2579 } 2580 2581 if (p_le_inq_cb->adv_len != 0) 2582 { 2583 /* Check to see the BLE device has the Appearance UUID in the advertising data. If it does 2584 * then try to convert the appearance value to a class of device value Bluedroid can use. 2585 * Otherwise fall back to trying to infer if it is a HID device based on the service class. 2586 */ 2587 p_uuid16 = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, BTM_BLE_AD_TYPE_APPEARANCE, &len); 2588 if (p_uuid16 && len == 2) 2589 { 2590 btm_ble_appearance_to_cod((UINT16)p_uuid16[0] | (p_uuid16[1] << 8), p_cur->dev_class); 2591 } 2592 else 2593 { 2594 if ((p_uuid16 = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, 2595 BTM_BLE_AD_TYPE_16SRV_CMPL, &len)) != NULL) 2596 { 2597 UINT8 i; 2598 for (i = 0; i + 2 <= len; i = i + 2) 2599 { 2600 /* if this BLE device support HID over LE, set HID Major in class of device */ 2601 if ((p_uuid16[i] | (p_uuid16[i+1] << 8)) == UUID_SERVCLASS_LE_HID) 2602 { 2603 p_cur->dev_class[0] = 0; 2604 p_cur->dev_class[1] = BTM_COD_MAJOR_PERIPHERAL; 2605 p_cur->dev_class[2] = 0; 2606 break; 2607 } 2608 } 2609 } 2610 } 2611 } 2612 2613 /* if BR/EDR not supported is not set, assume is a DUMO device */ 2614 if ((p_cur->flag & BTM_BLE_BREDR_NOT_SPT) == 0 && 2615 evt_type != BTM_BLE_CONNECT_DIR_EVT) 2616 { 2617 if (p_cur->ble_addr_type != BLE_ADDR_RANDOM) 2618 { 2619 BTM_TRACE_DEBUG("BR/EDR NOT support bit not set, treat as DUMO"); 2620 p_cur->device_type |= BT_DEVICE_TYPE_DUMO; 2621 } else { 2622 BTM_TRACE_DEBUG("Random address, treating device as LE only"); 2623 } 2624 } 2625 else 2626 { 2627 BTM_TRACE_DEBUG("BR/EDR NOT SUPPORT bit set, LE only device"); 2628 } 2629 2630 return to_report; 2631 2632 } 2633 2634 /******************************************************************************* 2635 ** 2636 ** Function btm_clear_all_pending_le_entry 2637 ** 2638 ** Description This function is called to clear all LE pending entry in 2639 ** inquiry database. 2640 ** 2641 ** Returns void 2642 ** 2643 *******************************************************************************/ 2644 void btm_clear_all_pending_le_entry(void) 2645 { 2646 UINT16 xx; 2647 tINQ_DB_ENT *p_ent = btm_cb.btm_inq_vars.inq_db; 2648 2649 for (xx = 0; xx < BTM_INQ_DB_SIZE; xx++, p_ent++) 2650 { 2651 /* mark all pending LE entry as unused if an LE only device has scan response outstanding */ 2652 if ((p_ent->in_use) && 2653 (p_ent->inq_info.results.device_type == BT_DEVICE_TYPE_BLE) && 2654 !p_ent->scan_rsp) 2655 p_ent->in_use = FALSE; 2656 } 2657 } 2658 2659 /******************************************************************************* 2660 ** 2661 ** Function btm_send_sel_conn_callback 2662 ** 2663 ** Description send selection connection request callback. 2664 ** 2665 ** Parameters 2666 ** 2667 ** Returns void 2668 ** 2669 *******************************************************************************/ 2670 void btm_send_sel_conn_callback(BD_ADDR remote_bda, UINT8 evt_type, UINT8 *p_data, UINT8 addr_type) 2671 { 2672 UINT8 data_len, len; 2673 UINT8 *p_dev_name, remname[31] = {0}; 2674 UNUSED(addr_type); 2675 2676 if (btm_cb.ble_ctr_cb.p_select_cback == NULL || 2677 /* non-connectable device */ 2678 (evt_type != BTM_BLE_EVT_CONN_ADV && evt_type != BTM_BLE_EVT_CONN_DIR_ADV)) 2679 return; 2680 2681 STREAM_TO_UINT8 (data_len, p_data); 2682 2683 /* get the device name if exist in ADV data */ 2684 if (data_len != 0) 2685 { 2686 p_dev_name = BTM_CheckAdvData(p_data, BTM_BLE_AD_TYPE_NAME_CMPL, &len); 2687 2688 if (p_dev_name == NULL) 2689 p_dev_name = BTM_CheckAdvData(p_data, BTM_BLE_AD_TYPE_NAME_SHORT, &len); 2690 2691 if (p_dev_name) 2692 memcpy(remname, p_dev_name, len); 2693 } 2694 /* allow connection */ 2695 if ((* btm_cb.ble_ctr_cb.p_select_cback)(remote_bda, remname)) 2696 { 2697 /* terminate selective connection, initiate connection */ 2698 btm_ble_initiate_select_conn(remote_bda); 2699 } 2700 } 2701 2702 /******************************************************************************* 2703 ** 2704 ** Function btm_ble_process_adv_pkt 2705 ** 2706 ** Description This function is called when adv packet report events are 2707 ** received from the device. It updates the inquiry database. 2708 ** If the inquiry database is full, the oldest entry is discarded. 2709 ** 2710 ** Parameters 2711 ** 2712 ** Returns void 2713 ** 2714 *******************************************************************************/ 2715 void btm_ble_process_adv_pkt (UINT8 *p_data) 2716 { 2717 BD_ADDR bda; 2718 UINT8 evt_type = 0, *p = p_data; 2719 UINT8 addr_type = 0; 2720 UINT8 num_reports; 2721 UINT8 data_len; 2722 #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) 2723 BOOLEAN match = FALSE; 2724 #endif 2725 2726 /* Only process the results if the inquiry is still active */ 2727 if (!BTM_BLE_IS_SCAN_ACTIVE(btm_cb.ble_ctr_cb.scan_activity)) 2728 return; 2729 2730 /* Extract the number of reports in this event. */ 2731 STREAM_TO_UINT8(num_reports, p); 2732 2733 while (num_reports--) 2734 { 2735 /* Extract inquiry results */ 2736 STREAM_TO_UINT8 (evt_type, p); 2737 STREAM_TO_UINT8 (addr_type, p); 2738 STREAM_TO_BDADDR (bda, p); 2739 2740 #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) 2741 /* map address to security record */ 2742 match = btm_identity_addr_to_random_pseudo(bda, &addr_type, FALSE); 2743 2744 BTM_TRACE_DEBUG("btm_ble_process_adv_pkt:bda= %0x:%0x:%0x:%0x:%0x:%0x", 2745 bda[0],bda[1],bda[2],bda[3],bda[4],bda[5]); 2746 /* always do RRA resolution on host */ 2747 if (!match && BTM_BLE_IS_RESOLVE_BDA(bda)) 2748 { 2749 btm_ble_resolve_random_addr(bda, btm_ble_resolve_random_addr_on_adv, p_data); 2750 } 2751 else 2752 #endif 2753 btm_ble_process_adv_pkt_cont(bda, addr_type, evt_type, p); 2754 2755 STREAM_TO_UINT8(data_len, p); 2756 2757 /* Advance to the next event data_len + rssi byte */ 2758 p += data_len + 1; 2759 } 2760 } 2761 2762 /******************************************************************************* 2763 ** 2764 ** Function btm_ble_process_adv_pkt_cont 2765 ** 2766 ** Description This function is called after random address resolution is 2767 ** done, and proceed to process adv packet. 2768 ** 2769 ** Parameters 2770 ** 2771 ** Returns void 2772 ** 2773 *******************************************************************************/ 2774 static void btm_ble_process_adv_pkt_cont(BD_ADDR bda, UINT8 addr_type, UINT8 evt_type, UINT8 *p) 2775 { 2776 tINQ_DB_ENT *p_i; 2777 tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars; 2778 tBTM_INQ_RESULTS_CB *p_inq_results_cb = p_inq->p_inq_results_cb; 2779 tBTM_INQ_RESULTS_CB *p_obs_results_cb = btm_cb.ble_ctr_cb.p_obs_results_cb; 2780 tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var; 2781 BOOLEAN update = TRUE; 2782 UINT8 result = 0; 2783 2784 p_i = btm_inq_db_find (bda); 2785 2786 /* Check if this address has already been processed for this inquiry */ 2787 if (btm_inq_find_bdaddr(bda)) 2788 { 2789 /* never been report as an LE device */ 2790 if (p_i && 2791 (!(p_i->inq_info.results.device_type & BT_DEVICE_TYPE_BLE) || 2792 /* scan repsonse to be updated */ 2793 (!p_i->scan_rsp))) 2794 { 2795 update = TRUE; 2796 } 2797 else if (BTM_BLE_IS_OBS_ACTIVE(btm_cb.ble_ctr_cb.scan_activity)) 2798 { 2799 update = FALSE; 2800 } 2801 else 2802 { 2803 /* if yes, skip it */ 2804 return; /* assumption: one result per event */ 2805 } 2806 } 2807 /* If existing entry, use that, else get a new one (possibly reusing the oldest) */ 2808 if (p_i == NULL) 2809 { 2810 if ((p_i = btm_inq_db_new (bda)) != NULL) 2811 { 2812 p_inq->inq_cmpl_info.num_resp++; 2813 } 2814 else 2815 return; 2816 } 2817 else if (p_i->inq_count != p_inq->inq_counter) /* first time seen in this inquiry */ 2818 { 2819 p_inq->inq_cmpl_info.num_resp++; 2820 } 2821 /* update the LE device information in inquiry database */ 2822 if (!btm_ble_update_inq_result(p_i, addr_type, evt_type, p)) 2823 return; 2824 2825 if ((result = btm_ble_is_discoverable(bda, evt_type, p)) == 0) 2826 { 2827 LOG_WARN(LOG_TAG, "%s device is no longer discoverable so discarding advertising packet pkt", 2828 __func__); 2829 return; 2830 } 2831 if (!update) 2832 result &= ~BTM_BLE_INQ_RESULT; 2833 /* If the number of responses found and limited, issue a cancel inquiry */ 2834 if (p_inq->inqparms.max_resps && 2835 p_inq->inq_cmpl_info.num_resp == p_inq->inqparms.max_resps) 2836 { 2837 /* new device */ 2838 if (p_i == NULL || 2839 /* assume a DUMO device, BR/EDR inquiry is always active */ 2840 (p_i && 2841 (p_i->inq_info.results.device_type & BT_DEVICE_TYPE_BLE) == BT_DEVICE_TYPE_BLE && 2842 p_i->scan_rsp)) 2843 { 2844 BTM_TRACE_WARNING("INQ RES: Extra Response Received...cancelling inquiry.."); 2845 2846 /* if is non-periodic inquiry active, cancel now */ 2847 if ((p_inq->inq_active & BTM_BR_INQ_ACTIVE_MASK) != 0 && 2848 (p_inq->inq_active & BTM_PERIODIC_INQUIRY_ACTIVE) == 0) 2849 btsnd_hcic_inq_cancel(); 2850 2851 btm_ble_stop_inquiry(); 2852 2853 btm_acl_update_busy_level (BTM_BLI_INQ_DONE_EVT); 2854 } 2855 } 2856 /* background connection in selective connection mode */ 2857 if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE) 2858 { 2859 if (result & BTM_BLE_SEL_CONN_RESULT) 2860 btm_send_sel_conn_callback(bda, evt_type, p, addr_type); 2861 else 2862 { 2863 BTM_TRACE_DEBUG("None LE device, can not initiate selective connection"); 2864 } 2865 } 2866 else 2867 { 2868 if (p_inq_results_cb && (result & BTM_BLE_INQ_RESULT)) 2869 { 2870 (p_inq_results_cb)((tBTM_INQ_RESULTS *) &p_i->inq_info.results, p_le_inq_cb->adv_data_cache); 2871 } 2872 if (p_obs_results_cb && (result & BTM_BLE_OBS_RESULT)) 2873 { 2874 (p_obs_results_cb)((tBTM_INQ_RESULTS *) &p_i->inq_info.results, p_le_inq_cb->adv_data_cache); 2875 } 2876 } 2877 } 2878 2879 /******************************************************************************* 2880 ** 2881 ** Function btm_ble_start_scan 2882 ** 2883 ** Description Start the BLE scan. 2884 ** 2885 ** Returns void 2886 ** 2887 *******************************************************************************/ 2888 tBTM_STATUS btm_ble_start_scan(void) 2889 { 2890 tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var; 2891 tBTM_STATUS status = BTM_CMD_STARTED; 2892 2893 /* start scan, disable duplicate filtering */ 2894 if (!btsnd_hcic_ble_set_scan_enable (BTM_BLE_SCAN_ENABLE, p_inq->scan_duplicate_filter)) 2895 { 2896 status = BTM_NO_RESOURCES; 2897 } 2898 else 2899 { 2900 if (p_inq->scan_type == BTM_BLE_SCAN_MODE_ACTI) 2901 btm_ble_set_topology_mask(BTM_BLE_STATE_ACTIVE_SCAN_BIT); 2902 else 2903 btm_ble_set_topology_mask(BTM_BLE_STATE_PASSIVE_SCAN_BIT); 2904 } 2905 return status; 2906 } 2907 2908 /******************************************************************************* 2909 ** 2910 ** Function btm_ble_stop_scan 2911 ** 2912 ** Description Stop the BLE scan. 2913 ** 2914 ** Returns void 2915 ** 2916 *******************************************************************************/ 2917 void btm_ble_stop_scan(void) 2918 { 2919 BTM_TRACE_EVENT ("btm_ble_stop_scan "); 2920 2921 /* Clear the inquiry callback if set */ 2922 btm_cb.ble_ctr_cb.inq_var.scan_type = BTM_BLE_SCAN_MODE_NONE; 2923 2924 /* stop discovery now */ 2925 btsnd_hcic_ble_set_scan_enable (BTM_BLE_SCAN_DISABLE, BTM_BLE_DUPLICATE_ENABLE); 2926 2927 btm_update_scanner_filter_policy(SP_ADV_ALL); 2928 2929 btm_cb.ble_ctr_cb.wl_state &= ~BTM_BLE_WL_SCAN; 2930 } 2931 /******************************************************************************* 2932 ** 2933 ** Function btm_ble_stop_inquiry 2934 ** 2935 ** Description Stop the BLE Inquiry. 2936 ** 2937 ** Returns void 2938 ** 2939 *******************************************************************************/ 2940 void btm_ble_stop_inquiry(void) 2941 { 2942 tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars; 2943 tBTM_BLE_CB *p_ble_cb = &btm_cb.ble_ctr_cb; 2944 2945 alarm_cancel(p_ble_cb->inq_var.inquiry_timer); 2946 2947 p_ble_cb->scan_activity &= ~BTM_BLE_INQUIRY_MASK; 2948 2949 /* If no more scan activity, stop LE scan now */ 2950 if (!BTM_BLE_IS_SCAN_ACTIVE(p_ble_cb->scan_activity)) 2951 btm_ble_stop_scan(); 2952 else if((p_ble_cb->inq_var.scan_interval != BTM_BLE_LOW_LATENCY_SCAN_INT) || 2953 (p_ble_cb->inq_var.scan_window != BTM_BLE_LOW_LATENCY_SCAN_WIN)) 2954 { 2955 BTM_TRACE_DEBUG("%s: setting default params for ongoing observe", __FUNCTION__); 2956 btm_ble_stop_scan(); 2957 btm_ble_start_scan(); 2958 } 2959 2960 /* If we have a callback registered for inquiry complete, call it */ 2961 BTM_TRACE_DEBUG ("BTM Inq Compl Callback: status 0x%02x, num results %d", 2962 p_inq->inq_cmpl_info.status, p_inq->inq_cmpl_info.num_resp); 2963 2964 btm_process_inq_complete(HCI_SUCCESS, (UINT8)(p_inq->inqparms.mode & BTM_BLE_INQUIRY_MASK)); 2965 } 2966 2967 /******************************************************************************* 2968 ** 2969 ** Function btm_ble_stop_observe 2970 ** 2971 ** Description Stop the BLE Observe. 2972 ** 2973 ** Returns void 2974 ** 2975 *******************************************************************************/ 2976 static void btm_ble_stop_observe(void) 2977 { 2978 tBTM_BLE_CB *p_ble_cb = & btm_cb.ble_ctr_cb; 2979 tBTM_CMPL_CB *p_obs_cb = p_ble_cb->p_obs_cmpl_cb; 2980 2981 alarm_cancel(p_ble_cb->observer_timer); 2982 2983 p_ble_cb->scan_activity &= ~BTM_LE_OBSERVE_ACTIVE; 2984 2985 p_ble_cb->p_obs_results_cb = NULL; 2986 p_ble_cb->p_obs_cmpl_cb = NULL; 2987 2988 if (!BTM_BLE_IS_SCAN_ACTIVE(p_ble_cb->scan_activity)) 2989 btm_ble_stop_scan(); 2990 2991 if (p_obs_cb) 2992 (p_obs_cb)((tBTM_INQUIRY_CMPL *) &btm_cb.btm_inq_vars.inq_cmpl_info); 2993 } 2994 /******************************************************************************* 2995 ** 2996 ** Function btm_ble_adv_states_operation 2997 ** 2998 ** Description Set or clear adv states in topology mask 2999 ** 3000 ** Returns operation status. TRUE if sucessful, FALSE otherwise. 3001 ** 3002 *******************************************************************************/ 3003 typedef BOOLEAN (BTM_TOPOLOGY_FUNC_PTR)(tBTM_BLE_STATE_MASK); 3004 static BOOLEAN btm_ble_adv_states_operation(BTM_TOPOLOGY_FUNC_PTR *p_handler, UINT8 adv_evt) 3005 { 3006 BOOLEAN rt = FALSE; 3007 3008 switch (adv_evt) 3009 { 3010 case BTM_BLE_CONNECT_EVT: 3011 rt = (*p_handler)(BTM_BLE_STATE_CONN_ADV_BIT); 3012 break; 3013 3014 case BTM_BLE_NON_CONNECT_EVT: 3015 rt = (*p_handler) (BTM_BLE_STATE_NON_CONN_ADV_BIT); 3016 break; 3017 case BTM_BLE_CONNECT_DIR_EVT: 3018 rt = (*p_handler) (BTM_BLE_STATE_HI_DUTY_DIR_ADV_BIT); 3019 break; 3020 3021 case BTM_BLE_DISCOVER_EVT: 3022 rt = (*p_handler) (BTM_BLE_STATE_SCAN_ADV_BIT); 3023 break; 3024 3025 case BTM_BLE_CONNECT_LO_DUTY_DIR_EVT: 3026 rt = (*p_handler) (BTM_BLE_STATE_LO_DUTY_DIR_ADV_BIT); 3027 break; 3028 3029 default: 3030 BTM_TRACE_ERROR("unknown adv event : %d", adv_evt); 3031 break; 3032 } 3033 3034 return rt; 3035 } 3036 3037 /******************************************************************************* 3038 ** 3039 ** Function btm_ble_start_adv 3040 ** 3041 ** Description start the BLE advertising. 3042 ** 3043 ** Returns void 3044 ** 3045 *******************************************************************************/ 3046 tBTM_STATUS btm_ble_start_adv(void) 3047 { 3048 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 3049 tBTM_STATUS rt = BTM_NO_RESOURCES; 3050 3051 if (!btm_ble_adv_states_operation (btm_ble_topology_check, p_cb->evt_type)) 3052 return BTM_WRONG_MODE; 3053 3054 #if (defined BLE_PRIVACY_SPT && BLE_PRIVACY_SPT == TRUE) 3055 /* To relax resolving list, always have resolving list enabled, unless directed adv */ 3056 if (p_cb->evt_type != BTM_BLE_CONNECT_LO_DUTY_DIR_EVT && 3057 p_cb->evt_type != BTM_BLE_CONNECT_DIR_EVT) 3058 /* enable resolving list is desired */ 3059 btm_ble_enable_resolving_list_for_platform(BTM_BLE_RL_ADV); 3060 #endif 3061 if (p_cb->afp != AP_SCAN_CONN_ALL) 3062 { 3063 btm_execute_wl_dev_operation(); 3064 btm_cb.ble_ctr_cb.wl_state |= BTM_BLE_WL_ADV; 3065 } 3066 3067 if (btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_ENABLE)) 3068 { 3069 p_cb->adv_mode = BTM_BLE_ADV_ENABLE; 3070 btm_ble_adv_states_operation(btm_ble_set_topology_mask, p_cb->evt_type); 3071 rt = BTM_SUCCESS; 3072 } 3073 else 3074 { 3075 p_cb->adv_mode = BTM_BLE_ADV_DISABLE; 3076 btm_cb.ble_ctr_cb.wl_state &= ~BTM_BLE_WL_ADV; 3077 } 3078 return rt; 3079 } 3080 3081 /******************************************************************************* 3082 ** 3083 ** Function btm_ble_stop_adv 3084 ** 3085 ** Description Stop the BLE advertising. 3086 ** 3087 ** Returns void 3088 ** 3089 *******************************************************************************/ 3090 tBTM_STATUS btm_ble_stop_adv(void) 3091 { 3092 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 3093 tBTM_STATUS rt = BTM_SUCCESS; 3094 3095 if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE) 3096 { 3097 if (btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_DISABLE)) 3098 { 3099 p_cb->fast_adv_on = FALSE; 3100 p_cb->adv_mode = BTM_BLE_ADV_DISABLE; 3101 btm_cb.ble_ctr_cb.wl_state &= ~BTM_BLE_WL_ADV; 3102 3103 /* clear all adv states */ 3104 btm_ble_clear_topology_mask (BTM_BLE_STATE_ALL_ADV_MASK); 3105 } 3106 else 3107 rt = BTM_NO_RESOURCES; 3108 } 3109 return rt; 3110 } 3111 3112 static void btm_ble_fast_adv_timer_timeout(UNUSED_ATTR void *data) 3113 { 3114 /* fast adv is completed, fall back to slow adv interval */ 3115 btm_ble_start_slow_adv(); 3116 } 3117 3118 /******************************************************************************* 3119 ** 3120 ** Function btm_ble_start_slow_adv 3121 ** 3122 ** Description Restart adv with slow adv interval 3123 ** 3124 ** Returns void 3125 ** 3126 *******************************************************************************/ 3127 static void btm_ble_start_slow_adv(void) 3128 { 3129 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 3130 3131 if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE) 3132 { 3133 tBTM_LE_RANDOM_CB *p_addr_cb = &btm_cb.ble_ctr_cb.addr_mgnt_cb; 3134 BD_ADDR p_addr_ptr = {0}; 3135 tBLE_ADDR_TYPE init_addr_type = BLE_ADDR_PUBLIC; 3136 tBLE_ADDR_TYPE own_addr_type = p_addr_cb->own_addr_type; 3137 3138 btm_ble_stop_adv(); 3139 3140 p_cb->evt_type = btm_set_conn_mode_adv_init_addr(p_cb, p_addr_ptr, &init_addr_type, 3141 &own_addr_type); 3142 3143 /* slow adv mode never goes into directed adv */ 3144 btsnd_hcic_ble_write_adv_params (BTM_BLE_GAP_ADV_SLOW_INT, BTM_BLE_GAP_ADV_SLOW_INT, 3145 p_cb->evt_type, own_addr_type, 3146 init_addr_type, p_addr_ptr, 3147 p_cb->adv_chnl_map, p_cb->afp); 3148 3149 btm_ble_start_adv(); 3150 } 3151 } 3152 3153 static void btm_ble_inquiry_timer_gap_limited_discovery_timeout(UNUSED_ATTR void *data) 3154 { 3155 /* lim_timeout expired, limited discovery should exit now */ 3156 btm_cb.btm_inq_vars.discoverable_mode &= ~BTM_BLE_LIMITED_DISCOVERABLE; 3157 btm_ble_set_adv_flag(btm_cb.btm_inq_vars.connectable_mode, 3158 btm_cb.btm_inq_vars.discoverable_mode); 3159 } 3160 3161 static void btm_ble_inquiry_timer_timeout(UNUSED_ATTR void *data) 3162 { 3163 btm_ble_stop_inquiry(); 3164 } 3165 3166 static void btm_ble_observer_timer_timeout(UNUSED_ATTR void *data) 3167 { 3168 btm_ble_stop_observe(); 3169 } 3170 3171 void btm_ble_adv_raddr_timer_timeout(void *data) 3172 { 3173 if ((btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type == BLE_ADDR_RANDOM) && 3174 (BTM_BleMaxMultiAdvInstanceCount() > 0)) { 3175 btm_ble_multi_adv_configure_rpa((tBTM_BLE_MULTI_ADV_INST *)data); 3176 } 3177 } 3178 3179 void btm_ble_refresh_raddr_timer_timeout(UNUSED_ATTR void *data) 3180 { 3181 if (btm_cb.ble_ctr_cb.addr_mgnt_cb.own_addr_type == BLE_ADDR_RANDOM) { 3182 /* refresh the random addr */ 3183 btm_gen_resolvable_private_addr((void *)btm_gen_resolve_paddr_low); 3184 } 3185 } 3186 3187 /******************************************************************************* 3188 ** 3189 ** Function btm_ble_read_remote_features_complete 3190 ** 3191 ** Description This function is called when the command complete message 3192 ** is received from the HCI for the read LE remote feature supported 3193 ** complete event. 3194 ** 3195 ** Returns void 3196 ** 3197 *******************************************************************************/ 3198 void btm_ble_read_remote_features_complete(UINT8 *p) 3199 { 3200 tACL_CONN *p_acl_cb = &btm_cb.acl_db[0]; 3201 UINT16 handle; 3202 UINT8 status; 3203 int xx; 3204 3205 BTM_TRACE_EVENT ("btm_ble_read_remote_features_complete "); 3206 3207 STREAM_TO_UINT8(status, p); 3208 3209 // if LE read remote feature failed for HCI_ERR_CONN_FAILED_ESTABLISHMENT, 3210 // expect disconnect complete to be received 3211 if (status != HCI_ERR_CONN_FAILED_ESTABLISHMENT) 3212 { 3213 STREAM_TO_UINT16 (handle, p); 3214 3215 /* Look up the connection by handle and copy features */ 3216 for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_acl_cb++) 3217 { 3218 if ((p_acl_cb->in_use) && (p_acl_cb->hci_handle == handle)) 3219 { 3220 STREAM_TO_ARRAY(p_acl_cb->peer_le_features, p, BD_FEATURES_LEN); 3221 btsnd_hcic_rmt_ver_req (p_acl_cb->hci_handle); 3222 break; 3223 } 3224 } 3225 } 3226 3227 } 3228 3229 /******************************************************************************* 3230 ** 3231 ** Function btm_ble_write_adv_enable_complete 3232 ** 3233 ** Description This function process the write adv enable command complete. 3234 ** 3235 ** Returns void 3236 ** 3237 *******************************************************************************/ 3238 void btm_ble_write_adv_enable_complete(UINT8 * p) 3239 { 3240 tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var; 3241 3242 /* if write adv enable/disbale not succeed */ 3243 if (*p != HCI_SUCCESS) 3244 { 3245 /* toggle back the adv mode */ 3246 p_cb->adv_mode = !p_cb->adv_mode; 3247 } 3248 } 3249 3250 /******************************************************************************* 3251 ** 3252 ** Function btm_ble_dir_adv_tout 3253 ** 3254 ** Description when directed adv time out 3255 ** 3256 ** Returns void 3257 ** 3258 *******************************************************************************/ 3259 void btm_ble_dir_adv_tout(void) 3260 { 3261 btm_cb.ble_ctr_cb.inq_var.adv_mode = BTM_BLE_ADV_DISABLE; 3262 3263 /* make device fall back into undirected adv mode by default */ 3264 btm_cb.ble_ctr_cb.inq_var.directed_conn = FALSE; 3265 } 3266 3267 /******************************************************************************* 3268 ** 3269 ** Function btm_ble_set_topology_mask 3270 ** 3271 ** Description set BLE topology mask 3272 ** 3273 ** Returns TRUE is request is allowed, FALSE otherwise. 3274 ** 3275 *******************************************************************************/ 3276 BOOLEAN btm_ble_set_topology_mask(tBTM_BLE_STATE_MASK request_state_mask) 3277 { 3278 request_state_mask &= BTM_BLE_STATE_ALL_MASK; 3279 btm_cb.ble_ctr_cb.cur_states |= (request_state_mask & BTM_BLE_STATE_ALL_MASK); 3280 return TRUE; 3281 } 3282 3283 /******************************************************************************* 3284 ** 3285 ** Function btm_ble_clear_topology_mask 3286 ** 3287 ** Description Clear BLE topology bit mask 3288 ** 3289 ** Returns TRUE is request is allowed, FALSE otherwise. 3290 ** 3291 *******************************************************************************/ 3292 BOOLEAN btm_ble_clear_topology_mask (tBTM_BLE_STATE_MASK request_state_mask) 3293 { 3294 request_state_mask &= BTM_BLE_STATE_ALL_MASK; 3295 btm_cb.ble_ctr_cb.cur_states &= ~request_state_mask; 3296 return TRUE; 3297 } 3298 3299 /******************************************************************************* 3300 ** 3301 ** Function btm_ble_update_link_topology_mask 3302 ** 3303 ** Description This function update the link topology mask 3304 ** 3305 ** Returns void 3306 ** 3307 *******************************************************************************/ 3308 void btm_ble_update_link_topology_mask(UINT8 link_role, BOOLEAN increase) 3309 { 3310 btm_ble_clear_topology_mask (BTM_BLE_STATE_ALL_CONN_MASK); 3311 3312 if (increase) 3313 btm_cb.ble_ctr_cb.link_count[link_role]++; 3314 else if (btm_cb.ble_ctr_cb.link_count[link_role] > 0) 3315 btm_cb.ble_ctr_cb.link_count[link_role]--; 3316 3317 if (btm_cb.ble_ctr_cb.link_count[HCI_ROLE_MASTER]) 3318 btm_ble_set_topology_mask (BTM_BLE_STATE_MASTER_BIT); 3319 3320 if (btm_cb.ble_ctr_cb.link_count[HCI_ROLE_SLAVE]) 3321 btm_ble_set_topology_mask(BTM_BLE_STATE_SLAVE_BIT); 3322 3323 if (link_role == HCI_ROLE_SLAVE && increase) 3324 { 3325 btm_cb.ble_ctr_cb.inq_var.adv_mode = BTM_BLE_ADV_DISABLE; 3326 /* make device fall back into undirected adv mode by default */ 3327 btm_cb.ble_ctr_cb.inq_var.directed_conn = BTM_BLE_CONNECT_EVT; 3328 /* clear all adv states */ 3329 btm_ble_clear_topology_mask(BTM_BLE_STATE_ALL_ADV_MASK); 3330 } 3331 } 3332 3333 /******************************************************************************* 3334 ** 3335 ** Function btm_ble_update_mode_operation 3336 ** 3337 ** Description This function update the GAP role operation when a link status 3338 ** is updated. 3339 ** 3340 ** Returns void 3341 ** 3342 *******************************************************************************/ 3343 void btm_ble_update_mode_operation(UINT8 link_role, BD_ADDR bd_addr, UINT8 status) 3344 { 3345 if (status == HCI_ERR_DIRECTED_ADVERTISING_TIMEOUT) 3346 { 3347 btm_cb.ble_ctr_cb.inq_var.adv_mode = BTM_BLE_ADV_DISABLE; 3348 /* make device fall back into undirected adv mode by default */ 3349 btm_cb.ble_ctr_cb.inq_var.directed_conn = BTM_BLE_CONNECT_EVT; 3350 /* clear all adv states */ 3351 btm_ble_clear_topology_mask (BTM_BLE_STATE_ALL_ADV_MASK); 3352 } 3353 3354 if (btm_cb.ble_ctr_cb.inq_var.connectable_mode == BTM_BLE_CONNECTABLE) 3355 { 3356 btm_ble_set_connectability(btm_cb.btm_inq_vars.connectable_mode | 3357 btm_cb.ble_ctr_cb.inq_var.connectable_mode); 3358 } 3359 3360 /* when no connection is attempted, and controller is not rejecting last request 3361 due to resource limitation, start next direct connection or background connection 3362 now in order */ 3363 if (btm_ble_get_conn_st() == BLE_CONN_IDLE && status != HCI_ERR_HOST_REJECT_RESOURCES && 3364 !btm_send_pending_direct_conn()) 3365 { 3366 btm_ble_resume_bg_conn(); 3367 } 3368 } 3369 3370 /******************************************************************************* 3371 ** 3372 ** Function btm_ble_init 3373 ** 3374 ** Description Initialize the control block variable values. 3375 ** 3376 ** Returns void 3377 ** 3378 *******************************************************************************/ 3379 void btm_ble_init(void) 3380 { 3381 tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb; 3382 3383 BTM_TRACE_DEBUG("%s", __func__); 3384 3385 alarm_free(p_cb->observer_timer); 3386 alarm_free(p_cb->inq_var.fast_adv_timer); 3387 memset(p_cb, 0, sizeof(tBTM_BLE_CB)); 3388 memset(&(btm_cb.cmn_ble_vsc_cb), 0 , sizeof(tBTM_BLE_VSC_CB)); 3389 btm_cb.cmn_ble_vsc_cb.values_read = FALSE; 3390 3391 p_cb->observer_timer = alarm_new("btm_ble.observer_timer"); 3392 p_cb->cur_states = 0; 3393 p_cb->conn_pending_q = fixed_queue_new(SIZE_MAX); 3394 3395 p_cb->inq_var.adv_mode = BTM_BLE_ADV_DISABLE; 3396 p_cb->inq_var.scan_type = BTM_BLE_SCAN_MODE_NONE; 3397 p_cb->inq_var.adv_chnl_map = BTM_BLE_DEFAULT_ADV_CHNL_MAP; 3398 p_cb->inq_var.afp = BTM_BLE_DEFAULT_AFP; 3399 p_cb->inq_var.sfp = BTM_BLE_DEFAULT_SFP; 3400 p_cb->inq_var.connectable_mode = BTM_BLE_NON_CONNECTABLE; 3401 p_cb->inq_var.discoverable_mode = BTM_BLE_NON_DISCOVERABLE; 3402 p_cb->inq_var.fast_adv_timer = alarm_new("btm_ble_inq.fast_adv_timer"); 3403 p_cb->inq_var.inquiry_timer = alarm_new("btm_ble_inq.inquiry_timer"); 3404 3405 /* for background connection, reset connection params to be undefined */ 3406 p_cb->scan_int = p_cb->scan_win = BTM_BLE_SCAN_PARAM_UNDEF; 3407 3408 p_cb->inq_var.evt_type = BTM_BLE_NON_CONNECT_EVT; 3409 3410 p_cb->addr_mgnt_cb.refresh_raddr_timer = 3411 alarm_new("btm_ble_addr.refresh_raddr_timer"); 3412 3413 #if BLE_VND_INCLUDED == FALSE 3414 btm_ble_adv_filter_init(); 3415 #endif 3416 } 3417 3418 /******************************************************************************* 3419 ** 3420 ** Function btm_ble_topology_check 3421 ** 3422 ** Description check to see requested state is supported. One state check at 3423 ** a time is supported 3424 ** 3425 ** Returns TRUE is request is allowed, FALSE otherwise. 3426 ** 3427 *******************************************************************************/ 3428 BOOLEAN btm_ble_topology_check(tBTM_BLE_STATE_MASK request_state_mask) 3429 { 3430 BOOLEAN rt = FALSE; 3431 3432 UINT8 state_offset = 0; 3433 UINT16 cur_states = btm_cb.ble_ctr_cb.cur_states; 3434 UINT8 mask, offset; 3435 UINT8 request_state = 0; 3436 3437 /* check only one bit is set and within valid range */ 3438 if (request_state_mask == BTM_BLE_STATE_INVALID || 3439 request_state_mask > BTM_BLE_STATE_SCAN_ADV_BIT || 3440 (request_state_mask & (request_state_mask -1 )) != 0) 3441 { 3442 BTM_TRACE_ERROR("illegal state requested: %d", request_state_mask); 3443 return rt; 3444 } 3445 3446 while (request_state_mask) 3447 { 3448 request_state_mask >>= 1; 3449 request_state ++; 3450 } 3451 3452 /* check if the requested state is supported or not */ 3453 mask = btm_le_state_combo_tbl[0][request_state - 1][0]; 3454 offset = btm_le_state_combo_tbl[0][request_state-1][1]; 3455 3456 const uint8_t *ble_supported_states = controller_get_interface()->get_ble_supported_states(); 3457 3458 if (!BTM_LE_STATES_SUPPORTED(ble_supported_states, mask, offset)) 3459 { 3460 BTM_TRACE_ERROR("state requested not supported: %d", request_state); 3461 return rt; 3462 } 3463 3464 rt = TRUE; 3465 /* make sure currently active states are all supported in conjunction with the requested 3466 state. If the bit in table is not set, the combination is not supported */ 3467 while (cur_states != 0) 3468 { 3469 if (cur_states & 0x01) 3470 { 3471 mask = btm_le_state_combo_tbl[request_state][state_offset][0]; 3472 offset = btm_le_state_combo_tbl[request_state][state_offset][1]; 3473 3474 if (mask != 0 && offset != 0) 3475 { 3476 if (!BTM_LE_STATES_SUPPORTED(ble_supported_states, mask, offset)) 3477 { 3478 rt = FALSE; 3479 break; 3480 } 3481 } 3482 } 3483 cur_states >>= 1; 3484 state_offset ++; 3485 } 3486 return rt; 3487 } 3488 3489 #endif /* BLE_INCLUDED */ 3490
