Files
esp-idf/components/bt/host/bluedroid/stack/pan/pan_utils.c
T
linruihao 4f54340e51 feat(bt/bluedroid): support Classic Bluetooth PAN profile
- Port part of PAN/BNEP code from Android
- Add ESP API and BTC layer
2026-08-17 19:52:21 +08:00

336 lines
11 KiB
C

/******************************************************************************
*
* Copyright (C) 1999-2012 Broadcom Corporation
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
******************************************************************************/
/*****************************************************************************
*
* This file contains main functions to support PAN profile
* commands and events.
*
*****************************************************************************/
#include "common/bt_target.h"
#if (PAN_INCLUDED == TRUE)
#include <string.h>
#include "stack/bnep_api.h"
#include "bt_common.h"
#include "stack/btm_api.h"
#include "stack/hcidefs.h"
#include "stack/l2c_api.h"
#include "stack/pan_api.h"
#include "pan_int.h"
#include "stack/sdp_api.h"
#include "stack/sdpdefs.h"
static const UINT8 pan_proto_elem_data[] = {
0x35, 0x18, /* data element sequence of length 0x18 bytes */
0x35, 0x06, /* data element sequence for L2CAP descriptor */
0x19, 0x01, 0x00, /* UUID for L2CAP - 0x0100 */
0x09, 0x00, 0x0F, /* PSM for BNEP - 0x000F */
0x35, 0x0E, /* data element sequence for BNEP descriptor */
0x19, 0x00, 0x0F, /* UUID for BNEP - 0x000F */
0x09, 0x01,
0x00, /* BNEP specific parameter 0 -- Version of BNEP = version 1 = 0x0001
*/
0x35,
0x06, /* BNEP specific parameter 1 -- Supported network packet type list */
0x09, 0x08, 0x00, /* network packet type IPv4 = 0x0800 */
0x09, 0x08, 0x06 /* network packet type ARP = 0x0806 */
};
/*******************************************************************************
*
* Function pan_register_with_sdp
*
* Description
*
* Returns
*
******************************************************************************/
UINT32 pan_register_with_sdp(UINT16 uuid, UINT8 sec_mask,
const char *p_name, const char *p_desc)
{
UINT32 sdp_handle;
UINT16 browse_list = UUID_SERVCLASS_PUBLIC_BROWSE_GROUP;
UINT16 security = 0;
UINT32 proto_len = (UINT32)pan_proto_elem_data[1];
/* Create a record */
sdp_handle = SDP_CreateRecord();
if (sdp_handle == 0) {
PAN_TRACE_ERROR("PAN_SetRole - could not create SDP record");
return 0;
}
/* Service Class ID List */
SDP_AddServiceClassIdList(sdp_handle, 1, &uuid);
/* Add protocol element sequence from the constant string */
SDP_AddAttribute(sdp_handle, ATTR_ID_PROTOCOL_DESC_LIST,
DATA_ELE_SEQ_DESC_TYPE, proto_len,
(UINT8 *)(pan_proto_elem_data + 2));
/* Language base */
SDP_AddLanguageBaseAttrIDList(sdp_handle, LANG_ID_CODE_ENGLISH,
LANG_ID_CHAR_ENCODE_UTF8, LANGUAGE_BASE_ID);
/* Profile descriptor list */
SDP_AddProfileDescriptorList(sdp_handle, uuid, PAN_PROFILE_VERSION);
/* Service Name */
SDP_AddAttribute(sdp_handle, ATTR_ID_SERVICE_NAME, TEXT_STR_DESC_TYPE,
(UINT32)(strlen(p_name) + 1), (UINT8 *)p_name);
/* Service description */
SDP_AddAttribute(sdp_handle, ATTR_ID_SERVICE_DESCRIPTION, TEXT_STR_DESC_TYPE,
(UINT32)(strlen(p_desc) + 1), (UINT8 *)p_desc);
/* Security description */
if (sec_mask) {
UINT16_TO_BE_FIELD(&security, 0x0001);
}
SDP_AddAttribute(sdp_handle, ATTR_ID_SECURITY_DESCRIPTION, UINT_DESC_TYPE, 2,
(UINT8 *)&security);
#if (PAN_SUPPORTS_ROLE_NAP == TRUE)
if (uuid == UUID_SERVCLASS_NAP) {
UINT16 NetAccessType = 0x0005; /* Ethernet */
UINT32 NetAccessRate = 0x0001312D0; /* 10Mb/sec */
UINT8 array[10], *p;
/* Net access type. */
p = array;
UINT16_TO_BE_STREAM(p, NetAccessType);
SDP_AddAttribute(sdp_handle, ATTR_ID_NET_ACCESS_TYPE, UINT_DESC_TYPE, 2,
array);
/* Net access rate. */
p = array;
UINT32_TO_BE_STREAM(p, NetAccessRate);
SDP_AddAttribute(sdp_handle, ATTR_ID_MAX_NET_ACCESS_RATE, UINT_DESC_TYPE, 4,
array);
/* Register with Security Manager for the specific security level */
if ((!BTM_SetSecurityLevel(TRUE, p_name, BTM_SEC_SERVICE_BNEP_NAP, sec_mask,
BT_PSM_BNEP, BTM_SEC_PROTO_BNEP,
UUID_SERVCLASS_NAP)) ||
(!BTM_SetSecurityLevel(FALSE, p_name, BTM_SEC_SERVICE_BNEP_NAP,
sec_mask, BT_PSM_BNEP, BTM_SEC_PROTO_BNEP,
UUID_SERVCLASS_NAP))) {
PAN_TRACE_ERROR("PAN Security Registration failed for NAP\n");
}
}
#endif
#if (PAN_SUPPORTS_ROLE_GN == TRUE)
if (uuid == UUID_SERVCLASS_GN) {
if ((!BTM_SetSecurityLevel(TRUE, p_name, BTM_SEC_SERVICE_BNEP_GN, sec_mask,
BT_PSM_BNEP, BTM_SEC_PROTO_BNEP,
UUID_SERVCLASS_GN)) ||
(!BTM_SetSecurityLevel(FALSE, p_name, BTM_SEC_SERVICE_BNEP_GN, sec_mask,
BT_PSM_BNEP, BTM_SEC_PROTO_BNEP,
UUID_SERVCLASS_GN))) {
PAN_TRACE_ERROR("PAN Security Registration failed for GN");
}
}
#endif
#if (PAN_SUPPORTS_ROLE_PANU == TRUE)
if (uuid == UUID_SERVCLASS_PANU) {
if ((!BTM_SetSecurityLevel(TRUE, p_name, BTM_SEC_SERVICE_BNEP_PANU,
sec_mask, BT_PSM_BNEP, BTM_SEC_PROTO_BNEP,
UUID_SERVCLASS_PANU)) ||
(!BTM_SetSecurityLevel(FALSE, p_name, BTM_SEC_SERVICE_BNEP_PANU,
sec_mask, BT_PSM_BNEP, BTM_SEC_PROTO_BNEP,
UUID_SERVCLASS_PANU))) {
PAN_TRACE_ERROR("PAN Security Registration failed for PANU");
}
}
#endif
/* Make the service browsable */
SDP_AddUuidSequence(sdp_handle, ATTR_ID_BROWSE_GROUP_LIST, 1, &browse_list);
return sdp_handle;
}
/*******************************************************************************
*
* Function pan_allocate_pcb
*
* Description
*
* Returns
*
******************************************************************************/
tPAN_CONN *pan_allocate_pcb(BD_ADDR p_bda, UINT16 handle)
{
UINT16 i;
for (i = 0; i < MAX_PAN_CONNS; i++) {
if (pan_cb.pcb[i].con_state != PAN_STATE_IDLE &&
pan_cb.pcb[i].handle == handle) {
return NULL;
}
}
for (i = 0; i < MAX_PAN_CONNS; i++) {
if (pan_cb.pcb[i].con_state != PAN_STATE_IDLE &&
!bdcmp(pan_cb.pcb[i].rem_bda, p_bda)) {
return NULL;
}
}
for (i = 0; i < MAX_PAN_CONNS; i++) {
if (pan_cb.pcb[i].con_state == PAN_STATE_IDLE) {
memset(&(pan_cb.pcb[i]), 0, sizeof(tPAN_CONN));
bdcpy(pan_cb.pcb[i].rem_bda, p_bda);
pan_cb.pcb[i].handle = handle;
return &(pan_cb.pcb[i]);
}
}
return NULL;
}
/*******************************************************************************
*
* Function pan_get_pcb_by_handle
*
* Description
*
* Returns
*
******************************************************************************/
tPAN_CONN *pan_get_pcb_by_handle(UINT16 handle)
{
UINT16 i;
for (i = 0; i < MAX_PAN_CONNS; i++) {
if (pan_cb.pcb[i].con_state != PAN_STATE_IDLE &&
pan_cb.pcb[i].handle == handle) {
return &(pan_cb.pcb[i]);
}
}
return NULL;
}
/*******************************************************************************
*
* Function pan_get_pcb_by_addr
*
* Description
*
* Returns
*
******************************************************************************/
tPAN_CONN *pan_get_pcb_by_addr(BD_ADDR p_bda)
{
UINT16 i;
for (i = 0; i < MAX_PAN_CONNS; i++) {
if (pan_cb.pcb[i].con_state == PAN_STATE_IDLE) {
continue;
}
if (!bdcmp(pan_cb.pcb[i].rem_bda, p_bda)) {
return &(pan_cb.pcb[i]);
}
/*
if (pan_cb.pcb[i].mfilter_present &&
p_bda == pan_cb.pcb[i].multi_cast_bridge)
return &(pan_cb.pcb[i]);
*/
}
return NULL;
}
/*******************************************************************************
*
* Function pan_close_all_connections
*
* Description
*
* Returns void
*
******************************************************************************/
void pan_close_all_connections(void)
{
UINT16 i;
for (i = 0; i < MAX_PAN_CONNS; i++) {
if (pan_cb.pcb[i].con_state != PAN_STATE_IDLE) {
BNEP_Disconnect(pan_cb.pcb[i].handle);
pan_cb.pcb[i].con_state = PAN_STATE_IDLE;
}
}
pan_cb.active_role = PAN_ROLE_INACTIVE;
pan_cb.num_conns = 0;
return;
}
/*******************************************************************************
*
* Function pan_release_pcb
*
* Description This function releases a PCB.
*
* Returns void
*
******************************************************************************/
void pan_release_pcb(tPAN_CONN *p_pcb)
{
/* Drop any response pointer we may be holding */
memset(p_pcb, 0, sizeof(tPAN_CONN));
p_pcb->con_state = PAN_STATE_IDLE;
}
/*******************************************************************************
*
* Function pan_dump_status
*
* Description This function dumps the pan control block and connection
* blocks information
*
* Returns none
*
******************************************************************************/
void pan_dump_status(void)
{
#if (PAN_SUPPORTS_DEBUG_DUMP == TRUE)
UINT16 i;
tPAN_CONN *p_pcb;
PAN_TRACE_DEBUG("PAN role %x, active role %d, num_conns %d", pan_cb.role,
pan_cb.active_role, pan_cb.num_conns);
for (i = 0, p_pcb = pan_cb.pcb; i < MAX_PAN_CONNS; i++, p_pcb++) {
PAN_TRACE_DEBUG(
"pcb[%d] state:%d handle:%d src:0x%x rem_bda:%02x:%02x:%02x:%02x:%02x:%02x",
i, p_pcb->con_state, p_pcb->handle, p_pcb->src_uuid,
p_pcb->rem_bda[0], p_pcb->rem_bda[1], p_pcb->rem_bda[2],
p_pcb->rem_bda[3], p_pcb->rem_bda[4], p_pcb->rem_bda[5]);
}
#endif
}
#endif /* (PAN_INCLUDED == TRUE) */