stack/btm/btm_ble_gap.c

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