Google Git
Sign in
android / platform / external / bluetooth / bluedroid / 5738f83 / . / stack / btm / btm_ble_gap.c
blob: b9e17c0f949236451e1272bd67523cc2f8281672 [file] [log] [blame]
/******************************************************************************
*
* Copyright (C) 2008-2012 Broadcom Corporation
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
******************************************************************************/
/******************************************************************************
*
* This file contains functions for BLE GAP.
*
******************************************************************************/
#include <string.h>
#include <stdio.h>
#include <stddef.h>
#include "bt_types.h"
#include "btu.h"
#include "btm_int.h"
#include "hcimsgs.h"
#if (GAP_INCLUDED == TRUE)
#include "gap_api.h"
#endif
#if (BLE_INCLUDED == TRUE)
#define BTM_BLE_NAME_SHORT 0x01
#define BTM_BLE_NAME_CMPL 0x02
#define BTM_BLE_FILTER_TARGET_UNKNOWN 0xff
#define BTM_BLE_POLICY_UNKNOWN 0xff
#define BLE_RESOLVE_ADDR_MSB 0x40 /* most significant bit, bit7, bit6 is 01 to be resolvable random */
#define BLE_RESOLVE_ADDR_MASK 0xc0 /* bit 6, and bit7 */
#define BTM_BLE_IS_RESOLVE_BDA(x) ((x[0] & BLE_RESOLVE_ADDR_MASK) == BLE_RESOLVE_ADDR_MSB)
#define BTM_EXT_BLE_RMT_NAME_TIMEOUT 30
static tBLE_BD_ADDR le_bda_any ={BLE_ADDR_PUBLIC, {0x00,0x00,0x00,0x00,0x00,0x00}};
#define BTM_BLE_VALID_CONN_DIRECT(x) (memcmp(&le_bda_any, x, sizeof(tBLE_BD_ADDR)) != 0)
/*******************************************************************************
** Local functions
*******************************************************************************/
static void btm_ble_update_adv_flag(UINT8 flag);
static void btm_ble_process_adv_pkt_cont(BD_ADDR bda, UINT8 addr_type, UINT8 evt_type, UINT8 *p);
static UINT8 *btm_ble_build_adv_data(tBTM_BLE_AD_MASK *p_data_mask, UINT8 **p_dst, tBTM_BLE_ADV_DATA *p_data);
/*******************************************************************************
**
** Function BTM_BleReset
**
** Description This function is called to reset ULP controller.
**
** Parameters None.
**
** Returns void
**
*******************************************************************************/
void BTM_BleReset(void)
{
btsnd_hcic_ble_reset();
}
/*******************************************************************************
**
** Function BTM_BleObserve
**
** Description This procedure keep the device listening for advertising
** events from a broadcast device.
**
** Parameters start: start or stop observe.
** white_list: use white list in observer mode or not.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS BTM_BleObserve(BOOLEAN start, UINT8 duration,
tBTM_INQ_RESULTS_CB *p_results_cb, tBTM_CMPL_CB *p_cmpl_cb)
{
tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var;
tBTM_STATUS status = BTM_NO_RESOURCES;
BTM_TRACE_EVENT0 ("BTM_BleObserve ");
if (start)
{
if (p_inq->proc_mode != BTM_BLE_INQUIRY_NONE)
return BTM_BUSY;
btm_cb.btm_inq_vars.p_inq_results_cb = p_results_cb;
btm_cb.btm_inq_vars.p_inq_cmpl_cb = p_cmpl_cb;
/* allow config scanning type */
if (btsnd_hcic_ble_set_scan_params ((UINT8)((p_inq->scan_type == BTM_BLE_SCAN_MODE_NONE) ? BTM_BLE_SCAN_MODE_ACTI: p_inq->scan_type),
(UINT16)(!p_inq->scan_interval ? BTM_BLE_GAP_DISC_SCAN_INT : p_inq->scan_interval),
(UINT16)(!p_inq->scan_window ? BTM_BLE_GAP_DISC_SCAN_WIN : p_inq->scan_window),
BLE_ADDR_PUBLIC,
BTM_BLE_DEFAULT_SFP)) /* assume observe always not using white list */
{
/* start scan, disable duplicate filtering */
if (btsnd_hcic_ble_set_scan_enable (BTM_BLE_SCAN_ENABLE, BTM_BLE_DUPLICATE_DISABLE))
{
status = BTM_SUCCESS;
p_inq->proc_mode = BTM_BLE_OBSERVE;
btm_cb.btm_inq_vars.inq_active = TRUE;
if (duration != 0)
{
/* start inquiry timer */
btu_start_timer (&p_inq->inq_timer_ent, BTU_TTYPE_BLE_INQUIRY, duration);
}
}
}
}
else if (p_inq->proc_mode == BTM_BLE_OBSERVE)
{
btm_ble_stop_scan();
}
return status;
}
/*******************************************************************************
**
** Function BTM_BleBroadcast
**
** Description This function is to start or stop broadcasting.
**
** Parameters start: start or stop broadcasting.
**
** Returns status.
**
*******************************************************************************/
tBTM_STATUS BTM_BleBroadcast(BOOLEAN start)
{
tBTM_STATUS status = BTM_NO_RESOURCES;
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
UINT8 evt_type = p_cb->scan_rsp ? BTM_BLE_DISCOVER_EVT: BTM_BLE_NON_CONNECT_EVT;
#ifdef BTM_BLE_PC_ADV_TEST_MODE
if (BTM_BLE_PC_ADV_TEST_MODE)
{
evt_type = p_cb->scan_rsp ? BTM_BLE_CONNECT_EVT: BTM_BLE_NON_CONNECT_EVT;
}
#endif
if (start && p_cb->adv_mode == BTM_BLE_ADV_DISABLE)
{
/* update adv params */
if (!btsnd_hcic_ble_write_adv_params ((UINT16)(p_cb->adv_interval_min ? p_cb->adv_interval_min : BTM_BLE_GAP_ADV_INT),
(UINT16)(p_cb->adv_interval_max ? p_cb->adv_interval_max : BTM_BLE_GAP_ADV_INT),
evt_type,
p_cb->own_addr_type,
p_cb->direct_bda.type, p_cb->direct_bda.bda,
p_cb->adv_chnl_map,
p_cb->afp))
status = BTM_NO_RESOURCES;
else
p_cb->evt_type = evt_type;
if (btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_ENABLE))
{
p_cb->adv_mode = BTM_BLE_ADV_ENABLE;
status = BTM_SUCCESS;
}
}
else if (!start && p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
{
if (btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_DISABLE))
{
p_cb->adv_mode = BTM_BLE_ADV_DISABLE;
status = BTM_SUCCESS;
}
}
else
{
status = BTM_WRONG_MODE;
BTM_TRACE_ERROR2("Can not %s Broadcast, device %s in Broadcast mode",
(start ? "Start" : "Stop"), (start ? "alerady" :"not"));
}
return status;
}
/*******************************************************************************
**
** Function BTM_RegisterScanReqEvt
**
** Description This function is called to register a scan request callback
** on the advertiser.
**
** Parameters p_scan_req_cback: scan request callback. If NULL, remove the
** registration.
**
** Returns void
**
*******************************************************************************/
void BTM_RegisterScanReqEvt(tBTM_BLE_SCAN_REQ_CBACK *p_scan_req_cback)
{
#ifdef BTM_BLE_PC_ADV_TEST_MODE // For general stack code (e.g. BTInsight testing), we simply do not define it to exclude or set it to TRUE to include
if (BTM_BLE_PC_ADV_TEST_MODE) // For stack component, it is always defined and maps to a global variable g_bDraculaAdvertisingMode
{
tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;
p_cb->p_scan_req_cback = p_scan_req_cback;
}
#endif
}
/*******************************************************************************
**
** Function BTM_BleConfigPrivacy
**
** Description This function is called to enable or disable the privacy in
** the local device.
**
** Parameters enable: TRUE to enable it; FALSE to disable it.
**
** Returns void
**
*******************************************************************************/
void BTM_BleConfigPrivacy(BOOLEAN enable)
{
tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;
BTM_TRACE_EVENT0 (" BTM_BleConfigPrivacy");
p_cb->privacy = enable;
}
/*******************************************************************************
**
** Function BTM_BleSetBgConnType
**
** Description This function is called to set BLE connectable mode for a
** peripheral device.
**
** Parameters bg_conn_type: it can be auto connection, or selective connection.
** p_select_cback: callback function when selective connection procedure
** is being used.
**
** Returns void
**
*******************************************************************************/
BOOLEAN BTM_BleSetBgConnType(tBTM_BLE_CONN_TYPE bg_conn_type,
tBTM_BLE_SEL_CBACK *p_select_cback)
{
BOOLEAN started = TRUE;
BTM_TRACE_EVENT0 ("BTM_BleSetBgConnType ");
if (btm_cb.ble_ctr_cb.bg_conn_type != bg_conn_type)
{
switch (bg_conn_type)
{
case BTM_BLE_CONN_AUTO:
btm_ble_start_auto_conn(TRUE);
break;
case BTM_BLE_CONN_SELECTIVE:
if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_AUTO)
{
btm_ble_start_auto_conn(FALSE);
}
started = btm_ble_start_select_conn(TRUE, p_select_cback);
break;
case BTM_BLE_CONN_NONE:
if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_AUTO)
{
btm_ble_start_auto_conn(FALSE);
}
else if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE)
{
btm_ble_start_select_conn(FALSE, NULL);
}
started = TRUE;
break;
default:
BTM_TRACE_ERROR1("invalid bg connection type : %d ", bg_conn_type);
started = FALSE;
break;
}
if (started)
btm_cb.ble_ctr_cb.bg_conn_type = bg_conn_type;
}
return started;
}
/*******************************************************************************
**
** Function BTM_BleUpdateBgConnDev
**
** Description This function is called to add or remove a device into/from
** background connection procedure. The background connection
* procedure is decided by the background connection type, it can be
* auto connection, or selective connection.
**
** Parameters add_remove: TRUE to add; FALSE to remove.
** remote_bda: device address to add/remove.
**
** Returns void
**
*******************************************************************************/
BOOLEAN BTM_BleUpdateBgConnDev(BOOLEAN add_remove, BD_ADDR remote_bda)
{
tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;
tBTM_BLE_SEL_CBACK *p_select_cback;
BOOLEAN ret = TRUE;
BTM_TRACE_EVENT0 (" BTM_BleUpdateBgConnDev");
/* if auto connection is active */
if (p_cb->bg_conn_state == BLE_BG_CONN_ACTIVE)
{
if (p_cb->bg_conn_type == BTM_BLE_CONN_AUTO)
{
/* terminate auto connection first */
ret = btm_ble_start_auto_conn(FALSE);
}
else if (p_cb->bg_conn_type == BTM_BLE_CONN_SELECTIVE)
{
p_select_cback = btm_cb.ble_ctr_cb.p_select_cback;
ret = btm_ble_start_select_conn(FALSE, NULL);
}
}
if (ret)
{
/* update white list */
ret = btm_update_bg_conn_list(add_remove, remote_bda);
btm_update_dev_to_white_list(add_remove, remote_bda, BLE_ADDR_PUBLIC);
}
if (ret && p_cb->bg_conn_state == BLE_BG_CONN_IDLE)
{
if (p_cb->bg_conn_type == BTM_BLE_CONN_AUTO)
{
/* restart auto connection */
btm_ble_start_auto_conn(TRUE);
}
else if (p_cb->bg_conn_type == BTM_BLE_CONN_SELECTIVE)
{
p_select_cback = btm_cb.ble_ctr_cb.p_select_cback;
btm_ble_start_select_conn(TRUE, p_select_cback);
}
}
return ret;
}
/*******************************************************************************
**
** Function BTM_BleSetConnMode
**
** Description This function is called to set BLE connectable mode for a
** peripheral device.
**
** Parameters directed: is directed connectable mode, or non-directed.
** p_dir_bda: connectable direct initiator's LE device address
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS BTM_BleSetConnMode(BOOLEAN directed, tBLE_BD_ADDR *p_dir_bda)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
tBTM_STATUS status = BTM_SUCCESS;
BD_ADDR reconn_bda;
BTM_TRACE_EVENT0 ("BTM_BleSetConnMode ");
memcpy(&p_cb->direct_bda, &le_bda_any, sizeof(tBLE_BD_ADDR));
p_cb->own_addr_type = BLE_ADDR_PUBLIC;
if (directed)
{
if (p_dir_bda)
{
memcpy(&p_cb->direct_bda, p_dir_bda, sizeof(tBLE_BD_ADDR));
if (btm_cb.ble_ctr_cb.privacy /* && GAP privacy ad reconnect addr exist */)
{
/* write reconnect address to controller*/
btsnd_hcic_ble_set_random_addr(reconn_bda);
}
/* else use static address or publich address */
}
else
status = BTM_ILLEGAL_VALUE;
}
else /* undirected connecatable */
{
if (btm_cb.ble_ctr_cb.privacy /* GAP privacy flag enabled */)
{
/* generate resolvable private address */
btm_gen_resolvable_private_addr();
} /* else use publich address */
}
return status;
}
/*******************************************************************************
**
** Function BTM_BleSetAdvParams
**
** Description This function is called to set advertising parameters.
**
** Parameters adv_int_min: minimum advertising interval
** adv_int_max: maximum advertising interval
** p_dir_bda: connectable direct initiator's LE device address
** chnl_map: advertising channel map.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS BTM_BleSetAdvParams(UINT16 adv_int_min, UINT16 adv_int_max,
tBLE_BD_ADDR *p_dir_bda,
tBTM_BLE_ADV_CHNL_MAP chnl_map)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
tBTM_STATUS status = BTM_SUCCESS;
BTM_TRACE_EVENT0 ("BTM_BleSetAdvParams");
if (!BTM_BLE_VALID_PRAM(adv_int_min, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX) ||
!BTM_BLE_VALID_PRAM(adv_int_max, BTM_BLE_ADV_INT_MIN, BTM_BLE_ADV_INT_MAX))
{
return BTM_ILLEGAL_VALUE;
}
p_cb->adv_interval_min = adv_int_min;
p_cb->adv_interval_max = adv_int_max;
p_cb->adv_chnl_map = chnl_map;
if (p_dir_bda)
{
memcpy(&p_cb->direct_bda, p_dir_bda, sizeof(tBLE_BD_ADDR));
}
else
memcpy(&p_cb->direct_bda, &le_bda_any, sizeof(tBLE_BD_ADDR));
if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
{
BTM_TRACE_EVENT0 ("update params for an active adv");
if (p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE)
{
if (BTM_BLE_VALID_CONN_DIRECT(&p_cb->direct_bda))
p_cb->evt_type = BTM_BLE_CONNECT_DIR_EVT;
else
p_cb->evt_type = BTM_BLE_CONNECT_EVT;
BTM_TRACE_DEBUG1(" evt_type = %d", p_cb->evt_type);
}
if (!btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_DISABLE))
status = BTM_NO_RESOURCES;
else
/* update adv params */
if (!btsnd_hcic_ble_write_adv_params (p_cb->adv_interval_min,
p_cb->adv_interval_max,
p_cb->evt_type,
p_cb->own_addr_type,
p_cb->direct_bda.type,
p_cb->direct_bda.bda,
p_cb->adv_chnl_map,
p_cb->afp))
status = BTM_NO_RESOURCES;
else if (!btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_ENABLE))
{
p_cb->adv_mode = BTM_BLE_ADV_DISABLE;
status = BTM_NO_RESOURCES;
}
}
return status;
}
/*******************************************************************************
**
** Function BTM_BleReadAdvParams
**
** Description This function is called to set advertising parameters.
**
** Parameters adv_int_min: minimum advertising interval
** adv_int_max: maximum advertising interval
** p_dir_bda: connectable direct initiator's LE device address
** chnl_map: advertising channel map.
**
** Returns void
**
*******************************************************************************/
void BTM_BleReadAdvParams (UINT16 *adv_int_min, UINT16 *adv_int_max,
tBLE_BD_ADDR *p_dir_bda, tBTM_BLE_ADV_CHNL_MAP *p_chnl_map)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
BTM_TRACE_EVENT0 ("BTM_BleReadAdvParams ");
*adv_int_min = p_cb->adv_interval_min;
*adv_int_max = p_cb->adv_interval_max;
*p_chnl_map = p_cb->adv_chnl_map;
if (p_dir_bda != NULL)
{
memcpy(p_dir_bda, &p_cb->direct_bda, sizeof(tBLE_BD_ADDR));
}
}
/*******************************************************************************
**
** Function BTM_BleSetScanParams
**
** Description This function is called to set Scan parameters.
**
** Parameters adv_int_min: minimum advertising interval
** adv_int_max: maximum advertising interval
** p_dir_bda: connectable direct initiator's LE device address
** chnl_map: advertising channel map.
** scan_type: active scan or passive scan
**
** Returns void
**
*******************************************************************************/
void BTM_BleSetScanParams(UINT16 scan_interval, UINT16 scan_window, tBTM_BLE_SCAN_MODE scan_mode)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
BTM_TRACE_EVENT0 (" BTM_BleSetScanParams");
if (BTM_BLE_VALID_PRAM(scan_interval, BTM_BLE_SCAN_INT_MIN, BTM_BLE_SCAN_INT_MAX) &&
BTM_BLE_VALID_PRAM(scan_window, BTM_BLE_SCAN_WIN_MIN, BTM_BLE_SCAN_WIN_MAX) &&
(scan_mode == BTM_BLE_SCAN_MODE_ACTI || scan_mode == BTM_BLE_SCAN_MODE_PASS))
{
p_cb->scan_type = scan_mode;
if (BTM_BLE_CONN_PARAM_UNDEF != scan_interval)
p_cb->scan_interval = scan_interval;
if (BTM_BLE_CONN_PARAM_UNDEF != scan_window)
p_cb->scan_window = scan_window;
}
else
{
BTM_TRACE_ERROR2("Illegal params: scan_interval = %d scan_window = %d",
scan_interval, scan_window);
}
}
/*******************************************************************************
**
** Function BTM_BleWriteScanRsp
**
** Description This function is called to write LE scan response.
**
** Parameters: p_scan_rsp: scan response information.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS BTM_BleWriteScanRsp(tBTM_BLE_AD_MASK data_mask, tBTM_BLE_ADV_DATA *p_data)
{
tBTM_STATUS status = BTM_NO_RESOURCES;
UINT8 rsp_data[BTM_BLE_AD_DATA_LEN],
*p = rsp_data;
BTM_TRACE_EVENT0 (" BTM_BleWriteScanRsp");
memset(rsp_data, 0, BTM_BLE_AD_DATA_LEN);
btm_ble_build_adv_data(&data_mask, &p, p_data);
if (btsnd_hcic_ble_set_scan_rsp_data((UINT8)(p - rsp_data), rsp_data))
{
status = BTM_SUCCESS;
if (p_data != NULL)
btm_cb.ble_ctr_cb.inq_var.scan_rsp = TRUE;
else
btm_cb.ble_ctr_cb.inq_var.scan_rsp = FALSE;
}
else
status = BTM_ILLEGAL_VALUE;
return status;
}
/*******************************************************************************
**
** Function BTM_BleWriteAdvData
**
** Description This function is called to write advertising data.
**
** Parameters: None.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS BTM_BleWriteAdvData(tBTM_BLE_AD_MASK data_mask, tBTM_BLE_ADV_DATA *p_data)
{
tBTM_BLE_LOCAL_ADV_DATA *p_cb_data = &btm_cb.ble_ctr_cb.inq_var.adv_data;
UINT8 *p;
UINT16 mask = data_mask;
memset(p_cb_data, 0, sizeof(tBTM_BLE_LOCAL_ADV_DATA));
p = p_cb_data->ad_data;
p_cb_data->data_mask = data_mask;
BTM_TRACE_EVENT0 ("BTM_BleWriteAdvData ");
p_cb_data->p_flags = btm_ble_build_adv_data(&mask, &p, p_data);
p_cb_data->p_pad = p;
if (data_mask != 0)
{
BTM_TRACE_ERROR0("Partial data write into ADV");
}
p_cb_data->data_mask &= ~mask;
if (btsnd_hcic_ble_set_adv_data((UINT8)(p_cb_data->p_pad - p_cb_data->ad_data),
p_cb_data->ad_data))
return BTM_SUCCESS;
else
return BTM_NO_RESOURCES;
}
/*******************************************************************************
**
** Function BTM_CheckAdvData
**
** Description This function is called to get ADV data for a specific type.
**
** Parameters p_adv - pointer of ADV data
** type - finding ADV data type
** p_length - return the length of ADV data not including type
**
** Returns pointer of ADV data
**
*******************************************************************************/
UINT8 *BTM_CheckAdvData( UINT8 *p_adv, UINT8 type, UINT8 *p_length)
{
UINT8 *p = p_adv;
UINT8 length;
UINT8 adv_type;
BTM_TRACE_API1("BTM_CheckAdvData type=0x%02X", type);
STREAM_TO_UINT8(length, p);
while ( length && (p - p_adv <= BTM_BLE_CACHE_ADV_DATA_MAX))
{
STREAM_TO_UINT8(adv_type, p);
if ( adv_type == type )
{
/* length doesn't include itself */
*p_length = length - 1; /* minus the length of type */
return p;
}
p += length - 1; /* skip the length of data */
STREAM_TO_UINT8(length, p);
}
*p_length = 0;
return NULL;
}
/*******************************************************************************
**
** Function btm_ble_build_adv_data
**
** Description This function is called build the adv data and rsp data.
*******************************************************************************/
static UINT8 *btm_ble_build_adv_data(tBTM_BLE_AD_MASK *p_data_mask, UINT8 **p_dst, tBTM_BLE_ADV_DATA *p_data)
{
UINT16 data_mask = *p_data_mask;
UINT8 *p = *p_dst,
*p_flag = NULL;
UINT16 len = BTM_BLE_AD_DATA_LEN, cp_len = 0;
UINT8 i = 0;
tBTM_BLE_ATTR *p_attr;
tBTM_BLE_PROP_ELEM *p_elem;
BTM_TRACE_EVENT0 (" btm_ble_build_adv_data");
/* build the adv data structure and build the data string */
if (data_mask)
{
/* flags */
if (data_mask & BTM_BLE_AD_BIT_FLAGS)
{
*p++ = 2;
*p++ = BTM_BLE_AD_TYPE_FLAG;
p_flag = p;
if (p_data)
*p++ = p_data->flag;
else
*p++ = 0;
len -= 3;
data_mask &= ~BTM_BLE_AD_BIT_FLAGS;
}
/* device name */
if (len > 2 && data_mask & BTM_BLE_AD_BIT_DEV_NAME)
{
if (strlen(btm_cb.cfg.bd_name) > (UINT16)(len - 2))
{
*p++ = len - 2 + 1;
*p++ = BTM_BLE_AD_TYPE_NAME_SHORT;
ARRAY_TO_STREAM(p, btm_cb.cfg.bd_name, len - 2);
}
else
{
cp_len = (UINT16)strlen(btm_cb.cfg.bd_name);
*p++ = cp_len + 1;
*p++ = BTM_BLE_AD_TYPE_NAME_CMPL;
ARRAY_TO_STREAM(p, btm_cb.cfg.bd_name, cp_len);
}
len -= (cp_len + 2);
data_mask &= ~BTM_BLE_AD_BIT_DEV_NAME;
}
/* manufacturer data */
if (len > 2 && data_mask & BTM_BLE_AD_BIT_MANU &&
p_data && p_data->manu.len != 0 && p_data->manu.p_val)
{
if (p_data->manu.len > (len - 2))
cp_len = len - 2;
else
cp_len = p_data->manu.len;
*p++ = cp_len + 1;
*p++ = BTM_BLE_AD_TYPE_MANU;
ARRAY_TO_STREAM(p, p_data->manu.p_val, cp_len);
len -= (cp_len + 2);
data_mask &= ~BTM_BLE_AD_BIT_MANU;
}
/* TX power */
if (len > 2 && data_mask & BTM_BLE_AD_BIT_TX_PWR)
{
*p++ = 2;
*p++ = BTM_BLE_AD_TYPE_TX_PWR;
*p++ = btm_cb.ble_ctr_cb.inq_var.tx_power;
len -= 3;
data_mask &= ~BTM_BLE_AD_BIT_TX_PWR;
}
/* services */
if (len > 2 && data_mask & BTM_BLE_AD_BIT_SERVICE &&
p_data && p_data->services.num_service != 0 &&
p_data->services.p_uuid)
{
if (p_data->services.num_service * 2 > (len - 2))
{
cp_len = (len - 2)/2;
*p ++ = 1 + cp_len * 2;
*p++ = BTM_BLE_AD_TYPE_SRV_PART;
}
else
{
cp_len = p_data->services.num_service;
*p++ = 1 + cp_len * 2;
*p++ = BTM_BLE_AD_TYPE_SRV_CMPL;
}
for (i = 0; i < cp_len; i ++)
{
UINT16_TO_STREAM(p, *(p_data->services.p_uuid + i));
}
len -= (cp_len * 2 + 2);
data_mask &= ~BTM_BLE_AD_BIT_SERVICE;
}
if (len >= 6 && data_mask & BTM_BLE_AD_BIT_INT_RANGE &&
p_data)
{
*p++ = 5;
*p++ = BTM_BLE_AD_TYPE_INT_RANGE;
UINT16_TO_STREAM(p, p_data->int_range.low);
UINT16_TO_STREAM(p, p_data->int_range.hi);
len -= 6;
data_mask &= ~BTM_BLE_AD_BIT_INT_RANGE;
}
if (data_mask & BTM_BLE_AD_BIT_ATTR && p_data && p_data->attr.num_attr != 0)
{
for (i = 0; i < p_data->attr.num_attr ; i ++)
{
p_attr = p_data->attr.attr_list + i;
if (len >= (2 + 2 + p_attr->data_len))/* len byte(1) + ATTR type(1) + Uuid len(2) + value length */
{
*p ++ = p_attr->data_len + 2 + 1; /* Uuid len + value length */
*p ++ = BTM_BLE_AD_TYPE_ATTR;
UINT16_TO_STREAM(p, p_attr->uuid);
ARRAY_TO_STREAM(p, p_attr->p_data, p_attr->data_len);
len -= (4 + p_attr->data_len);
}
else
break;
}
if (i == p_data->attr.num_attr)
data_mask &= ~BTM_BLE_AD_BIT_ATTR;
}
if (data_mask & BTM_BLE_AD_BIT_PROPRIETARY && p_data && p_data->p_proprietary)
{
for (i = 0; i < p_data->p_proprietary->num_elem ; i ++)
{
p_elem = p_data->p_proprietary->p_elem + i;
if (len >= (2 + p_elem->len))/* len byte(1) + ATTR type(1) + Uuid len(2) + value length */
{
*p ++ = p_elem->len + 1; /* Uuid len + value length */
*p ++ = p_elem->adv_type;
ARRAY_TO_STREAM(p, p_elem->p_val, p_elem->len);
len -= (2 + p_elem->len);
}
else
{
BTM_TRACE_WARNING0("data exceed max adv packet length");
break;
}
}
data_mask &= ~BTM_BLE_AD_BIT_PROPRIETARY;
}
}
*p_data_mask = data_mask;
*p_dst = p;
return p_flag;
}
/*******************************************************************************
**
** Function btm_ble_set_discoverability
**
** Description This function is called to set BLE discoverable mode.
**
** Parameters: mode: discoverability mode.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS btm_ble_set_discoverability(UINT16 combined_mode)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
UINT16 mode = (combined_mode & BTM_BLE_DISCOVERABLE_MASK);
UINT8 flag = 0;
UINT8 new_mode = BTM_BLE_ADV_ENABLE;
UINT8 evt_type = (p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE) ? \
((p_cb->scan_rsp) ? BTM_BLE_DISCOVER_EVT : BTM_BLE_NON_CONNECT_EVT )\
: BTM_BLE_CONNECT_EVT;
tBTM_STATUS status = BTM_SUCCESS;
BTM_TRACE_EVENT2 ("btm_ble_set_discoverability mode=0x%0x combined_mode=0x%x", mode, combined_mode);
/*** Check mode parameter ***/
if (mode > BTM_BLE_MAX_DISCOVERABLE)
return(BTM_ILLEGAL_VALUE);
p_cb->br_edr_supported_flag |= (combined_mode & BTM_DISCOVERABLE_MASK);
p_cb->discoverable_mode = mode;
if (!p_cb->br_edr_supported_flag)
{
flag = BTM_BLE_BREDR_NOT_SPT;
BTM_TRACE_DEBUG1("btm_ble_set_discoverability (BREDR not sup)flag=0x%x",flag);
}
BTM_TRACE_DEBUG1 ("br_edr_supported=0x%x", p_cb->br_edr_supported_flag);
if (mode == BTM_BLE_LIMITED_DISCOVERABLE || mode == BTM_BLE_GENERAL_DISCOVERABLE)
{
BTM_TRACE_EVENT0 ("mode == BTM_BLE_LIMITED_DISCOVERABLE ");
/* write ADV data with limited disc flag */
if (mode == BTM_BLE_LIMITED_DISCOVERABLE)
flag |= BTM_BLE_LIMIT_DISC_FLAG ;
else
flag |= BTM_BLE_GEN_DISC_FLAG;
}
else /* non-discoverable */
{
BTM_TRACE_EVENT0 ("mode == BTM_BLE_NON_DISCOVERABLE ");
if (p_cb->connectable_mode == BTM_BLE_NON_CONNECTABLE)
{
p_cb->br_edr_supported_flag = 0;
BTM_TRACE_EVENT0 ("always disable adv in non-discoverable non-connectable mode if no scan rsp ");
if (!p_cb->scan_rsp )
new_mode = BTM_BLE_ADV_DISABLE;
}
else
{
if (BTM_BLE_VALID_CONN_DIRECT(&p_cb->direct_bda))
{
BTM_TRACE_DEBUG0("evt_type = BTM_BLE_CONNECT_DIR_EVT");
evt_type = BTM_BLE_CONNECT_DIR_EVT;
}
else
{
BTM_TRACE_DEBUG0(" evt_type = BTM_BLE_CONNECT_EVT");
evt_type = BTM_BLE_CONNECT_EVT;
}
}
}
btm_ble_update_adv_flag(flag);
/* update adv params if start advertising */
BTM_TRACE_EVENT2 ("evt_type=0x%x p-cb->evt_type=0x%x ", evt_type, p_cb->evt_type);
if (new_mode == BTM_BLE_ADV_ENABLE && evt_type != p_cb->evt_type)
{
if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
{
BTM_TRACE_EVENT0 ("Set Adv disable");
p_cb->adv_mode = BTM_BLE_ADV_DISABLE;
btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_DISABLE);
}
/* update adv params */
if (!btsnd_hcic_ble_write_adv_params ((UINT16)(p_cb->adv_interval_min ? p_cb->adv_interval_min : BTM_BLE_GAP_ADV_INT),
(UINT16)(p_cb->adv_interval_max ? p_cb->adv_interval_max : BTM_BLE_GAP_ADV_INT),
evt_type,
p_cb->own_addr_type,
p_cb->direct_bda.type, p_cb->direct_bda.bda,
p_cb->adv_chnl_map,
p_cb->afp))
status = BTM_NO_RESOURCES;
else
p_cb->evt_type = evt_type;
}
if (status == BTM_SUCCESS && p_cb->adv_mode != new_mode)
{
/* update advertising mode */
if (!btsnd_hcic_ble_set_adv_enable (new_mode))
status = BTM_NO_RESOURCES;
else
p_cb->adv_mode = new_mode;
}
/* set up stop advertising timer */
if (status == BTM_SUCCESS && mode == BTM_BLE_LIMITED_DISCOVERABLE)
{
BTM_TRACE_EVENT1 ("start timer for limited disc mode duration=%d (30 secs)", BTM_BLE_GAP_LIM_TOUT);
/* start Tgap(lim_timeout) */
btu_start_timer (&p_cb->inq_timer_ent, BTU_TTYPE_BLE_GAP_LIM_DISC,
BTM_BLE_GAP_LIM_TOUT);
}
return status;
}
/*******************************************************************************
**
** Function btm_ble_set_connectability
**
** Description This function is called to set BLE connectability mode.
**
** Parameters: mode: connectability mode.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS btm_ble_set_connectability(UINT16 combined_mode)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
UINT16 mode = (combined_mode & BTM_BLE_CONNECTABLE_MASK);
UINT8 cur_flag = 0;
UINT8 cur_br_edr_not_sup_flag;
UINT8 new_flag;
UINT8 new_mode = BTM_BLE_ADV_ENABLE;
UINT8 evt_type = (p_cb->scan_rsp) ? BTM_BLE_DISCOVER_EVT: BTM_BLE_NON_CONNECT_EVT;
tBTM_STATUS status = BTM_SUCCESS;
BTM_TRACE_EVENT2 ("btm_ble_set_connectability mode=0x%0x combined_mode=0x%x", mode, combined_mode);
/*** Check mode parameter ***/
if (mode > BTM_BLE_MAX_CONNECTABLE)
return(BTM_ILLEGAL_VALUE);
if (btm_cb.ble_ctr_cb.inq_var.adv_data.p_flags)
cur_flag = *btm_cb.ble_ctr_cb.inq_var.adv_data.p_flags ;
cur_br_edr_not_sup_flag = (cur_flag & ((UINT8) BTM_BLE_BREDR_NOT_SPT));
p_cb->br_edr_supported_flag |= ((combined_mode & BTM_CONNECTABLE_MASK) << 4);
if (p_cb->br_edr_supported_flag && cur_br_edr_not_sup_flag)
{
new_flag = cur_flag & ((UINT8) (~BTM_BLE_BREDR_NOT_SPT));
BTM_TRACE_EVENT2 ("new flag=0x%x cur flag=0x%x",new_flag, cur_flag);
btm_ble_update_adv_flag(new_flag);
}
p_cb->connectable_mode = mode;
if (mode == BTM_BLE_NON_CONNECTABLE)
{
if (p_cb->discoverable_mode == BTM_BLE_NON_DISCOVERABLE)
{
p_cb->br_edr_supported_flag = 0;
BTM_TRACE_EVENT0 ("always disable adv in non-discoverable non-connectable mode with no scan rsp");
if(!p_cb->scan_rsp)
new_mode = BTM_BLE_ADV_DISABLE;
}
}
else /* connectable */
{
BTM_TRACE_DEBUG2("btm_ble_set_connectability: mode = %04x discoverable_mode= %02x", mode, p_cb->discoverable_mode);
if (BTM_BLE_VALID_CONN_DIRECT(&p_cb->direct_bda))
{
BTM_TRACE_DEBUG0("evt_type = BTM_BLE_CONNECT_DIR_EVT");
evt_type = BTM_BLE_CONNECT_DIR_EVT;
}
else
{
BTM_TRACE_DEBUG0(" evt_type = BTM_BLE_CONNECT_EVT");
evt_type = BTM_BLE_CONNECT_EVT;
}
}
/* update adv params if needed */
if (p_cb->evt_type != evt_type && new_mode == BTM_BLE_ADV_ENABLE)
{
if (p_cb->adv_mode == BTM_BLE_ADV_ENABLE)
{
p_cb->adv_mode = BTM_BLE_ADV_DISABLE;
btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_DISABLE);
}
if (!btsnd_hcic_ble_write_adv_params ((UINT16)(p_cb->adv_interval_min ? p_cb->adv_interval_min : BTM_BLE_GAP_ADV_INT),
(UINT16)(p_cb->adv_interval_max ? p_cb->adv_interval_max : BTM_BLE_GAP_ADV_INT),
evt_type,
p_cb->own_addr_type,
p_cb->direct_bda.type,
p_cb->direct_bda.bda,
p_cb->adv_chnl_map,
p_cb->afp))
status = BTM_NO_RESOURCES;
else
p_cb->evt_type = evt_type;
}
/* update advertising mode */
if (status == BTM_SUCCESS && new_mode != p_cb->adv_mode)
{
if (btsnd_hcic_ble_set_adv_enable (new_mode))
{
status = BTM_SUCCESS;
p_cb->adv_mode = new_mode;
}
}
return status;
}
/*******************************************************************************
**
** Function btm_ble_start_inquiry
**
** Description This function is called to start BLE inquiry procedure.
** If the duration is zero, the periodic inquiry mode is cancelled.
**
** Parameters: mode - GENERAL or LIMITED inquiry
** p_inq_params - pointer to the BLE inquiry parameter.
** p_results_cb - callback returning pointer to results (tBTM_INQ_RESULTS)
** p_cmpl_cb - callback indicating the end of an inquiry
**
**
**
** Returns BTM_CMD_STARTED if successfully started
** BTM_ILLEGAL_VALUE if a bad parameter is detected
** BTM_NO_RESOURCES if could not allocate a message buffer
** BTM_SUCCESS - if cancelling the periodic inquiry
** BTM_BUSY - if an inquiry is already active
** BTM_WRONG_MODE if the device is not up.
**
*******************************************************************************/
tBTM_STATUS btm_ble_start_inquiry (UINT8 mode, UINT8 duration)
{
tBTM_STATUS status = BTM_NO_RESOURCES;
tBTM_BLE_INQ_CB *p_inq = &btm_cb.ble_ctr_cb.inq_var;
BTM_TRACE_DEBUG2("btm_ble_start_inquiry: mode = %02x inq_active = %d", mode, btm_cb.btm_inq_vars.inq_active);
if (p_inq->proc_mode != BTM_BLE_INQUIRY_NONE)
{
BTM_TRACE_ERROR0("LE scan is active, can not start inquiry");
return(BTM_BUSY);
}
btm_update_scanner_filter_policy(SP_ADV_ALL);
/* start scan, already enable duplicate filtering */
if (btsnd_hcic_ble_set_scan_enable (BTM_BLE_SCAN_ENABLE, BTM_BLE_DUPLICATE_DISABLE))
{
status = BTM_SUCCESS;
p_inq->proc_mode = mode;
if (duration != 0)
{
/* start inquiry timer */
btu_start_timer (&p_inq->inq_timer_ent, BTU_TTYPE_BLE_INQUIRY, duration);
}
}
return status;
}
/*******************************************************************************
**
** Function btm_ble_read_remote_name_cmpl
**
** Description This function is called when BLE remote name is received.
**
** Returns void
**
*******************************************************************************/
void btm_ble_read_remote_name_cmpl(BOOLEAN status, BD_ADDR bda, UINT16 length, char *p_name)
{
UINT8 hci_status = HCI_SUCCESS;
BD_NAME bd_name;
memset(bd_name, 0, BD_NAME_LEN);
memcpy((UINT8*)bd_name, p_name, length);
if ((!status) || (length==0))
{
hci_status = HCI_ERR_HOST_TIMEOUT;
}
btm_process_remote_name(bda, bd_name, length, hci_status);
btm_sec_rmt_name_request_complete (bda, (UINT8 *)p_name, hci_status);
}
/*******************************************************************************
**
** Function btm_ble_read_remote_name
**
** Description This function read remote LE device name using GATT read
** procedure.
**
** Parameters: None.
**
** Returns void
**
*******************************************************************************/
tBTM_STATUS btm_ble_read_remote_name(BD_ADDR remote_bda, tBTM_INQ_INFO *p_cur, tBTM_CMPL_CB *p_cb)
{
tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars;
if (p_cur &&
p_cur->results.ble_evt_type != BTM_BLE_EVT_CONN_ADV &&
p_cur->results.ble_evt_type != BTM_BLE_EVT_CONN_DIR_ADV)
{
BTM_TRACE_DEBUG0("name request to non-connectable device failed.");
return BTM_ERR_PROCESSING;
}
/* read remote device name using GATT procedure */
if (p_inq->remname_active)
return BTM_BUSY;
if (!GAP_BleReadPeerDevName(remote_bda, btm_ble_read_remote_name_cmpl))
return BTM_BUSY;
p_inq->p_remname_cmpl_cb = p_cb;
p_inq->remname_active = TRUE;
memcpy(p_inq->remname_bda, remote_bda, BD_ADDR_LEN);
btu_start_timer (&p_inq->rmt_name_timer_ent,
BTU_TTYPE_BTM_RMT_NAME,
BTM_EXT_BLE_RMT_NAME_TIMEOUT);
return BTM_CMD_STARTED;
}
/*******************************************************************************
**
** Function btm_ble_cancel_remote_name
**
** Description This function cancel read remote LE device name.
**
** Parameters: None.
**
** Returns void
**
*******************************************************************************/
BOOLEAN btm_ble_cancel_remote_name(BD_ADDR remote_bda)
{
tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars;
BOOLEAN status;
status = GAP_BleCancelReadPeerDevName(remote_bda);
p_inq->remname_active = FALSE;
memset(p_inq->remname_bda, 0, BD_ADDR_LEN);
btu_stop_timer(&p_inq->rmt_name_timer_ent);
return status;
}
/*******************************************************************************
**
** Function btm_ble_update_adv_flag
**
** Description This function update the limited discoverable flag in the adv
** data.
**
** Parameters: None.
**
** Returns void
**
*******************************************************************************/
static void btm_ble_update_adv_flag(UINT8 flag)
{
tBTM_BLE_LOCAL_ADV_DATA *p_adv_data = &btm_cb.ble_ctr_cb.inq_var.adv_data;
UINT8 *p;
BTM_TRACE_DEBUG1 ("btm_ble_update_adv_flag new=0x%x", flag);
if (p_adv_data->p_flags != NULL)
{
BTM_TRACE_DEBUG1 ("btm_ble_update_adv_flag old=0x%x", *p_adv_data->p_flags);
*p_adv_data->p_flags = flag;
}
else /* no FLAGS in ADV data*/
{
p = (p_adv_data->p_pad == NULL) ? p_adv_data->ad_data : p_adv_data->p_pad;
/* need 3 bytes space to stuff in the flags, if not */
/* erase all written data, just for flags */
if ((BTM_BLE_AD_DATA_LEN - (p - p_adv_data->ad_data)) < 3)
{
p = p_adv_data->p_pad = p_adv_data->ad_data;
memset(p_adv_data->ad_data, 0, BTM_BLE_AD_DATA_LEN);
}
*p++ = 2;
*p++ = BTM_BLE_AD_TYPE_FLAG;
p_adv_data->p_flags = p;
*p++ = flag;
p_adv_data->p_pad = p;
}
if (btsnd_hcic_ble_set_adv_data((UINT8)(p_adv_data->p_pad - p_adv_data->ad_data),
p_adv_data->ad_data))
p_adv_data->data_mask |= BTM_BLE_AD_BIT_FLAGS;
}
#if 0
/*******************************************************************************
**
** Function btm_ble_parse_adv_data
**
** Description This function parse the adv data into a structure.
**
** Returns pointer to entry, or NULL if not found
**
*******************************************************************************/
static void btm_ble_parse_adv_data(tBTM_INQ_INFO *p_info, UINT8 *p_data,
UINT8 len, tBTM_BLE_INQ_DATA *p_adv_data, UINT8 *p_buf)
{
UINT8 *p_cur = p_data;
UINT8 ad_len, ad_type, ad_flag;
tBTM_BLE_ATTR *p_attr;
BTM_TRACE_EVENT0 (" btm_ble_parse_adv_data");
while (len > 0)
{
BTM_TRACE_DEBUG1("btm_ble_parse_adv_data: len = %d", len);
if ((ad_len = *p_cur ++) == 0)
break;
ad_type = *p_cur ++;
BTM_TRACE_DEBUG2(" ad_type = %02x ad_len = %d", ad_type, ad_len);
switch (ad_type)
{
case BTM_BLE_AD_TYPE_NAME_SHORT:
case BTM_BLE_AD_TYPE_NAME_CMPL:
p_adv_data->ad_mask |= BTM_BLE_AD_BIT_DEV_NAME;
if (p_info)
{
p_info->remote_name_type =(ad_type == BTM_BLE_AD_TYPE_NAME_SHORT) ?
BTM_BLE_NAME_SHORT: BTM_BLE_NAME_CMPL;
memcpy(p_info->remote_name, p_cur, ad_len -1);
p_info->remote_name[ad_len] = 0;
p_adv_data->p_remote_name = p_info->remote_name;
p_info->remote_name_len = p_adv_data->remote_name_len = ad_len - 1;
BTM_TRACE_DEBUG1("BTM_BLE_AD_TYPE_NAME name = %s",p_adv_data->p_remote_name);
}
p_cur += (ad_len -1);
break;
case BTM_BLE_AD_TYPE_FLAG:
p_adv_data->ad_mask |= BTM_BLE_AD_BIT_FLAGS;
ad_flag = *p_cur ++;
p_adv_data->flag = (UINT8)(ad_flag & BTM_BLE_ADV_FLAG_MASK) ;
BTM_TRACE_DEBUG3("BTM_BLE_AD_TYPE_FLAG flag = %s | %s | %s",
(p_adv_data->flag & BTM_BLE_LIMIT_DISC_FLAG)? "LE_LIMIT_DISC" : "",
(p_adv_data->flag & BTM_BLE_GEN_DISC_FLAG)? "LE_GENERAL_DISC" : "",
(p_adv_data->flag & BTM_BLE_BREDR_NOT_SPT)? "LE Only device" : "");
break;
case BTM_BLE_AD_TYPE_TX_PWR:
p_adv_data->ad_mask |= BTM_BLE_AD_BIT_TX_PWR;
p_adv_data->tx_power_level = (INT8)*p_cur ++;
BTM_TRACE_DEBUG1("BTM_BLE_AD_TYPE_TX_PWR tx_level = %d", p_adv_data->tx_power_level);
break;
case BTM_BLE_AD_TYPE_ATTR:
p_adv_data->ad_mask |= BTM_BLE_AD_BIT_ATTR;
p_attr = &p_adv_data->attr_data.attr_list[p_adv_data->attr_data.num_attr];
p_attr->uuid = *p_cur ++;
if (ad_len > 3)
{
p_attr->data_len = ad_len - 3;
p_attr->p_data = p_buf;
memcpy(p_attr->p_data, p_cur, p_attr->data_len);
p_buf += p_attr->data_len;
}
p_adv_data->attr_data.num_attr ++;
BTM_TRACE_DEBUG2("BTM_BLE_AD_TYPE_ATTR[%d] uuid = 0x%04x",p_adv_data->attr_data.num_attr, p_attr->uuid);
break;
case BTM_BLE_AD_TYPE_MANU:
case BTM_BLE_AD_TYPE_SRV_CMPL:
case BTM_BLE_AD_TYPE_SRV_PART:
p_adv_data->ad_mask |= ad_type;
/* need allocate memory to store UUID list */
p_adv_data->service.num_service = (ad_len - 1)/2;
BTM_TRACE_DEBUG1("service UUID list, num = %d", p_adv_data->service.num_service);
default:
p_cur += (ad_len - 1);
break;
}
len -= (ad_len + 1);
}
}
#endif
/*******************************************************************************
**
** Function btm_ble_cache_adv_data
**
** Description Update advertising cache data.
**
** Returns void
**
*******************************************************************************/
void btm_ble_cache_adv_data(tBTM_INQ_RESULTS *p_cur, UINT8 data_len, UINT8 *p, UINT8 evt_type)
{
tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
UINT8 *p_cache;
UINT8 length;
/* cache adv report/scan response data */
if (evt_type != BTM_BLE_SCAN_RSP_EVT)
{
p_le_inq_cb->adv_len = 0;
memset(p_le_inq_cb->adv_data_cache, 0, BTM_BLE_CACHE_ADV_DATA_MAX);
}
if (data_len > 0)
{
p_cache = &p_le_inq_cb->adv_data_cache[p_le_inq_cb->adv_len];
STREAM_TO_UINT8(length, p);
while ( length && ((p_le_inq_cb->adv_len + length + 1) <= BTM_BLE_CACHE_ADV_DATA_MAX))
{
/* copy from the length byte & data into cache */
memcpy(p_cache, p-1, length+1);
/* advance the cache pointer past data */
p_cache += length+1;
/* increment cache length */
p_le_inq_cb->adv_len += length+1;
/* skip the length of data */
p += length;
STREAM_TO_UINT8(length, p);
}
}
/* parse service UUID from adv packet and save it in inq db eir_uuid */
/* TODO */
}
/*******************************************************************************
**
** Function btm_ble_is_discoverable
**
** Description check ADV flag to make sure device is discoverable and match
** the search condition
**
** Parameters
**
** Returns void
**
*******************************************************************************/
BOOLEAN btm_ble_is_discoverable(BD_ADDR bda, UINT8 evt_type, UINT8 *p)
{
BOOLEAN is_discoverable = FALSE;
UINT8 *p_flag, flag = 0;
UINT8 data_len;
tBTM_INQ_PARMS *p_cond = &btm_cb.btm_inq_vars.inqparms;
STREAM_TO_UINT8 (data_len, p);
/* for observer, always "discoverable */
if (btm_cb.ble_ctr_cb.inq_var.proc_mode == BTM_BLE_OBSERVE ||
(btm_cb.ble_ctr_cb.inq_var.proc_mode == BTM_BLE_SELECT_SCAN &&
btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE))
return TRUE;
/* does not match filter condition */
if (p_cond->filter_cond_type == BTM_FILTER_COND_BD_ADDR &&
memcmp(bda, p_cond->filter_cond.bdaddr_cond, BD_ADDR_LEN) != 0)
{
BTM_TRACE_DEBUG0("BD ADDR does not meet filter condition");
return FALSE;
}
/* scan response does not include the flag */
if (evt_type == BTM_BLE_SCAN_RSP_EVT)
return FALSE;
if (data_len > BTM_BLE_ADV_DATA_LEN_MAX)
{
BTM_TRACE_WARNING1("ADV data too long %d. discard", data_len);
return FALSE;
}
if (data_len != 0)
{
if ((p_flag = BTM_CheckAdvData(p, BTM_BLE_AD_TYPE_FLAG, &data_len)) != NULL)
{
flag = * p_flag;
if ((btm_cb.ble_ctr_cb.inq_var.proc_mode == BTM_BLE_GENERAL_INQUIRY) &&
(flag & (BTM_BLE_LIMIT_DISC_FLAG|BTM_BLE_GEN_DISC_FLAG)) != 0)
{
BTM_TRACE_DEBUG0("Find Generable Discoverable device");
is_discoverable = TRUE;
}
else if (btm_cb.ble_ctr_cb.inq_var.proc_mode == BTM_BLE_LIMITED_INQUIRY &&
(flag & BTM_BLE_LIMIT_DISC_FLAG) != 0)
{
BTM_TRACE_DEBUG0("Find limited discoverable device");
is_discoverable = TRUE;
}
}
}
if (!is_discoverable)
{
BTM_TRACE_ERROR1("discoverable flag not desired: %d", flag);
}
return is_discoverable;
}
/*******************************************************************************
**
** Function btm_ble_update_inq_result
**
** Description Update adv packet information into inquiry result.
**
** Parameters
**
** Returns void
**
*******************************************************************************/
BOOLEAN btm_ble_update_inq_result(tINQ_DB_ENT *p_i, UINT8 addr_type, UINT8 evt_type, UINT8 *p)
{
BOOLEAN to_report = TRUE;
tBTM_INQ_RESULTS *p_cur = &p_i->inq_info.results;
UINT8 len;
UINT8 *p_flag;
tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars;
UINT8 data_len, rssi;
tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
UINT8 *p1;
STREAM_TO_UINT8 (data_len, p);
if (data_len > BTM_BLE_ADV_DATA_LEN_MAX)
{
BTM_TRACE_WARNING1("EIR data too long %d. discard", data_len);
return FALSE;
}
btm_ble_cache_adv_data(p_cur, data_len, p, evt_type);
p1 = (p + data_len);
STREAM_TO_UINT8 (rssi, p1);
/* Save the info */
p_cur->inq_result_type = BTM_INQ_RESULT_BLE;
p_cur->ble_addr_type = addr_type;
p_cur->rssi = rssi;
/* active scan, always wait until get scan_rsp to report the result */
if ((btm_cb.ble_ctr_cb.inq_var.scan_type == BTM_BLE_SCAN_MODE_ACTI &&
(evt_type == BTM_BLE_CONNECT_EVT || evt_type == BTM_BLE_DISCOVER_EVT)))
{
p_i->scan_rsp = FALSE;
to_report = FALSE;
}
else
p_i->scan_rsp = TRUE;
if (p_i->inq_count != p_inq->inq_counter)
p_cur->device_type = BT_DEVICE_TYPE_BLE;
else
p_cur->device_type |= BT_DEVICE_TYPE_BLE;
if (evt_type != BTM_BLE_SCAN_RSP_EVT)
p_cur->ble_evt_type = evt_type;
p_i->inq_count = p_inq->inq_counter; /* Mark entry for current inquiry */
if (p_le_inq_cb->adv_len != 0)
{
if ((p_flag = BTM_CheckAdvData(p_le_inq_cb->adv_data_cache, BTM_BLE_AD_TYPE_FLAG, &len)) != NULL)
p_cur->flag = * p_flag;
}
/* if BR/EDR not supported is not set, assume is a DUMO device */
if ((p_cur->flag & BTM_BLE_BREDR_NOT_SPT) == 0)
{
BTM_TRACE_ERROR0("BR/EDR NOT support bit not set, treat as DUMO");
p_cur->device_type |= BT_DEVICE_TYPE_DUMO;
}
else
{
BTM_TRACE_DEBUG0("BR/EDR NOT SUPPORT bit set, LE only device");
}
return to_report;
}
/*******************************************************************************
**
** Function btm_send_sel_conn_callback
**
** Description send selection connection request callback.
**
** Parameters
**
** Returns void
**
*******************************************************************************/
void btm_send_sel_conn_callback(BD_ADDR remote_bda, UINT8 evt_type, UINT8 *p_data, UINT8 addr_type)
{
UINT8 data_len, len;
UINT8 *p_dev_name, remname[31] = {0};
if (btm_cb.ble_ctr_cb.p_select_cback == NULL ||
/* non-connectable device */
(evt_type != BTM_BLE_EVT_CONN_ADV && evt_type != BTM_BLE_EVT_CONN_DIR_ADV))
return;
STREAM_TO_UINT8 (data_len, p_data);
/* get the device name if exist in ADV data */
if (data_len != 0)
{
p_dev_name = BTM_CheckAdvData(p_data, BTM_BLE_AD_TYPE_NAME_CMPL, &len);
if (p_dev_name == NULL)
p_dev_name = BTM_CheckAdvData(p_data, BTM_BLE_AD_TYPE_NAME_SHORT, &len);
if (p_dev_name)
memcpy(remname, p_dev_name, len);
}
/* allow connection */
if ((* btm_cb.ble_ctr_cb.p_select_cback)(remote_bda, remname))
{
/* terminate selective connection, initiate connection */
btm_ble_initiate_select_conn(remote_bda);
}
}
/*******************************************************************************
**
** Function btm_ble_resolve_random_addr_cmpl
**
** Description resolve random address complete callback.
**
** Returns void
**
*******************************************************************************/
static void btm_ble_resolve_random_addr_cmpl(void * p_rec, void *p)
{
tBTM_SEC_DEV_REC *match_rec = (tBTM_SEC_DEV_REC *) p_rec;
UINT8 addr_type = BLE_ADDR_RANDOM;
BD_ADDR bda;
UINT8 *pp = (UINT8 *)p + 1;
UINT8 evt_type;
BTM_TRACE_EVENT0 ("btm_ble_resolve_random_addr_cmpl ");
STREAM_TO_UINT8 (evt_type, pp);
STREAM_TO_UINT8 (addr_type, pp);
STREAM_TO_BDADDR (bda, pp);
if (match_rec)
{
BTM_TRACE_ERROR0("Random match");
memcpy(match_rec->ble.cur_rand_addr, bda, BD_ADDR_LEN);
memcpy(bda, match_rec->bd_addr, BD_ADDR_LEN);
}
else
{
BTM_TRACE_ERROR0("Random unmatch");
}
btm_ble_process_adv_pkt_cont(bda, addr_type, evt_type, pp);
return;
}
/*******************************************************************************
**
** Function btm_ble_process_adv_pkt
**
** Description This function is called when adv packet report events are
** received from the device. It updates the inquiry database.
** If the inquiry database is full, the oldest entry is discarded.
**
** Parameters
**
** Returns void
**
*******************************************************************************/
void btm_ble_process_adv_pkt (UINT8 *p_data)
{
BD_ADDR bda;
UINT8 evt_type = 0, *p = p_data;
UINT8 addr_type = 0;
BTM_TRACE_EVENT0 ("btm_ble_process_adv_pkt ");
/* always get one device at a time */
p ++;
/* Extract inquiry results */
STREAM_TO_UINT8 (evt_type, p);
STREAM_TO_UINT8 (addr_type, p);
STREAM_TO_BDADDR (bda, p);
#ifdef BTM_BLE_PC_ADV_TEST_MODE // For general stack code (e.g. BTInsight testing), we simply do not define it to exclude or set it to TRUE to include
if (BTM_BLE_PC_ADV_TEST_MODE) // For stack component, it is always defined and maps to a global variable g_bDraculaAdvertisingMode
{
if (btm_cb.ble_ctr_cb.p_scan_req_cback)
(*btm_cb.ble_ctr_cb.p_scan_req_cback)(bda, addr_type, evt_type);
}
#endif
/* Only process the results if the inquiry is still active */
if (!btm_cb.btm_inq_vars.inq_active &&
(btm_cb.ble_ctr_cb.bg_conn_type != BTM_BLE_CONN_SELECTIVE ||
/* or selective auto connection is active */
btm_cb.ble_ctr_cb.p_select_cback == NULL))
return;
#if SMP_INCLUDED == TRUE
if (addr_type == BLE_ADDR_RANDOM && BTM_BLE_IS_RESOLVE_BDA(bda))
{
btm_ble_resolve_random_addr(bda, btm_ble_resolve_random_addr_cmpl, p_data);
}
else
#endif
btm_ble_process_adv_pkt_cont(bda, addr_type, evt_type, p);
}
/*******************************************************************************
**
** Function btm_ble_process_adv_pkt_cont
**
** Description This function is called after random address resolution is
** done, and proceed to process adv packet.
**
** Parameters
**
** Returns void
**
*******************************************************************************/
static void btm_ble_process_adv_pkt_cont(BD_ADDR bda, UINT8 addr_type, UINT8 evt_type, UINT8 *p)
{
tINQ_DB_ENT *p_i;
BOOLEAN to_report = FALSE;
tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars;
tBTM_INQ_RESULTS_CB *p_inq_results_cb = p_inq->p_inq_results_cb;
tBTM_BLE_INQ_CB *p_le_inq_cb = &btm_cb.ble_ctr_cb.inq_var;
p_i = btm_inq_db_find (bda);
/* Check if this address has already been processed for this inquiry */
if (btm_inq_find_bdaddr(bda))
{
/* never been report as an LE device */
if ((p_i &&
(!(p_i->inq_info.results.device_type & BT_DEVICE_TYPE_BLE) ||
/* scan repsonse to be updated */
(!p_i->scan_rsp)))
||
btm_cb.ble_ctr_cb.inq_var.proc_mode == BTM_BLE_OBSERVE)
{
BTM_TRACE_DEBUG0("update new BLE information ");
to_report = TRUE;
}
else
{
BTM_TRACE_DEBUG0("LE in le_bd_db already");
/* if yes, skip it */
return; /* assumption: one result per event */
}
}
else /* not been processed int his round */
{
BTM_TRACE_DEBUG0("new LE BD_ADDR");
to_report = TRUE;
}
/* If existing entry, use that, else get a new one (possibly reusing the oldest) */
if (p_i == NULL)
{
if (btm_ble_is_discoverable(bda, evt_type, p))
{
if ((p_i = btm_inq_db_new (bda)) != NULL)
{
p_inq->inq_cmpl_info.num_resp++;
BTM_TRACE_DEBUG0("adv pkt process: new record is added into inq db");
to_report = TRUE;
}
else
return;
}
else
{
BTM_TRACE_ERROR0("discard adv pkt");
return;
}
}
else if (p_i->inq_count != p_inq->inq_counter) /* first time seen in this inquiry */
{
p_inq->inq_cmpl_info.num_resp++;
}
/* update the LE device information in inquiry database */
if (to_report)
{
to_report = btm_ble_update_inq_result(p_i, addr_type, evt_type, p);
}
#if BTM_USE_INQ_RESULTS_FILTER == TRUE
/* If the number of responses found and limited, issue a cancel inquiry */
if (p_inq->inqparms.max_resps &&
p_inq->inq_cmpl_info.num_resp == p_inq->inqparms.max_resps)
{
/* new device */
if (p_i == NULL ||
(/* assume a DUMO device, BR/EDR inquiry is always active */
p_i && p_i->inq_info.results.device_type == BT_DEVICE_TYPE_BLE && p_i->scan_rsp))
{
BTM_TRACE_WARNING0("INQ RES: Extra Response Received...cancelling inquiry..");
if (!(p_inq->inq_active & BTM_PERIODIC_INQUIRY_ACTIVE) )
btsnd_hcic_inq_cancel();
/* stop LE scan now */
btm_ble_stop_scan();
#if BTM_BUSY_LEVEL_CHANGE_INCLUDED == TRUE
btm_acl_update_busy_level (BTM_BLI_INQ_DONE_EVT);
#endif
}
}
#endif
/* background connection in selective connection mode */
if (btm_cb.ble_ctr_cb.bg_conn_type == BTM_BLE_CONN_SELECTIVE)
{
btm_send_sel_conn_callback(bda, evt_type, p, addr_type);
}
else if (p_inq_results_cb && to_report)
{
BTM_TRACE_DEBUG0("BTMINQ LE: Found devices, send callback btm_inqrslt_cb");
if (p_inq->inq_active)
(p_inq_results_cb)((tBTM_INQ_RESULTS *) &p_i->inq_info.results, p_le_inq_cb->adv_data_cache);
}
}
/*******************************************************************************
**
** Function btm_ble_stop_scan
**
** Description Stop the BLE scan.
**
** Returns void
**
*******************************************************************************/
void btm_ble_stop_scan(void)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
tBTM_INQUIRY_VAR_ST *p_inq = &btm_cb.btm_inq_vars;
BTM_TRACE_EVENT0 ("btm_ble_stop_scan ");
btu_stop_timer (&p_cb->inq_timer_ent);
/* Clear the inquiry callback if set */
p_cb->scan_type = BTM_BLE_SCAN_MODE_NONE;
p_cb->proc_mode = BTM_BLE_INQUIRY_NONE;
/* stop discovery now */
btsnd_hcic_ble_set_scan_enable (BTM_BLE_SCAN_DISABLE, BTM_BLE_DUPLICATE_ENABLE);
/* If we have a callback registered for inquiry complete, call it */
BTM_TRACE_DEBUG2 ("BTM Inq Compl Callback: status 0x%02x, num results %d",
p_inq->inq_cmpl_info.status, p_inq->inq_cmpl_info.num_resp);
btm_update_scanner_filter_policy(SP_ADV_ALL);
btm_process_inq_complete(HCI_SUCCESS, (UINT8)(p_inq->inqparms.mode & BTM_BLE_INQUIRY_MASK));
}
/*******************************************************************************
**
** Function btm_ble_stop_adv
**
** Description Stop the BLE advertising.
**
** Returns void
**
*******************************************************************************/
void btm_ble_stop_adv(void)
{
BTM_TRACE_EVENT0 (" btm_ble_stop_adv");
if (btsnd_hcic_ble_set_adv_enable (BTM_BLE_ADV_DISABLE))
{
btm_cb.ble_ctr_cb.inq_var.adv_mode = BTM_BLE_ADV_DISABLE;
}
}
/*******************************************************************************
**
** Function btm_ble_timeout
**
** Description Called when BTM BLE inquiry timer expires
**
** Returns void
**
*******************************************************************************/
void btm_ble_timeout(TIMER_LIST_ENT *p_tle)
{
BTM_TRACE_EVENT0 ("btm_ble_timeout");
switch (p_tle->event)
{
case BTU_TTYPE_BLE_INQUIRY:
btm_ble_stop_scan();
break;
case BTU_TTYPE_BLE_GAP_LIM_DISC:
/* lim_timeout expiried, limited discovery should exit now */
btm_ble_update_adv_flag(BTM_BLE_NON_LIMIT_DISC_FLAG);
btm_ble_stop_adv();
break;
case BTU_TTYPE_BLE_RANDOM_ADDR:
if (btm_cb.ble_ctr_cb.inq_var.adv_mode == BTM_BLE_ADV_ENABLE &&
btm_cb.ble_ctr_cb.inq_var.own_addr_type == BLE_ADDR_RANDOM)
{
/* refresh the random addr */
btm_gen_resolvable_private_addr();
}
break;
}
}
/*******************************************************************************
**
** Function btm_ble_connected
**
** Description This function is when a LE connection to the peer device is
** establsihed
**
** Returns void
**
*******************************************************************************/
void btm_ble_connected (UINT8 *bda, UINT16 handle, UINT8 enc_mode, UINT8 role)
{
tBTM_SEC_DEV_REC *p_dev_rec = btm_find_dev (bda);
tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;
BTM_TRACE_EVENT0 ("btm_ble_connected");
/* Commenting out trace due to obf/compilation problems.
*/
#if (BT_USE_TRACES == TRUE)
if (p_dev_rec)
{
BTM_TRACE_EVENT4 ("Security Manager: btm_sec_connected : handle:%d enc_mode:%d bda:%x RName:%s",
handle, enc_mode,
(bda[2]<<24)+(bda[3]<<16)+(bda[4]<<8)+bda[5],
p_dev_rec->sec_bd_name);
BTM_TRACE_DEBUG1 ("btm_ble_connected sec_flags=0x%x",p_dev_rec->sec_flags);
}
else
{
BTM_TRACE_EVENT3 ("Security Manager: btm_sec_connected: handle:%d enc_mode:%d bda:%x ",
handle, enc_mode,
(bda[2]<<24)+(bda[3]<<16)+(bda[4]<<8)+bda[5]);
}
#endif
if (!p_dev_rec)
{
/* There is no device record for new connection. Allocate one */
p_dev_rec = btm_sec_alloc_dev (bda);
}
else /* Update the timestamp for this device */
{
p_dev_rec->timestamp = btm_cb.dev_rec_count++;
}
p_dev_rec->device_type = BT_DEVICE_TYPE_BLE;
p_dev_rec->hci_handle = handle;
if (role == HCI_ROLE_MASTER)
p_dev_rec->role_master = TRUE;
p_cb->inq_var.adv_mode = BTM_BLE_ADV_DISABLE;
return;
}
/*******************************************************************************
**
** Function btm_ble_read_remote_features_complete
**
** Description This function is called when the command complete message
** is received from the HCI for the read LE remote feature supported
** complete event.
**
** Returns void
**
*******************************************************************************/
void btm_ble_read_remote_features_complete(UINT8 *p)
{
tACL_CONN *p_acl_cb = &btm_cb.acl_db[0];
UINT8 size;
UINT16 handle;
int xx, yy;
tBTM_SEC_DEV_REC *p_dev_rec;
BTM_TRACE_EVENT0 ("btm_ble_read_remote_features_complete ");
STREAM_TO_UINT16 (handle, p);
STREAM_TO_UINT8 (size, p);
/* Look up the connection by handle and copy features */
for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p_acl_cb++)
{
if ((p_acl_cb->in_use) && (p_acl_cb->hci_handle == handle))
{
for (yy = 0; yy < BD_FEATURES_LEN; yy++)
STREAM_TO_UINT8 (p_acl_cb->features[yy], p);
p_dev_rec = btm_find_dev_by_handle (handle);
if (!p_dev_rec)
{
/* Get a new device; might be doing dedicated bonding */
p_dev_rec = btm_find_or_alloc_dev (p_acl_cb->remote_addr);
}
memcpy (p_dev_rec->features, p_acl_cb->features, BD_FEATURES_LEN);
break;
}
}
}
/*******************************************************************************
**
** Function btm_ble_write_adv_enable_complete
**
** Description This function process the write adv enable command complete.
**
** Returns void
**
*******************************************************************************/
void btm_ble_write_adv_enable_complete(UINT8 * p)
{
tBTM_BLE_INQ_CB *p_cb = &btm_cb.ble_ctr_cb.inq_var;
/* if write adv enable/disbale not succeed */
if (*p != HCI_SUCCESS)
{
/* toggle back the adv mode */
p_cb->adv_mode = !p_cb->adv_mode;
}
}
/*******************************************************************************
**
** Function btm_ble_init
**
** Description Initialize the control block variable values.
**
** Returns void
**
*******************************************************************************/
void btm_ble_init (void)
{
tBTM_BLE_CB *p_cb = &btm_cb.ble_ctr_cb;
BTM_TRACE_EVENT0 ("btm_ble_init ");
memset(p_cb, 0, sizeof(tBTM_BLE_CB));
p_cb->inq_var.adv_mode = BTM_BLE_ADV_DISABLE;
p_cb->inq_var.scan_type = BTM_BLE_SCAN_MODE_NONE;
p_cb->inq_var.adv_chnl_map = BTM_BLE_DEFAULT_ADV_CHNL_MAP;
p_cb->inq_var.afp = BTM_BLE_DEFAULT_AFP;
p_cb->inq_var.sfp = BTM_BLE_DEFAULT_SFP;
p_cb->inq_var.connectable_mode = BTM_BLE_NON_CONNECTABLE;
p_cb->inq_var.discoverable_mode = BTM_BLE_NON_DISCOVERABLE;
/* for background connection, reset connection params to be undefined */
p_cb->scan_int = p_cb->scan_win = BTM_BLE_CONN_PARAM_UNDEF;
p_cb->inq_var.evt_type = BTM_BLE_UNKNOWN_EVT;
}
#endif /* BLE_INCLUDED */