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