Apply clang-format to the rest of the tree
find * | grep "\.[ch]" | xargs clang-format --style=file -i
Test: mma -j32
Change-Id: I6fcc9862bb7bc07c2a367ca58fef2b3cd27a6f05
diff --git a/stack/btm/btm_acl.cc b/stack/btm/btm_acl.cc
index cfe333b..f1e9d3c 100644
--- a/stack/btm/btm_acl.cc
+++ b/stack/btm/btm_acl.cc
@@ -31,30 +31,30 @@
*
*****************************************************************************/
+#include <stddef.h>
+#include <stdio.h>
#include <stdlib.h>
#include <string.h>
-#include <stdio.h>
-#include <stddef.h>
-#include "bt_types.h"
-#include "bt_target.h"
-#include "device/include/controller.h"
#include "bt_common.h"
-#include "hcimsgs.h"
-#include "btu.h"
+#include "bt_target.h"
+#include "bt_types.h"
+#include "bt_utils.h"
#include "btm_api.h"
#include "btm_int.h"
-#include "l2c_int.h"
+#include "btu.h"
+#include "device/include/controller.h"
#include "hcidefs.h"
-#include "bt_utils.h"
+#include "hcimsgs.h"
+#include "l2c_int.h"
#include "osi/include/osi.h"
+extern fixed_queue_t* btu_general_alarm_queue;
-extern fixed_queue_t *btu_general_alarm_queue;
-
-static void btm_read_remote_features (uint16_t handle);
-static void btm_read_remote_ext_features (uint16_t handle, uint8_t page_number);
-static void btm_process_remote_ext_features (tACL_CONN *p_acl_cb, uint8_t num_read_pages);
+static void btm_read_remote_features(uint16_t handle);
+static void btm_read_remote_ext_features(uint16_t handle, uint8_t page_number);
+static void btm_process_remote_ext_features(tACL_CONN* p_acl_cb,
+ uint8_t num_read_pages);
/* 3 seconds timeout waiting for responses */
#define BTM_DEV_REPLY_TIMEOUT_MS (3 * 1000)
@@ -68,12 +68,11 @@
* Returns void
*
******************************************************************************/
-void btm_acl_init (void)
-{
- BTM_TRACE_DEBUG ("btm_acl_init");
- /* Initialize nonzero defaults */
- btm_cb.btm_def_link_super_tout = HCI_DEFAULT_INACT_TOUT;
- btm_cb.acl_disc_reason = 0xff ;
+void btm_acl_init(void) {
+ BTM_TRACE_DEBUG("btm_acl_init");
+ /* Initialize nonzero defaults */
+ btm_cb.btm_def_link_super_tout = HCI_DEFAULT_INACT_TOUT;
+ btm_cb.acl_disc_reason = 0xff;
}
/*******************************************************************************
@@ -91,25 +90,21 @@
* NULL if not found.
*
******************************************************************************/
-tACL_CONN *btm_bda_to_acl (const BD_ADDR bda, tBT_TRANSPORT transport)
-{
- tACL_CONN *p = &btm_cb.acl_db[0];
- uint16_t xx;
- if (bda)
- {
- for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p++)
- {
- if ((p->in_use) && (!memcmp (p->remote_addr, bda, BD_ADDR_LEN)) &&
- p->transport == transport)
- {
- BTM_TRACE_DEBUG ("btm_bda_to_acl found");
- return(p);
- }
- }
+tACL_CONN* btm_bda_to_acl(const BD_ADDR bda, tBT_TRANSPORT transport) {
+ tACL_CONN* p = &btm_cb.acl_db[0];
+ uint16_t xx;
+ if (bda) {
+ for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p++) {
+ if ((p->in_use) && (!memcmp(p->remote_addr, bda, BD_ADDR_LEN)) &&
+ p->transport == transport) {
+ BTM_TRACE_DEBUG("btm_bda_to_acl found");
+ return (p);
+ }
}
+ }
- /* If here, no BD Addr found */
- return((tACL_CONN *)NULL);
+ /* If here, no BD Addr found */
+ return ((tACL_CONN*)NULL);
}
/*******************************************************************************
@@ -122,21 +117,18 @@
* Returns index to the acl_db or MAX_L2CAP_LINKS.
*
******************************************************************************/
-uint8_t btm_handle_to_acl_index (uint16_t hci_handle)
-{
- tACL_CONN *p = &btm_cb.acl_db[0];
- uint8_t xx;
- BTM_TRACE_DEBUG ("btm_handle_to_acl_index");
- for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p++)
- {
- if ((p->in_use) && (p->hci_handle == hci_handle))
- {
- break;
- }
+uint8_t btm_handle_to_acl_index(uint16_t hci_handle) {
+ tACL_CONN* p = &btm_cb.acl_db[0];
+ uint8_t xx;
+ BTM_TRACE_DEBUG("btm_handle_to_acl_index");
+ for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p++) {
+ if ((p->in_use) && (p->hci_handle == hci_handle)) {
+ break;
}
+ }
- /* If here, no BD Addr found */
- return(xx);
+ /* If here, no BD Addr found */
+ return (xx);
}
#if (BLE_PRIVACY_SPT == TRUE)
@@ -150,41 +142,41 @@
* Returns success return true, otherwise false.
*
******************************************************************************/
-bool btm_ble_get_acl_remote_addr(tBTM_SEC_DEV_REC *p_dev_rec, BD_ADDR conn_addr,
- tBLE_ADDR_TYPE *p_addr_type)
-{
- bool st = true;
+bool btm_ble_get_acl_remote_addr(tBTM_SEC_DEV_REC* p_dev_rec, BD_ADDR conn_addr,
+ tBLE_ADDR_TYPE* p_addr_type) {
+ bool st = true;
- if (p_dev_rec == NULL)
- {
- BTM_TRACE_ERROR("btm_ble_get_acl_remote_addr can not find device with matching address");
- return false;
- }
+ if (p_dev_rec == NULL) {
+ BTM_TRACE_ERROR(
+ "btm_ble_get_acl_remote_addr can not find device with matching "
+ "address");
+ return false;
+ }
- switch (p_dev_rec->ble.active_addr_type)
- {
+ switch (p_dev_rec->ble.active_addr_type) {
case BTM_BLE_ADDR_PSEUDO:
- memcpy(conn_addr, p_dev_rec->bd_addr, BD_ADDR_LEN);
- * p_addr_type = p_dev_rec->ble.ble_addr_type;
- break;
+ memcpy(conn_addr, p_dev_rec->bd_addr, BD_ADDR_LEN);
+ *p_addr_type = p_dev_rec->ble.ble_addr_type;
+ break;
case BTM_BLE_ADDR_RRA:
- memcpy(conn_addr, p_dev_rec->ble.cur_rand_addr, BD_ADDR_LEN);
- * p_addr_type = BLE_ADDR_RANDOM;
- break;
+ memcpy(conn_addr, p_dev_rec->ble.cur_rand_addr, BD_ADDR_LEN);
+ *p_addr_type = BLE_ADDR_RANDOM;
+ break;
case BTM_BLE_ADDR_STATIC:
- memcpy(conn_addr, p_dev_rec->ble.static_addr, BD_ADDR_LEN);
- * p_addr_type = p_dev_rec->ble.static_addr_type;
- break;
+ memcpy(conn_addr, p_dev_rec->ble.static_addr, BD_ADDR_LEN);
+ *p_addr_type = p_dev_rec->ble.static_addr_type;
+ break;
default:
- BTM_TRACE_ERROR("Unknown active address: %d", p_dev_rec->ble.active_addr_type);
- st = false;
- break;
- }
+ BTM_TRACE_ERROR("Unknown active address: %d",
+ p_dev_rec->ble.active_addr_type);
+ st = false;
+ break;
+ }
- return st;
+ return st;
}
#endif
/*******************************************************************************
@@ -197,133 +189,120 @@
* Returns void
*
******************************************************************************/
-void btm_acl_created (BD_ADDR bda, DEV_CLASS dc, BD_NAME bdn,
- uint16_t hci_handle, uint8_t link_role, tBT_TRANSPORT transport)
-{
- tBTM_SEC_DEV_REC *p_dev_rec = NULL;
- tACL_CONN *p;
- uint8_t xx;
+void btm_acl_created(BD_ADDR bda, DEV_CLASS dc, BD_NAME bdn,
+ uint16_t hci_handle, uint8_t link_role,
+ tBT_TRANSPORT transport) {
+ tBTM_SEC_DEV_REC* p_dev_rec = NULL;
+ tACL_CONN* p;
+ uint8_t xx;
- BTM_TRACE_DEBUG ("btm_acl_created hci_handle=%d link_role=%d transport=%d",
- hci_handle,link_role, transport);
- /* Ensure we don't have duplicates */
- p = btm_bda_to_acl(bda, transport);
- if (p != (tACL_CONN *)NULL)
- {
- p->hci_handle = hci_handle;
- p->link_role = link_role;
- p->transport = transport;
- BTM_TRACE_DEBUG ("Duplicate btm_acl_created: RemBdAddr: %02x%02x%02x%02x%02x%02x",
- bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
- BTM_SetLinkPolicy(p->remote_addr, &btm_cb.btm_def_link_policy);
- return;
- }
+ BTM_TRACE_DEBUG("btm_acl_created hci_handle=%d link_role=%d transport=%d",
+ hci_handle, link_role, transport);
+ /* Ensure we don't have duplicates */
+ p = btm_bda_to_acl(bda, transport);
+ if (p != (tACL_CONN*)NULL) {
+ p->hci_handle = hci_handle;
+ p->link_role = link_role;
+ p->transport = transport;
+ BTM_TRACE_DEBUG(
+ "Duplicate btm_acl_created: RemBdAddr: %02x%02x%02x%02x%02x%02x",
+ bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
+ BTM_SetLinkPolicy(p->remote_addr, &btm_cb.btm_def_link_policy);
+ return;
+ }
- /* Allocate acl_db entry */
- for (xx = 0, p = &btm_cb.acl_db[0]; xx < MAX_L2CAP_LINKS; xx++, p++)
- {
- if (!p->in_use)
- {
- p->in_use = true;
- p->hci_handle = hci_handle;
- p->link_role = link_role;
- p->link_up_issued = false;
- memcpy (p->remote_addr, bda, BD_ADDR_LEN);
+ /* Allocate acl_db entry */
+ for (xx = 0, p = &btm_cb.acl_db[0]; xx < MAX_L2CAP_LINKS; xx++, p++) {
+ if (!p->in_use) {
+ p->in_use = true;
+ p->hci_handle = hci_handle;
+ p->link_role = link_role;
+ p->link_up_issued = false;
+ memcpy(p->remote_addr, bda, BD_ADDR_LEN);
- p->transport = transport;
+ p->transport = transport;
#if (BLE_PRIVACY_SPT == TRUE)
- if (transport == BT_TRANSPORT_LE)
- btm_ble_refresh_local_resolvable_private_addr(bda,
- btm_cb.ble_ctr_cb.addr_mgnt_cb.private_addr);
+ if (transport == BT_TRANSPORT_LE)
+ btm_ble_refresh_local_resolvable_private_addr(
+ bda, btm_cb.ble_ctr_cb.addr_mgnt_cb.private_addr);
#else
- p->conn_addr_type = BLE_ADDR_PUBLIC;
- memcpy(p->conn_addr, &controller_get_interface()->get_address()->address, BD_ADDR_LEN);
+ p->conn_addr_type = BLE_ADDR_PUBLIC;
+ memcpy(p->conn_addr, &controller_get_interface()->get_address()->address,
+ BD_ADDR_LEN);
#endif
- p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
- btm_pm_sm_alloc(xx);
+ btm_pm_sm_alloc(xx);
+ if (dc) memcpy(p->remote_dc, dc, DEV_CLASS_LEN);
- if (dc)
- memcpy (p->remote_dc, dc, DEV_CLASS_LEN);
+ if (bdn) memcpy(p->remote_name, bdn, BTM_MAX_REM_BD_NAME_LEN);
- if (bdn)
- memcpy (p->remote_name, bdn, BTM_MAX_REM_BD_NAME_LEN);
+ /* if BR/EDR do something more */
+ if (transport == BT_TRANSPORT_BR_EDR) {
+ btsnd_hcic_read_rmt_clk_offset(p->hci_handle);
+ btsnd_hcic_rmt_ver_req(p->hci_handle);
+ }
+ p_dev_rec = btm_find_dev_by_handle(hci_handle);
- /* if BR/EDR do something more */
- if (transport == BT_TRANSPORT_BR_EDR)
- {
- btsnd_hcic_read_rmt_clk_offset (p->hci_handle);
- btsnd_hcic_rmt_ver_req (p->hci_handle);
- }
- p_dev_rec = btm_find_dev_by_handle (hci_handle);
+ if (p_dev_rec) {
+ BTM_TRACE_DEBUG("device_type=0x%x", p_dev_rec->device_type);
+ }
- if (p_dev_rec )
- {
- BTM_TRACE_DEBUG ("device_type=0x%x", p_dev_rec->device_type);
- }
+ if (p_dev_rec && !(transport == BT_TRANSPORT_LE)) {
+ /* If remote features already known, copy them and continue connection
+ * setup */
+ if ((p_dev_rec->num_read_pages) &&
+ (p_dev_rec->num_read_pages <= (HCI_EXT_FEATURES_PAGE_MAX + 1))) {
+ memcpy(p->peer_lmp_features, p_dev_rec->features,
+ (HCI_FEATURE_BYTES_PER_PAGE * p_dev_rec->num_read_pages));
+ p->num_read_pages = p_dev_rec->num_read_pages;
- if (p_dev_rec && !(transport == BT_TRANSPORT_LE))
- {
- /* If remote features already known, copy them and continue connection setup */
- if ((p_dev_rec->num_read_pages) &&
- (p_dev_rec->num_read_pages <= (HCI_EXT_FEATURES_PAGE_MAX + 1)))
- {
- memcpy (p->peer_lmp_features, p_dev_rec->features,
- (HCI_FEATURE_BYTES_PER_PAGE * p_dev_rec->num_read_pages));
- p->num_read_pages = p_dev_rec->num_read_pages;
+ const uint8_t req_pend = (p_dev_rec->sm4 & BTM_SM4_REQ_PEND);
- const uint8_t req_pend = (p_dev_rec->sm4 & BTM_SM4_REQ_PEND);
+ /* Store the Peer Security Capabilites (in SM4 and rmt_sec_caps) */
+ btm_sec_set_peer_sec_caps(p, p_dev_rec);
- /* Store the Peer Security Capabilites (in SM4 and rmt_sec_caps) */
- btm_sec_set_peer_sec_caps(p, p_dev_rec);
-
- BTM_TRACE_API("%s: pend:%d", __func__, req_pend);
- if (req_pend)
- {
- /* Request for remaining Security Features (if any) */
- l2cu_resubmit_pending_sec_req (p_dev_rec->bd_addr);
- }
- btm_establish_continue (p);
- return;
- }
- }
-
- /* If here, features are not known yet */
- if (p_dev_rec && transport == BT_TRANSPORT_LE)
- {
-#if (BLE_PRIVACY_SPT == TRUE)
- btm_ble_get_acl_remote_addr (p_dev_rec, p->active_remote_addr,
- &p->active_remote_addr_type);
-#endif
-
- if (HCI_LE_SLAVE_INIT_FEAT_EXC_SUPPORTED(controller_get_interface()->get_features_ble()->as_array)
- || link_role == HCI_ROLE_MASTER)
- {
- btsnd_hcic_ble_read_remote_feat(p->hci_handle);
- }
- else
- {
- btm_establish_continue(p);
- }
- }
- else
- {
- btm_read_remote_features (p->hci_handle);
- }
-
- /* read page 1 - on rmt feature event for buffer reasons */
- return;
+ BTM_TRACE_API("%s: pend:%d", __func__, req_pend);
+ if (req_pend) {
+ /* Request for remaining Security Features (if any) */
+ l2cu_resubmit_pending_sec_req(p_dev_rec->bd_addr);
+ }
+ btm_establish_continue(p);
+ return;
}
+ }
+
+ /* If here, features are not known yet */
+ if (p_dev_rec && transport == BT_TRANSPORT_LE) {
+#if (BLE_PRIVACY_SPT == TRUE)
+ btm_ble_get_acl_remote_addr(p_dev_rec, p->active_remote_addr,
+ &p->active_remote_addr_type);
+#endif
+
+ if (HCI_LE_SLAVE_INIT_FEAT_EXC_SUPPORTED(
+ controller_get_interface()->get_features_ble()->as_array) ||
+ link_role == HCI_ROLE_MASTER) {
+ btsnd_hcic_ble_read_remote_feat(p->hci_handle);
+ } else {
+ btm_establish_continue(p);
+ }
+ } else {
+ btm_read_remote_features(p->hci_handle);
+ }
+
+ /* read page 1 - on rmt feature event for buffer reasons */
+ return;
}
+ }
}
void btm_acl_update_conn_addr(uint8_t conn_handle, BD_ADDR address) {
- uint8_t idx = btm_handle_to_acl_index(conn_handle);
- if (idx != MAX_L2CAP_LINKS) {
- memcpy(btm_cb.acl_db[idx].conn_addr, address, BD_ADDR_LEN);
- }
+ uint8_t idx = btm_handle_to_acl_index(conn_handle);
+ if (idx != MAX_L2CAP_LINKS) {
+ memcpy(btm_cb.acl_db[idx].conn_addr, address, BD_ADDR_LEN);
+ }
}
/*******************************************************************************
@@ -336,19 +315,20 @@
* Returns void
*
******************************************************************************/
-void btm_acl_report_role_change (uint8_t hci_status, BD_ADDR bda)
-{
- tBTM_ROLE_SWITCH_CMPL ref_data;
- BTM_TRACE_DEBUG ("btm_acl_report_role_change");
- if (btm_cb.devcb.p_switch_role_cb
- && (bda && (0 == memcmp(btm_cb.devcb.switch_role_ref_data.remote_bd_addr, bda, BD_ADDR_LEN))))
- {
- memcpy (&ref_data, &btm_cb.devcb.switch_role_ref_data, sizeof(tBTM_ROLE_SWITCH_CMPL));
- ref_data.hci_status = hci_status;
- (*btm_cb.devcb.p_switch_role_cb)(&ref_data);
- memset (&btm_cb.devcb.switch_role_ref_data, 0, sizeof(tBTM_ROLE_SWITCH_CMPL));
- btm_cb.devcb.p_switch_role_cb = NULL;
- }
+void btm_acl_report_role_change(uint8_t hci_status, BD_ADDR bda) {
+ tBTM_ROLE_SWITCH_CMPL ref_data;
+ BTM_TRACE_DEBUG("btm_acl_report_role_change");
+ if (btm_cb.devcb.p_switch_role_cb &&
+ (bda && (0 == memcmp(btm_cb.devcb.switch_role_ref_data.remote_bd_addr,
+ bda, BD_ADDR_LEN)))) {
+ memcpy(&ref_data, &btm_cb.devcb.switch_role_ref_data,
+ sizeof(tBTM_ROLE_SWITCH_CMPL));
+ ref_data.hci_status = hci_status;
+ (*btm_cb.devcb.p_switch_role_cb)(&ref_data);
+ memset(&btm_cb.devcb.switch_role_ref_data, 0,
+ sizeof(tBTM_ROLE_SWITCH_CMPL));
+ btm_cb.devcb.p_switch_role_cb = NULL;
+ }
}
/*******************************************************************************
@@ -362,81 +342,68 @@
* Returns void
*
******************************************************************************/
-void btm_acl_removed (BD_ADDR bda, tBT_TRANSPORT transport)
-{
- tACL_CONN *p;
- tBTM_BL_EVENT_DATA evt_data;
- tBTM_SEC_DEV_REC *p_dev_rec=NULL;
- BTM_TRACE_DEBUG ("btm_acl_removed");
- p = btm_bda_to_acl(bda, transport);
- if (p != (tACL_CONN *)NULL)
- {
- p->in_use = false;
+void btm_acl_removed(BD_ADDR bda, tBT_TRANSPORT transport) {
+ tACL_CONN* p;
+ tBTM_BL_EVENT_DATA evt_data;
+ tBTM_SEC_DEV_REC* p_dev_rec = NULL;
+ BTM_TRACE_DEBUG("btm_acl_removed");
+ p = btm_bda_to_acl(bda, transport);
+ if (p != (tACL_CONN*)NULL) {
+ p->in_use = false;
- /* if the disconnected channel has a pending role switch, clear it now */
- btm_acl_report_role_change(HCI_ERR_NO_CONNECTION, bda);
+ /* if the disconnected channel has a pending role switch, clear it now */
+ btm_acl_report_role_change(HCI_ERR_NO_CONNECTION, bda);
- /* Only notify if link up has had a chance to be issued */
- if (p->link_up_issued)
- {
- p->link_up_issued = false;
+ /* Only notify if link up has had a chance to be issued */
+ if (p->link_up_issued) {
+ p->link_up_issued = false;
- /* If anyone cares, tell him database changed */
- if (btm_cb.p_bl_changed_cb)
- {
- evt_data.event = BTM_BL_DISCN_EVT;
- evt_data.discn.p_bda = bda;
- evt_data.discn.handle = p->hci_handle;
- evt_data.discn.transport = p->transport;
- (*btm_cb.p_bl_changed_cb)(&evt_data);
- }
+ /* If anyone cares, tell him database changed */
+ if (btm_cb.p_bl_changed_cb) {
+ evt_data.event = BTM_BL_DISCN_EVT;
+ evt_data.discn.p_bda = bda;
+ evt_data.discn.handle = p->hci_handle;
+ evt_data.discn.transport = p->transport;
+ (*btm_cb.p_bl_changed_cb)(&evt_data);
+ }
- btm_acl_update_busy_level (BTM_BLI_ACL_DOWN_EVT);
- }
-
- BTM_TRACE_DEBUG ("acl hci_handle=%d transport=%d connectable_mode=0x%0x link_role=%d",
- p->hci_handle,
- p->transport,
- btm_cb.ble_ctr_cb.inq_var.connectable_mode,
- p->link_role);
-
- p_dev_rec = btm_find_dev(bda);
- if ( p_dev_rec)
- {
- BTM_TRACE_DEBUG("before update p_dev_rec->sec_flags=0x%x", p_dev_rec->sec_flags);
- if (p->transport == BT_TRANSPORT_LE)
- {
- BTM_TRACE_DEBUG("LE link down");
- p_dev_rec->sec_flags &= ~(BTM_SEC_LE_ENCRYPTED | BTM_SEC_ROLE_SWITCHED);
- if ( (p_dev_rec->sec_flags & BTM_SEC_LE_LINK_KEY_KNOWN) == 0)
- {
- BTM_TRACE_DEBUG("Not Bonded");
- p_dev_rec->sec_flags &= ~(BTM_SEC_LE_LINK_KEY_AUTHED | BTM_SEC_LE_AUTHENTICATED);
- }
- else
- {
- BTM_TRACE_DEBUG("Bonded");
- }
- }
- else
- {
- BTM_TRACE_DEBUG("Bletooth link down");
- p_dev_rec->sec_flags &= ~(BTM_SEC_AUTHORIZED | BTM_SEC_AUTHENTICATED
- | BTM_SEC_ENCRYPTED | BTM_SEC_ROLE_SWITCHED);
- }
- BTM_TRACE_DEBUG("after update p_dev_rec->sec_flags=0x%x", p_dev_rec->sec_flags);
- }
- else
- {
- BTM_TRACE_ERROR("Device not found");
-
- }
-
- /* Clear the ACL connection data */
- memset(p, 0, sizeof(tACL_CONN));
+ btm_acl_update_busy_level(BTM_BLI_ACL_DOWN_EVT);
}
-}
+ BTM_TRACE_DEBUG(
+ "acl hci_handle=%d transport=%d connectable_mode=0x%0x link_role=%d",
+ p->hci_handle, p->transport, btm_cb.ble_ctr_cb.inq_var.connectable_mode,
+ p->link_role);
+
+ p_dev_rec = btm_find_dev(bda);
+ if (p_dev_rec) {
+ BTM_TRACE_DEBUG("before update p_dev_rec->sec_flags=0x%x",
+ p_dev_rec->sec_flags);
+ if (p->transport == BT_TRANSPORT_LE) {
+ BTM_TRACE_DEBUG("LE link down");
+ p_dev_rec->sec_flags &= ~(BTM_SEC_LE_ENCRYPTED | BTM_SEC_ROLE_SWITCHED);
+ if ((p_dev_rec->sec_flags & BTM_SEC_LE_LINK_KEY_KNOWN) == 0) {
+ BTM_TRACE_DEBUG("Not Bonded");
+ p_dev_rec->sec_flags &=
+ ~(BTM_SEC_LE_LINK_KEY_AUTHED | BTM_SEC_LE_AUTHENTICATED);
+ } else {
+ BTM_TRACE_DEBUG("Bonded");
+ }
+ } else {
+ BTM_TRACE_DEBUG("Bletooth link down");
+ p_dev_rec->sec_flags &= ~(BTM_SEC_AUTHORIZED | BTM_SEC_AUTHENTICATED |
+ BTM_SEC_ENCRYPTED | BTM_SEC_ROLE_SWITCHED);
+ }
+ BTM_TRACE_DEBUG("after update p_dev_rec->sec_flags=0x%x",
+ p_dev_rec->sec_flags);
+ } else {
+ BTM_TRACE_ERROR("Device not found");
+ }
+
+ /* Clear the ACL connection data */
+ memset(p, 0, sizeof(tACL_CONN));
+ }
+}
/*******************************************************************************
*
@@ -448,19 +415,16 @@
* Returns void
*
******************************************************************************/
-void btm_acl_device_down (void)
-{
- tACL_CONN *p = &btm_cb.acl_db[0];
- uint16_t xx;
- BTM_TRACE_DEBUG ("btm_acl_device_down");
- for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p++)
- {
- if (p->in_use)
- {
- BTM_TRACE_DEBUG ("hci_handle=%d HCI_ERR_HW_FAILURE ",p->hci_handle );
- l2c_link_hci_disc_comp (p->hci_handle, HCI_ERR_HW_FAILURE);
- }
+void btm_acl_device_down(void) {
+ tACL_CONN* p = &btm_cb.acl_db[0];
+ uint16_t xx;
+ BTM_TRACE_DEBUG("btm_acl_device_down");
+ for (xx = 0; xx < MAX_L2CAP_LINKS; xx++, p++) {
+ if (p->in_use) {
+ BTM_TRACE_DEBUG("hci_handle=%d HCI_ERR_HW_FAILURE ", p->hci_handle);
+ l2c_link_hci_disc_comp(p->hci_handle, HCI_ERR_HW_FAILURE);
}
+ }
}
/*******************************************************************************
@@ -473,62 +437,59 @@
* Returns void
*
******************************************************************************/
-void btm_acl_update_busy_level (tBTM_BLI_EVENT event)
-{
- bool old_inquiry_state = btm_cb.is_inquiry;
- tBTM_BL_UPDATE_DATA evt;
- evt.busy_level_flags = 0;
- switch (event)
- {
- case BTM_BLI_ACL_UP_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_ACL_UP_EVT");
- break;
- case BTM_BLI_ACL_DOWN_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_ACL_DOWN_EVT");
- break;
- case BTM_BLI_PAGE_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_PAGE_EVT");
- btm_cb.is_paging = true;
- evt.busy_level_flags= BTM_BL_PAGING_STARTED;
- break;
- case BTM_BLI_PAGE_DONE_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_PAGE_DONE_EVT");
- btm_cb.is_paging = false;
- evt.busy_level_flags = BTM_BL_PAGING_COMPLETE;
- break;
- case BTM_BLI_INQ_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_INQ_EVT");
- btm_cb.is_inquiry = true;
- evt.busy_level_flags = BTM_BL_INQUIRY_STARTED;
- break;
- case BTM_BLI_INQ_CANCEL_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_INQ_CANCEL_EVT");
- btm_cb.is_inquiry = false;
- evt.busy_level_flags = BTM_BL_INQUIRY_CANCELLED;
- break;
- case BTM_BLI_INQ_DONE_EVT:
- BTM_TRACE_DEBUG ("BTM_BLI_INQ_DONE_EVT");
- btm_cb.is_inquiry = false;
- evt.busy_level_flags = BTM_BL_INQUIRY_COMPLETE;
- break;
- }
+void btm_acl_update_busy_level(tBTM_BLI_EVENT event) {
+ bool old_inquiry_state = btm_cb.is_inquiry;
+ tBTM_BL_UPDATE_DATA evt;
+ evt.busy_level_flags = 0;
+ switch (event) {
+ case BTM_BLI_ACL_UP_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_ACL_UP_EVT");
+ break;
+ case BTM_BLI_ACL_DOWN_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_ACL_DOWN_EVT");
+ break;
+ case BTM_BLI_PAGE_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_PAGE_EVT");
+ btm_cb.is_paging = true;
+ evt.busy_level_flags = BTM_BL_PAGING_STARTED;
+ break;
+ case BTM_BLI_PAGE_DONE_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_PAGE_DONE_EVT");
+ btm_cb.is_paging = false;
+ evt.busy_level_flags = BTM_BL_PAGING_COMPLETE;
+ break;
+ case BTM_BLI_INQ_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_INQ_EVT");
+ btm_cb.is_inquiry = true;
+ evt.busy_level_flags = BTM_BL_INQUIRY_STARTED;
+ break;
+ case BTM_BLI_INQ_CANCEL_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_INQ_CANCEL_EVT");
+ btm_cb.is_inquiry = false;
+ evt.busy_level_flags = BTM_BL_INQUIRY_CANCELLED;
+ break;
+ case BTM_BLI_INQ_DONE_EVT:
+ BTM_TRACE_DEBUG("BTM_BLI_INQ_DONE_EVT");
+ btm_cb.is_inquiry = false;
+ evt.busy_level_flags = BTM_BL_INQUIRY_COMPLETE;
+ break;
+ }
- uint8_t busy_level;
- if (btm_cb.is_paging || btm_cb.is_inquiry)
- busy_level = 10;
- else
- busy_level = BTM_GetNumAclLinks();
+ uint8_t busy_level;
+ if (btm_cb.is_paging || btm_cb.is_inquiry)
+ busy_level = 10;
+ else
+ busy_level = BTM_GetNumAclLinks();
- if ((busy_level != btm_cb.busy_level) ||(old_inquiry_state != btm_cb.is_inquiry))
- {
- evt.event = BTM_BL_UPDATE_EVT;
- evt.busy_level = busy_level;
- btm_cb.busy_level = busy_level;
- if (btm_cb.p_bl_changed_cb && (btm_cb.bl_evt_mask & BTM_BL_UPDATE_MASK))
- {
- (*btm_cb.p_bl_changed_cb)((tBTM_BL_EVENT_DATA *)&evt);
- }
+ if ((busy_level != btm_cb.busy_level) ||
+ (old_inquiry_state != btm_cb.is_inquiry)) {
+ evt.event = BTM_BL_UPDATE_EVT;
+ evt.busy_level = busy_level;
+ btm_cb.busy_level = busy_level;
+ if (btm_cb.p_bl_changed_cb && (btm_cb.bl_evt_mask & BTM_BL_UPDATE_MASK)) {
+ (*btm_cb.p_bl_changed_cb)((tBTM_BL_EVENT_DATA*)&evt);
}
+ }
}
/*******************************************************************************
@@ -542,23 +503,20 @@
* BTM_UNKNOWN_ADDR if no active link with bd addr specified
*
******************************************************************************/
-tBTM_STATUS BTM_GetRole (BD_ADDR remote_bd_addr, uint8_t *p_role)
-{
- tACL_CONN *p;
- BTM_TRACE_DEBUG ("BTM_GetRole");
- p = btm_bda_to_acl(remote_bd_addr, BT_TRANSPORT_BR_EDR);
- if (p == NULL)
- {
- *p_role = BTM_ROLE_UNDEFINED;
- return(BTM_UNKNOWN_ADDR);
- }
+tBTM_STATUS BTM_GetRole(BD_ADDR remote_bd_addr, uint8_t* p_role) {
+ tACL_CONN* p;
+ BTM_TRACE_DEBUG("BTM_GetRole");
+ p = btm_bda_to_acl(remote_bd_addr, BT_TRANSPORT_BR_EDR);
+ if (p == NULL) {
+ *p_role = BTM_ROLE_UNDEFINED;
+ return (BTM_UNKNOWN_ADDR);
+ }
- /* Get the current role */
- *p_role = p->link_role;
- return(BTM_SUCCESS);
+ /* Get the current role */
+ *p_role = p->link_role;
+ return (BTM_SUCCESS);
}
-
/*******************************************************************************
*
* Function BTM_SwitchRole
@@ -578,113 +536,97 @@
* BTM_BUSY if the previous command is not completed
*
******************************************************************************/
-tBTM_STATUS BTM_SwitchRole (BD_ADDR remote_bd_addr, uint8_t new_role, tBTM_CMPL_CB *p_cb)
-{
- tACL_CONN *p;
- tBTM_SEC_DEV_REC *p_dev_rec = NULL;
+tBTM_STATUS BTM_SwitchRole(BD_ADDR remote_bd_addr, uint8_t new_role,
+ tBTM_CMPL_CB* p_cb) {
+ tACL_CONN* p;
+ tBTM_SEC_DEV_REC* p_dev_rec = NULL;
#if (BTM_SCO_INCLUDED == TRUE)
- bool is_sco_active;
+ bool is_sco_active;
#endif
- tBTM_STATUS status;
- tBTM_PM_MODE pwr_mode;
- tBTM_PM_PWR_MD settings;
- BD_ADDR_PTR p_bda;
- BTM_TRACE_API ("BTM_SwitchRole BDA: %02x-%02x-%02x-%02x-%02x-%02x",
- remote_bd_addr[0], remote_bd_addr[1], remote_bd_addr[2],
- remote_bd_addr[3], remote_bd_addr[4], remote_bd_addr[5]);
+ tBTM_STATUS status;
+ tBTM_PM_MODE pwr_mode;
+ tBTM_PM_PWR_MD settings;
+ BD_ADDR_PTR p_bda;
+ BTM_TRACE_API("BTM_SwitchRole BDA: %02x-%02x-%02x-%02x-%02x-%02x",
+ remote_bd_addr[0], remote_bd_addr[1], remote_bd_addr[2],
+ remote_bd_addr[3], remote_bd_addr[4], remote_bd_addr[5]);
- /* Make sure the local device supports switching */
- if (!controller_get_interface()->supports_master_slave_role_switch())
- return(BTM_MODE_UNSUPPORTED);
+ /* Make sure the local device supports switching */
+ if (!controller_get_interface()->supports_master_slave_role_switch())
+ return (BTM_MODE_UNSUPPORTED);
- if (btm_cb.devcb.p_switch_role_cb && p_cb)
- {
- p_bda = btm_cb.devcb.switch_role_ref_data.remote_bd_addr;
- BTM_TRACE_DEBUG ("Role switch on other device is in progress 0x%02x%02x%02x%02x%02x%02x",
- p_bda[0], p_bda[1], p_bda[2],
- p_bda[3], p_bda[4], p_bda[5]);
- return(BTM_BUSY);
- }
+ if (btm_cb.devcb.p_switch_role_cb && p_cb) {
+ p_bda = btm_cb.devcb.switch_role_ref_data.remote_bd_addr;
+ BTM_TRACE_DEBUG(
+ "Role switch on other device is in progress 0x%02x%02x%02x%02x%02x%02x",
+ p_bda[0], p_bda[1], p_bda[2], p_bda[3], p_bda[4], p_bda[5]);
+ return (BTM_BUSY);
+ }
- p = btm_bda_to_acl(remote_bd_addr, BT_TRANSPORT_BR_EDR);
- if (p == NULL)
- return(BTM_UNKNOWN_ADDR);
+ p = btm_bda_to_acl(remote_bd_addr, BT_TRANSPORT_BR_EDR);
+ if (p == NULL) return (BTM_UNKNOWN_ADDR);
- /* Finished if already in desired role */
- if (p->link_role == new_role)
- return(BTM_SUCCESS);
+ /* Finished if already in desired role */
+ if (p->link_role == new_role) return (BTM_SUCCESS);
#if (BTM_SCO_INCLUDED == TRUE)
- /* Check if there is any SCO Active on this BD Address */
- is_sco_active = btm_is_sco_active_by_bdaddr(remote_bd_addr);
+ /* Check if there is any SCO Active on this BD Address */
+ is_sco_active = btm_is_sco_active_by_bdaddr(remote_bd_addr);
- if (is_sco_active == true)
- return(BTM_NO_RESOURCES);
+ if (is_sco_active == true) return (BTM_NO_RESOURCES);
#endif
- /* Ignore role switch request if the previous request was not completed */
- if (p->switch_role_state != BTM_ACL_SWKEY_STATE_IDLE)
- {
- BTM_TRACE_DEBUG ("BTM_SwitchRole busy: %d",
- p->switch_role_state);
- return(BTM_BUSY);
- }
+ /* Ignore role switch request if the previous request was not completed */
+ if (p->switch_role_state != BTM_ACL_SWKEY_STATE_IDLE) {
+ BTM_TRACE_DEBUG("BTM_SwitchRole busy: %d", p->switch_role_state);
+ return (BTM_BUSY);
+ }
- status = BTM_ReadPowerMode(p->remote_addr, &pwr_mode);
- if (status != BTM_SUCCESS)
- return(status);
+ status = BTM_ReadPowerMode(p->remote_addr, &pwr_mode);
+ if (status != BTM_SUCCESS) return (status);
- /* Wake up the link if in sniff or park before attempting switch */
- if (pwr_mode == BTM_PM_MD_PARK || pwr_mode == BTM_PM_MD_SNIFF)
- {
- memset( (void*)&settings, 0, sizeof(settings));
- settings.mode = BTM_PM_MD_ACTIVE;
- status = BTM_SetPowerMode (BTM_PM_SET_ONLY_ID, p->remote_addr, &settings);
- if (status != BTM_CMD_STARTED)
- return(BTM_WRONG_MODE);
+ /* Wake up the link if in sniff or park before attempting switch */
+ if (pwr_mode == BTM_PM_MD_PARK || pwr_mode == BTM_PM_MD_SNIFF) {
+ memset((void*)&settings, 0, sizeof(settings));
+ settings.mode = BTM_PM_MD_ACTIVE;
+ status = BTM_SetPowerMode(BTM_PM_SET_ONLY_ID, p->remote_addr, &settings);
+ if (status != BTM_CMD_STARTED) return (BTM_WRONG_MODE);
- p->switch_role_state = BTM_ACL_SWKEY_STATE_MODE_CHANGE;
- }
- /* some devices do not support switch while encryption is on */
- else
- {
- p_dev_rec = btm_find_dev (remote_bd_addr);
- if ((p_dev_rec != NULL)
- && ((p_dev_rec->sec_flags & BTM_SEC_ENCRYPTED) != 0)
- && !BTM_EPR_AVAILABLE(p))
- {
- /* bypass turning off encryption if change link key is already doing it */
- if (p->encrypt_state != BTM_ACL_ENCRYPT_STATE_ENCRYPT_OFF)
- {
- btsnd_hcic_set_conn_encrypt (p->hci_handle, false);
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_ENCRYPT_OFF;
- }
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_MODE_CHANGE;
+ }
+ /* some devices do not support switch while encryption is on */
+ else {
+ p_dev_rec = btm_find_dev(remote_bd_addr);
+ if ((p_dev_rec != NULL) &&
+ ((p_dev_rec->sec_flags & BTM_SEC_ENCRYPTED) != 0) &&
+ !BTM_EPR_AVAILABLE(p)) {
+ /* bypass turning off encryption if change link key is already doing it */
+ if (p->encrypt_state != BTM_ACL_ENCRYPT_STATE_ENCRYPT_OFF) {
+ btsnd_hcic_set_conn_encrypt(p->hci_handle, false);
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_ENCRYPT_OFF;
+ }
- p->switch_role_state = BTM_ACL_SWKEY_STATE_ENCRYPTION_OFF;
- }
- else
- {
- btsnd_hcic_switch_role (remote_bd_addr, new_role);
- p->switch_role_state = BTM_ACL_SWKEY_STATE_IN_PROGRESS;
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_ENCRYPTION_OFF;
+ } else {
+ btsnd_hcic_switch_role(remote_bd_addr, new_role);
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_IN_PROGRESS;
#if (BTM_DISC_DURING_RS == TRUE)
- if (p_dev_rec)
- p_dev_rec->rs_disc_pending = BTM_SEC_RS_PENDING;
+ if (p_dev_rec) p_dev_rec->rs_disc_pending = BTM_SEC_RS_PENDING;
#endif
- }
}
+ }
- /* Initialize return structure in case request fails */
- if (p_cb)
- {
- memcpy (btm_cb.devcb.switch_role_ref_data.remote_bd_addr, remote_bd_addr,
- BD_ADDR_LEN);
- btm_cb.devcb.switch_role_ref_data.role = new_role;
- /* initialized to an error code */
- btm_cb.devcb.switch_role_ref_data.hci_status = HCI_ERR_UNSUPPORTED_VALUE;
- btm_cb.devcb.p_switch_role_cb = p_cb;
- }
- return(BTM_CMD_STARTED);
+ /* Initialize return structure in case request fails */
+ if (p_cb) {
+ memcpy(btm_cb.devcb.switch_role_ref_data.remote_bd_addr, remote_bd_addr,
+ BD_ADDR_LEN);
+ btm_cb.devcb.switch_role_ref_data.role = new_role;
+ /* initialized to an error code */
+ btm_cb.devcb.switch_role_ref_data.hci_status = HCI_ERR_UNSUPPORTED_VALUE;
+ btm_cb.devcb.p_switch_role_cb = p_cb;
+ }
+ return (BTM_CMD_STARTED);
}
/*******************************************************************************
@@ -699,80 +641,77 @@
* Returns void
*
******************************************************************************/
-void btm_acl_encrypt_change (uint16_t handle, uint8_t status, uint8_t encr_enable)
-{
- tACL_CONN *p;
- uint8_t xx;
- tBTM_SEC_DEV_REC *p_dev_rec;
- tBTM_BL_ROLE_CHG_DATA evt;
+void btm_acl_encrypt_change(uint16_t handle, uint8_t status,
+ uint8_t encr_enable) {
+ tACL_CONN* p;
+ uint8_t xx;
+ tBTM_SEC_DEV_REC* p_dev_rec;
+ tBTM_BL_ROLE_CHG_DATA evt;
- BTM_TRACE_DEBUG ("btm_acl_encrypt_change handle=%d status=%d encr_enabl=%d",
- handle, status, encr_enable);
- xx = btm_handle_to_acl_index(handle);
- /* don't assume that we can never get a bad hci_handle */
- if (xx < MAX_L2CAP_LINKS)
- p = &btm_cb.acl_db[xx];
- else
- return;
+ BTM_TRACE_DEBUG("btm_acl_encrypt_change handle=%d status=%d encr_enabl=%d",
+ handle, status, encr_enable);
+ xx = btm_handle_to_acl_index(handle);
+ /* don't assume that we can never get a bad hci_handle */
+ if (xx < MAX_L2CAP_LINKS)
+ p = &btm_cb.acl_db[xx];
+ else
+ return;
- /* Process Role Switch if active */
- if (p->switch_role_state == BTM_ACL_SWKEY_STATE_ENCRYPTION_OFF)
- {
- /* if encryption turn off failed we still will try to switch role */
- if (encr_enable)
- {
- p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_IDLE;
- }
- else
- {
- p->switch_role_state = BTM_ACL_SWKEY_STATE_SWITCHING;
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_TEMP_FUNC;
- }
+ /* Process Role Switch if active */
+ if (p->switch_role_state == BTM_ACL_SWKEY_STATE_ENCRYPTION_OFF) {
+ /* if encryption turn off failed we still will try to switch role */
+ if (encr_enable) {
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_IDLE;
+ } else {
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_SWITCHING;
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_TEMP_FUNC;
+ }
- btsnd_hcic_switch_role(p->remote_addr, (uint8_t)!p->link_role);
+ btsnd_hcic_switch_role(p->remote_addr, (uint8_t)!p->link_role);
#if (BTM_DISC_DURING_RS == TRUE)
- p_dev_rec = btm_find_dev(p->remote_addr);
- if (p_dev_rec != NULL) p_dev_rec->rs_disc_pending = BTM_SEC_RS_PENDING;
+ p_dev_rec = btm_find_dev(p->remote_addr);
+ if (p_dev_rec != NULL) p_dev_rec->rs_disc_pending = BTM_SEC_RS_PENDING;
#endif
+ }
+ /* Finished enabling Encryption after role switch */
+ else if (p->switch_role_state == BTM_ACL_SWKEY_STATE_ENCRYPTION_ON) {
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_IDLE;
+ btm_acl_report_role_change(btm_cb.devcb.switch_role_ref_data.hci_status,
+ p->remote_addr);
+
+ /* if role change event is registered, report it now */
+ if (btm_cb.p_bl_changed_cb && (btm_cb.bl_evt_mask & BTM_BL_ROLE_CHG_MASK)) {
+ evt.event = BTM_BL_ROLE_CHG_EVT;
+ evt.new_role = btm_cb.devcb.switch_role_ref_data.role;
+ evt.p_bda = btm_cb.devcb.switch_role_ref_data.remote_bd_addr;
+ evt.hci_status = btm_cb.devcb.switch_role_ref_data.hci_status;
+ (*btm_cb.p_bl_changed_cb)((tBTM_BL_EVENT_DATA*)&evt);
+
+ BTM_TRACE_DEBUG(
+ "Role Switch Event: new_role 0x%02x, HCI Status 0x%02x, rs_st:%d",
+ evt.new_role, evt.hci_status, p->switch_role_state);
}
- /* Finished enabling Encryption after role switch */
- else if (p->switch_role_state == BTM_ACL_SWKEY_STATE_ENCRYPTION_ON)
- {
- p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_IDLE;
- btm_acl_report_role_change(btm_cb.devcb.switch_role_ref_data.hci_status, p->remote_addr);
-
- /* if role change event is registered, report it now */
- if (btm_cb.p_bl_changed_cb && (btm_cb.bl_evt_mask & BTM_BL_ROLE_CHG_MASK))
- {
- evt.event = BTM_BL_ROLE_CHG_EVT;
- evt.new_role = btm_cb.devcb.switch_role_ref_data.role;
- evt.p_bda = btm_cb.devcb.switch_role_ref_data.remote_bd_addr;
- evt.hci_status = btm_cb.devcb.switch_role_ref_data.hci_status;
- (*btm_cb.p_bl_changed_cb)((tBTM_BL_EVENT_DATA *)&evt);
-
- BTM_TRACE_DEBUG("Role Switch Event: new_role 0x%02x, HCI Status 0x%02x, rs_st:%d",
- evt.new_role, evt.hci_status, p->switch_role_state);
- }
#if (BTM_DISC_DURING_RS == TRUE)
- /* If a disconnect is pending, issue it now that role switch has completed */
- p_dev_rec = btm_find_dev(p->remote_addr);
- if (p_dev_rec != NULL)
- {
- if (p_dev_rec->rs_disc_pending == BTM_SEC_DISC_PENDING)
- {
- BTM_TRACE_WARNING("btm_acl_encrypt_change -> Issuing delayed HCI_Disconnect!!!");
- btsnd_hcic_disconnect(p_dev_rec->hci_handle, HCI_ERR_PEER_USER);
- }
- BTM_TRACE_ERROR("btm_acl_encrypt_change: tBTM_SEC_DEV:0x%x rs_disc_pending=%d",
- PTR_TO_UINT(p_dev_rec), p_dev_rec->rs_disc_pending);
- p_dev_rec->rs_disc_pending = BTM_SEC_RS_NOT_PENDING; /* reset flag */
- }
-#endif
+ /* If a disconnect is pending, issue it now that role switch has completed
+ */
+ p_dev_rec = btm_find_dev(p->remote_addr);
+ if (p_dev_rec != NULL) {
+ if (p_dev_rec->rs_disc_pending == BTM_SEC_DISC_PENDING) {
+ BTM_TRACE_WARNING(
+ "btm_acl_encrypt_change -> Issuing delayed HCI_Disconnect!!!");
+ btsnd_hcic_disconnect(p_dev_rec->hci_handle, HCI_ERR_PEER_USER);
+ }
+ BTM_TRACE_ERROR(
+ "btm_acl_encrypt_change: tBTM_SEC_DEV:0x%x rs_disc_pending=%d",
+ PTR_TO_UINT(p_dev_rec), p_dev_rec->rs_disc_pending);
+ p_dev_rec->rs_disc_pending = BTM_SEC_RS_NOT_PENDING; /* reset flag */
}
+#endif
+ }
}
/*******************************************************************************
*
@@ -783,46 +722,48 @@
* Returns status of the operation
*
******************************************************************************/
-tBTM_STATUS BTM_SetLinkPolicy (BD_ADDR remote_bda, uint16_t *settings)
-{
- tACL_CONN *p;
- uint8_t *localFeatures = BTM_ReadLocalFeatures();
- BTM_TRACE_DEBUG ("%s", __func__);
-/* BTM_TRACE_API ("%s: requested settings: 0x%04x", __func__, *settings ); */
+tBTM_STATUS BTM_SetLinkPolicy(BD_ADDR remote_bda, uint16_t* settings) {
+ tACL_CONN* p;
+ uint8_t* localFeatures = BTM_ReadLocalFeatures();
+ BTM_TRACE_DEBUG("%s", __func__);
+ /* BTM_TRACE_API ("%s: requested settings: 0x%04x", __func__, *settings ); */
- /* First, check if hold mode is supported */
- if (*settings != HCI_DISABLE_ALL_LM_MODES)
- {
- if ( (*settings & HCI_ENABLE_MASTER_SLAVE_SWITCH) && (!HCI_SWITCH_SUPPORTED(localFeatures)) )
- {
- *settings &= (~HCI_ENABLE_MASTER_SLAVE_SWITCH);
- BTM_TRACE_API ("BTM_SetLinkPolicy switch not supported (settings: 0x%04x)", *settings );
- }
- if ( (*settings & HCI_ENABLE_HOLD_MODE) && (!HCI_HOLD_MODE_SUPPORTED(localFeatures)) )
- {
- *settings &= (~HCI_ENABLE_HOLD_MODE);
- BTM_TRACE_API ("BTM_SetLinkPolicy hold not supported (settings: 0x%04x)", *settings );
- }
- if ( (*settings & HCI_ENABLE_SNIFF_MODE) && (!HCI_SNIFF_MODE_SUPPORTED(localFeatures)) )
- {
- *settings &= (~HCI_ENABLE_SNIFF_MODE);
- BTM_TRACE_API ("BTM_SetLinkPolicy sniff not supported (settings: 0x%04x)", *settings );
- }
- if ( (*settings & HCI_ENABLE_PARK_MODE) && (!HCI_PARK_MODE_SUPPORTED(localFeatures)) )
- {
- *settings &= (~HCI_ENABLE_PARK_MODE);
- BTM_TRACE_API ("BTM_SetLinkPolicy park not supported (settings: 0x%04x)", *settings );
- }
+ /* First, check if hold mode is supported */
+ if (*settings != HCI_DISABLE_ALL_LM_MODES) {
+ if ((*settings & HCI_ENABLE_MASTER_SLAVE_SWITCH) &&
+ (!HCI_SWITCH_SUPPORTED(localFeatures))) {
+ *settings &= (~HCI_ENABLE_MASTER_SLAVE_SWITCH);
+ BTM_TRACE_API("BTM_SetLinkPolicy switch not supported (settings: 0x%04x)",
+ *settings);
}
-
- p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
- if (p != NULL) {
- btsnd_hcic_write_policy_set(p->hci_handle, *settings);
- return BTM_CMD_STARTED;
+ if ((*settings & HCI_ENABLE_HOLD_MODE) &&
+ (!HCI_HOLD_MODE_SUPPORTED(localFeatures))) {
+ *settings &= (~HCI_ENABLE_HOLD_MODE);
+ BTM_TRACE_API("BTM_SetLinkPolicy hold not supported (settings: 0x%04x)",
+ *settings);
}
+ if ((*settings & HCI_ENABLE_SNIFF_MODE) &&
+ (!HCI_SNIFF_MODE_SUPPORTED(localFeatures))) {
+ *settings &= (~HCI_ENABLE_SNIFF_MODE);
+ BTM_TRACE_API("BTM_SetLinkPolicy sniff not supported (settings: 0x%04x)",
+ *settings);
+ }
+ if ((*settings & HCI_ENABLE_PARK_MODE) &&
+ (!HCI_PARK_MODE_SUPPORTED(localFeatures))) {
+ *settings &= (~HCI_ENABLE_PARK_MODE);
+ BTM_TRACE_API("BTM_SetLinkPolicy park not supported (settings: 0x%04x)",
+ *settings);
+ }
+ }
- /* If here, no BD Addr found */
- return(BTM_UNKNOWN_ADDR);
+ p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
+ if (p != NULL) {
+ btsnd_hcic_write_policy_set(p->hci_handle, *settings);
+ return BTM_CMD_STARTED;
+ }
+
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
/*******************************************************************************
@@ -835,75 +776,83 @@
* Returns void
*
******************************************************************************/
-void BTM_SetDefaultLinkPolicy (uint16_t settings)
-{
- uint8_t *localFeatures = BTM_ReadLocalFeatures();
+void BTM_SetDefaultLinkPolicy(uint16_t settings) {
+ uint8_t* localFeatures = BTM_ReadLocalFeatures();
- BTM_TRACE_DEBUG("BTM_SetDefaultLinkPolicy setting:0x%04x", settings);
+ BTM_TRACE_DEBUG("BTM_SetDefaultLinkPolicy setting:0x%04x", settings);
- if((settings & HCI_ENABLE_MASTER_SLAVE_SWITCH) && (!HCI_SWITCH_SUPPORTED(localFeatures)))
- {
- settings &= ~HCI_ENABLE_MASTER_SLAVE_SWITCH;
- BTM_TRACE_DEBUG("BTM_SetDefaultLinkPolicy switch not supported (settings: 0x%04x)", settings);
- }
- if ((settings & HCI_ENABLE_HOLD_MODE) && (!HCI_HOLD_MODE_SUPPORTED(localFeatures)))
- {
- settings &= ~HCI_ENABLE_HOLD_MODE;
- BTM_TRACE_DEBUG("BTM_SetDefaultLinkPolicy hold not supported (settings: 0x%04x)", settings);
- }
- if ((settings & HCI_ENABLE_SNIFF_MODE) && (!HCI_SNIFF_MODE_SUPPORTED(localFeatures)))
- {
- settings &= ~HCI_ENABLE_SNIFF_MODE;
- BTM_TRACE_DEBUG("BTM_SetDefaultLinkPolicy sniff not supported (settings: 0x%04x)", settings);
- }
- if ((settings & HCI_ENABLE_PARK_MODE) && (!HCI_PARK_MODE_SUPPORTED(localFeatures)))
- {
- settings &= ~HCI_ENABLE_PARK_MODE;
- BTM_TRACE_DEBUG("BTM_SetDefaultLinkPolicy park not supported (settings: 0x%04x)", settings);
- }
- BTM_TRACE_DEBUG("Set DefaultLinkPolicy:0x%04x", settings);
+ if ((settings & HCI_ENABLE_MASTER_SLAVE_SWITCH) &&
+ (!HCI_SWITCH_SUPPORTED(localFeatures))) {
+ settings &= ~HCI_ENABLE_MASTER_SLAVE_SWITCH;
+ BTM_TRACE_DEBUG(
+ "BTM_SetDefaultLinkPolicy switch not supported (settings: 0x%04x)",
+ settings);
+ }
+ if ((settings & HCI_ENABLE_HOLD_MODE) &&
+ (!HCI_HOLD_MODE_SUPPORTED(localFeatures))) {
+ settings &= ~HCI_ENABLE_HOLD_MODE;
+ BTM_TRACE_DEBUG(
+ "BTM_SetDefaultLinkPolicy hold not supported (settings: 0x%04x)",
+ settings);
+ }
+ if ((settings & HCI_ENABLE_SNIFF_MODE) &&
+ (!HCI_SNIFF_MODE_SUPPORTED(localFeatures))) {
+ settings &= ~HCI_ENABLE_SNIFF_MODE;
+ BTM_TRACE_DEBUG(
+ "BTM_SetDefaultLinkPolicy sniff not supported (settings: 0x%04x)",
+ settings);
+ }
+ if ((settings & HCI_ENABLE_PARK_MODE) &&
+ (!HCI_PARK_MODE_SUPPORTED(localFeatures))) {
+ settings &= ~HCI_ENABLE_PARK_MODE;
+ BTM_TRACE_DEBUG(
+ "BTM_SetDefaultLinkPolicy park not supported (settings: 0x%04x)",
+ settings);
+ }
+ BTM_TRACE_DEBUG("Set DefaultLinkPolicy:0x%04x", settings);
- btm_cb.btm_def_link_policy = settings;
+ btm_cb.btm_def_link_policy = settings;
- /* Set the default Link Policy of the controller */
- btsnd_hcic_write_def_policy_set(settings);
+ /* Set the default Link Policy of the controller */
+ btsnd_hcic_write_def_policy_set(settings);
}
-
void btm_use_preferred_conn_params(BD_ADDR bda) {
- tL2C_LCB *p_lcb = l2cu_find_lcb_by_bd_addr (bda, BT_TRANSPORT_LE);
- tBTM_SEC_DEV_REC *p_dev_rec = btm_find_or_alloc_dev (bda);
+ tL2C_LCB* p_lcb = l2cu_find_lcb_by_bd_addr(bda, BT_TRANSPORT_LE);
+ tBTM_SEC_DEV_REC* p_dev_rec = btm_find_or_alloc_dev(bda);
- /* If there are any preferred connection parameters, set them now */
- if ( (p_dev_rec->conn_params.min_conn_int >= BTM_BLE_CONN_INT_MIN ) &&
- (p_dev_rec->conn_params.min_conn_int <= BTM_BLE_CONN_INT_MAX ) &&
- (p_dev_rec->conn_params.max_conn_int >= BTM_BLE_CONN_INT_MIN ) &&
- (p_dev_rec->conn_params.max_conn_int <= BTM_BLE_CONN_INT_MAX ) &&
- (p_dev_rec->conn_params.slave_latency <= BTM_BLE_CONN_LATENCY_MAX ) &&
- (p_dev_rec->conn_params.supervision_tout >= BTM_BLE_CONN_SUP_TOUT_MIN) &&
- (p_dev_rec->conn_params.supervision_tout <= BTM_BLE_CONN_SUP_TOUT_MAX) &&
- ((p_lcb->min_interval < p_dev_rec->conn_params.min_conn_int &&
- p_dev_rec->conn_params.min_conn_int != BTM_BLE_CONN_PARAM_UNDEF) ||
- (p_lcb->min_interval > p_dev_rec->conn_params.max_conn_int) ||
- (p_lcb->latency > p_dev_rec->conn_params.slave_latency) ||
- (p_lcb->timeout > p_dev_rec->conn_params.supervision_tout)))
- {
- BTM_TRACE_DEBUG ("%s: HANDLE=%d min_conn_int=%d max_conn_int=%d slave_latency=%d supervision_tout=%d", __func__,
- p_lcb->handle, p_dev_rec->conn_params.min_conn_int, p_dev_rec->conn_params.max_conn_int,
- p_dev_rec->conn_params.slave_latency, p_dev_rec->conn_params.supervision_tout);
+ /* If there are any preferred connection parameters, set them now */
+ if ((p_dev_rec->conn_params.min_conn_int >= BTM_BLE_CONN_INT_MIN) &&
+ (p_dev_rec->conn_params.min_conn_int <= BTM_BLE_CONN_INT_MAX) &&
+ (p_dev_rec->conn_params.max_conn_int >= BTM_BLE_CONN_INT_MIN) &&
+ (p_dev_rec->conn_params.max_conn_int <= BTM_BLE_CONN_INT_MAX) &&
+ (p_dev_rec->conn_params.slave_latency <= BTM_BLE_CONN_LATENCY_MAX) &&
+ (p_dev_rec->conn_params.supervision_tout >= BTM_BLE_CONN_SUP_TOUT_MIN) &&
+ (p_dev_rec->conn_params.supervision_tout <= BTM_BLE_CONN_SUP_TOUT_MAX) &&
+ ((p_lcb->min_interval < p_dev_rec->conn_params.min_conn_int &&
+ p_dev_rec->conn_params.min_conn_int != BTM_BLE_CONN_PARAM_UNDEF) ||
+ (p_lcb->min_interval > p_dev_rec->conn_params.max_conn_int) ||
+ (p_lcb->latency > p_dev_rec->conn_params.slave_latency) ||
+ (p_lcb->timeout > p_dev_rec->conn_params.supervision_tout))) {
+ BTM_TRACE_DEBUG(
+ "%s: HANDLE=%d min_conn_int=%d max_conn_int=%d slave_latency=%d "
+ "supervision_tout=%d",
+ __func__, p_lcb->handle, p_dev_rec->conn_params.min_conn_int,
+ p_dev_rec->conn_params.max_conn_int,
+ p_dev_rec->conn_params.slave_latency,
+ p_dev_rec->conn_params.supervision_tout);
- p_lcb->min_interval = p_dev_rec->conn_params.min_conn_int;
- p_lcb->max_interval = p_dev_rec->conn_params.max_conn_int;
- p_lcb->timeout = p_dev_rec->conn_params.supervision_tout;
- p_lcb->latency = p_dev_rec->conn_params.slave_latency;
+ p_lcb->min_interval = p_dev_rec->conn_params.min_conn_int;
+ p_lcb->max_interval = p_dev_rec->conn_params.max_conn_int;
+ p_lcb->timeout = p_dev_rec->conn_params.supervision_tout;
+ p_lcb->latency = p_dev_rec->conn_params.slave_latency;
- btsnd_hcic_ble_upd_ll_conn_params (p_lcb->handle,
- p_dev_rec->conn_params.min_conn_int,
- p_dev_rec->conn_params.max_conn_int,
- p_dev_rec->conn_params.slave_latency,
- p_dev_rec->conn_params.supervision_tout,
- 0, 0);
- }
+ btsnd_hcic_ble_upd_ll_conn_params(
+ p_lcb->handle, p_dev_rec->conn_params.min_conn_int,
+ p_dev_rec->conn_params.max_conn_int,
+ p_dev_rec->conn_params.slave_latency,
+ p_dev_rec->conn_params.supervision_tout, 0, 0);
+ }
}
/*******************************************************************************
@@ -916,39 +865,34 @@
* Returns void
*
******************************************************************************/
-void btm_read_remote_version_complete (uint8_t *p)
-{
- tACL_CONN *p_acl_cb = &btm_cb.acl_db[0];
- uint8_t status;
- uint16_t handle;
- int xx;
- BTM_TRACE_DEBUG ("btm_read_remote_version_complete");
+void btm_read_remote_version_complete(uint8_t* p) {
+ tACL_CONN* p_acl_cb = &btm_cb.acl_db[0];
+ uint8_t status;
+ uint16_t handle;
+ int xx;
+ BTM_TRACE_DEBUG("btm_read_remote_version_complete");
- STREAM_TO_UINT8 (status, p);
- STREAM_TO_UINT16 (handle, p);
+ STREAM_TO_UINT8(status, p);
+ STREAM_TO_UINT16(handle, 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))
- {
- if (status == HCI_SUCCESS)
- {
- STREAM_TO_UINT8 (p_acl_cb->lmp_version, p);
- STREAM_TO_UINT16 (p_acl_cb->manufacturer, p);
- STREAM_TO_UINT16 (p_acl_cb->lmp_subversion, 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)) {
+ if (status == HCI_SUCCESS) {
+ STREAM_TO_UINT8(p_acl_cb->lmp_version, p);
+ STREAM_TO_UINT16(p_acl_cb->manufacturer, p);
+ STREAM_TO_UINT16(p_acl_cb->lmp_subversion, p);
+ }
- if (p_acl_cb->transport == BT_TRANSPORT_LE) {
- l2cble_notify_le_connection (p_acl_cb->remote_addr);
- btm_use_preferred_conn_params(p_acl_cb->remote_addr);
- }
- break;
- }
+ if (p_acl_cb->transport == BT_TRANSPORT_LE) {
+ l2cble_notify_le_connection(p_acl_cb->remote_addr);
+ btm_use_preferred_conn_params(p_acl_cb->remote_addr);
+ }
+ break;
}
+ }
}
-
/*******************************************************************************
*
* Function btm_process_remote_ext_features
@@ -959,50 +903,45 @@
* Returns void
*
******************************************************************************/
-void btm_process_remote_ext_features (tACL_CONN *p_acl_cb, uint8_t num_read_pages)
-{
- uint16_t handle = p_acl_cb->hci_handle;
- tBTM_SEC_DEV_REC *p_dev_rec = btm_find_dev_by_handle (handle);
- uint8_t page_idx;
+void btm_process_remote_ext_features(tACL_CONN* p_acl_cb,
+ uint8_t num_read_pages) {
+ uint16_t handle = p_acl_cb->hci_handle;
+ tBTM_SEC_DEV_REC* p_dev_rec = btm_find_dev_by_handle(handle);
+ uint8_t page_idx;
- BTM_TRACE_DEBUG ("btm_process_remote_ext_features");
+ BTM_TRACE_DEBUG("btm_process_remote_ext_features");
- /* Make sure we have the record to save remote features information */
- if (p_dev_rec == NULL)
- {
- /* Get a new device; might be doing dedicated bonding */
- p_dev_rec = btm_find_or_alloc_dev (p_acl_cb->remote_addr);
+ /* Make sure we have the record to save remote features information */
+ if (p_dev_rec == NULL) {
+ /* Get a new device; might be doing dedicated bonding */
+ p_dev_rec = btm_find_or_alloc_dev(p_acl_cb->remote_addr);
+ }
+
+ p_acl_cb->num_read_pages = num_read_pages;
+ p_dev_rec->num_read_pages = num_read_pages;
+
+ /* Move the pages to placeholder */
+ for (page_idx = 0; page_idx < num_read_pages; page_idx++) {
+ if (page_idx > HCI_EXT_FEATURES_PAGE_MAX) {
+ BTM_TRACE_ERROR("%s: page=%d unexpected", __func__, page_idx);
+ break;
}
+ memcpy(p_dev_rec->features[page_idx], p_acl_cb->peer_lmp_features[page_idx],
+ HCI_FEATURE_BYTES_PER_PAGE);
+ }
- p_acl_cb->num_read_pages = num_read_pages;
- p_dev_rec->num_read_pages = num_read_pages;
+ const uint8_t req_pend = (p_dev_rec->sm4 & BTM_SM4_REQ_PEND);
- /* Move the pages to placeholder */
- for (page_idx = 0; page_idx < num_read_pages; page_idx++)
- {
- if (page_idx > HCI_EXT_FEATURES_PAGE_MAX)
- {
- BTM_TRACE_ERROR("%s: page=%d unexpected", __func__, page_idx);
- break;
- }
- memcpy (p_dev_rec->features[page_idx], p_acl_cb->peer_lmp_features[page_idx],
- HCI_FEATURE_BYTES_PER_PAGE);
- }
+ /* Store the Peer Security Capabilites (in SM4 and rmt_sec_caps) */
+ btm_sec_set_peer_sec_caps(p_acl_cb, p_dev_rec);
- const uint8_t req_pend = (p_dev_rec->sm4 & BTM_SM4_REQ_PEND);
-
- /* Store the Peer Security Capabilites (in SM4 and rmt_sec_caps) */
- btm_sec_set_peer_sec_caps(p_acl_cb, p_dev_rec);
-
- BTM_TRACE_API("%s: pend:%d", __func__, req_pend);
- if (req_pend)
- {
- /* Request for remaining Security Features (if any) */
- l2cu_resubmit_pending_sec_req (p_dev_rec->bd_addr);
- }
+ BTM_TRACE_API("%s: pend:%d", __func__, req_pend);
+ if (req_pend) {
+ /* Request for remaining Security Features (if any) */
+ l2cu_resubmit_pending_sec_req(p_dev_rec->bd_addr);
+ }
}
-
/*******************************************************************************
*
* Function btm_read_remote_features
@@ -1013,30 +952,28 @@
* Returns void
*
******************************************************************************/
-void btm_read_remote_features (uint16_t handle)
-{
- uint8_t acl_idx;
- tACL_CONN *p_acl_cb;
+void btm_read_remote_features(uint16_t handle) {
+ uint8_t acl_idx;
+ tACL_CONN* p_acl_cb;
- BTM_TRACE_DEBUG("btm_read_remote_features() handle: %d", handle);
+ BTM_TRACE_DEBUG("btm_read_remote_features() handle: %d", handle);
- acl_idx = btm_handle_to_acl_index(handle);
- if (acl_idx >= MAX_L2CAP_LINKS)
- {
- BTM_TRACE_ERROR("btm_read_remote_features handle=%d invalid", handle);
- return;
- }
+ acl_idx = btm_handle_to_acl_index(handle);
+ if (acl_idx >= MAX_L2CAP_LINKS) {
+ BTM_TRACE_ERROR("btm_read_remote_features handle=%d invalid", handle);
+ return;
+ }
- p_acl_cb = &btm_cb.acl_db[acl_idx];
- p_acl_cb->num_read_pages = 0;
- memset (p_acl_cb->peer_lmp_features, 0, sizeof(p_acl_cb->peer_lmp_features));
+ p_acl_cb = &btm_cb.acl_db[acl_idx];
+ p_acl_cb->num_read_pages = 0;
+ memset(p_acl_cb->peer_lmp_features, 0, sizeof(p_acl_cb->peer_lmp_features));
- /* first send read remote supported features HCI command */
- /* because we don't know whether the remote support extended feature command */
- btsnd_hcic_rmt_features_req (handle);
+ /* first send read remote supported features HCI command */
+ /* because we don't know whether the remote support extended feature command
+ */
+ btsnd_hcic_rmt_features_req(handle);
}
-
/*******************************************************************************
*
* Function btm_read_remote_ext_features
@@ -1047,14 +984,13 @@
* Returns void
*
******************************************************************************/
-void btm_read_remote_ext_features (uint16_t handle, uint8_t page_number)
-{
- BTM_TRACE_DEBUG("btm_read_remote_ext_features() handle: %d page: %d", handle, page_number);
+void btm_read_remote_ext_features(uint16_t handle, uint8_t page_number) {
+ BTM_TRACE_DEBUG("btm_read_remote_ext_features() handle: %d page: %d", handle,
+ page_number);
- btsnd_hcic_rmt_ext_features(handle, page_number);
+ btsnd_hcic_rmt_ext_features(handle, page_number);
}
-
/*******************************************************************************
*
* Function btm_read_remote_features_complete
@@ -1065,54 +1001,57 @@
* Returns void
*
******************************************************************************/
-void btm_read_remote_features_complete (uint8_t *p)
-{
- tACL_CONN *p_acl_cb;
- uint8_t status;
- uint16_t handle;
- uint8_t acl_idx;
+void btm_read_remote_features_complete(uint8_t* p) {
+ tACL_CONN* p_acl_cb;
+ uint8_t status;
+ uint16_t handle;
+ uint8_t acl_idx;
- BTM_TRACE_DEBUG ("btm_read_remote_features_complete");
- STREAM_TO_UINT8 (status, p);
+ BTM_TRACE_DEBUG("btm_read_remote_features_complete");
+ STREAM_TO_UINT8(status, p);
- if (status != HCI_SUCCESS)
- {
- BTM_TRACE_ERROR ("btm_read_remote_features_complete failed (status 0x%02x)", status);
- return;
- }
+ if (status != HCI_SUCCESS) {
+ BTM_TRACE_ERROR("btm_read_remote_features_complete failed (status 0x%02x)",
+ status);
+ return;
+ }
- STREAM_TO_UINT16 (handle, p);
+ STREAM_TO_UINT16(handle, p);
- acl_idx = btm_handle_to_acl_index(handle);
- if (acl_idx >= MAX_L2CAP_LINKS)
- {
- BTM_TRACE_ERROR("btm_read_remote_features_complete handle=%d invalid", handle);
- return;
- }
+ acl_idx = btm_handle_to_acl_index(handle);
+ if (acl_idx >= MAX_L2CAP_LINKS) {
+ BTM_TRACE_ERROR("btm_read_remote_features_complete handle=%d invalid",
+ handle);
+ return;
+ }
- p_acl_cb = &btm_cb.acl_db[acl_idx];
+ p_acl_cb = &btm_cb.acl_db[acl_idx];
- /* Copy the received features page */
- STREAM_TO_ARRAY(p_acl_cb->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0], p,
- HCI_FEATURE_BYTES_PER_PAGE);
+ /* Copy the received features page */
+ STREAM_TO_ARRAY(p_acl_cb->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0], p,
+ HCI_FEATURE_BYTES_PER_PAGE);
- if ((HCI_LMP_EXTENDED_SUPPORTED(p_acl_cb->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0])) &&
- (controller_get_interface()->supports_reading_remote_extended_features()))
- {
- /* if the remote controller has extended features and local controller supports
- ** HCI_Read_Remote_Extended_Features command then start reading these feature starting
- ** with extended features page 1 */
- BTM_TRACE_DEBUG ("Start reading remote extended features");
- btm_read_remote_ext_features(handle, HCI_EXT_FEATURES_PAGE_1);
- return;
- }
+ if ((HCI_LMP_EXTENDED_SUPPORTED(
+ p_acl_cb->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0])) &&
+ (controller_get_interface()
+ ->supports_reading_remote_extended_features())) {
+ /* if the remote controller has extended features and local controller
+ *supports
+ ** HCI_Read_Remote_Extended_Features command then start reading these
+ *feature starting
+ ** with extended features page 1 */
+ BTM_TRACE_DEBUG("Start reading remote extended features");
+ btm_read_remote_ext_features(handle, HCI_EXT_FEATURES_PAGE_1);
+ return;
+ }
- /* Remote controller has no extended features. Process remote controller supported features
- (features page HCI_EXT_FEATURES_PAGE_0). */
- btm_process_remote_ext_features (p_acl_cb, 1);
+ /* Remote controller has no extended features. Process remote controller
+ supported features
+ (features page HCI_EXT_FEATURES_PAGE_0). */
+ btm_process_remote_ext_features(p_acl_cb, 1);
- /* Continue with HCI connection establishment */
- btm_establish_continue (p_acl_cb);
+ /* Continue with HCI connection establishment */
+ btm_establish_continue(p_acl_cb);
}
/*******************************************************************************
@@ -1125,57 +1064,58 @@
* Returns void
*
******************************************************************************/
-void btm_read_remote_ext_features_complete (uint8_t *p)
-{
- tACL_CONN *p_acl_cb;
- uint8_t page_num, max_page;
- uint16_t handle;
- uint8_t acl_idx;
+void btm_read_remote_ext_features_complete(uint8_t* p) {
+ tACL_CONN* p_acl_cb;
+ uint8_t page_num, max_page;
+ uint16_t handle;
+ uint8_t acl_idx;
- BTM_TRACE_DEBUG ("btm_read_remote_ext_features_complete");
+ BTM_TRACE_DEBUG("btm_read_remote_ext_features_complete");
- ++p;
- STREAM_TO_UINT16 (handle, p);
- STREAM_TO_UINT8 (page_num, p);
- STREAM_TO_UINT8 (max_page, p);
+ ++p;
+ STREAM_TO_UINT16(handle, p);
+ STREAM_TO_UINT8(page_num, p);
+ STREAM_TO_UINT8(max_page, p);
- /* Validate parameters */
- acl_idx = btm_handle_to_acl_index(handle);
- if (acl_idx >= MAX_L2CAP_LINKS)
- {
- BTM_TRACE_ERROR("btm_read_remote_ext_features_complete handle=%d invalid", handle);
- return;
- }
+ /* Validate parameters */
+ acl_idx = btm_handle_to_acl_index(handle);
+ if (acl_idx >= MAX_L2CAP_LINKS) {
+ BTM_TRACE_ERROR("btm_read_remote_ext_features_complete handle=%d invalid",
+ handle);
+ return;
+ }
- if (max_page > HCI_EXT_FEATURES_PAGE_MAX)
- {
- BTM_TRACE_ERROR("btm_read_remote_ext_features_complete page=%d unknown", max_page);
- return;
- }
+ if (max_page > HCI_EXT_FEATURES_PAGE_MAX) {
+ BTM_TRACE_ERROR("btm_read_remote_ext_features_complete page=%d unknown",
+ max_page);
+ return;
+ }
- p_acl_cb = &btm_cb.acl_db[acl_idx];
+ p_acl_cb = &btm_cb.acl_db[acl_idx];
- /* Copy the received features page */
- STREAM_TO_ARRAY(p_acl_cb->peer_lmp_features[page_num], p, HCI_FEATURE_BYTES_PER_PAGE);
+ /* Copy the received features page */
+ STREAM_TO_ARRAY(p_acl_cb->peer_lmp_features[page_num], p,
+ HCI_FEATURE_BYTES_PER_PAGE);
- /* If there is the next remote features page and
- * we have space to keep this page data - read this page */
- if ((page_num < max_page) && (page_num < HCI_EXT_FEATURES_PAGE_MAX))
- {
- page_num++;
- BTM_TRACE_DEBUG("BTM reads next remote extended features page (%d)", page_num);
- btm_read_remote_ext_features (handle, page_num);
- return;
- }
+ /* If there is the next remote features page and
+ * we have space to keep this page data - read this page */
+ if ((page_num < max_page) && (page_num < HCI_EXT_FEATURES_PAGE_MAX)) {
+ page_num++;
+ BTM_TRACE_DEBUG("BTM reads next remote extended features page (%d)",
+ page_num);
+ btm_read_remote_ext_features(handle, page_num);
+ return;
+ }
- /* Reading of remote feature pages is complete */
- BTM_TRACE_DEBUG("BTM reached last remote extended features page (%d)", page_num);
+ /* Reading of remote feature pages is complete */
+ BTM_TRACE_DEBUG("BTM reached last remote extended features page (%d)",
+ page_num);
- /* Process the pages */
- btm_process_remote_ext_features (p_acl_cb, (uint8_t) (page_num + 1));
+ /* Process the pages */
+ btm_process_remote_ext_features(p_acl_cb, (uint8_t)(page_num + 1));
- /* Continue with HCI connection establishment */
- btm_establish_continue (p_acl_cb);
+ /* Continue with HCI connection establishment */
+ btm_establish_continue(p_acl_cb);
}
/*******************************************************************************
@@ -1188,28 +1128,28 @@
* Returns void
*
******************************************************************************/
-void btm_read_remote_ext_features_failed (uint8_t status, uint16_t handle)
-{
- tACL_CONN *p_acl_cb;
- uint8_t acl_idx;
+void btm_read_remote_ext_features_failed(uint8_t status, uint16_t handle) {
+ tACL_CONN* p_acl_cb;
+ uint8_t acl_idx;
- BTM_TRACE_WARNING ("btm_read_remote_ext_features_failed (status 0x%02x) for handle %d",
- status, handle);
+ BTM_TRACE_WARNING(
+ "btm_read_remote_ext_features_failed (status 0x%02x) for handle %d",
+ status, handle);
- acl_idx = btm_handle_to_acl_index(handle);
- if (acl_idx >= MAX_L2CAP_LINKS)
- {
- BTM_TRACE_ERROR("btm_read_remote_ext_features_failed handle=%d invalid", handle);
- return;
- }
+ acl_idx = btm_handle_to_acl_index(handle);
+ if (acl_idx >= MAX_L2CAP_LINKS) {
+ BTM_TRACE_ERROR("btm_read_remote_ext_features_failed handle=%d invalid",
+ handle);
+ return;
+ }
- p_acl_cb = &btm_cb.acl_db[acl_idx];
+ p_acl_cb = &btm_cb.acl_db[acl_idx];
- /* Process supported features only */
- btm_process_remote_ext_features (p_acl_cb, 1);
+ /* Process supported features only */
+ btm_process_remote_ext_features(p_acl_cb, 1);
- /* Continue HCI connection establishment */
- btm_establish_continue (p_acl_cb);
+ /* Continue HCI connection establishment */
+ btm_establish_continue(p_acl_cb);
}
/*******************************************************************************
@@ -1223,41 +1163,38 @@
* Returns void
*
******************************************************************************/
-void btm_establish_continue (tACL_CONN *p_acl_cb)
-{
- tBTM_BL_EVENT_DATA evt_data;
- BTM_TRACE_DEBUG ("btm_establish_continue");
+void btm_establish_continue(tACL_CONN* p_acl_cb) {
+ tBTM_BL_EVENT_DATA evt_data;
+ BTM_TRACE_DEBUG("btm_establish_continue");
#if (BTM_BYPASS_EXTRA_ACL_SETUP == FALSE)
- if (p_acl_cb->transport == BT_TRANSPORT_BR_EDR)
- {
- /* For now there are a some devices that do not like sending */
- /* commands events and data at the same time. */
- /* Set the packet types to the default allowed by the device */
- btm_set_packet_types (p_acl_cb, btm_cb.btm_acl_pkt_types_supported);
+ if (p_acl_cb->transport == BT_TRANSPORT_BR_EDR) {
+ /* For now there are a some devices that do not like sending */
+ /* commands events and data at the same time. */
+ /* Set the packet types to the default allowed by the device */
+ btm_set_packet_types(p_acl_cb, btm_cb.btm_acl_pkt_types_supported);
- if (btm_cb.btm_def_link_policy)
- BTM_SetLinkPolicy (p_acl_cb->remote_addr, &btm_cb.btm_def_link_policy);
- }
+ if (btm_cb.btm_def_link_policy)
+ BTM_SetLinkPolicy(p_acl_cb->remote_addr, &btm_cb.btm_def_link_policy);
+ }
#endif
- p_acl_cb->link_up_issued = true;
+ p_acl_cb->link_up_issued = true;
- /* If anyone cares, tell him database changed */
- if (btm_cb.p_bl_changed_cb)
- {
- evt_data.event = BTM_BL_CONN_EVT;
- evt_data.conn.p_bda = p_acl_cb->remote_addr;
- evt_data.conn.p_bdn = p_acl_cb->remote_name;
- evt_data.conn.p_dc = p_acl_cb->remote_dc;
- evt_data.conn.p_features = p_acl_cb->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0];
- evt_data.conn.handle = p_acl_cb->hci_handle;
- evt_data.conn.transport = p_acl_cb->transport;
+ /* If anyone cares, tell him database changed */
+ if (btm_cb.p_bl_changed_cb) {
+ evt_data.event = BTM_BL_CONN_EVT;
+ evt_data.conn.p_bda = p_acl_cb->remote_addr;
+ evt_data.conn.p_bdn = p_acl_cb->remote_name;
+ evt_data.conn.p_dc = p_acl_cb->remote_dc;
+ evt_data.conn.p_features =
+ p_acl_cb->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0];
+ evt_data.conn.handle = p_acl_cb->hci_handle;
+ evt_data.conn.transport = p_acl_cb->transport;
- (*btm_cb.p_bl_changed_cb)(&evt_data);
- }
- btm_acl_update_busy_level (BTM_BLI_ACL_UP_EVT);
+ (*btm_cb.p_bl_changed_cb)(&evt_data);
+ }
+ btm_acl_update_busy_level(BTM_BLI_ACL_UP_EVT);
}
-
/*******************************************************************************
*
* Function BTM_SetDefaultLinkSuperTout
@@ -1269,10 +1206,9 @@
* Returns void
*
******************************************************************************/
-void BTM_SetDefaultLinkSuperTout (uint16_t timeout)
-{
- BTM_TRACE_DEBUG ("BTM_SetDefaultLinkSuperTout");
- btm_cb.btm_def_link_super_tout = timeout;
+void BTM_SetDefaultLinkSuperTout(uint16_t timeout) {
+ BTM_TRACE_DEBUG("BTM_SetDefaultLinkSuperTout");
+ btm_cb.btm_def_link_super_tout = timeout;
}
/*******************************************************************************
@@ -1284,21 +1220,18 @@
* Returns status of the operation
*
******************************************************************************/
-tBTM_STATUS BTM_GetLinkSuperTout (BD_ADDR remote_bda, uint16_t *p_timeout)
-{
- tACL_CONN *p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
+tBTM_STATUS BTM_GetLinkSuperTout(BD_ADDR remote_bda, uint16_t* p_timeout) {
+ tACL_CONN* p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_GetLinkSuperTout");
- if (p != (tACL_CONN *)NULL)
- {
- *p_timeout = p->link_super_tout;
- return(BTM_SUCCESS);
- }
- /* If here, no BD Addr found */
- return(BTM_UNKNOWN_ADDR);
+ BTM_TRACE_DEBUG("BTM_GetLinkSuperTout");
+ if (p != (tACL_CONN*)NULL) {
+ *p_timeout = p->link_super_tout;
+ return (BTM_SUCCESS);
+ }
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
-
/*******************************************************************************
*
* Function BTM_SetLinkSuperTout
@@ -1308,28 +1241,24 @@
* Returns status of the operation
*
******************************************************************************/
-tBTM_STATUS BTM_SetLinkSuperTout (BD_ADDR remote_bda, uint16_t timeout)
-{
- tACL_CONN *p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
+tBTM_STATUS BTM_SetLinkSuperTout(BD_ADDR remote_bda, uint16_t timeout) {
+ tACL_CONN* p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_SetLinkSuperTout");
- if (p != (tACL_CONN *)NULL)
- {
- p->link_super_tout = timeout;
+ BTM_TRACE_DEBUG("BTM_SetLinkSuperTout");
+ if (p != (tACL_CONN*)NULL) {
+ p->link_super_tout = timeout;
- /* Only send if current role is Master; 2.0 spec requires this */
- if (p->link_role == BTM_ROLE_MASTER)
- {
- btsnd_hcic_write_link_super_tout(LOCAL_BR_EDR_CONTROLLER_ID,
- p->hci_handle, timeout);
- return(BTM_CMD_STARTED);
- }
- else
- return(BTM_SUCCESS);
- }
+ /* Only send if current role is Master; 2.0 spec requires this */
+ if (p->link_role == BTM_ROLE_MASTER) {
+ btsnd_hcic_write_link_super_tout(LOCAL_BR_EDR_CONTROLLER_ID,
+ p->hci_handle, timeout);
+ return (BTM_CMD_STARTED);
+ } else
+ return (BTM_SUCCESS);
+ }
- /* If here, no BD Addr found */
- return(BTM_UNKNOWN_ADDR);
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
/*******************************************************************************
@@ -1342,22 +1271,20 @@
* Returns true if connection is up, else false.
*
******************************************************************************/
-bool BTM_IsAclConnectionUp (BD_ADDR remote_bda, tBT_TRANSPORT transport)
-{
- tACL_CONN *p;
+bool BTM_IsAclConnectionUp(BD_ADDR remote_bda, tBT_TRANSPORT transport) {
+ tACL_CONN* p;
- BTM_TRACE_API ("BTM_IsAclConnectionUp: RemBdAddr: %02x%02x%02x%02x%02x%02x",
- remote_bda[0], remote_bda[1], remote_bda[2],
- remote_bda[3], remote_bda[4], remote_bda[5]);
+ BTM_TRACE_API("BTM_IsAclConnectionUp: RemBdAddr: %02x%02x%02x%02x%02x%02x",
+ remote_bda[0], remote_bda[1], remote_bda[2], remote_bda[3],
+ remote_bda[4], remote_bda[5]);
- p = btm_bda_to_acl(remote_bda, transport);
- if (p != (tACL_CONN *)NULL)
- {
- return(true);
- }
+ p = btm_bda_to_acl(remote_bda, transport);
+ if (p != (tACL_CONN*)NULL) {
+ return (true);
+ }
- /* If here, no BD Addr found */
- return(false);
+ /* If here, no BD Addr found */
+ return (false);
}
/*******************************************************************************
@@ -1370,17 +1297,14 @@
* Returns uint16_t Number of active ACL links
*
******************************************************************************/
-uint16_t BTM_GetNumAclLinks (void)
-{
- uint16_t num_acl = 0;
+uint16_t BTM_GetNumAclLinks(void) {
+ uint16_t num_acl = 0;
- for (uint16_t i = 0; i < MAX_L2CAP_LINKS; ++i)
- {
- if (btm_cb.acl_db[i].in_use)
- ++num_acl;
- }
+ for (uint16_t i = 0; i < MAX_L2CAP_LINKS; ++i) {
+ if (btm_cb.acl_db[i].in_use) ++num_acl;
+ }
- return num_acl;
+ return num_acl;
}
/*******************************************************************************
@@ -1393,14 +1317,12 @@
* Returns true if connection is up, else false.
*
******************************************************************************/
-uint16_t btm_get_acl_disc_reason_code (void)
-{
- uint8_t res = btm_cb.acl_disc_reason;
- BTM_TRACE_DEBUG ("btm_get_acl_disc_reason_code");
- return(res);
+uint16_t btm_get_acl_disc_reason_code(void) {
+ uint8_t res = btm_cb.acl_disc_reason;
+ BTM_TRACE_DEBUG("btm_get_acl_disc_reason_code");
+ return (res);
}
-
/*******************************************************************************
*
* Function BTM_GetHCIConnHandle
@@ -1411,18 +1333,17 @@
* Returns the handle of the connection, or 0xFFFF if none.
*
******************************************************************************/
-uint16_t BTM_GetHCIConnHandle (const BD_ADDR remote_bda, tBT_TRANSPORT transport)
-{
- tACL_CONN *p;
- BTM_TRACE_DEBUG ("BTM_GetHCIConnHandle");
- p = btm_bda_to_acl(remote_bda, transport);
- if (p != (tACL_CONN *)NULL)
- {
- return(p->hci_handle);
- }
+uint16_t BTM_GetHCIConnHandle(const BD_ADDR remote_bda,
+ tBT_TRANSPORT transport) {
+ tACL_CONN* p;
+ BTM_TRACE_DEBUG("BTM_GetHCIConnHandle");
+ p = btm_bda_to_acl(remote_bda, transport);
+ if (p != (tACL_CONN*)NULL) {
+ return (p->hci_handle);
+ }
- /* If here, no BD Addr found */
- return(0xFFFF);
+ /* If here, no BD Addr found */
+ return (0xFFFF);
}
/*******************************************************************************
@@ -1437,14 +1358,12 @@
* Returns void
*
******************************************************************************/
-void btm_process_clk_off_comp_evt (uint16_t hci_handle, uint16_t clock_offset)
-{
- uint8_t xx;
- BTM_TRACE_DEBUG ("btm_process_clk_off_comp_evt");
- /* Look up the connection by handle and set the current mode */
- xx = btm_handle_to_acl_index(hci_handle);
- if (xx < MAX_L2CAP_LINKS)
- btm_cb.acl_db[xx].clock_offset = clock_offset;
+void btm_process_clk_off_comp_evt(uint16_t hci_handle, uint16_t clock_offset) {
+ uint8_t xx;
+ BTM_TRACE_DEBUG("btm_process_clk_off_comp_evt");
+ /* Look up the connection by handle and set the current mode */
+ xx = btm_handle_to_acl_index(hci_handle);
+ if (xx < MAX_L2CAP_LINKS) btm_cb.acl_db[xx].clock_offset = clock_offset;
}
/*******************************************************************************
@@ -1459,101 +1378,93 @@
* Returns void
*
******************************************************************************/
-void btm_acl_role_changed (uint8_t hci_status, BD_ADDR bd_addr, uint8_t new_role)
-{
- uint8_t *p_bda = (bd_addr) ? bd_addr :
- btm_cb.devcb.switch_role_ref_data.remote_bd_addr;
- tACL_CONN *p = btm_bda_to_acl(p_bda, BT_TRANSPORT_BR_EDR);
- tBTM_ROLE_SWITCH_CMPL *p_data = &btm_cb.devcb.switch_role_ref_data;
- tBTM_SEC_DEV_REC *p_dev_rec;
- tBTM_BL_ROLE_CHG_DATA evt;
+void btm_acl_role_changed(uint8_t hci_status, BD_ADDR bd_addr,
+ uint8_t new_role) {
+ uint8_t* p_bda =
+ (bd_addr) ? bd_addr : btm_cb.devcb.switch_role_ref_data.remote_bd_addr;
+ tACL_CONN* p = btm_bda_to_acl(p_bda, BT_TRANSPORT_BR_EDR);
+ tBTM_ROLE_SWITCH_CMPL* p_data = &btm_cb.devcb.switch_role_ref_data;
+ tBTM_SEC_DEV_REC* p_dev_rec;
+ tBTM_BL_ROLE_CHG_DATA evt;
- BTM_TRACE_DEBUG ("btm_acl_role_changed");
- /* Ignore any stray events */
- if (p == NULL)
- {
- /* it could be a failure */
- if (hci_status != HCI_SUCCESS)
- btm_acl_report_role_change(hci_status, bd_addr);
- return;
+ BTM_TRACE_DEBUG("btm_acl_role_changed");
+ /* Ignore any stray events */
+ if (p == NULL) {
+ /* it could be a failure */
+ if (hci_status != HCI_SUCCESS)
+ btm_acl_report_role_change(hci_status, bd_addr);
+ return;
+ }
+
+ p_data->hci_status = hci_status;
+
+ if (hci_status == HCI_SUCCESS) {
+ p_data->role = new_role;
+ memcpy(p_data->remote_bd_addr, p_bda, BD_ADDR_LEN);
+
+ /* Update cached value */
+ p->link_role = new_role;
+
+ /* Reload LSTO: link supervision timeout is reset in the LM after a role
+ * switch */
+ if (new_role == BTM_ROLE_MASTER) {
+ BTM_SetLinkSuperTout(p->remote_addr, p->link_super_tout);
}
+ } else {
+ /* so the BTM_BL_ROLE_CHG_EVT uses the old role */
+ new_role = p->link_role;
+ }
- p_data->hci_status = hci_status;
+ /* Check if any SCO req is pending for role change */
+ btm_sco_chk_pend_rolechange(p->hci_handle);
- if (hci_status == HCI_SUCCESS)
- {
- p_data->role = new_role;
- memcpy(p_data->remote_bd_addr, p_bda, BD_ADDR_LEN);
+ /* if switching state is switching we need to turn encryption on */
+ /* if idle, we did not change encryption */
+ if (p->switch_role_state == BTM_ACL_SWKEY_STATE_SWITCHING) {
+ btsnd_hcic_set_conn_encrypt(p->hci_handle, true);
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_ENCRYPT_ON;
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_ENCRYPTION_ON;
+ return;
+ }
- /* Update cached value */
- p->link_role = new_role;
+ /* Set the switch_role_state to IDLE since the reply received from HCI */
+ /* regardless of its result either success or failed. */
+ if (p->switch_role_state == BTM_ACL_SWKEY_STATE_IN_PROGRESS) {
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_IDLE;
+ }
- /* Reload LSTO: link supervision timeout is reset in the LM after a role switch */
- if (new_role == BTM_ROLE_MASTER)
- {
- BTM_SetLinkSuperTout (p->remote_addr, p->link_super_tout);
- }
- }
- else
- {
- /* so the BTM_BL_ROLE_CHG_EVT uses the old role */
- new_role = p->link_role;
- }
+ /* if role switch complete is needed, report it now */
+ btm_acl_report_role_change(hci_status, bd_addr);
- /* Check if any SCO req is pending for role change */
- btm_sco_chk_pend_rolechange (p->hci_handle);
+ /* if role change event is registered, report it now */
+ if (btm_cb.p_bl_changed_cb && (btm_cb.bl_evt_mask & BTM_BL_ROLE_CHG_MASK)) {
+ evt.event = BTM_BL_ROLE_CHG_EVT;
+ evt.new_role = new_role;
+ evt.p_bda = p_bda;
+ evt.hci_status = hci_status;
+ (*btm_cb.p_bl_changed_cb)((tBTM_BL_EVENT_DATA*)&evt);
+ }
- /* if switching state is switching we need to turn encryption on */
- /* if idle, we did not change encryption */
- if (p->switch_role_state == BTM_ACL_SWKEY_STATE_SWITCHING)
- {
- btsnd_hcic_set_conn_encrypt (p->hci_handle, true);
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_ENCRYPT_ON;
- p->switch_role_state = BTM_ACL_SWKEY_STATE_ENCRYPTION_ON;
- return;
- }
-
- /* Set the switch_role_state to IDLE since the reply received from HCI */
- /* regardless of its result either success or failed. */
- if (p->switch_role_state == BTM_ACL_SWKEY_STATE_IN_PROGRESS)
- {
- p->switch_role_state = BTM_ACL_SWKEY_STATE_IDLE;
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_IDLE;
- }
-
- /* if role switch complete is needed, report it now */
- btm_acl_report_role_change(hci_status, bd_addr);
-
- /* if role change event is registered, report it now */
- if (btm_cb.p_bl_changed_cb && (btm_cb.bl_evt_mask & BTM_BL_ROLE_CHG_MASK))
- {
- evt.event = BTM_BL_ROLE_CHG_EVT;
- evt.new_role = new_role;
- evt.p_bda = p_bda;
- evt.hci_status = hci_status;
- (*btm_cb.p_bl_changed_cb)((tBTM_BL_EVENT_DATA *)&evt);
- }
-
- BTM_TRACE_DEBUG("Role Switch Event: new_role 0x%02x, HCI Status 0x%02x, rs_st:%d",
- p_data->role, p_data->hci_status, p->switch_role_state);
+ BTM_TRACE_DEBUG(
+ "Role Switch Event: new_role 0x%02x, HCI Status 0x%02x, rs_st:%d",
+ p_data->role, p_data->hci_status, p->switch_role_state);
#if (BTM_DISC_DURING_RS == TRUE)
- /* If a disconnect is pending, issue it now that role switch has completed */
- p_dev_rec = btm_find_dev(p_bda);
- if (p_dev_rec != NULL)
- {
- if (p_dev_rec->rs_disc_pending == BTM_SEC_DISC_PENDING)
- {
- BTM_TRACE_WARNING("btm_acl_role_changed -> Issuing delayed HCI_Disconnect!!!");
- btsnd_hcic_disconnect(p_dev_rec->hci_handle, HCI_ERR_PEER_USER);
- }
- BTM_TRACE_ERROR("tBTM_SEC_DEV:0x%x rs_disc_pending=%d",
- PTR_TO_UINT(p_dev_rec), p_dev_rec->rs_disc_pending);
- p_dev_rec->rs_disc_pending = BTM_SEC_RS_NOT_PENDING; /* reset flag */
+ /* If a disconnect is pending, issue it now that role switch has completed */
+ p_dev_rec = btm_find_dev(p_bda);
+ if (p_dev_rec != NULL) {
+ if (p_dev_rec->rs_disc_pending == BTM_SEC_DISC_PENDING) {
+ BTM_TRACE_WARNING(
+ "btm_acl_role_changed -> Issuing delayed HCI_Disconnect!!!");
+ btsnd_hcic_disconnect(p_dev_rec->hci_handle, HCI_ERR_PEER_USER);
}
+ BTM_TRACE_ERROR("tBTM_SEC_DEV:0x%x rs_disc_pending=%d",
+ PTR_TO_UINT(p_dev_rec), p_dev_rec->rs_disc_pending);
+ p_dev_rec->rs_disc_pending = BTM_SEC_RS_NOT_PENDING; /* reset flag */
+ }
#endif
-
}
/*******************************************************************************
@@ -1566,22 +1477,19 @@
*
******************************************************************************/
-uint8_t BTM_AllocateSCN(void)
-{
- uint8_t x;
- BTM_TRACE_DEBUG ("BTM_AllocateSCN");
+uint8_t BTM_AllocateSCN(void) {
+ uint8_t x;
+ BTM_TRACE_DEBUG("BTM_AllocateSCN");
- // stack reserves scn 1 for HFP, HSP we still do the correct way
- for (x = 1; x < BTM_MAX_SCN; x++)
- {
- if (!btm_cb.btm_scn[x])
- {
- btm_cb.btm_scn[x] = true;
- return(x+1);
- }
+ // stack reserves scn 1 for HFP, HSP we still do the correct way
+ for (x = 1; x < BTM_MAX_SCN; x++) {
+ if (!btm_cb.btm_scn[x]) {
+ btm_cb.btm_scn[x] = true;
+ return (x + 1);
}
+ }
- return(0); /* No free ports */
+ return (0); /* No free ports */
}
/*******************************************************************************
@@ -1594,22 +1502,19 @@
*
******************************************************************************/
-bool BTM_TryAllocateSCN(uint8_t scn)
-{
- /* Make sure we don't exceed max port range.
- * Stack reserves scn 1 for HFP, HSP we still do the correct way.
- */
- if ( (scn>=BTM_MAX_SCN) || (scn == 1) )
- return false;
+bool BTM_TryAllocateSCN(uint8_t scn) {
+ /* Make sure we don't exceed max port range.
+ * Stack reserves scn 1 for HFP, HSP we still do the correct way.
+ */
+ if ((scn >= BTM_MAX_SCN) || (scn == 1)) return false;
- /* check if this port is available */
- if (!btm_cb.btm_scn[scn-1])
- {
- btm_cb.btm_scn[scn-1] = true;
- return true;
- }
+ /* check if this port is available */
+ if (!btm_cb.btm_scn[scn - 1]) {
+ btm_cb.btm_scn[scn - 1] = true;
+ return true;
+ }
- return (false); /* Port was busy */
+ return (false); /* Port was busy */
}
/*******************************************************************************
@@ -1621,16 +1526,13 @@
* Returns true or false
*
******************************************************************************/
-bool BTM_FreeSCN(uint8_t scn)
-{
- BTM_TRACE_DEBUG ("BTM_FreeSCN ");
- if (scn <= BTM_MAX_SCN)
- {
- btm_cb.btm_scn[scn-1] = false;
- return(true);
- }
- else
- return(false); /* Illegal SCN passed in */
+bool BTM_FreeSCN(uint8_t scn) {
+ BTM_TRACE_DEBUG("BTM_FreeSCN ");
+ if (scn <= BTM_MAX_SCN) {
+ btm_cb.btm_scn[scn - 1] = false;
+ return (true);
+ } else
+ return (false); /* Illegal SCN passed in */
}
/*******************************************************************************
@@ -1644,27 +1546,27 @@
* Returns status of the operation
*
******************************************************************************/
-tBTM_STATUS btm_set_packet_types (tACL_CONN *p, uint16_t pkt_types)
-{
- uint16_t temp_pkt_types;
- BTM_TRACE_DEBUG ("btm_set_packet_types");
- /* Save in the ACL control blocks, types that we support */
- temp_pkt_types = (pkt_types & BTM_ACL_SUPPORTED_PKTS_MASK &
- btm_cb.btm_acl_pkt_types_supported);
+tBTM_STATUS btm_set_packet_types(tACL_CONN* p, uint16_t pkt_types) {
+ uint16_t temp_pkt_types;
+ BTM_TRACE_DEBUG("btm_set_packet_types");
+ /* Save in the ACL control blocks, types that we support */
+ temp_pkt_types = (pkt_types & BTM_ACL_SUPPORTED_PKTS_MASK &
+ btm_cb.btm_acl_pkt_types_supported);
- /* OR in any exception packet types if at least 2.0 version of spec */
- temp_pkt_types |= ((pkt_types & BTM_ACL_EXCEPTION_PKTS_MASK) |
- (btm_cb.btm_acl_pkt_types_supported & BTM_ACL_EXCEPTION_PKTS_MASK));
+ /* OR in any exception packet types if at least 2.0 version of spec */
+ temp_pkt_types |=
+ ((pkt_types & BTM_ACL_EXCEPTION_PKTS_MASK) |
+ (btm_cb.btm_acl_pkt_types_supported & BTM_ACL_EXCEPTION_PKTS_MASK));
- /* Exclude packet types not supported by the peer */
- btm_acl_chk_peer_pkt_type_support (p, &temp_pkt_types);
+ /* Exclude packet types not supported by the peer */
+ btm_acl_chk_peer_pkt_type_support(p, &temp_pkt_types);
- BTM_TRACE_DEBUG ("SetPacketType Mask -> 0x%04x", temp_pkt_types);
+ BTM_TRACE_DEBUG("SetPacketType Mask -> 0x%04x", temp_pkt_types);
- btsnd_hcic_change_conn_type (p->hci_handle, temp_pkt_types);
- p->pkt_types_mask = temp_pkt_types;
+ btsnd_hcic_change_conn_type(p->hci_handle, temp_pkt_types);
+ p->pkt_types_mask = temp_pkt_types;
- return(BTM_CMD_STARTED);
+ return (BTM_CMD_STARTED);
}
/*******************************************************************************
@@ -1675,54 +1577,49 @@
* connection, 0 if connection is not established
*
******************************************************************************/
-uint16_t btm_get_max_packet_size (BD_ADDR addr)
-{
- tACL_CONN *p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
- uint16_t pkt_types = 0;
- uint16_t pkt_size = 0;
- BTM_TRACE_DEBUG ("btm_get_max_packet_size");
- if (p != NULL)
- {
- pkt_types = p->pkt_types_mask;
+uint16_t btm_get_max_packet_size(BD_ADDR addr) {
+ tACL_CONN* p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
+ uint16_t pkt_types = 0;
+ uint16_t pkt_size = 0;
+ BTM_TRACE_DEBUG("btm_get_max_packet_size");
+ if (p != NULL) {
+ pkt_types = p->pkt_types_mask;
+ } else {
+ /* Special case for when info for the local device is requested */
+ if (memcmp(controller_get_interface()->get_address(), addr, BD_ADDR_LEN) ==
+ 0) {
+ pkt_types = btm_cb.btm_acl_pkt_types_supported;
}
- else
- {
- /* Special case for when info for the local device is requested */
- if (memcmp (controller_get_interface()->get_address(), addr, BD_ADDR_LEN) == 0)
- {
- pkt_types = btm_cb.btm_acl_pkt_types_supported;
- }
- }
+ }
- if (pkt_types)
- {
- if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_3_DH5))
- pkt_size = HCI_EDR3_DH5_PACKET_SIZE;
- else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_2_DH5))
- pkt_size = HCI_EDR2_DH5_PACKET_SIZE;
- else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_3_DH3))
- pkt_size = HCI_EDR3_DH3_PACKET_SIZE;
- else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DH5)
- pkt_size = HCI_DH5_PACKET_SIZE;
- else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_2_DH3))
- pkt_size = HCI_EDR2_DH3_PACKET_SIZE;
- else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DM5)
- pkt_size = HCI_DM5_PACKET_SIZE;
- else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DH3)
- pkt_size = HCI_DH3_PACKET_SIZE;
- else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DM3)
- pkt_size = HCI_DM3_PACKET_SIZE;
- else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_3_DH1))
- pkt_size = HCI_EDR3_DH1_PACKET_SIZE;
- else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_2_DH1))
- pkt_size = HCI_EDR2_DH1_PACKET_SIZE;
- else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DH1)
- pkt_size = HCI_DH1_PACKET_SIZE;
- else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DM1)
- pkt_size = HCI_DM1_PACKET_SIZE;
- }
+ if (pkt_types) {
+ if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_3_DH5))
+ pkt_size = HCI_EDR3_DH5_PACKET_SIZE;
+ else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_2_DH5))
+ pkt_size = HCI_EDR2_DH5_PACKET_SIZE;
+ else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_3_DH3))
+ pkt_size = HCI_EDR3_DH3_PACKET_SIZE;
+ else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DH5)
+ pkt_size = HCI_DH5_PACKET_SIZE;
+ else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_2_DH3))
+ pkt_size = HCI_EDR2_DH3_PACKET_SIZE;
+ else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DM5)
+ pkt_size = HCI_DM5_PACKET_SIZE;
+ else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DH3)
+ pkt_size = HCI_DH3_PACKET_SIZE;
+ else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DM3)
+ pkt_size = HCI_DM3_PACKET_SIZE;
+ else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_3_DH1))
+ pkt_size = HCI_EDR3_DH1_PACKET_SIZE;
+ else if (!(pkt_types & BTM_ACL_PKT_TYPES_MASK_NO_2_DH1))
+ pkt_size = HCI_EDR2_DH1_PACKET_SIZE;
+ else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DH1)
+ pkt_size = HCI_DH1_PACKET_SIZE;
+ else if (pkt_types & BTM_ACL_PKT_TYPES_MASK_DM1)
+ pkt_size = HCI_DM1_PACKET_SIZE;
+ }
- return(pkt_size);
+ return (pkt_size);
}
/*******************************************************************************
@@ -1732,24 +1629,20 @@
* Returns If connected report peer device info
*
******************************************************************************/
-tBTM_STATUS BTM_ReadRemoteVersion (BD_ADDR addr, uint8_t *lmp_version,
- uint16_t *manufacturer, uint16_t *lmp_sub_version)
-{
- tACL_CONN *p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_ReadRemoteVersion");
- if (p == NULL)
- return(BTM_UNKNOWN_ADDR);
+tBTM_STATUS BTM_ReadRemoteVersion(BD_ADDR addr, uint8_t* lmp_version,
+ uint16_t* manufacturer,
+ uint16_t* lmp_sub_version) {
+ tACL_CONN* p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
+ BTM_TRACE_DEBUG("BTM_ReadRemoteVersion");
+ if (p == NULL) return (BTM_UNKNOWN_ADDR);
- if (lmp_version)
- *lmp_version = p->lmp_version;
+ if (lmp_version) *lmp_version = p->lmp_version;
- if (manufacturer)
- *manufacturer = p->manufacturer;
+ if (manufacturer) *manufacturer = p->manufacturer;
- if (lmp_sub_version)
- *lmp_sub_version = p->lmp_subversion;
+ if (lmp_sub_version) *lmp_sub_version = p->lmp_subversion;
- return(BTM_SUCCESS);
+ return (BTM_SUCCESS);
}
/*******************************************************************************
@@ -1759,16 +1652,14 @@
* Returns pointer to the remote supported features mask (8 bytes)
*
******************************************************************************/
-uint8_t *BTM_ReadRemoteFeatures (BD_ADDR addr)
-{
- tACL_CONN *p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_ReadRemoteFeatures");
- if (p == NULL)
- {
- return(NULL);
- }
+uint8_t* BTM_ReadRemoteFeatures(BD_ADDR addr) {
+ tACL_CONN* p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
+ BTM_TRACE_DEBUG("BTM_ReadRemoteFeatures");
+ if (p == NULL) {
+ return (NULL);
+ }
- return(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]);
+ return (p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]);
}
/*******************************************************************************
@@ -1779,22 +1670,20 @@
* or NULL if bad page
*
******************************************************************************/
-uint8_t *BTM_ReadRemoteExtendedFeatures (BD_ADDR addr, uint8_t page_number)
-{
- tACL_CONN *p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_ReadRemoteExtendedFeatures");
- if (p == NULL)
- {
- return(NULL);
- }
+uint8_t* BTM_ReadRemoteExtendedFeatures(BD_ADDR addr, uint8_t page_number) {
+ tACL_CONN* p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
+ BTM_TRACE_DEBUG("BTM_ReadRemoteExtendedFeatures");
+ if (p == NULL) {
+ return (NULL);
+ }
- if (page_number > HCI_EXT_FEATURES_PAGE_MAX)
- {
- BTM_TRACE_ERROR("Warning: BTM_ReadRemoteExtendedFeatures page %d unknown", page_number);
- return NULL;
- }
+ if (page_number > HCI_EXT_FEATURES_PAGE_MAX) {
+ BTM_TRACE_ERROR("Warning: BTM_ReadRemoteExtendedFeatures page %d unknown",
+ page_number);
+ return NULL;
+ }
- return(p->peer_lmp_features[page_number]);
+ return (p->peer_lmp_features[page_number]);
}
/*******************************************************************************
@@ -1804,16 +1693,14 @@
* Returns number of features pages read from the remote device.
*
******************************************************************************/
-uint8_t BTM_ReadNumberRemoteFeaturesPages (BD_ADDR addr)
-{
- tACL_CONN *p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_ReadNumberRemoteFeaturesPages");
- if (p == NULL)
- {
- return(0);
- }
+uint8_t BTM_ReadNumberRemoteFeaturesPages(BD_ADDR addr) {
+ tACL_CONN* p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
+ BTM_TRACE_DEBUG("BTM_ReadNumberRemoteFeaturesPages");
+ if (p == NULL) {
+ return (0);
+ }
- return(p->num_read_pages);
+ return (p->num_read_pages);
}
/*******************************************************************************
@@ -1823,16 +1710,14 @@
* Returns pointer to all features of the remote (24 bytes).
*
******************************************************************************/
-uint8_t *BTM_ReadAllRemoteFeatures (BD_ADDR addr)
-{
- tACL_CONN *p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
- BTM_TRACE_DEBUG ("BTM_ReadAllRemoteFeatures");
- if (p == NULL)
- {
- return(NULL);
- }
+uint8_t* BTM_ReadAllRemoteFeatures(BD_ADDR addr) {
+ tACL_CONN* p = btm_bda_to_acl(addr, BT_TRANSPORT_BR_EDR);
+ BTM_TRACE_DEBUG("BTM_ReadAllRemoteFeatures");
+ if (p == NULL) {
+ return (NULL);
+ }
- return(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]);
+ return (p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]);
}
/*******************************************************************************
@@ -1845,23 +1730,21 @@
* Returns BTM_SUCCESS if successfully registered, otherwise error
*
******************************************************************************/
-tBTM_STATUS BTM_RegBusyLevelNotif (tBTM_BL_CHANGE_CB *p_cb, uint8_t *p_level,
- tBTM_BL_EVENT_MASK evt_mask)
-{
- BTM_TRACE_DEBUG ("BTM_RegBusyLevelNotif");
- if (p_level)
- *p_level = btm_cb.busy_level;
+tBTM_STATUS BTM_RegBusyLevelNotif(tBTM_BL_CHANGE_CB* p_cb, uint8_t* p_level,
+ tBTM_BL_EVENT_MASK evt_mask) {
+ BTM_TRACE_DEBUG("BTM_RegBusyLevelNotif");
+ if (p_level) *p_level = btm_cb.busy_level;
- btm_cb.bl_evt_mask = evt_mask;
+ btm_cb.bl_evt_mask = evt_mask;
- if (!p_cb)
- btm_cb.p_bl_changed_cb = NULL;
- else if (btm_cb.p_bl_changed_cb)
- return(BTM_BUSY);
- else
- btm_cb.p_bl_changed_cb = p_cb;
+ if (!p_cb)
+ btm_cb.p_bl_changed_cb = NULL;
+ else if (btm_cb.p_bl_changed_cb)
+ return (BTM_BUSY);
+ else
+ btm_cb.p_bl_changed_cb = p_cb;
- return(BTM_SUCCESS);
+ return (BTM_SUCCESS);
}
/*******************************************************************************
@@ -1873,35 +1756,29 @@
* Returns status of the operation
*
******************************************************************************/
-tBTM_STATUS BTM_SetQoS (BD_ADDR bd, FLOW_SPEC *p_flow, tBTM_CMPL_CB *p_cb)
-{
- tACL_CONN *p = &btm_cb.acl_db[0];
+tBTM_STATUS BTM_SetQoS(BD_ADDR bd, FLOW_SPEC* p_flow, tBTM_CMPL_CB* p_cb) {
+ tACL_CONN* p = &btm_cb.acl_db[0];
- BTM_TRACE_API ("BTM_SetQoS: BdAddr: %02x%02x%02x%02x%02x%02x",
- bd[0], bd[1], bd[2],
- bd[3], bd[4], bd[5]);
+ BTM_TRACE_API("BTM_SetQoS: BdAddr: %02x%02x%02x%02x%02x%02x", bd[0], bd[1],
+ bd[2], bd[3], bd[4], bd[5]);
- /* If someone already waiting on the version, do not allow another */
- if (btm_cb.devcb.p_qos_setup_cmpl_cb)
- return(BTM_BUSY);
+ /* If someone already waiting on the version, do not allow another */
+ if (btm_cb.devcb.p_qos_setup_cmpl_cb) return (BTM_BUSY);
- p = btm_bda_to_acl(bd, BT_TRANSPORT_BR_EDR);
- if (p != NULL)
- {
- btm_cb.devcb.p_qos_setup_cmpl_cb = p_cb;
- alarm_set_on_queue(btm_cb.devcb.qos_setup_timer,
- BTM_DEV_REPLY_TIMEOUT_MS,
- btm_qos_setup_timeout, NULL,
- btu_general_alarm_queue);
+ p = btm_bda_to_acl(bd, BT_TRANSPORT_BR_EDR);
+ if (p != NULL) {
+ btm_cb.devcb.p_qos_setup_cmpl_cb = p_cb;
+ alarm_set_on_queue(btm_cb.devcb.qos_setup_timer, BTM_DEV_REPLY_TIMEOUT_MS,
+ btm_qos_setup_timeout, NULL, btu_general_alarm_queue);
- btsnd_hcic_qos_setup(p->hci_handle, p_flow->qos_flags, p_flow->service_type,
- p_flow->token_rate, p_flow->peak_bandwidth,
- p_flow->latency,p_flow->delay_variation);
- return(BTM_CMD_STARTED);
- }
+ btsnd_hcic_qos_setup(p->hci_handle, p_flow->qos_flags, p_flow->service_type,
+ p_flow->token_rate, p_flow->peak_bandwidth,
+ p_flow->latency, p_flow->delay_variation);
+ return (BTM_CMD_STARTED);
+ }
- /* If here, no BD Addr found */
- return(BTM_UNKNOWN_ADDR);
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
/*******************************************************************************
@@ -1913,12 +1790,10 @@
* Returns void
*
******************************************************************************/
-void btm_qos_setup_timeout(UNUSED_ATTR void *data)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_qos_setup_cmpl_cb;
- btm_cb.devcb.p_qos_setup_cmpl_cb = NULL;
- if (p_cb)
- (*p_cb)((void *) NULL);
+void btm_qos_setup_timeout(UNUSED_ATTR void* data) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_qos_setup_cmpl_cb;
+ btm_cb.devcb.p_qos_setup_cmpl_cb = NULL;
+ if (p_cb) (*p_cb)((void*)NULL);
}
/*******************************************************************************
@@ -1931,34 +1806,32 @@
* Returns void
*
******************************************************************************/
-void btm_qos_setup_complete(uint8_t status, uint16_t handle, FLOW_SPEC *p_flow)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_qos_setup_cmpl_cb;
- tBTM_QOS_SETUP_CMPL qossu;
+void btm_qos_setup_complete(uint8_t status, uint16_t handle,
+ FLOW_SPEC* p_flow) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_qos_setup_cmpl_cb;
+ tBTM_QOS_SETUP_CMPL qossu;
- BTM_TRACE_DEBUG("%s", __func__);
- alarm_cancel(btm_cb.devcb.qos_setup_timer);
- btm_cb.devcb.p_qos_setup_cmpl_cb = NULL;
+ BTM_TRACE_DEBUG("%s", __func__);
+ alarm_cancel(btm_cb.devcb.qos_setup_timer);
+ btm_cb.devcb.p_qos_setup_cmpl_cb = NULL;
- /* If there was a registered callback, call it */
- if (p_cb)
- {
- memset(&qossu, 0, sizeof(tBTM_QOS_SETUP_CMPL));
- qossu.status = status;
- qossu.handle = handle;
- if (p_flow != NULL)
- {
- qossu.flow.qos_flags = p_flow->qos_flags;
- qossu.flow.service_type = p_flow->service_type;
- qossu.flow.token_rate = p_flow->token_rate;
- qossu.flow.peak_bandwidth = p_flow->peak_bandwidth;
- qossu.flow.latency = p_flow->latency;
- qossu.flow.delay_variation = p_flow->delay_variation;
- }
- BTM_TRACE_DEBUG ("BTM: p_flow->delay_variation: 0x%02x",
- qossu.flow.delay_variation);
- (*p_cb)(&qossu);
+ /* If there was a registered callback, call it */
+ if (p_cb) {
+ memset(&qossu, 0, sizeof(tBTM_QOS_SETUP_CMPL));
+ qossu.status = status;
+ qossu.handle = handle;
+ if (p_flow != NULL) {
+ qossu.flow.qos_flags = p_flow->qos_flags;
+ qossu.flow.service_type = p_flow->service_type;
+ qossu.flow.token_rate = p_flow->token_rate;
+ qossu.flow.peak_bandwidth = p_flow->peak_bandwidth;
+ qossu.flow.latency = p_flow->latency;
+ qossu.flow.delay_variation = p_flow->delay_variation;
}
+ BTM_TRACE_DEBUG("BTM: p_flow->delay_variation: 0x%02x",
+ qossu.flow.delay_variation);
+ (*p_cb)(&qossu);
+ }
}
/*******************************************************************************
@@ -1973,38 +1846,33 @@
* Returns BTM_CMD_STARTED if successfully initiated or error code
*
******************************************************************************/
-tBTM_STATUS BTM_ReadRSSI (const BD_ADDR remote_bda, tBTM_CMPL_CB *p_cb)
-{
- tACL_CONN *p;
- tBT_TRANSPORT transport = BT_TRANSPORT_BR_EDR;
- tBT_DEVICE_TYPE dev_type;
- tBLE_ADDR_TYPE addr_type;
- BTM_TRACE_API ("BTM_ReadRSSI: RemBdAddr: %02x%02x%02x%02x%02x%02x",
- remote_bda[0], remote_bda[1], remote_bda[2],
- remote_bda[3], remote_bda[4], remote_bda[5]);
+tBTM_STATUS BTM_ReadRSSI(const BD_ADDR remote_bda, tBTM_CMPL_CB* p_cb) {
+ tACL_CONN* p;
+ tBT_TRANSPORT transport = BT_TRANSPORT_BR_EDR;
+ tBT_DEVICE_TYPE dev_type;
+ tBLE_ADDR_TYPE addr_type;
+ BTM_TRACE_API("BTM_ReadRSSI: RemBdAddr: %02x%02x%02x%02x%02x%02x",
+ remote_bda[0], remote_bda[1], remote_bda[2], remote_bda[3],
+ remote_bda[4], remote_bda[5]);
- /* If someone already waiting on the version, do not allow another */
- if (btm_cb.devcb.p_rssi_cmpl_cb)
- return(BTM_BUSY);
+ /* If someone already waiting on the version, do not allow another */
+ if (btm_cb.devcb.p_rssi_cmpl_cb) return (BTM_BUSY);
- BTM_ReadDevInfo(remote_bda, &dev_type, &addr_type);
- if (dev_type == BT_DEVICE_TYPE_BLE)
- transport = BT_TRANSPORT_LE;
+ BTM_ReadDevInfo(remote_bda, &dev_type, &addr_type);
+ if (dev_type == BT_DEVICE_TYPE_BLE) transport = BT_TRANSPORT_LE;
- p = btm_bda_to_acl(remote_bda, transport);
- if (p != (tACL_CONN *)NULL)
- {
- btm_cb.devcb.p_rssi_cmpl_cb = p_cb;
- alarm_set_on_queue(btm_cb.devcb.read_rssi_timer,
- BTM_DEV_REPLY_TIMEOUT_MS, btm_read_rssi_timeout,
- NULL, btu_general_alarm_queue);
+ p = btm_bda_to_acl(remote_bda, transport);
+ if (p != (tACL_CONN*)NULL) {
+ btm_cb.devcb.p_rssi_cmpl_cb = p_cb;
+ alarm_set_on_queue(btm_cb.devcb.read_rssi_timer, BTM_DEV_REPLY_TIMEOUT_MS,
+ btm_read_rssi_timeout, NULL, btu_general_alarm_queue);
- btsnd_hcic_read_rssi (p->hci_handle);
- return(BTM_CMD_STARTED);
- }
+ btsnd_hcic_read_rssi(p->hci_handle);
+ return (BTM_CMD_STARTED);
+ }
- /* If here, no BD Addr found */
- return(BTM_UNKNOWN_ADDR);
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
/*******************************************************************************
@@ -2018,33 +1886,29 @@
* Returns BTM_CMD_STARTED if successfully initiated or error code
*
******************************************************************************/
-tBTM_STATUS BTM_ReadLinkQuality (BD_ADDR remote_bda, tBTM_CMPL_CB *p_cb)
-{
- tACL_CONN *p;
+tBTM_STATUS BTM_ReadLinkQuality(BD_ADDR remote_bda, tBTM_CMPL_CB* p_cb) {
+ tACL_CONN* p;
- BTM_TRACE_API ("BTM_ReadLinkQuality: RemBdAddr: %02x%02x%02x%02x%02x%02x",
- remote_bda[0], remote_bda[1], remote_bda[2],
- remote_bda[3], remote_bda[4], remote_bda[5]);
+ BTM_TRACE_API("BTM_ReadLinkQuality: RemBdAddr: %02x%02x%02x%02x%02x%02x",
+ remote_bda[0], remote_bda[1], remote_bda[2], remote_bda[3],
+ remote_bda[4], remote_bda[5]);
- /* If someone already waiting on the version, do not allow another */
- if (btm_cb.devcb.p_link_qual_cmpl_cb)
- return(BTM_BUSY);
+ /* If someone already waiting on the version, do not allow another */
+ if (btm_cb.devcb.p_link_qual_cmpl_cb) return (BTM_BUSY);
- p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
- if (p != (tACL_CONN *)NULL)
- {
- btm_cb.devcb.p_link_qual_cmpl_cb = p_cb;
- alarm_set_on_queue(btm_cb.devcb.read_link_quality_timer,
- BTM_DEV_REPLY_TIMEOUT_MS,
- btm_read_link_quality_timeout, NULL,
- btu_general_alarm_queue);
+ p = btm_bda_to_acl(remote_bda, BT_TRANSPORT_BR_EDR);
+ if (p != (tACL_CONN*)NULL) {
+ btm_cb.devcb.p_link_qual_cmpl_cb = p_cb;
+ alarm_set_on_queue(btm_cb.devcb.read_link_quality_timer,
+ BTM_DEV_REPLY_TIMEOUT_MS, btm_read_link_quality_timeout,
+ NULL, btu_general_alarm_queue);
- btsnd_hcic_get_link_quality(p->hci_handle);
- return(BTM_CMD_STARTED);
- }
+ btsnd_hcic_get_link_quality(p->hci_handle);
+ return (BTM_CMD_STARTED);
+ }
- /* If here, no BD Addr found */
- return(BTM_UNKNOWN_ADDR);
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
/*******************************************************************************
@@ -2059,44 +1923,38 @@
* Returns BTM_CMD_STARTED if successfully initiated or error code
*
******************************************************************************/
-tBTM_STATUS BTM_ReadTxPower (BD_ADDR remote_bda, tBT_TRANSPORT transport, tBTM_CMPL_CB *p_cb)
-{
- tACL_CONN *p;
-#define BTM_READ_RSSI_TYPE_CUR 0x00
-#define BTM_READ_RSSI_TYPE_MAX 0X01
+tBTM_STATUS BTM_ReadTxPower(BD_ADDR remote_bda, tBT_TRANSPORT transport,
+ tBTM_CMPL_CB* p_cb) {
+ tACL_CONN* p;
+#define BTM_READ_RSSI_TYPE_CUR 0x00
+#define BTM_READ_RSSI_TYPE_MAX 0X01
- BTM_TRACE_API ("BTM_ReadTxPower: RemBdAddr: %02x%02x%02x%02x%02x%02x",
- remote_bda[0], remote_bda[1], remote_bda[2],
- remote_bda[3], remote_bda[4], remote_bda[5]);
+ BTM_TRACE_API("BTM_ReadTxPower: RemBdAddr: %02x%02x%02x%02x%02x%02x",
+ remote_bda[0], remote_bda[1], remote_bda[2], remote_bda[3],
+ remote_bda[4], remote_bda[5]);
- /* If someone already waiting on the version, do not allow another */
- if (btm_cb.devcb.p_tx_power_cmpl_cb)
- return(BTM_BUSY);
+ /* If someone already waiting on the version, do not allow another */
+ if (btm_cb.devcb.p_tx_power_cmpl_cb) return (BTM_BUSY);
- p = btm_bda_to_acl(remote_bda, transport);
- if (p != (tACL_CONN *)NULL)
- {
- btm_cb.devcb.p_tx_power_cmpl_cb = p_cb;
- alarm_set_on_queue(btm_cb.devcb.read_tx_power_timer,
- BTM_DEV_REPLY_TIMEOUT_MS,
- btm_read_tx_power_timeout, NULL,
- btu_general_alarm_queue);
+ p = btm_bda_to_acl(remote_bda, transport);
+ if (p != (tACL_CONN*)NULL) {
+ btm_cb.devcb.p_tx_power_cmpl_cb = p_cb;
+ alarm_set_on_queue(btm_cb.devcb.read_tx_power_timer,
+ BTM_DEV_REPLY_TIMEOUT_MS, btm_read_tx_power_timeout,
+ NULL, btu_general_alarm_queue);
- if (p->transport == BT_TRANSPORT_LE)
- {
- memcpy(btm_cb.devcb.read_tx_pwr_addr, remote_bda, BD_ADDR_LEN);
- btsnd_hcic_ble_read_adv_chnl_tx_power();
- }
- else
- {
- btsnd_hcic_read_tx_power(p->hci_handle, BTM_READ_RSSI_TYPE_CUR);
- }
-
- return(BTM_CMD_STARTED);
+ if (p->transport == BT_TRANSPORT_LE) {
+ memcpy(btm_cb.devcb.read_tx_pwr_addr, remote_bda, BD_ADDR_LEN);
+ btsnd_hcic_ble_read_adv_chnl_tx_power();
+ } else {
+ btsnd_hcic_read_tx_power(p->hci_handle, BTM_READ_RSSI_TYPE_CUR);
}
- /* If here, no BD Addr found */
- return (BTM_UNKNOWN_ADDR);
+ return (BTM_CMD_STARTED);
+ }
+
+ /* If here, no BD Addr found */
+ return (BTM_UNKNOWN_ADDR);
}
/*******************************************************************************
@@ -2108,12 +1966,10 @@
* Returns void
*
******************************************************************************/
-void btm_read_tx_power_timeout(UNUSED_ATTR void *data)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_tx_power_cmpl_cb;
- btm_cb.devcb.p_tx_power_cmpl_cb = NULL;
- if (p_cb)
- (*p_cb)((void *) NULL);
+void btm_read_tx_power_timeout(UNUSED_ATTR void* data) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_tx_power_cmpl_cb;
+ btm_cb.devcb.p_tx_power_cmpl_cb = NULL;
+ if (p_cb) (*p_cb)((void*)NULL);
}
/*******************************************************************************
@@ -2126,55 +1982,46 @@
* Returns void
*
******************************************************************************/
-void btm_read_tx_power_complete(uint8_t *p, bool is_ble)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_tx_power_cmpl_cb;
- tBTM_TX_POWER_RESULTS results;
- uint16_t handle;
- tACL_CONN *p_acl_cb = &btm_cb.acl_db[0];
- uint16_t index;
+void btm_read_tx_power_complete(uint8_t* p, bool is_ble) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_tx_power_cmpl_cb;
+ tBTM_TX_POWER_RESULTS results;
+ uint16_t handle;
+ tACL_CONN* p_acl_cb = &btm_cb.acl_db[0];
+ uint16_t index;
- BTM_TRACE_DEBUG("%s", __func__);
- alarm_cancel(btm_cb.devcb.read_tx_power_timer);
- btm_cb.devcb.p_tx_power_cmpl_cb = NULL;
+ BTM_TRACE_DEBUG("%s", __func__);
+ alarm_cancel(btm_cb.devcb.read_tx_power_timer);
+ btm_cb.devcb.p_tx_power_cmpl_cb = NULL;
- /* If there was a registered callback, call it */
- if (p_cb)
- {
- STREAM_TO_UINT8 (results.hci_status, p);
+ /* If there was a registered callback, call it */
+ if (p_cb) {
+ STREAM_TO_UINT8(results.hci_status, p);
- if (results.hci_status == HCI_SUCCESS)
- {
- results.status = BTM_SUCCESS;
+ if (results.hci_status == HCI_SUCCESS) {
+ results.status = BTM_SUCCESS;
- if (!is_ble)
- {
- STREAM_TO_UINT16 (handle, p);
- STREAM_TO_UINT8 (results.tx_power, p);
+ if (!is_ble) {
+ STREAM_TO_UINT16(handle, p);
+ STREAM_TO_UINT8(results.tx_power, p);
- /* Search through the list of active channels for the correct BD Addr */
- for (index = 0; index < MAX_L2CAP_LINKS; index++, p_acl_cb++)
- {
- if ((p_acl_cb->in_use) && (handle == p_acl_cb->hci_handle))
- {
- memcpy (results.rem_bda, p_acl_cb->remote_addr, BD_ADDR_LEN);
- break;
- }
- }
- }
- else
- {
- STREAM_TO_UINT8 (results.tx_power, p);
- memcpy(results.rem_bda, btm_cb.devcb.read_tx_pwr_addr, BD_ADDR_LEN);
- }
- BTM_TRACE_DEBUG ("BTM TX power Complete: tx_power %d, hci status 0x%02x",
- results.tx_power, results.hci_status);
+ /* Search through the list of active channels for the correct BD Addr */
+ for (index = 0; index < MAX_L2CAP_LINKS; index++, p_acl_cb++) {
+ if ((p_acl_cb->in_use) && (handle == p_acl_cb->hci_handle)) {
+ memcpy(results.rem_bda, p_acl_cb->remote_addr, BD_ADDR_LEN);
+ break;
+ }
}
- else
- results.status = BTM_ERR_PROCESSING;
+ } else {
+ STREAM_TO_UINT8(results.tx_power, p);
+ memcpy(results.rem_bda, btm_cb.devcb.read_tx_pwr_addr, BD_ADDR_LEN);
+ }
+ BTM_TRACE_DEBUG("BTM TX power Complete: tx_power %d, hci status 0x%02x",
+ results.tx_power, results.hci_status);
+ } else
+ results.status = BTM_ERR_PROCESSING;
- (*p_cb)(&results);
- }
+ (*p_cb)(&results);
+ }
}
/*******************************************************************************
@@ -2186,12 +2033,10 @@
* Returns void
*
******************************************************************************/
-void btm_read_rssi_timeout(UNUSED_ATTR void *data)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_rssi_cmpl_cb;
- btm_cb.devcb.p_rssi_cmpl_cb = NULL;
- if (p_cb)
- (*p_cb)((void *) NULL);
+void btm_read_rssi_timeout(UNUSED_ATTR void* data) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_rssi_cmpl_cb;
+ btm_cb.devcb.p_rssi_cmpl_cb = NULL;
+ if (p_cb) (*p_cb)((void*)NULL);
}
/*******************************************************************************
@@ -2204,48 +2049,42 @@
* Returns void
*
******************************************************************************/
-void btm_read_rssi_complete (uint8_t *p)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_rssi_cmpl_cb;
- tBTM_RSSI_RESULTS results;
- uint16_t handle;
- tACL_CONN *p_acl_cb = &btm_cb.acl_db[0];
- uint16_t index;
+void btm_read_rssi_complete(uint8_t* p) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_rssi_cmpl_cb;
+ tBTM_RSSI_RESULTS results;
+ uint16_t handle;
+ tACL_CONN* p_acl_cb = &btm_cb.acl_db[0];
+ uint16_t index;
- BTM_TRACE_DEBUG("%s", __func__);
- alarm_cancel(btm_cb.devcb.read_rssi_timer);
- btm_cb.devcb.p_rssi_cmpl_cb = NULL;
+ BTM_TRACE_DEBUG("%s", __func__);
+ alarm_cancel(btm_cb.devcb.read_rssi_timer);
+ btm_cb.devcb.p_rssi_cmpl_cb = NULL;
- /* If there was a registered callback, call it */
- if (p_cb)
- {
- STREAM_TO_UINT8 (results.hci_status, p);
+ /* If there was a registered callback, call it */
+ if (p_cb) {
+ STREAM_TO_UINT8(results.hci_status, p);
- if (results.hci_status == HCI_SUCCESS)
- {
- results.status = BTM_SUCCESS;
+ if (results.hci_status == HCI_SUCCESS) {
+ results.status = BTM_SUCCESS;
- STREAM_TO_UINT16 (handle, p);
+ STREAM_TO_UINT16(handle, p);
- STREAM_TO_UINT8 (results.rssi, p);
- BTM_TRACE_DEBUG ("BTM RSSI Complete: rssi %d, hci status 0x%02x",
- results.rssi, results.hci_status);
+ STREAM_TO_UINT8(results.rssi, p);
+ BTM_TRACE_DEBUG("BTM RSSI Complete: rssi %d, hci status 0x%02x",
+ results.rssi, results.hci_status);
- /* Search through the list of active channels for the correct BD Addr */
- for (index = 0; index < MAX_L2CAP_LINKS; index++, p_acl_cb++)
- {
- if ((p_acl_cb->in_use) && (handle == p_acl_cb->hci_handle))
- {
- memcpy (results.rem_bda, p_acl_cb->remote_addr, BD_ADDR_LEN);
- break;
- }
- }
+ /* Search through the list of active channels for the correct BD Addr */
+ for (index = 0; index < MAX_L2CAP_LINKS; index++, p_acl_cb++) {
+ if ((p_acl_cb->in_use) && (handle == p_acl_cb->hci_handle)) {
+ memcpy(results.rem_bda, p_acl_cb->remote_addr, BD_ADDR_LEN);
+ break;
}
- else
- results.status = BTM_ERR_PROCESSING;
+ }
+ } else
+ results.status = BTM_ERR_PROCESSING;
- (*p_cb)(&results);
- }
+ (*p_cb)(&results);
+ }
}
/*******************************************************************************
@@ -2257,12 +2096,10 @@
* Returns void
*
******************************************************************************/
-void btm_read_link_quality_timeout(UNUSED_ATTR void *data)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_link_qual_cmpl_cb;
- btm_cb.devcb.p_link_qual_cmpl_cb = NULL;
- if (p_cb)
- (*p_cb)((void *) NULL);
+void btm_read_link_quality_timeout(UNUSED_ATTR void* data) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_link_qual_cmpl_cb;
+ btm_cb.devcb.p_link_qual_cmpl_cb = NULL;
+ if (p_cb) (*p_cb)((void*)NULL);
}
/*******************************************************************************
@@ -2275,48 +2112,43 @@
* Returns void
*
******************************************************************************/
-void btm_read_link_quality_complete(uint8_t *p)
-{
- tBTM_CMPL_CB *p_cb = btm_cb.devcb.p_link_qual_cmpl_cb;
- tBTM_LINK_QUALITY_RESULTS results;
- uint16_t handle;
- tACL_CONN *p_acl_cb = &btm_cb.acl_db[0];
- uint16_t index;
+void btm_read_link_quality_complete(uint8_t* p) {
+ tBTM_CMPL_CB* p_cb = btm_cb.devcb.p_link_qual_cmpl_cb;
+ tBTM_LINK_QUALITY_RESULTS results;
+ uint16_t handle;
+ tACL_CONN* p_acl_cb = &btm_cb.acl_db[0];
+ uint16_t index;
- BTM_TRACE_DEBUG("%s", __func__);
- alarm_cancel(btm_cb.devcb.read_link_quality_timer);
- btm_cb.devcb.p_link_qual_cmpl_cb = NULL;
+ BTM_TRACE_DEBUG("%s", __func__);
+ alarm_cancel(btm_cb.devcb.read_link_quality_timer);
+ btm_cb.devcb.p_link_qual_cmpl_cb = NULL;
- /* If there was a registered callback, call it */
- if (p_cb)
- {
- STREAM_TO_UINT8 (results.hci_status, p);
+ /* If there was a registered callback, call it */
+ if (p_cb) {
+ STREAM_TO_UINT8(results.hci_status, p);
- if (results.hci_status == HCI_SUCCESS)
- {
- results.status = BTM_SUCCESS;
+ if (results.hci_status == HCI_SUCCESS) {
+ results.status = BTM_SUCCESS;
- STREAM_TO_UINT16 (handle, p);
+ STREAM_TO_UINT16(handle, p);
- STREAM_TO_UINT8 (results.link_quality, p);
- BTM_TRACE_DEBUG ("BTM Link Quality Complete: Link Quality %d, hci status 0x%02x",
- results.link_quality, results.hci_status);
+ STREAM_TO_UINT8(results.link_quality, p);
+ BTM_TRACE_DEBUG(
+ "BTM Link Quality Complete: Link Quality %d, hci status 0x%02x",
+ results.link_quality, results.hci_status);
- /* Search through the list of active channels for the correct BD Addr */
- for (index = 0; index < MAX_L2CAP_LINKS; index++, p_acl_cb++)
- {
- if ((p_acl_cb->in_use) && (handle == p_acl_cb->hci_handle))
- {
- memcpy (results.rem_bda, p_acl_cb->remote_addr, BD_ADDR_LEN);
- break;
- }
- }
+ /* Search through the list of active channels for the correct BD Addr */
+ for (index = 0; index < MAX_L2CAP_LINKS; index++, p_acl_cb++) {
+ if ((p_acl_cb->in_use) && (handle == p_acl_cb->hci_handle)) {
+ memcpy(results.rem_bda, p_acl_cb->remote_addr, BD_ADDR_LEN);
+ break;
}
- else
- results.status = BTM_ERR_PROCESSING;
+ }
+ } else
+ results.status = BTM_ERR_PROCESSING;
- (*p_cb)(&results);
- }
+ (*p_cb)(&results);
+ }
}
/*******************************************************************************
@@ -2329,36 +2161,30 @@
* BTM_NO_RESOURCES.
*
******************************************************************************/
-tBTM_STATUS btm_remove_acl (BD_ADDR bd_addr, tBT_TRANSPORT transport)
-{
- uint16_t hci_handle = BTM_GetHCIConnHandle(bd_addr, transport);
- tBTM_STATUS status = BTM_SUCCESS;
+tBTM_STATUS btm_remove_acl(BD_ADDR bd_addr, tBT_TRANSPORT transport) {
+ uint16_t hci_handle = BTM_GetHCIConnHandle(bd_addr, transport);
+ tBTM_STATUS status = BTM_SUCCESS;
- BTM_TRACE_DEBUG ("btm_remove_acl");
+ BTM_TRACE_DEBUG("btm_remove_acl");
#if (BTM_DISC_DURING_RS == TRUE)
- tBTM_SEC_DEV_REC *p_dev_rec = btm_find_dev (bd_addr);
+ tBTM_SEC_DEV_REC* p_dev_rec = btm_find_dev(bd_addr);
- /* Role Switch is pending, postpone until completed */
- if (p_dev_rec && (p_dev_rec->rs_disc_pending == BTM_SEC_RS_PENDING))
- {
- p_dev_rec->rs_disc_pending = BTM_SEC_DISC_PENDING;
- }
- else /* otherwise can disconnect right away */
+ /* Role Switch is pending, postpone until completed */
+ if (p_dev_rec && (p_dev_rec->rs_disc_pending == BTM_SEC_RS_PENDING)) {
+ p_dev_rec->rs_disc_pending = BTM_SEC_DISC_PENDING;
+ } else /* otherwise can disconnect right away */
#endif
- {
- if (hci_handle != 0xFFFF && p_dev_rec &&
- p_dev_rec->sec_state!= BTM_SEC_STATE_DISCONNECTING)
- {
- btsnd_hcic_disconnect(hci_handle, HCI_ERR_PEER_USER);
- }
- else
- status = BTM_UNKNOWN_ADDR;
- }
+ {
+ if (hci_handle != 0xFFFF && p_dev_rec &&
+ p_dev_rec->sec_state != BTM_SEC_STATE_DISCONNECTING) {
+ btsnd_hcic_disconnect(hci_handle, HCI_ERR_PEER_USER);
+ } else
+ status = BTM_UNKNOWN_ADDR;
+ }
- return status;
+ return status;
}
-
/*******************************************************************************
*
* Function BTM_SetTraceLevel
@@ -2369,13 +2195,11 @@
* Returns The new or current trace level
*
******************************************************************************/
-uint8_t BTM_SetTraceLevel (uint8_t new_level)
-{
- BTM_TRACE_DEBUG ("BTM_SetTraceLevel");
- if (new_level != 0xFF)
- btm_cb.trace_level = new_level;
+uint8_t BTM_SetTraceLevel(uint8_t new_level) {
+ BTM_TRACE_DEBUG("BTM_SetTraceLevel");
+ if (new_level != 0xFF) btm_cb.trace_level = new_level;
- return(btm_cb.trace_level);
+ return (btm_cb.trace_level);
}
/*******************************************************************************
@@ -2389,38 +2213,34 @@
* Returns void
*
******************************************************************************/
-void btm_cont_rswitch (tACL_CONN *p, tBTM_SEC_DEV_REC *p_dev_rec,
- uint8_t hci_status)
-{
- BTM_TRACE_DEBUG ("btm_cont_rswitch");
- /* Check to see if encryption needs to be turned off if pending
- change of link key or role switch */
- if (p->switch_role_state == BTM_ACL_SWKEY_STATE_MODE_CHANGE)
+void btm_cont_rswitch(tACL_CONN* p, tBTM_SEC_DEV_REC* p_dev_rec,
+ uint8_t hci_status) {
+ BTM_TRACE_DEBUG("btm_cont_rswitch");
+ /* Check to see if encryption needs to be turned off if pending
+ change of link key or role switch */
+ if (p->switch_role_state == BTM_ACL_SWKEY_STATE_MODE_CHANGE) {
+ /* Must turn off Encryption first if necessary */
+ /* Some devices do not support switch or change of link key while encryption
+ * is on */
+ if (p_dev_rec != NULL &&
+ ((p_dev_rec->sec_flags & BTM_SEC_ENCRYPTED) != 0) &&
+ !BTM_EPR_AVAILABLE(p)) {
+ btsnd_hcic_set_conn_encrypt(p->hci_handle, false);
+ p->encrypt_state = BTM_ACL_ENCRYPT_STATE_ENCRYPT_OFF;
+ if (p->switch_role_state == BTM_ACL_SWKEY_STATE_MODE_CHANGE)
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_ENCRYPTION_OFF;
+ } else /* Encryption not used or EPR supported, continue with switch
+ and/or change of link key */
{
- /* Must turn off Encryption first if necessary */
- /* Some devices do not support switch or change of link key while encryption is on */
- if (p_dev_rec != NULL && ((p_dev_rec->sec_flags & BTM_SEC_ENCRYPTED) != 0)
- && !BTM_EPR_AVAILABLE(p))
- {
- btsnd_hcic_set_conn_encrypt(p->hci_handle, false);
- p->encrypt_state = BTM_ACL_ENCRYPT_STATE_ENCRYPT_OFF;
- if (p->switch_role_state == BTM_ACL_SWKEY_STATE_MODE_CHANGE)
- p->switch_role_state = BTM_ACL_SWKEY_STATE_ENCRYPTION_OFF;
- }
- else /* Encryption not used or EPR supported, continue with switch
- and/or change of link key */
- {
- if (p->switch_role_state == BTM_ACL_SWKEY_STATE_MODE_CHANGE)
- {
- p->switch_role_state = BTM_ACL_SWKEY_STATE_IN_PROGRESS;
+ if (p->switch_role_state == BTM_ACL_SWKEY_STATE_MODE_CHANGE) {
+ p->switch_role_state = BTM_ACL_SWKEY_STATE_IN_PROGRESS;
#if (BTM_DISC_DURING_RS == TRUE)
- if (p_dev_rec)
- p_dev_rec->rs_disc_pending = BTM_SEC_RS_PENDING;
+ if (p_dev_rec) p_dev_rec->rs_disc_pending = BTM_SEC_RS_PENDING;
#endif
- btsnd_hcic_switch_role(p->remote_addr, (uint8_t)!p->link_role);
- }
- }
+ btsnd_hcic_switch_role(p->remote_addr, (uint8_t)!p->link_role);
+ }
}
+ }
}
/*******************************************************************************
@@ -2430,32 +2250,29 @@
* Description send pending page request
*
******************************************************************************/
-void btm_acl_resubmit_page (void)
-{
- tBTM_SEC_DEV_REC *p_dev_rec;
- BT_HDR *p_buf;
- uint8_t *pp;
- BD_ADDR bda;
- BTM_TRACE_DEBUG ("btm_acl_resubmit_page");
- /* If there were other page request schedule can start the next one */
- p_buf = (BT_HDR *)fixed_queue_try_dequeue(btm_cb.page_queue);
- if (p_buf != NULL)
- {
- /* skip 3 (2 bytes opcode and 1 byte len) to get to the bd_addr
- * for both create_conn and rmt_name */
- pp = (uint8_t *)(p_buf + 1) + p_buf->offset + 3;
+void btm_acl_resubmit_page(void) {
+ tBTM_SEC_DEV_REC* p_dev_rec;
+ BT_HDR* p_buf;
+ uint8_t* pp;
+ BD_ADDR bda;
+ BTM_TRACE_DEBUG("btm_acl_resubmit_page");
+ /* If there were other page request schedule can start the next one */
+ p_buf = (BT_HDR*)fixed_queue_try_dequeue(btm_cb.page_queue);
+ if (p_buf != NULL) {
+ /* skip 3 (2 bytes opcode and 1 byte len) to get to the bd_addr
+ * for both create_conn and rmt_name */
+ pp = (uint8_t*)(p_buf + 1) + p_buf->offset + 3;
- STREAM_TO_BDADDR (bda, pp);
+ STREAM_TO_BDADDR(bda, pp);
- p_dev_rec = btm_find_or_alloc_dev (bda);
+ p_dev_rec = btm_find_or_alloc_dev(bda);
- memcpy (btm_cb.connecting_bda, p_dev_rec->bd_addr, BD_ADDR_LEN);
- memcpy (btm_cb.connecting_dc, p_dev_rec->dev_class, DEV_CLASS_LEN);
+ memcpy(btm_cb.connecting_bda, p_dev_rec->bd_addr, BD_ADDR_LEN);
+ memcpy(btm_cb.connecting_dc, p_dev_rec->dev_class, DEV_CLASS_LEN);
- btu_hcif_send_cmd (LOCAL_BR_EDR_CONTROLLER_ID, p_buf);
- }
- else
- btm_cb.paging = false;
+ btu_hcif_send_cmd(LOCAL_BR_EDR_CONTROLLER_ID, p_buf);
+ } else
+ btm_cb.paging = false;
}
/*******************************************************************************
@@ -2466,15 +2283,14 @@
* hci_reset
*
******************************************************************************/
-void btm_acl_reset_paging (void)
-{
- BT_HDR *p;
- BTM_TRACE_DEBUG ("btm_acl_reset_paging");
- /* If we sent reset we are definitely not paging any more */
- while ((p = (BT_HDR *)fixed_queue_try_dequeue(btm_cb.page_queue)) != NULL)
- osi_free(p);
+void btm_acl_reset_paging(void) {
+ BT_HDR* p;
+ BTM_TRACE_DEBUG("btm_acl_reset_paging");
+ /* If we sent reset we are definitely not paging any more */
+ while ((p = (BT_HDR*)fixed_queue_try_dequeue(btm_cb.page_queue)) != NULL)
+ osi_free(p);
- btm_cb.paging = false;
+ btm_cb.paging = false;
}
/*******************************************************************************
@@ -2484,48 +2300,41 @@
* Description send a paging command or queue it in btm_cb
*
******************************************************************************/
-void btm_acl_paging (BT_HDR *p, BD_ADDR bda)
-{
- tBTM_SEC_DEV_REC *p_dev_rec;
+void btm_acl_paging(BT_HDR* p, BD_ADDR bda) {
+ tBTM_SEC_DEV_REC* p_dev_rec;
- BTM_TRACE_DEBUG ("btm_acl_paging discing:%d, paging:%d BDA: %06x%06x",
- btm_cb.discing, btm_cb.paging,
- (bda[0]<<16) + (bda[1]<<8) + bda[2], (bda[3]<<16) + (bda[4] << 8) + bda[5]);
- if (btm_cb.discing)
- {
- btm_cb.paging = true;
+ BTM_TRACE_DEBUG("btm_acl_paging discing:%d, paging:%d BDA: %06x%06x",
+ btm_cb.discing, btm_cb.paging,
+ (bda[0] << 16) + (bda[1] << 8) + bda[2],
+ (bda[3] << 16) + (bda[4] << 8) + bda[5]);
+ if (btm_cb.discing) {
+ btm_cb.paging = true;
+ fixed_queue_enqueue(btm_cb.page_queue, p);
+ } else {
+ if (!BTM_ACL_IS_CONNECTED(bda)) {
+ BTM_TRACE_DEBUG(
+ "connecting_bda: %06x%06x",
+ (btm_cb.connecting_bda[0] << 16) + (btm_cb.connecting_bda[1] << 8) +
+ btm_cb.connecting_bda[2],
+ (btm_cb.connecting_bda[3] << 16) + (btm_cb.connecting_bda[4] << 8) +
+ btm_cb.connecting_bda[5]);
+ if (btm_cb.paging &&
+ memcmp(bda, btm_cb.connecting_bda, BD_ADDR_LEN) != 0) {
fixed_queue_enqueue(btm_cb.page_queue, p);
- }
- else
+ } else {
+ p_dev_rec = btm_find_or_alloc_dev(bda);
+ memcpy(btm_cb.connecting_bda, p_dev_rec->bd_addr, BD_ADDR_LEN);
+ memcpy(btm_cb.connecting_dc, p_dev_rec->dev_class, DEV_CLASS_LEN);
+
+ btu_hcif_send_cmd(LOCAL_BR_EDR_CONTROLLER_ID, p);
+ }
+
+ btm_cb.paging = true;
+ } else /* ACL is already up */
{
- if (!BTM_ACL_IS_CONNECTED (bda))
- {
- BTM_TRACE_DEBUG ("connecting_bda: %06x%06x",
- (btm_cb.connecting_bda[0]<<16) + (btm_cb.connecting_bda[1]<<8) +
- btm_cb.connecting_bda[2],
- (btm_cb.connecting_bda[3]<<16) + (btm_cb.connecting_bda[4] << 8) +
- btm_cb.connecting_bda[5]);
- if (btm_cb.paging &&
- memcmp (bda, btm_cb.connecting_bda, BD_ADDR_LEN) != 0)
- {
- fixed_queue_enqueue(btm_cb.page_queue, p);
- }
- else
- {
- p_dev_rec = btm_find_or_alloc_dev (bda);
- memcpy (btm_cb.connecting_bda, p_dev_rec->bd_addr, BD_ADDR_LEN);
- memcpy (btm_cb.connecting_dc, p_dev_rec->dev_class, DEV_CLASS_LEN);
-
- btu_hcif_send_cmd (LOCAL_BR_EDR_CONTROLLER_ID, p);
- }
-
- btm_cb.paging = true;
- }
- else /* ACL is already up */
- {
- btu_hcif_send_cmd (LOCAL_BR_EDR_CONTROLLER_ID, p);
- }
+ btu_hcif_send_cmd(LOCAL_BR_EDR_CONTROLLER_ID, p);
}
+ }
}
/*******************************************************************************
@@ -2538,28 +2347,25 @@
* false if no one needs the notification.
*
******************************************************************************/
-bool btm_acl_notif_conn_collision (BD_ADDR bda)
-{
- tBTM_BL_EVENT_DATA evt_data;
+bool btm_acl_notif_conn_collision(BD_ADDR bda) {
+ tBTM_BL_EVENT_DATA evt_data;
- /* Report possible collision to the upper layer. */
- if (btm_cb.p_bl_changed_cb)
- {
- BTM_TRACE_DEBUG ("btm_acl_notif_conn_collision: RemBdAddr: %02x%02x%02x%02x%02x%02x",
- bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
+ /* Report possible collision to the upper layer. */
+ if (btm_cb.p_bl_changed_cb) {
+ BTM_TRACE_DEBUG(
+ "btm_acl_notif_conn_collision: RemBdAddr: %02x%02x%02x%02x%02x%02x",
+ bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
- evt_data.event = BTM_BL_COLLISION_EVT;
- evt_data.conn.p_bda = bda;
- evt_data.conn.transport = BT_TRANSPORT_BR_EDR;
- evt_data.conn.handle = BTM_INVALID_HCI_HANDLE;
- (*btm_cb.p_bl_changed_cb)(&evt_data);
- return true;
- }
- else
- return false;
+ evt_data.event = BTM_BL_COLLISION_EVT;
+ evt_data.conn.p_bda = bda;
+ evt_data.conn.transport = BT_TRANSPORT_BR_EDR;
+ evt_data.conn.handle = BTM_INVALID_HCI_HANDLE;
+ (*btm_cb.p_bl_changed_cb)(&evt_data);
+ return true;
+ } else
+ return false;
}
-
/*******************************************************************************
*
* Function btm_acl_chk_peer_pkt_type_support
@@ -2567,36 +2373,48 @@
* Description Check if peer supports requested packets
*
******************************************************************************/
-void btm_acl_chk_peer_pkt_type_support (tACL_CONN *p, uint16_t *p_pkt_type)
-{
- /* 3 and 5 slot packets? */
- if (!HCI_3_SLOT_PACKETS_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- *p_pkt_type &= ~(BTM_ACL_PKT_TYPES_MASK_DH3 +BTM_ACL_PKT_TYPES_MASK_DM3);
+void btm_acl_chk_peer_pkt_type_support(tACL_CONN* p, uint16_t* p_pkt_type) {
+ /* 3 and 5 slot packets? */
+ if (!HCI_3_SLOT_PACKETS_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
+ *p_pkt_type &= ~(BTM_ACL_PKT_TYPES_MASK_DH3 + BTM_ACL_PKT_TYPES_MASK_DM3);
- if (!HCI_5_SLOT_PACKETS_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- *p_pkt_type &= ~(BTM_ACL_PKT_TYPES_MASK_DH5 + BTM_ACL_PKT_TYPES_MASK_DM5);
+ if (!HCI_5_SLOT_PACKETS_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
+ *p_pkt_type &= ~(BTM_ACL_PKT_TYPES_MASK_DH5 + BTM_ACL_PKT_TYPES_MASK_DM5);
- /* 2 and 3 MPS support? */
- if (!HCI_EDR_ACL_2MPS_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- /* Not supported. Add 'not_supported' mask for all 2MPS packet types */
- *p_pkt_type |= (BTM_ACL_PKT_TYPES_MASK_NO_2_DH1 + BTM_ACL_PKT_TYPES_MASK_NO_2_DH3 +
- BTM_ACL_PKT_TYPES_MASK_NO_2_DH5);
+ /* 2 and 3 MPS support? */
+ if (!HCI_EDR_ACL_2MPS_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
+ /* Not supported. Add 'not_supported' mask for all 2MPS packet types */
+ *p_pkt_type |=
+ (BTM_ACL_PKT_TYPES_MASK_NO_2_DH1 + BTM_ACL_PKT_TYPES_MASK_NO_2_DH3 +
+ BTM_ACL_PKT_TYPES_MASK_NO_2_DH5);
- if (!HCI_EDR_ACL_3MPS_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- /* Not supported. Add 'not_supported' mask for all 3MPS packet types */
- *p_pkt_type |= (BTM_ACL_PKT_TYPES_MASK_NO_3_DH1 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH3 +
- BTM_ACL_PKT_TYPES_MASK_NO_3_DH5);
+ if (!HCI_EDR_ACL_3MPS_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
+ /* Not supported. Add 'not_supported' mask for all 3MPS packet types */
+ *p_pkt_type |=
+ (BTM_ACL_PKT_TYPES_MASK_NO_3_DH1 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH3 +
+ BTM_ACL_PKT_TYPES_MASK_NO_3_DH5);
- /* EDR 3 and 5 slot support? */
- if (HCI_EDR_ACL_2MPS_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0])
- || HCI_EDR_ACL_3MPS_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- {
- if (!HCI_3_SLOT_EDR_ACL_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- /* Not supported. Add 'not_supported' mask for all 3-slot EDR packet types */
- *p_pkt_type |= (BTM_ACL_PKT_TYPES_MASK_NO_2_DH3 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH3);
+ /* EDR 3 and 5 slot support? */
+ if (HCI_EDR_ACL_2MPS_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]) ||
+ HCI_EDR_ACL_3MPS_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0])) {
+ if (!HCI_3_SLOT_EDR_ACL_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
+ /* Not supported. Add 'not_supported' mask for all 3-slot EDR packet types
+ */
+ *p_pkt_type |=
+ (BTM_ACL_PKT_TYPES_MASK_NO_2_DH3 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH3);
- if (!HCI_5_SLOT_EDR_ACL_SUPPORTED(p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
- /* Not supported. Add 'not_supported' mask for all 5-slot EDR packet types */
- *p_pkt_type |= (BTM_ACL_PKT_TYPES_MASK_NO_2_DH5 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH5);
- }
+ if (!HCI_5_SLOT_EDR_ACL_SUPPORTED(
+ p->peer_lmp_features[HCI_EXT_FEATURES_PAGE_0]))
+ /* Not supported. Add 'not_supported' mask for all 5-slot EDR packet types
+ */
+ *p_pkt_type |=
+ (BTM_ACL_PKT_TYPES_MASK_NO_2_DH5 + BTM_ACL_PKT_TYPES_MASK_NO_3_DH5);
+ }
}