mirror of
https://github.com/espressif/esp-idf.git
synced 2026-10-02 03:00:34 +03:00
feat(bt/bluedroid): support Classic Bluetooth PAN profile
- Port part of PAN/BNEP code from Android - Add ESP API and BTC layer
This commit is contained in:
linruihao
@@ -0,0 +1,812 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* Copyright (C) 2001-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 the BNEP API code
|
||||
*
|
||||
******************************************************************************/
|
||||
|
||||
#include "common/bt_target.h"
|
||||
|
||||
#if (BNEP_INCLUDED == TRUE)
|
||||
|
||||
#include <string.h>
|
||||
|
||||
#include "osi/allocator.h"
|
||||
#include "osi/fixed_queue.h"
|
||||
|
||||
#include "stack/bnep_api.h"
|
||||
#include "bnep_int.h"
|
||||
|
||||
extern fixed_queue_t* btu_general_alarm_queue;
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Init
|
||||
*
|
||||
* Description This function initializes the BNEP unit. It should be called
|
||||
* before accessing any other APIs to initialize the control
|
||||
* block.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
void BNEP_Init(void)
|
||||
{
|
||||
memset(&bnep_cb, 0, sizeof(tBNEP_CB));
|
||||
|
||||
#if defined(BNEP_INITIAL_TRACE_LEVEL)
|
||||
bnep_cb.trace_level = BNEP_INITIAL_TRACE_LEVEL;
|
||||
#else
|
||||
bnep_cb.trace_level = BT_TRACE_LEVEL_NONE; /* No traces */
|
||||
#endif
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Register
|
||||
*
|
||||
* Description This function is called by the upper layer to register
|
||||
* its callbacks with BNEP
|
||||
*
|
||||
* Parameters: p_reg_info - contains all callback function pointers
|
||||
*
|
||||
*
|
||||
* Returns BNEP_SUCCESS if registered successfully
|
||||
* BNEP_FAILURE if connection state callback is missing
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_Register(tBNEP_REGISTER *p_reg_info)
|
||||
{
|
||||
/* There should be connection state call back registered */
|
||||
if ((!p_reg_info) || (!(p_reg_info->p_conn_state_cb))) {
|
||||
return BNEP_SECURITY_FAIL;
|
||||
}
|
||||
|
||||
bnep_cb.p_conn_ind_cb = p_reg_info->p_conn_ind_cb;
|
||||
bnep_cb.p_conn_state_cb = p_reg_info->p_conn_state_cb;
|
||||
bnep_cb.p_data_ind_cb = p_reg_info->p_data_ind_cb;
|
||||
bnep_cb.p_data_buf_cb = p_reg_info->p_data_buf_cb;
|
||||
bnep_cb.p_filter_ind_cb = p_reg_info->p_filter_ind_cb;
|
||||
bnep_cb.p_mfilter_ind_cb = p_reg_info->p_mfilter_ind_cb;
|
||||
bnep_cb.p_tx_data_flow_cb = p_reg_info->p_tx_data_flow_cb;
|
||||
|
||||
if (bnep_register_with_l2cap()) {
|
||||
return BNEP_SECURITY_FAIL;
|
||||
}
|
||||
|
||||
bnep_cb.profile_registered = TRUE;
|
||||
return BNEP_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Deregister
|
||||
*
|
||||
* Description This function is called by the upper layer to de-register
|
||||
* its callbacks.
|
||||
*
|
||||
* Parameters: void
|
||||
*
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
void BNEP_Deregister(void)
|
||||
{
|
||||
/* Clear all the call backs registered */
|
||||
bnep_cb.p_conn_ind_cb = NULL;
|
||||
bnep_cb.p_conn_state_cb = NULL;
|
||||
bnep_cb.p_data_ind_cb = NULL;
|
||||
bnep_cb.p_data_buf_cb = NULL;
|
||||
bnep_cb.p_filter_ind_cb = NULL;
|
||||
bnep_cb.p_mfilter_ind_cb = NULL;
|
||||
bnep_cb.p_tx_data_flow_cb = NULL;
|
||||
|
||||
bnep_cb.profile_registered = FALSE;
|
||||
L2CA_Deregister(BT_PSM_BNEP);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Connect
|
||||
*
|
||||
* Description This function creates a BNEP connection to a remote
|
||||
* device.
|
||||
*
|
||||
* Parameters: p_rem_addr - BD_ADDR of the peer
|
||||
* src_uuid - source uuid for the connection
|
||||
* dst_uuid - destination uuid for the connection
|
||||
* p_handle - pointer to return the handle for the
|
||||
* connection
|
||||
*
|
||||
* Returns BNEP_SUCCESS if connection started
|
||||
* BNEP_NO_RESOURCES if no resources
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_Connect(BD_ADDR p_rem_bda, tBT_UUID *src_uuid,
|
||||
tBT_UUID *dst_uuid, UINT16 *p_handle)
|
||||
{
|
||||
UINT16 cid;
|
||||
tBNEP_CONN * p_bcb = bnepu_find_bcb_by_bd_addr(p_rem_bda);
|
||||
|
||||
BNEP_TRACE_DEBUG("%s BDA:%02x:%02x:%02x:%02x:%02x:%02x", __func__,
|
||||
p_rem_bda[0], p_rem_bda[1], p_rem_bda[2], p_rem_bda[3],
|
||||
p_rem_bda[4], p_rem_bda[5]);
|
||||
|
||||
if (!bnep_cb.profile_registered) {
|
||||
return BNEP_WRONG_STATE;
|
||||
}
|
||||
|
||||
/* Both source and destination UUID lengths should be same */
|
||||
if (src_uuid->len != dst_uuid->len) {
|
||||
return BNEP_CONN_FAILED_UUID_SIZE;
|
||||
}
|
||||
|
||||
if (!p_bcb) {
|
||||
p_bcb = bnepu_allocate_bcb(p_rem_bda);
|
||||
if (p_bcb == NULL) {
|
||||
return (BNEP_NO_RESOURCES);
|
||||
}
|
||||
} else if (p_bcb->con_state != BNEP_STATE_CONNECTED) {
|
||||
return BNEP_WRONG_STATE;
|
||||
} else {
|
||||
/* Backup current UUID values to restore if role change fails */
|
||||
memcpy((UINT8 *) & (p_bcb->prv_src_uuid), (UINT8 *) & (p_bcb->src_uuid),
|
||||
sizeof(tBT_UUID));
|
||||
memcpy((UINT8 *) & (p_bcb->prv_dst_uuid), (UINT8 *) & (p_bcb->dst_uuid),
|
||||
sizeof(tBT_UUID));
|
||||
}
|
||||
|
||||
/* We are the originator of this connection */
|
||||
p_bcb->con_flags |= BNEP_FLAGS_IS_ORIG;
|
||||
|
||||
memcpy((UINT8*) & (p_bcb->src_uuid), (UINT8*)src_uuid, sizeof(tBT_UUID));
|
||||
memcpy((UINT8*) & (p_bcb->dst_uuid), (UINT8*)dst_uuid, sizeof(tBT_UUID));
|
||||
|
||||
if (p_bcb->con_state == BNEP_STATE_CONNECTED) {
|
||||
/* Transition to the next appropriate state, waiting for connection confirm.
|
||||
*/
|
||||
p_bcb->con_state = BNEP_STATE_SEC_CHECKING;
|
||||
|
||||
BNEP_TRACE_API("BNEP initiating security procedures for src uuid 0x%x",
|
||||
p_bcb->src_uuid.uu.uuid16);
|
||||
|
||||
#if (BNEP_DO_AUTH_FOR_ROLE_SWITCH == TRUE)
|
||||
btm_sec_mx_access_request(p_bcb->rem_bda, BT_PSM_BNEP, TRUE,
|
||||
BTM_SEC_PROTO_BNEP, bnep_get_uuid32(src_uuid),
|
||||
&bnep_sec_check_complete, p_bcb);
|
||||
#else
|
||||
bnep_sec_check_complete(p_bcb->rem_bda, BT_TRANSPORT_BR_EDR, p_bcb,
|
||||
BTM_SUCCESS);
|
||||
#endif
|
||||
|
||||
} else {
|
||||
/* Transition to the next appropriate state, waiting for connection confirm.
|
||||
*/
|
||||
p_bcb->con_state = BNEP_STATE_CONN_START;
|
||||
|
||||
cid = L2CA_ConnectReq(BT_PSM_BNEP, p_bcb->rem_bda);
|
||||
if (cid != 0) {
|
||||
p_bcb->l2cap_cid = cid;
|
||||
|
||||
} else {
|
||||
BNEP_TRACE_ERROR("BNEP - Originate failed");
|
||||
if (bnep_cb.p_conn_state_cb)
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_FAILED, FALSE);
|
||||
bnepu_release_bcb(p_bcb);
|
||||
return BNEP_CONN_FAILED;
|
||||
}
|
||||
|
||||
/* Start timer waiting for connect */
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_CONN_TIMEOUT_SEC);
|
||||
}
|
||||
|
||||
*p_handle = p_bcb->handle;
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_ConnectResp
|
||||
*
|
||||
* Description This function is called in response to connection indication
|
||||
*
|
||||
*
|
||||
* Parameters: handle - handle given in the connection indication
|
||||
* resp - response for the connection indication
|
||||
*
|
||||
* Returns BNEP_SUCCESS if connection started
|
||||
* BNEP_WRONG_HANDLE if the connection is not found
|
||||
* BNEP_WRONG_STATE if the response is not expected
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_ConnectResp(UINT16 handle, tBNEP_RESULT resp)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
UINT16 resp_code = BNEP_SETUP_CONN_OK;
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
if (p_bcb->con_state != BNEP_STATE_CONN_SETUP ||
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_SETUP_RCVD))) {
|
||||
return (BNEP_WRONG_STATE);
|
||||
}
|
||||
|
||||
BNEP_TRACE_API("BNEP_ConnectResp() for handle %d, response %d", handle,
|
||||
resp);
|
||||
|
||||
/* Form appropriate response based on profile response */
|
||||
if (resp == BNEP_CONN_FAILED_SRC_UUID) {
|
||||
resp_code = BNEP_SETUP_INVALID_SRC_UUID;
|
||||
} else if (resp == BNEP_CONN_FAILED_DST_UUID) {
|
||||
resp_code = BNEP_SETUP_INVALID_DEST_UUID;
|
||||
} else if (resp == BNEP_CONN_FAILED_UUID_SIZE) {
|
||||
resp_code = BNEP_SETUP_INVALID_UUID_SIZE;
|
||||
} else if (resp == BNEP_SUCCESS) {
|
||||
resp_code = BNEP_SETUP_CONN_OK;
|
||||
} else {
|
||||
resp_code = BNEP_SETUP_CONN_NOT_ALLOWED;
|
||||
}
|
||||
|
||||
bnep_send_conn_responce(p_bcb, resp_code);
|
||||
p_bcb->con_flags &= (~BNEP_FLAGS_SETUP_RCVD);
|
||||
|
||||
if (resp == BNEP_SUCCESS) {
|
||||
bnep_connected(p_bcb);
|
||||
} else if (p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED) {
|
||||
/* Restore the original parameters */
|
||||
p_bcb->con_state = BNEP_STATE_CONNECTED;
|
||||
p_bcb->con_flags &= (~BNEP_FLAGS_SETUP_RCVD);
|
||||
|
||||
memcpy((UINT8*) & (p_bcb->src_uuid), (UINT8*) & (p_bcb->prv_src_uuid),
|
||||
sizeof(tBT_UUID));
|
||||
memcpy((UINT8*) & (p_bcb->dst_uuid), (UINT8*) & (p_bcb->prv_dst_uuid),
|
||||
sizeof(tBT_UUID));
|
||||
}
|
||||
|
||||
/* Process remaining part of the setup message (extension headers) */
|
||||
if (p_bcb->p_pending_data) {
|
||||
UINT8 extension_present = TRUE, *p, ext_type;
|
||||
UINT16 rem_len;
|
||||
|
||||
rem_len = p_bcb->p_pending_data->len;
|
||||
p = (UINT8*)(p_bcb->p_pending_data + 1) + p_bcb->p_pending_data->offset;
|
||||
while (extension_present && p && rem_len) {
|
||||
ext_type = *p++;
|
||||
rem_len--;
|
||||
extension_present = ext_type >> 7;
|
||||
ext_type &= 0x7F;
|
||||
|
||||
/* if unknown extension present stop processing */
|
||||
if (ext_type) {
|
||||
break;
|
||||
}
|
||||
|
||||
p = bnep_process_control_packet(p_bcb, p, &rem_len, TRUE);
|
||||
}
|
||||
|
||||
osi_free(p_bcb->p_pending_data);
|
||||
p_bcb->p_pending_data = NULL;
|
||||
}
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Disconnect
|
||||
*
|
||||
* Description This function is called to close the specified connection.
|
||||
*
|
||||
* Parameters: handle - handle of the connection
|
||||
*
|
||||
* Returns BNEP_SUCCESS if connection is disconnected
|
||||
* BNEP_WRONG_HANDLE if no connection is not found
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_Disconnect(UINT16 handle)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
if (p_bcb->con_state == BNEP_STATE_IDLE) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
BNEP_TRACE_API("BNEP_Disconnect() for handle %d", handle);
|
||||
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_WriteBuf
|
||||
*
|
||||
* Description This function sends data in a GKI buffer on BNEP connection
|
||||
*
|
||||
* Parameters: handle - handle of the connection to write
|
||||
* p_dest_addr - BD_ADDR/Ethernet addr of the destination
|
||||
* p_buf - pointer to address of buffer with data
|
||||
* protocol - protocol type of the packet
|
||||
* p_src_addr - (optional) BD_ADDR/ethernet address of the
|
||||
* source
|
||||
* (should be NULL if it is local BD Addr)
|
||||
* fw_ext_present - forwarded extensions present
|
||||
*
|
||||
* Returns: BNEP_WRONG_HANDLE - if passed handle is not valid
|
||||
* BNEP_WRONG_STATE - if connection is not active
|
||||
* BNEP_MTU_EXCEDED - If the data length is greater than
|
||||
* the MTU
|
||||
* BNEP_IGNORE_CMD - If the packet is filtered out
|
||||
* BNEP_Q_SIZE_EXCEEDED - If the Tx Q is full
|
||||
* BNEP_SUCCESS - If written successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_WriteBuf(UINT16 handle, BD_ADDR p_dest_addr,
|
||||
BT_HDR *p_buf, UINT16 protocol,
|
||||
BD_ADDR p_src_addr, BOOLEAN fw_ext_present)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
UINT8* p_data;
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
osi_free(p_buf);
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
/* Check the connection state */
|
||||
if ((p_bcb->con_state != BNEP_STATE_CONNECTED) &&
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED))) {
|
||||
osi_free(p_buf);
|
||||
return (BNEP_WRONG_STATE);
|
||||
}
|
||||
|
||||
/* Check MTU size */
|
||||
if (p_buf->len > BNEP_MTU_SIZE) {
|
||||
BNEP_TRACE_ERROR("BNEP_Write() length %d exceeded MTU %d", p_buf->len,
|
||||
BNEP_MTU_SIZE);
|
||||
osi_free(p_buf);
|
||||
return (BNEP_MTU_EXCEDED);
|
||||
}
|
||||
|
||||
/* Check if the packet should be filtered out */
|
||||
p_data = (UINT8*)(p_buf + 1) + p_buf->offset;
|
||||
if (bnep_is_packet_allowed(p_bcb, p_dest_addr, protocol, fw_ext_present,
|
||||
p_data, p_buf->len) != BNEP_SUCCESS) {
|
||||
/*
|
||||
** If packet is filtered and ext headers are present
|
||||
** drop the data and forward the ext headers
|
||||
*/
|
||||
if (fw_ext_present) {
|
||||
UINT8 ext, length;
|
||||
UINT16 org_len, new_len;
|
||||
/* parse the extension headers and find out the new packet len */
|
||||
org_len = p_buf->len;
|
||||
new_len = 0;
|
||||
do {
|
||||
if ((UINT16)(org_len - new_len) < 2) {
|
||||
osi_free(p_buf);
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
ext = *p_data++;
|
||||
length = *p_data++;
|
||||
new_len += 2;
|
||||
if ((UINT16)(org_len - new_len) < length) {
|
||||
osi_free(p_buf);
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
p_data += length;
|
||||
new_len += length;
|
||||
|
||||
} while (ext & 0x80);
|
||||
|
||||
if (protocol != BNEP_802_1_P_PROTOCOL) {
|
||||
protocol = 0;
|
||||
} else {
|
||||
/* Need 4 bytes for 802.1Q tag + ethertype after extensions */
|
||||
if (new_len + 4 > org_len) {
|
||||
osi_free(p_buf);
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
new_len += 4;
|
||||
p_data[2] = 0;
|
||||
p_data[3] = 0;
|
||||
}
|
||||
p_buf->len = new_len;
|
||||
} else {
|
||||
osi_free(p_buf);
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
}
|
||||
|
||||
/* Callers must leave BNEP_MINIMUM_OFFSET headroom. In-place payload
|
||||
* shifting is unsafe with exact-sized heap buffers (no capacity field). */
|
||||
if (p_buf->offset < BNEP_MINIMUM_OFFSET) {
|
||||
BNEP_TRACE_ERROR("BNEP_WriteBuf() offset %d < minimum %d",
|
||||
p_buf->offset, BNEP_MINIMUM_OFFSET);
|
||||
osi_free(p_buf);
|
||||
return (BNEP_INVALID_OFFSET);
|
||||
}
|
||||
|
||||
/* Check transmit queue */
|
||||
if (fixed_queue_length(p_bcb->xmit_q) >= BNEP_MAX_XMITQ_DEPTH) {
|
||||
osi_free(p_buf);
|
||||
return (BNEP_Q_SIZE_EXCEEDED);
|
||||
}
|
||||
|
||||
/* Build the BNEP header */
|
||||
bnepu_build_bnep_hdr(p_bcb, p_buf, protocol, p_src_addr, p_dest_addr,
|
||||
fw_ext_present);
|
||||
|
||||
/* Send the data or queue it up */
|
||||
bnepu_check_send_packet(p_bcb, p_buf);
|
||||
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Write
|
||||
*
|
||||
* Description This function sends data over a BNEP connection
|
||||
*
|
||||
* Parameters: handle - handle of the connection to write
|
||||
* p_dest_addr - BD_ADDR/Ethernet addr of the destination
|
||||
* p_data - pointer to data start
|
||||
* protocol - protocol type of the packet
|
||||
* p_src_addr - (optional) BD_ADDR/ethernet address of the
|
||||
* source
|
||||
* (should be NULL if it is local BD Addr)
|
||||
* fw_ext_present - forwarded extensions present
|
||||
*
|
||||
* Returns: BNEP_WRONG_HANDLE - if passed handle is not valid
|
||||
* BNEP_WRONG_STATE - if connection is not active
|
||||
* BNEP_MTU_EXCEDED - If the data length is greater than
|
||||
* the MTU
|
||||
* BNEP_IGNORE_CMD - If the packet is filtered out
|
||||
* BNEP_Q_SIZE_EXCEEDED - If the Tx Q is full
|
||||
* BNEP_NO_RESOURCES - If not able to allocate a buffer
|
||||
* BNEP_SUCCESS - If written successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_Write(UINT16 handle, BD_ADDR p_dest_addr,
|
||||
UINT8 *p_data, UINT16 len, UINT16 protocol,
|
||||
BD_ADDR p_src_addr, BOOLEAN fw_ext_present)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
UINT8* p;
|
||||
/* Offset of 802.1Q ethertype to clear in the private copy; UINT16_MAX = none */
|
||||
UINT16 clear_etype_off = 0xFFFF;
|
||||
|
||||
/* Check MTU size. Consider the possibility of having extension headers */
|
||||
if (len > BNEP_MTU_SIZE) {
|
||||
BNEP_TRACE_ERROR("BNEP_Write() length %d exceeded MTU %d", len,
|
||||
BNEP_MTU_SIZE);
|
||||
return (BNEP_MTU_EXCEDED);
|
||||
}
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
/* Check the connection state */
|
||||
if ((p_bcb->con_state != BNEP_STATE_CONNECTED) &&
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED))) {
|
||||
return (BNEP_WRONG_STATE);
|
||||
}
|
||||
|
||||
/* Check if the packet should be filtered out */
|
||||
if (bnep_is_packet_allowed(p_bcb, p_dest_addr, protocol, fw_ext_present,
|
||||
p_data, len) != BNEP_SUCCESS) {
|
||||
/*
|
||||
** If packet is filtered and ext headers are present
|
||||
** drop the data and forward the ext headers
|
||||
*/
|
||||
if (fw_ext_present) {
|
||||
UINT8 ext, length;
|
||||
UINT16 org_len, new_len;
|
||||
/* parse the extension headers and find out the new packet len */
|
||||
org_len = len;
|
||||
new_len = 0;
|
||||
p = p_data;
|
||||
do {
|
||||
if ((UINT16)(org_len - new_len) < 2) {
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
ext = *p_data++;
|
||||
length = *p_data++;
|
||||
new_len += 2;
|
||||
if ((UINT16)(org_len - new_len) < length) {
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
p_data += length;
|
||||
new_len += length;
|
||||
|
||||
} while (ext & 0x80);
|
||||
|
||||
if (protocol != BNEP_802_1_P_PROTOCOL) {
|
||||
protocol = 0;
|
||||
} else {
|
||||
/* Need 4 bytes for 802.1Q tag + ethertype after extensions */
|
||||
if (new_len + 4 > org_len) {
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
/* Do not mutate the caller's buffer (may be shared across peers). */
|
||||
clear_etype_off = new_len + 2;
|
||||
new_len += 4;
|
||||
}
|
||||
len = new_len;
|
||||
p_data = p;
|
||||
} else {
|
||||
return BNEP_IGNORE_CMD;
|
||||
}
|
||||
}
|
||||
|
||||
/* Check transmit queue */
|
||||
if (fixed_queue_length(p_bcb->xmit_q) >= BNEP_MAX_XMITQ_DEPTH) {
|
||||
return (BNEP_Q_SIZE_EXCEEDED);
|
||||
}
|
||||
|
||||
/* Get a buffer to copy the data into */
|
||||
BT_HDR * p_buf = (BT_HDR *)osi_malloc(BNEP_BUF_SIZE);
|
||||
if (p_buf == NULL) {
|
||||
BNEP_TRACE_ERROR("%s: no buffer", __func__);
|
||||
return (BNEP_NO_RESOURCES);
|
||||
}
|
||||
|
||||
p_buf->len = len;
|
||||
p_buf->offset = BNEP_MINIMUM_OFFSET;
|
||||
p = (UINT8*)(p_buf + 1) + BNEP_MINIMUM_OFFSET;
|
||||
|
||||
memcpy(p, p_data, len);
|
||||
if (clear_etype_off != 0xFFFF) {
|
||||
p[clear_etype_off] = 0;
|
||||
p[clear_etype_off + 1] = 0;
|
||||
}
|
||||
|
||||
/* Build the BNEP header */
|
||||
bnepu_build_bnep_hdr(p_bcb, p_buf, protocol, p_src_addr, p_dest_addr,
|
||||
fw_ext_present);
|
||||
|
||||
/* Send the data or queue it up */
|
||||
bnepu_check_send_packet(p_bcb, p_buf);
|
||||
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_SetProtocolFilters
|
||||
*
|
||||
* Description This function sets the protocol filters on peer device
|
||||
*
|
||||
* Parameters: handle - Handle for the connection
|
||||
* num_filters - total number of filter ranges
|
||||
* p_start_array - Array of beginnings of all protocol ranges
|
||||
* p_end_array - Array of ends of all protocol ranges
|
||||
*
|
||||
* Returns BNEP_WRONG_HANDLE - if the connection handle is
|
||||
* not valid
|
||||
* BNEP_SET_FILTER_FAIL - if the connection is in wrong
|
||||
* state
|
||||
* BNEP_TOO_MANY_FILTERS - if too many filters
|
||||
* BNEP_SUCCESS - if request sent successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_SetProtocolFilters(UINT16 handle, UINT16 num_filters,
|
||||
UINT16 *p_start_array,
|
||||
UINT16 *p_end_array)
|
||||
{
|
||||
UINT16 xx;
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
/* Check the connection state */
|
||||
if ((p_bcb->con_state != BNEP_STATE_CONNECTED) &&
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED))) {
|
||||
return (BNEP_WRONG_STATE);
|
||||
}
|
||||
|
||||
/* Validate the parameters */
|
||||
if (num_filters && (!p_start_array || !p_end_array)) {
|
||||
return (BNEP_SET_FILTER_FAIL);
|
||||
}
|
||||
|
||||
if (num_filters > BNEP_MAX_PROT_FILTERS) {
|
||||
return (BNEP_TOO_MANY_FILTERS);
|
||||
}
|
||||
|
||||
/* Fill the filter values in connection block */
|
||||
for (xx = 0; xx < num_filters; xx++) {
|
||||
p_bcb->sent_prot_filter_start[xx] = *p_start_array++;
|
||||
p_bcb->sent_prot_filter_end[xx] = *p_end_array++;
|
||||
}
|
||||
|
||||
p_bcb->sent_num_filters = num_filters;
|
||||
|
||||
bnepu_send_peer_our_filters(p_bcb);
|
||||
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_SetMulticastFilters
|
||||
*
|
||||
* Description This function sets the filters for multicast addresses for
|
||||
* BNEP.
|
||||
*
|
||||
* Parameters: handle - Handle for the connection
|
||||
* num_filters - total number of filter ranges
|
||||
* p_start_array - Pointer to sequence of beginnings of all
|
||||
* multicast address ranges
|
||||
* p_end_array - Pointer to sequence of ends of all
|
||||
* multicast address ranges
|
||||
*
|
||||
* Returns BNEP_WRONG_HANDLE - if the connection handle is
|
||||
* not valid
|
||||
* BNEP_SET_FILTER_FAIL - if the connection is in wrong
|
||||
* state
|
||||
* BNEP_TOO_MANY_FILTERS - if too many filters
|
||||
* BNEP_SUCCESS - if request sent successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_SetMulticastFilters(UINT16 handle, UINT16 num_filters,
|
||||
UINT8 *p_start_array,
|
||||
UINT8 *p_end_array)
|
||||
{
|
||||
UINT16 xx;
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
/* Check the connection state */
|
||||
if ((p_bcb->con_state != BNEP_STATE_CONNECTED) &&
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED))) {
|
||||
return (BNEP_WRONG_STATE);
|
||||
}
|
||||
|
||||
/* Validate the parameters */
|
||||
if (num_filters && (!p_start_array || !p_end_array)) {
|
||||
return (BNEP_SET_FILTER_FAIL);
|
||||
}
|
||||
|
||||
if (num_filters > BNEP_MAX_MULTI_FILTERS) {
|
||||
return (BNEP_TOO_MANY_FILTERS);
|
||||
}
|
||||
|
||||
/* Fill the multicast filter values in connection block */
|
||||
for (xx = 0; xx < num_filters; xx++) {
|
||||
memcpy(p_bcb->sent_mcast_filter_start[xx], p_start_array,
|
||||
BD_ADDR_LEN);
|
||||
memcpy(p_bcb->sent_mcast_filter_end[xx], p_end_array, BD_ADDR_LEN);
|
||||
|
||||
p_start_array += BD_ADDR_LEN;
|
||||
p_end_array += BD_ADDR_LEN;
|
||||
}
|
||||
|
||||
p_bcb->sent_mcast_filters = num_filters;
|
||||
|
||||
bnepu_send_peer_our_multi_filters(p_bcb);
|
||||
|
||||
return (BNEP_SUCCESS);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_SetTraceLevel
|
||||
*
|
||||
* Description This function sets the trace level for BNEP. If called with
|
||||
* a value of 0xFF, it simply reads the current trace level.
|
||||
*
|
||||
* Returns the new (current) trace level
|
||||
*
|
||||
******************************************************************************/
|
||||
UINT8 BNEP_SetTraceLevel(UINT8 new_level)
|
||||
{
|
||||
if (new_level != 0xFF) {
|
||||
bnep_cb.trace_level = new_level;
|
||||
}
|
||||
|
||||
return (bnep_cb.trace_level);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_GetStatus
|
||||
*
|
||||
* Description This function gets the status information for BNEP
|
||||
* connection
|
||||
*
|
||||
* Returns BNEP_SUCCESS - if the status is available
|
||||
* BNEP_NO_RESOURCES - if no structure is passed for
|
||||
* output
|
||||
* BNEP_WRONG_HANDLE - if the handle is invalid
|
||||
* BNEP_WRONG_STATE - if not in connected state
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT BNEP_GetStatus(UINT16 handle, tBNEP_STATUS *p_status)
|
||||
{
|
||||
#if (BNEP_SUPPORTS_STATUS_API == TRUE)
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
if (!p_status) {
|
||||
return BNEP_NO_RESOURCES;
|
||||
}
|
||||
|
||||
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
|
||||
return (BNEP_WRONG_HANDLE);
|
||||
}
|
||||
|
||||
p_bcb = &(bnep_cb.bcb[handle - 1]);
|
||||
|
||||
memset(p_status, 0, sizeof(tBNEP_STATUS));
|
||||
if ((p_bcb->con_state != BNEP_STATE_CONNECTED) &&
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED))) {
|
||||
return BNEP_WRONG_STATE;
|
||||
}
|
||||
|
||||
/* Read the status parameters from the connection control block */
|
||||
p_status->con_status = BNEP_STATUS_CONNECTED;
|
||||
p_status->l2cap_cid = p_bcb->l2cap_cid;
|
||||
p_status->rem_mtu_size = p_bcb->rem_mtu_size;
|
||||
p_status->xmit_q_depth = fixed_queue_length(p_bcb->xmit_q);
|
||||
p_status->sent_num_filters = p_bcb->sent_num_filters;
|
||||
p_status->sent_mcast_filters = p_bcb->sent_mcast_filters;
|
||||
p_status->rcvd_num_filters = p_bcb->rcvd_num_filters;
|
||||
p_status->rcvd_mcast_filters = p_bcb->rcvd_mcast_filters;
|
||||
|
||||
bdcpy(p_status->rem_bda, p_bcb->rem_bda);
|
||||
memcpy(&(p_status->src_uuid), &(p_bcb->src_uuid), sizeof(tBT_UUID));
|
||||
memcpy(&(p_status->dst_uuid), &(p_bcb->dst_uuid), sizeof(tBT_UUID));
|
||||
|
||||
return BNEP_SUCCESS;
|
||||
#else
|
||||
return (BNEP_IGNORE_CMD);
|
||||
#endif
|
||||
}
|
||||
|
||||
#endif /* (BNEP_INCLUDED == TRUE) */
|
||||
@@ -0,0 +1,794 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* Copyright (C) 2001-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 the main BNEP functions
|
||||
*
|
||||
******************************************************************************/
|
||||
|
||||
#include "common/bt_target.h"
|
||||
|
||||
#if (BNEP_INCLUDED == TRUE)
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
#include "stack/bt_types.h"
|
||||
#include "stack/hcidefs.h"
|
||||
#include "stack/hcimsgs.h"
|
||||
|
||||
#include "stack/l2c_api.h"
|
||||
#include "stack/l2cdefs.h"
|
||||
|
||||
#include "device/controller.h"
|
||||
|
||||
#include "osi/allocator.h"
|
||||
#include "osi/fixed_queue.h"
|
||||
|
||||
#include "stack/btm_api.h"
|
||||
#include "stack/btu.h"
|
||||
|
||||
#include "stack/bnep_api.h"
|
||||
#include "bnep_int.h"
|
||||
|
||||
extern fixed_queue_t* btu_general_alarm_queue;
|
||||
|
||||
/******************************************************************************/
|
||||
/* G L O B A L B N E P D A T A */
|
||||
/******************************************************************************/
|
||||
tBNEP_CB bnep_cb;
|
||||
|
||||
const UINT16 bnep_frame_hdr_sizes[] = {14, 1, 2, 8, 8};
|
||||
|
||||
/******************************************************************************/
|
||||
/* L O C A L F U N C T I O N P R O T O T Y P E S */
|
||||
/******************************************************************************/
|
||||
static void bnep_connect_ind(BD_ADDR bd_addr, UINT16 l2cap_cid,
|
||||
UINT16 psm, UINT8 l2cap_id);
|
||||
static void bnep_connect_cfm(UINT16 l2cap_cid, UINT16 result);
|
||||
static void bnep_config_ind(UINT16 l2cap_cid, tL2CAP_CFG_INFO* p_cfg);
|
||||
static void bnep_config_cfm(UINT16 l2cap_cid, tL2CAP_CFG_INFO* p_cfg);
|
||||
static void bnep_disconnect_ind(UINT16 l2cap_cid, BOOLEAN ack_needed);
|
||||
static void bnep_disconnect_cfm(UINT16 l2cap_cid, UINT16 result);
|
||||
static void bnep_data_ind(UINT16 l2cap_cid, BT_HDR * p_msg);
|
||||
static void bnep_congestion_ind(UINT16 lcid, BOOLEAN is_congested);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_register_with_l2cap
|
||||
*
|
||||
* Description This function registers BNEP PSM with L2CAP
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
tBNEP_RESULT bnep_register_with_l2cap(void)
|
||||
{
|
||||
/* Initialize the L2CAP configuration. We only care about MTU and flush */
|
||||
memset(&bnep_cb.l2cap_my_cfg, 0, sizeof(tL2CAP_CFG_INFO));
|
||||
|
||||
bnep_cb.l2cap_my_cfg.mtu_present = TRUE;
|
||||
bnep_cb.l2cap_my_cfg.mtu = BNEP_MTU_SIZE;
|
||||
bnep_cb.l2cap_my_cfg.flush_to_present = TRUE;
|
||||
bnep_cb.l2cap_my_cfg.flush_to = BNEP_FLUSH_TO;
|
||||
|
||||
bnep_cb.reg_info.pL2CA_ConnectInd_Cb = bnep_connect_ind;
|
||||
bnep_cb.reg_info.pL2CA_ConnectCfm_Cb = bnep_connect_cfm;
|
||||
bnep_cb.reg_info.pL2CA_ConfigInd_Cb = bnep_config_ind;
|
||||
bnep_cb.reg_info.pL2CA_ConfigCfm_Cb = bnep_config_cfm;
|
||||
bnep_cb.reg_info.pL2CA_DisconnectInd_Cb = bnep_disconnect_ind;
|
||||
bnep_cb.reg_info.pL2CA_DisconnectCfm_Cb = bnep_disconnect_cfm;
|
||||
bnep_cb.reg_info.pL2CA_DataInd_Cb = bnep_data_ind;
|
||||
bnep_cb.reg_info.pL2CA_CongestionStatus_Cb = bnep_congestion_ind;
|
||||
|
||||
/* Now, register with L2CAP */
|
||||
if (!L2CA_Register(BT_PSM_BNEP, &bnep_cb.reg_info)) {
|
||||
BNEP_TRACE_ERROR("BNEP - Registration failed");
|
||||
return BNEP_SECURITY_FAIL;
|
||||
}
|
||||
|
||||
return BNEP_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_connect_ind
|
||||
*
|
||||
* Description This function handles an inbound connection indication
|
||||
* from L2CAP. This is the case where we are acting as a
|
||||
* server.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_connect_ind(BD_ADDR bd_addr, UINT16 l2cap_cid,
|
||||
UNUSED_ATTR UINT16 psm, UINT8 l2cap_id)
|
||||
{
|
||||
tBNEP_CONN * p_bcb = bnepu_find_bcb_by_bd_addr(bd_addr);
|
||||
|
||||
/* If we are not acting as server, or already have a connection, or have */
|
||||
/* no more resources to handle the connection, reject the connection. */
|
||||
if (!(bnep_cb.profile_registered) || (p_bcb) ||
|
||||
((p_bcb = bnepu_allocate_bcb(bd_addr)) == NULL)) {
|
||||
L2CA_ConnectRsp(bd_addr, l2cap_id, l2cap_cid, L2CAP_CONN_NO_PSM, 0);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Transition to the next appropriate state, waiting for config setup. */
|
||||
p_bcb->con_state = BNEP_STATE_CFG_SETUP;
|
||||
|
||||
/* Save the L2CAP Channel ID. */
|
||||
p_bcb->l2cap_cid = l2cap_cid;
|
||||
|
||||
/* Send response to the L2CAP layer. */
|
||||
L2CA_ConnectRsp(bd_addr, l2cap_id, l2cap_cid, L2CAP_CONN_OK, L2CAP_CONN_OK);
|
||||
|
||||
/* Send a Configuration Request. */
|
||||
L2CA_ConfigReq(l2cap_cid, &bnep_cb.l2cap_my_cfg);
|
||||
|
||||
/* Start timer waiting for config setup */
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_CONN_TIMEOUT_SEC);
|
||||
|
||||
BNEP_TRACE_EVENT("BNEP - Rcvd L2CAP conn ind, CID: 0x%x", p_bcb->l2cap_cid);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_connect_cfm
|
||||
*
|
||||
* Description This function handles the connect confirm events
|
||||
* from L2CAP. This is the case when we are acting as a
|
||||
* client and have sent a connect request.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_connect_cfm(UINT16 l2cap_cid, UINT16 result)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
/* Find CCB based on CID */
|
||||
p_bcb = bnepu_find_bcb_by_cid(l2cap_cid);
|
||||
if (p_bcb == NULL) {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd conn cnf for unknown CID 0x%x", l2cap_cid);
|
||||
return;
|
||||
}
|
||||
|
||||
/* If the connection response contains success status, then */
|
||||
/* Transition to the next state and startup the timer. */
|
||||
if ((result == L2CAP_CONN_OK) &&
|
||||
(p_bcb->con_state == BNEP_STATE_CONN_START)) {
|
||||
p_bcb->con_state = BNEP_STATE_CFG_SETUP;
|
||||
|
||||
/* Send a Configuration Request. */
|
||||
L2CA_ConfigReq(l2cap_cid, &bnep_cb.l2cap_my_cfg);
|
||||
|
||||
/* Start timer waiting for config results */
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_CONN_TIMEOUT_SEC);
|
||||
|
||||
BNEP_TRACE_EVENT("BNEP - got conn cnf, sent cfg req, CID: 0x%x",
|
||||
p_bcb->l2cap_cid);
|
||||
} else {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd conn cnf with error: 0x%x CID 0x%x",
|
||||
result, p_bcb->l2cap_cid);
|
||||
|
||||
/* Tell the upper layer, if he has a callback */
|
||||
if (bnep_cb.p_conn_state_cb && p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) {
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_FAILED, FALSE);
|
||||
}
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_config_ind
|
||||
*
|
||||
* Description This function processes the L2CAP configuration indication
|
||||
* event.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_config_ind(UINT16 l2cap_cid, tL2CAP_CFG_INFO *p_cfg)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
UINT16 result, mtu = 0;
|
||||
|
||||
/* Find CCB based on CID */
|
||||
p_bcb = bnepu_find_bcb_by_cid(l2cap_cid);
|
||||
if (p_bcb == NULL) {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd L2CAP cfg ind, unknown CID: 0x%x",
|
||||
l2cap_cid);
|
||||
return;
|
||||
}
|
||||
|
||||
BNEP_TRACE_EVENT("BNEP - Rcvd cfg ind, CID: 0x%x", l2cap_cid);
|
||||
|
||||
/* Remember the remote MTU size */
|
||||
if ((!p_cfg->mtu_present) || (p_cfg->mtu < BNEP_MIN_MTU_SIZE)) {
|
||||
mtu = p_cfg->mtu;
|
||||
p_cfg->flush_to_present = FALSE;
|
||||
p_cfg->mtu_present = TRUE;
|
||||
p_cfg->mtu = BNEP_MIN_MTU_SIZE;
|
||||
p_cfg->result = result = L2CAP_CFG_UNACCEPTABLE_PARAMS;
|
||||
} else {
|
||||
if (p_cfg->mtu > BNEP_MTU_SIZE) {
|
||||
p_bcb->rem_mtu_size = BNEP_MTU_SIZE;
|
||||
} else {
|
||||
p_bcb->rem_mtu_size = p_cfg->mtu;
|
||||
}
|
||||
|
||||
/* For now, always accept configuration from the other side */
|
||||
p_cfg->flush_to_present = FALSE;
|
||||
p_cfg->mtu_present = FALSE;
|
||||
p_cfg->result = result = L2CAP_CFG_OK;
|
||||
}
|
||||
|
||||
L2CA_ConfigRsp(l2cap_cid, p_cfg);
|
||||
|
||||
if (result != L2CAP_CFG_OK) {
|
||||
BNEP_TRACE_EVENT("BNEP - Rcvd cfg ind with bad MTU %d, CID: 0x%x", mtu,
|
||||
l2cap_cid);
|
||||
return;
|
||||
}
|
||||
|
||||
p_bcb->con_flags |= BNEP_FLAGS_HIS_CFG_DONE;
|
||||
|
||||
if (p_bcb->con_flags & BNEP_FLAGS_MY_CFG_DONE) {
|
||||
p_bcb->con_state = BNEP_STATE_SEC_CHECKING;
|
||||
|
||||
/* Start timer waiting for setup or response */
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_HOST_TIMEOUT_SEC);
|
||||
|
||||
if (p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) {
|
||||
btm_sec_mx_access_request(
|
||||
p_bcb->rem_bda, BT_PSM_BNEP, TRUE, BTM_SEC_PROTO_BNEP,
|
||||
bnep_get_uuid32(&(p_bcb->src_uuid)), &bnep_sec_check_complete, p_bcb);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_config_cfm
|
||||
*
|
||||
* Description This function processes the L2CAP configuration confirmation
|
||||
* event.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_config_cfm(UINT16 l2cap_cid, tL2CAP_CFG_INFO *p_cfg)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
BNEP_TRACE_EVENT("BNEP - Rcvd cfg cfm, CID: 0x%x Result: %d", l2cap_cid,
|
||||
p_cfg->result);
|
||||
|
||||
/* Find CCB based on CID */
|
||||
p_bcb = bnepu_find_bcb_by_cid(l2cap_cid);
|
||||
if (p_bcb == NULL) {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd L2CAP cfg ind, unknown CID: 0x%x",
|
||||
l2cap_cid);
|
||||
return;
|
||||
}
|
||||
|
||||
/* For now, always accept configuration from the other side */
|
||||
if (p_cfg->result == L2CAP_CFG_OK) {
|
||||
p_bcb->con_flags |= BNEP_FLAGS_MY_CFG_DONE;
|
||||
|
||||
if (p_bcb->con_flags & BNEP_FLAGS_HIS_CFG_DONE) {
|
||||
p_bcb->con_state = BNEP_STATE_SEC_CHECKING;
|
||||
|
||||
/* Start timer waiting for setup or response */
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_HOST_TIMEOUT_SEC);
|
||||
|
||||
if (p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) {
|
||||
btm_sec_mx_access_request(p_bcb->rem_bda, BT_PSM_BNEP, TRUE,
|
||||
BTM_SEC_PROTO_BNEP,
|
||||
bnep_get_uuid32(&(p_bcb->src_uuid)),
|
||||
&bnep_sec_check_complete, p_bcb);
|
||||
}
|
||||
}
|
||||
} else {
|
||||
/* Tell the upper layer, if he has a callback */
|
||||
if ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) && (bnep_cb.p_conn_state_cb)) {
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_FAILED_CFG, FALSE);
|
||||
}
|
||||
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_disconnect_ind
|
||||
*
|
||||
* Description This function handles a disconnect event from L2CAP. If
|
||||
* requested to, we ack the disconnect before dropping the CCB
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_disconnect_ind(UINT16 l2cap_cid, BOOLEAN ack_needed)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
if (ack_needed) {
|
||||
L2CA_DisconnectRsp(l2cap_cid);
|
||||
}
|
||||
|
||||
/* Find CCB based on CID */
|
||||
p_bcb = bnepu_find_bcb_by_cid(l2cap_cid);
|
||||
if (p_bcb == NULL) {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd L2CAP disc, unknown CID: 0x%x", l2cap_cid);
|
||||
return;
|
||||
}
|
||||
|
||||
BNEP_TRACE_EVENT("BNEP - Rcvd L2CAP disc, CID: 0x%x", l2cap_cid);
|
||||
|
||||
/* Tell the user if he has a callback */
|
||||
if (p_bcb->con_state == BNEP_STATE_CONNECTED) {
|
||||
if (bnep_cb.p_conn_state_cb)
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_DISCONNECTED, FALSE);
|
||||
} else {
|
||||
if ((bnep_cb.p_conn_state_cb) &&
|
||||
((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) ||
|
||||
(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED)))
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_FAILED, FALSE);
|
||||
}
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_disconnect_cfm
|
||||
*
|
||||
* Description This function gets the disconnect confirm event from L2CAP
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_disconnect_cfm(UINT16 l2cap_cid, UINT16 result)
|
||||
{
|
||||
BNEP_TRACE_EVENT("BNEP - Rcvd L2CAP disc cfm, CID: 0x%x, Result 0x%x",
|
||||
l2cap_cid, result);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_congestion_ind
|
||||
*
|
||||
* Description This is a callback function called by L2CAP when
|
||||
* congestion status changes
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_congestion_ind(UINT16 l2cap_cid, BOOLEAN is_congested)
|
||||
{
|
||||
tBNEP_CONN * p_bcb;
|
||||
|
||||
/* Find BCB based on CID */
|
||||
p_bcb = bnepu_find_bcb_by_cid(l2cap_cid);
|
||||
if (p_bcb == NULL) {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd L2CAP cong, unknown CID: 0x%x", l2cap_cid);
|
||||
return;
|
||||
}
|
||||
|
||||
if (is_congested) {
|
||||
p_bcb->con_flags |= BNEP_FLAGS_L2CAP_CONGESTED;
|
||||
if (bnep_cb.p_tx_data_flow_cb) {
|
||||
bnep_cb.p_tx_data_flow_cb(p_bcb->handle, BNEP_TX_FLOW_OFF);
|
||||
}
|
||||
} else {
|
||||
p_bcb->con_flags &= ~BNEP_FLAGS_L2CAP_CONGESTED;
|
||||
|
||||
if (bnep_cb.p_tx_data_flow_cb) {
|
||||
bnep_cb.p_tx_data_flow_cb(p_bcb->handle, BNEP_TX_FLOW_ON);
|
||||
}
|
||||
|
||||
/* While not congested, send as many buffers as we can */
|
||||
while (!(p_bcb->con_flags & BNEP_FLAGS_L2CAP_CONGESTED)) {
|
||||
BT_HDR * p_buf = (BT_HDR *)fixed_queue_dequeue(p_bcb->xmit_q, 0);
|
||||
|
||||
if (!p_buf) {
|
||||
break;
|
||||
}
|
||||
|
||||
L2CA_DataWrite(l2cap_cid, p_buf);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_data_ind
|
||||
*
|
||||
* Description This function is called when data is received from L2CAP.
|
||||
* if we are the originator of the connection, we are the SDP
|
||||
* client, and the received message is queued for the client.
|
||||
*
|
||||
* If we are the destination of the connection, we are the SDP
|
||||
* server, so the message is passed to the server processing
|
||||
* function.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
static void bnep_data_ind(UINT16 l2cap_cid, BT_HDR *p_buf)
|
||||
{
|
||||
tBNEP_CONN *p_bcb;
|
||||
UINT8 *p = (UINT8 *)(p_buf + 1) + p_buf->offset;
|
||||
UINT16 rem_len = p_buf->len;
|
||||
UINT8 type, ctrl_type, ext_type = 0;
|
||||
BOOLEAN extension_present, fw_ext_present;
|
||||
UINT16 protocol = 0;
|
||||
|
||||
/* Find CCB based on CID */
|
||||
p_bcb = bnepu_find_bcb_by_cid(l2cap_cid);
|
||||
if (p_bcb == NULL) {
|
||||
BNEP_TRACE_WARNING("BNEP - Rcvd L2CAP data, unknown CID: 0x%x", l2cap_cid);
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check rem_len before any reading from the buffer */
|
||||
if (rem_len == 0) {
|
||||
BNEP_TRACE_EVENT("BNEP - rcvd frame, bad len: %d", p_buf->len);
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Get the type and extension bits */
|
||||
type = *p++;
|
||||
extension_present = type >> 7;
|
||||
type &= 0x7f;
|
||||
if (type > BNEP_FRAME_COMPRESSED_ETHERNET_DEST_ONLY ||
|
||||
(rem_len <= bnep_frame_hdr_sizes[type]) || (rem_len > BNEP_MTU_SIZE)) {
|
||||
BNEP_TRACE_EVENT("BNEP - rcvd frame, bad len: %d type: 0x%02x", p_buf->len,
|
||||
type);
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
rem_len--;
|
||||
|
||||
if ((p_bcb->con_state != BNEP_STATE_CONNECTED) &&
|
||||
(!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED)) &&
|
||||
(type != BNEP_FRAME_CONTROL)) {
|
||||
BNEP_TRACE_WARNING(
|
||||
"BNEP - Ignored L2CAP data while in state: %d, CID: 0x%x",
|
||||
p_bcb->con_state, l2cap_cid);
|
||||
|
||||
if (extension_present) {
|
||||
/*
|
||||
** When there is no connection if a data packet is received
|
||||
** with unknown control extension headers then those should be processed
|
||||
** according to complain/ignore law.
|
||||
** Extensions follow the type-specific networking header (e.g. 14-byte
|
||||
** Ethernet header for GENERAL_ETHERNET), not the BNEP type byte.
|
||||
*/
|
||||
UINT8 ext, length;
|
||||
UINT16 org_len, new_len;
|
||||
UINT16 hdr_len = bnep_frame_hdr_sizes[type];
|
||||
|
||||
if (rem_len < hdr_len) {
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
p += hdr_len;
|
||||
org_len = rem_len - hdr_len;
|
||||
do {
|
||||
if (org_len < 2) {
|
||||
break;
|
||||
}
|
||||
ext = *p++;
|
||||
length = *p++;
|
||||
|
||||
new_len = (length + 2);
|
||||
if (new_len > org_len) {
|
||||
break;
|
||||
}
|
||||
|
||||
if ((ext & 0x7F) == BNEP_EXTENSION_FILTER_CONTROL) {
|
||||
if (length == 0) {
|
||||
break;
|
||||
}
|
||||
if (*p > BNEP_FILTER_MULTI_ADDR_RESPONSE_MSG) {
|
||||
bnep_send_command_not_understood(p_bcb, *p);
|
||||
}
|
||||
}
|
||||
|
||||
p += length;
|
||||
org_len -= new_len;
|
||||
|
||||
} while (ext & 0x80);
|
||||
}
|
||||
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
BNEP_TRACE_DEBUG("BNEP - rcv frame, type: %d len: %d Ext: %d", type,
|
||||
p_buf->len, extension_present);
|
||||
|
||||
/* Initialize addresses to 'not supplied' */
|
||||
UINT8 *p_src_addr, *p_dst_addr;
|
||||
p_src_addr = p_dst_addr = NULL;
|
||||
|
||||
switch (type) {
|
||||
case BNEP_FRAME_GENERAL_ETHERNET:
|
||||
p_dst_addr = p;
|
||||
p += BD_ADDR_LEN;
|
||||
p_src_addr = p;
|
||||
p += BD_ADDR_LEN;
|
||||
BE_STREAM_TO_UINT16(protocol, p);
|
||||
rem_len -= 14;
|
||||
break;
|
||||
|
||||
case BNEP_FRAME_CONTROL:
|
||||
ctrl_type = *p;
|
||||
p = bnep_process_control_packet(p_bcb, p, &rem_len, FALSE);
|
||||
|
||||
/* Failed setup response releases the BCB; do not parse extensions. */
|
||||
if (p_bcb->con_state == BNEP_STATE_IDLE) {
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
if (ctrl_type == BNEP_SETUP_CONNECTION_REQUEST_MSG &&
|
||||
p_bcb->con_state != BNEP_STATE_CONNECTED && extension_present && p &&
|
||||
rem_len) {
|
||||
/* Allocate BT_HDR header plus payload; data is stored after the header. */
|
||||
if (p_bcb->p_pending_data) {
|
||||
osi_free(p_bcb->p_pending_data);
|
||||
p_bcb->p_pending_data = NULL;
|
||||
}
|
||||
p_bcb->p_pending_data = (BT_HDR *)osi_malloc(sizeof(BT_HDR) + rem_len);
|
||||
if (p_bcb->p_pending_data) {
|
||||
memcpy((UINT8 *)(p_bcb->p_pending_data + 1), p, rem_len);
|
||||
p_bcb->p_pending_data->len = rem_len;
|
||||
p_bcb->p_pending_data->offset = 0;
|
||||
}
|
||||
} else {
|
||||
while (extension_present && p && rem_len) {
|
||||
ext_type = *p++;
|
||||
rem_len--;
|
||||
extension_present = ext_type >> 7;
|
||||
ext_type &= 0x7F;
|
||||
|
||||
/* if unknown extension present stop processing */
|
||||
if (ext_type) {
|
||||
break;
|
||||
}
|
||||
|
||||
p = bnep_process_control_packet(p_bcb, p, &rem_len, TRUE);
|
||||
if (p_bcb->con_state == BNEP_STATE_IDLE) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
|
||||
case BNEP_FRAME_COMPRESSED_ETHERNET:
|
||||
BE_STREAM_TO_UINT16(protocol, p);
|
||||
rem_len -= 2;
|
||||
break;
|
||||
|
||||
case BNEP_FRAME_COMPRESSED_ETHERNET_SRC_ONLY:
|
||||
p_src_addr = p;
|
||||
p += BD_ADDR_LEN;
|
||||
BE_STREAM_TO_UINT16(protocol, p);
|
||||
rem_len -= 8;
|
||||
break;
|
||||
|
||||
case BNEP_FRAME_COMPRESSED_ETHERNET_DEST_ONLY:
|
||||
p_dst_addr = p;
|
||||
p += BD_ADDR_LEN;
|
||||
BE_STREAM_TO_UINT16(protocol, p);
|
||||
rem_len -= 8;
|
||||
break;
|
||||
}
|
||||
|
||||
/* Process the header extension if there is one */
|
||||
while (extension_present && p && rem_len) {
|
||||
ext_type = *p;
|
||||
extension_present = ext_type >> 7;
|
||||
ext_type &= 0x7F;
|
||||
|
||||
/* if unknown extension present stop processing */
|
||||
if (ext_type) {
|
||||
BNEP_TRACE_EVENT("Data extension type 0x%x found", ext_type);
|
||||
break;
|
||||
}
|
||||
|
||||
p++;
|
||||
rem_len--;
|
||||
p = bnep_process_control_packet(p_bcb, p, &rem_len, TRUE);
|
||||
if (p_bcb->con_state == BNEP_STATE_IDLE) {
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
p_buf->offset += p_buf->len - rem_len;
|
||||
p_buf->len = rem_len;
|
||||
|
||||
/* Always give the upper layer MAC addresses */
|
||||
if (!p_src_addr) {
|
||||
p_src_addr = (UINT8 *)p_bcb->rem_bda;
|
||||
}
|
||||
|
||||
if (!p_dst_addr) {
|
||||
p_dst_addr = (UINT8 *)controller_get_interface()->get_address();
|
||||
}
|
||||
|
||||
/* check whether there are any extensions to be forwarded */
|
||||
if (ext_type) {
|
||||
fw_ext_present = TRUE;
|
||||
} else {
|
||||
fw_ext_present = FALSE;
|
||||
}
|
||||
|
||||
if (bnep_cb.p_data_buf_cb) {
|
||||
(*bnep_cb.p_data_buf_cb)(p_bcb->handle, p_src_addr, p_dst_addr, protocol,
|
||||
p_buf, fw_ext_present);
|
||||
} else if (bnep_cb.p_data_ind_cb) {
|
||||
(*bnep_cb.p_data_ind_cb)(p_bcb->handle, p_src_addr, p_dst_addr, protocol,
|
||||
p, rem_len, fw_ext_present);
|
||||
osi_free(p_buf);
|
||||
} else {
|
||||
osi_free(p_buf);
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_conn_timer_timeout
|
||||
*
|
||||
* Description This function processes a timeout. If it is a startup
|
||||
* timeout, we check for reading our BD address. If it
|
||||
* is an L2CAP timeout, we send a disconnect req to L2CAP.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
void bnep_conn_timer_timeout(void *data)
|
||||
{
|
||||
tBNEP_CONN * p_bcb = (tBNEP_CONN *)data;
|
||||
|
||||
BNEP_TRACE_EVENT(
|
||||
"BNEP - CCB timeout in state: %d CID: 0x%x flags %x, re_transmit %d",
|
||||
p_bcb->con_state, p_bcb->l2cap_cid, p_bcb->con_flags,
|
||||
p_bcb->re_transmits);
|
||||
|
||||
if (p_bcb->con_state == BNEP_STATE_CONN_SETUP) {
|
||||
BNEP_TRACE_EVENT("BNEP - CCB timeout in state: %d CID: 0x%x",
|
||||
p_bcb->con_state, p_bcb->l2cap_cid);
|
||||
|
||||
if (!(p_bcb->con_flags & BNEP_FLAGS_IS_ORIG)) {
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
return;
|
||||
}
|
||||
|
||||
if (p_bcb->re_transmits++ != BNEP_MAX_RETRANSMITS) {
|
||||
bnep_send_conn_req(p_bcb);
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_CONN_TIMEOUT_SEC);
|
||||
} else {
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
if ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) && (bnep_cb.p_conn_state_cb))
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_FAILED, FALSE);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
return;
|
||||
}
|
||||
} else if (p_bcb->con_state != BNEP_STATE_CONNECTED) {
|
||||
BNEP_TRACE_EVENT("BNEP - CCB timeout in state: %d CID: 0x%x",
|
||||
p_bcb->con_state, p_bcb->l2cap_cid);
|
||||
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
/* Tell the user if he has a callback */
|
||||
if ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) && (bnep_cb.p_conn_state_cb))
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_CONN_FAILED, FALSE);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
} else if (p_bcb->con_flags & BNEP_FLAGS_FILTER_RESP_PEND) {
|
||||
if (p_bcb->re_transmits++ != BNEP_MAX_RETRANSMITS) {
|
||||
bnepu_send_peer_our_filters(p_bcb);
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_FILTER_SET_TIMEOUT_SEC);
|
||||
} else {
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
/* Tell the user if he has a callback */
|
||||
if (bnep_cb.p_conn_state_cb)
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_SET_FILTER_FAIL, FALSE);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
return;
|
||||
}
|
||||
} else if (p_bcb->con_flags & BNEP_FLAGS_MULTI_RESP_PEND) {
|
||||
if (p_bcb->re_transmits++ != BNEP_MAX_RETRANSMITS) {
|
||||
bnepu_send_peer_our_multi_filters(p_bcb);
|
||||
btu_start_timer(&p_bcb->conn_timer, BTU_TTYPE_BNEP, BNEP_FILTER_SET_TIMEOUT_SEC);
|
||||
} else {
|
||||
L2CA_DisconnectReq(p_bcb->l2cap_cid);
|
||||
|
||||
/* Tell the user if he has a callback */
|
||||
if (bnep_cb.p_conn_state_cb)
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda,
|
||||
BNEP_SET_FILTER_FAIL, FALSE);
|
||||
|
||||
bnepu_release_bcb(p_bcb);
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function bnep_connected
|
||||
*
|
||||
* Description This function is called when a connection is established
|
||||
* (after config).
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
void bnep_connected(tBNEP_CONN *p_bcb)
|
||||
{
|
||||
BOOLEAN is_role_change;
|
||||
|
||||
if (p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED) {
|
||||
is_role_change = TRUE;
|
||||
} else {
|
||||
is_role_change = FALSE;
|
||||
}
|
||||
|
||||
p_bcb->con_state = BNEP_STATE_CONNECTED;
|
||||
p_bcb->con_flags |= BNEP_FLAGS_CONN_COMPLETED;
|
||||
p_bcb->con_flags &= (~BNEP_FLAGS_SETUP_RCVD);
|
||||
|
||||
/* Ensure timer is stopped */
|
||||
btu_stop_timer(&p_bcb->conn_timer);
|
||||
p_bcb->re_transmits = 0;
|
||||
|
||||
/* Tell the upper layer, if he has a callback */
|
||||
if (bnep_cb.p_conn_state_cb)
|
||||
(*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda, BNEP_SUCCESS,
|
||||
is_role_change);
|
||||
}
|
||||
|
||||
#endif /* (BNEP_INCLUDED == TRUE) */
|
||||
File diff suppressed because it is too large
Load Diff
@@ -0,0 +1,241 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* Copyright (C) 2001-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 internally used BNEP definitions
|
||||
*
|
||||
******************************************************************************/
|
||||
|
||||
#ifndef BNEP_INT_H
|
||||
#define BNEP_INT_H
|
||||
|
||||
#include "common/bt_target.h"
|
||||
|
||||
#if (BNEP_INCLUDED == TRUE)
|
||||
|
||||
#include "stack/bnep_api.h"
|
||||
#include "btm_int.h"
|
||||
#include "stack/btu.h"
|
||||
|
||||
/* BNEP frame types
|
||||
*/
|
||||
#define BNEP_FRAME_GENERAL_ETHERNET 0x00
|
||||
#define BNEP_FRAME_CONTROL 0x01
|
||||
#define BNEP_FRAME_COMPRESSED_ETHERNET 0x02
|
||||
#define BNEP_FRAME_COMPRESSED_ETHERNET_SRC_ONLY 0x03
|
||||
#define BNEP_FRAME_COMPRESSED_ETHERNET_DEST_ONLY 0x04
|
||||
|
||||
/* BNEP filter control message types
|
||||
*/
|
||||
#define BNEP_CONTROL_COMMAND_NOT_UNDERSTOOD 0x00
|
||||
#define BNEP_SETUP_CONNECTION_REQUEST_MSG 0x01
|
||||
#define BNEP_SETUP_CONNECTION_RESPONSE_MSG 0x02
|
||||
#define BNEP_FILTER_NET_TYPE_SET_MSG 0x03
|
||||
#define BNEP_FILTER_NET_TYPE_RESPONSE_MSG 0x04
|
||||
#define BNEP_FILTER_MULTI_ADDR_SET_MSG 0x05
|
||||
#define BNEP_FILTER_MULTI_ADDR_RESPONSE_MSG 0x06
|
||||
|
||||
/* BNEP header extension types
|
||||
*/
|
||||
#define BNEP_EXTENSION_FILTER_CONTROL 0x00
|
||||
|
||||
/* BNEP Setup Connection response codes
|
||||
*/
|
||||
#define BNEP_SETUP_CONN_OK 0x0000
|
||||
#define BNEP_SETUP_INVALID_DEST_UUID 0x0001
|
||||
#define BNEP_SETUP_INVALID_SRC_UUID 0x0002
|
||||
#define BNEP_SETUP_INVALID_UUID_SIZE 0x0003
|
||||
#define BNEP_SETUP_CONN_NOT_ALLOWED 0x0004
|
||||
|
||||
/* BNEP filter control response codes
|
||||
*/
|
||||
#define BNEP_FILTER_CRL_OK 0x0000
|
||||
#define BNEP_FILTER_CRL_UNSUPPORTED 0x0001
|
||||
#define BNEP_FILTER_CRL_BAD_RANGE 0x0002
|
||||
#define BNEP_FILTER_CRL_MAX_REACHED 0x0003
|
||||
#define BNEP_FILTER_CRL_SECURITY_ERR 0x0004
|
||||
|
||||
/* 802.1p protocol packet will have actual protocol field in side the payload */
|
||||
#define BNEP_802_1_P_PROTOCOL 0x8100
|
||||
|
||||
/* Timeout definitions in seconds (btu_start_timer expects seconds). */
|
||||
/* Connection related timeout */
|
||||
#define BNEP_CONN_TIMEOUT_SEC 20
|
||||
/* host response timeout */
|
||||
#define BNEP_HOST_TIMEOUT_SEC 200
|
||||
#define BNEP_FILTER_SET_TIMEOUT_SEC 10
|
||||
|
||||
/* Define the Out-Flow default values. */
|
||||
#define BNEP_OFLOW_QOS_FLAG 0
|
||||
#define BNEP_OFLOW_SERV_TYPE 0
|
||||
#define BNEP_OFLOW_TOKEN_RATE 0
|
||||
#define BNEP_OFLOW_TOKEN_BUCKET_SIZE 0
|
||||
#define BNEP_OFLOW_PEAK_BANDWIDTH 0
|
||||
#define BNEP_OFLOW_LATENCY 0
|
||||
#define BNEP_OFLOW_DELAY_VARIATION 0
|
||||
|
||||
/* Define the In-Flow default values. */
|
||||
#define BNEP_IFLOW_QOS_FLAG 0
|
||||
#define BNEP_IFLOW_SERV_TYPE 0
|
||||
#define BNEP_IFLOW_TOKEN_RATE 0
|
||||
#define BNEP_IFLOW_TOKEN_BUCKET_SIZE 0
|
||||
#define BNEP_IFLOW_PEAK_BANDWIDTH 0
|
||||
#define BNEP_IFLOW_LATENCY 0
|
||||
#define BNEP_IFLOW_DELAY_VARIATION 0
|
||||
|
||||
#define BNEP_FLUSH_TO 0xFFFF
|
||||
|
||||
#define BNEP_MAX_RETRANSMITS 3
|
||||
|
||||
/* Define the BNEP Connection Control Block
|
||||
*/
|
||||
typedef struct {
|
||||
#define BNEP_STATE_IDLE 0
|
||||
#define BNEP_STATE_CONN_START 1
|
||||
#define BNEP_STATE_CFG_SETUP 2
|
||||
#define BNEP_STATE_CONN_SETUP 3
|
||||
#define BNEP_STATE_SEC_CHECKING 4
|
||||
#define BNEP_STATE_SETUP_RCVD 5
|
||||
#define BNEP_STATE_CONNECTED 6
|
||||
UINT8 con_state;
|
||||
|
||||
#define BNEP_FLAGS_IS_ORIG 0x01
|
||||
#define BNEP_FLAGS_HIS_CFG_DONE 0x02
|
||||
#define BNEP_FLAGS_MY_CFG_DONE 0x04
|
||||
#define BNEP_FLAGS_L2CAP_CONGESTED 0x08
|
||||
#define BNEP_FLAGS_FILTER_RESP_PEND 0x10
|
||||
#define BNEP_FLAGS_MULTI_RESP_PEND 0x20
|
||||
#define BNEP_FLAGS_SETUP_RCVD 0x40
|
||||
#define BNEP_FLAGS_CONN_COMPLETED 0x80
|
||||
UINT8 con_flags;
|
||||
BT_HDR *p_pending_data;
|
||||
|
||||
UINT16 l2cap_cid;
|
||||
BD_ADDR rem_bda;
|
||||
UINT16 rem_mtu_size;
|
||||
TIMER_LIST_ENT conn_timer;
|
||||
fixed_queue_t *xmit_q;
|
||||
|
||||
UINT16 sent_num_filters;
|
||||
UINT16 sent_prot_filter_start[BNEP_MAX_PROT_FILTERS];
|
||||
UINT16 sent_prot_filter_end[BNEP_MAX_PROT_FILTERS];
|
||||
|
||||
UINT16 sent_mcast_filters;
|
||||
BD_ADDR sent_mcast_filter_start[BNEP_MAX_MULTI_FILTERS];
|
||||
BD_ADDR sent_mcast_filter_end[BNEP_MAX_MULTI_FILTERS];
|
||||
|
||||
UINT16 rcvd_num_filters;
|
||||
UINT16 rcvd_prot_filter_start[BNEP_MAX_PROT_FILTERS];
|
||||
UINT16 rcvd_prot_filter_end[BNEP_MAX_PROT_FILTERS];
|
||||
|
||||
UINT16 rcvd_mcast_filters;
|
||||
BD_ADDR rcvd_mcast_filter_start[BNEP_MAX_MULTI_FILTERS];
|
||||
BD_ADDR rcvd_mcast_filter_end[BNEP_MAX_MULTI_FILTERS];
|
||||
|
||||
UINT16 bad_pkts_rcvd;
|
||||
UINT8 re_transmits;
|
||||
UINT16 handle;
|
||||
UINT32 sec_gen; /* invalidated on release; detects stale BTM callbacks */
|
||||
tBT_UUID prv_src_uuid;
|
||||
tBT_UUID prv_dst_uuid;
|
||||
tBT_UUID src_uuid;
|
||||
tBT_UUID dst_uuid;
|
||||
|
||||
} tBNEP_CONN;
|
||||
|
||||
/* The main BNEP control block
|
||||
*/
|
||||
typedef struct {
|
||||
tL2CAP_CFG_INFO l2cap_my_cfg; /* My L2CAP config */
|
||||
tBNEP_CONN bcb[BNEP_MAX_CONNECTIONS];
|
||||
|
||||
tBNEP_CONNECT_IND_CB *p_conn_ind_cb;
|
||||
tBNEP_CONN_STATE_CB *p_conn_state_cb;
|
||||
tBNEP_DATA_IND_CB *p_data_ind_cb;
|
||||
tBNEP_DATA_BUF_CB *p_data_buf_cb;
|
||||
tBNEP_FILTER_IND_CB *p_filter_ind_cb;
|
||||
tBNEP_MFILTER_IND_CB *p_mfilter_ind_cb;
|
||||
tBNEP_TX_DATA_FLOW_CB *p_tx_data_flow_cb;
|
||||
|
||||
tL2CAP_APPL_INFO reg_info;
|
||||
|
||||
BOOLEAN profile_registered; /* TRUE when we got our BD addr */
|
||||
UINT8 trace_level;
|
||||
|
||||
} tBNEP_CB;
|
||||
|
||||
/* Global BNEP data
|
||||
*/
|
||||
extern tBNEP_CB bnep_cb;
|
||||
|
||||
/* Functions provided by bnep_main.c
|
||||
*/
|
||||
extern tBNEP_RESULT bnep_register_with_l2cap(void);
|
||||
extern void bnep_disconnect(tBNEP_CONN *p_bcb, UINT16 reason);
|
||||
extern tBNEP_CONN *bnep_conn_originate(UINT8 *p_bd_addr);
|
||||
extern void bnep_conn_timer_timeout(void *data);
|
||||
extern void bnep_connected(tBNEP_CONN *p_bcb);
|
||||
|
||||
/* Functions provided by bnep_utils.c
|
||||
*/
|
||||
extern tBNEP_CONN *bnepu_find_bcb_by_cid(UINT16 cid);
|
||||
extern tBNEP_CONN *bnepu_find_bcb_by_bd_addr(BD_ADDR p_bda);
|
||||
extern tBNEP_CONN *bnepu_allocate_bcb(BD_ADDR p_rem_bda);
|
||||
extern void bnepu_release_bcb(tBNEP_CONN *p_bcb);
|
||||
extern void bnepu_send_peer_our_filters(tBNEP_CONN *p_bcb);
|
||||
extern void bnepu_send_peer_our_multi_filters(tBNEP_CONN *p_bcb);
|
||||
extern BOOLEAN bnepu_does_dest_support_prot(tBNEP_CONN *p_bcb, UINT16 protocol);
|
||||
extern void bnepu_build_bnep_hdr(tBNEP_CONN *p_bcb, BT_HDR *p_buf,
|
||||
UINT16 protocol,
|
||||
BD_ADDR p_src_addr,
|
||||
BD_ADDR p_dest_addr, BOOLEAN ext_bit);
|
||||
extern void test_bnepu_build_bnep_hdr(tBNEP_CONN *p_bcb, BT_HDR *p_buf,
|
||||
UINT16 protocol, UINT8 *p_src_addr,
|
||||
UINT8 *p_dest_addr, UINT8 type);
|
||||
|
||||
extern tBNEP_CONN *bnepu_get_route_to_dest(UINT8 *p_bda);
|
||||
extern void bnepu_check_send_packet(tBNEP_CONN *p_bcb, BT_HDR *p_buf);
|
||||
extern void bnep_send_command_not_understood(tBNEP_CONN *p_bcb,
|
||||
UINT8 cmd_code);
|
||||
extern void bnepu_process_peer_filter_set(tBNEP_CONN *p_bcb, UINT8 *p_filters,
|
||||
UINT16 len);
|
||||
extern void bnepu_process_peer_filter_rsp(tBNEP_CONN *p_bcb, UINT8 *p_data);
|
||||
extern void bnepu_process_multicast_filter_rsp(tBNEP_CONN *p_bcb,
|
||||
UINT8 *p_data);
|
||||
extern void bnep_send_conn_req(tBNEP_CONN *p_bcb);
|
||||
extern void bnep_send_conn_responce(tBNEP_CONN *p_bcb, UINT16 resp_code);
|
||||
extern void bnep_process_setup_conn_req(tBNEP_CONN *p_bcb, UINT8 *p_setup,
|
||||
UINT8 len);
|
||||
extern void bnep_process_setup_conn_responce(tBNEP_CONN *p_bcb,
|
||||
UINT8 *p_setup);
|
||||
extern UINT8 *bnep_process_control_packet(tBNEP_CONN *p_bcb, UINT8 *p,
|
||||
UINT16 *len, BOOLEAN is_ext);
|
||||
extern void bnep_sec_check_complete(BD_ADDR bd_addr,
|
||||
tBT_TRANSPORT transport, void *p_ref_data,
|
||||
UINT8 result);
|
||||
extern tBNEP_RESULT bnep_is_packet_allowed(tBNEP_CONN *p_bcb,
|
||||
BD_ADDR p_dest_addr,
|
||||
UINT16 protocol,
|
||||
BOOLEAN fw_ext_present,
|
||||
UINT8 *p_data, UINT16 data_len);
|
||||
extern UINT32 bnep_get_uuid32(tBT_UUID *src_uuid);
|
||||
|
||||
#endif /* (BNEP_INCLUDED == TRUE) */
|
||||
|
||||
#endif
|
||||
@@ -538,7 +538,7 @@ static void btu_general_alarm_process(void *param)
|
||||
#endif
|
||||
#if ((defined(BNEP_INCLUDED) && BNEP_INCLUDED == TRUE))
|
||||
case BTU_TTYPE_BNEP:
|
||||
bnep_process_timeout(p_tle);
|
||||
bnep_conn_timer_timeout((void *)p_tle->param);
|
||||
break;
|
||||
#endif
|
||||
|
||||
|
||||
@@ -0,0 +1,455 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* Copyright (C) 2001-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 interface file contains the interface to the Bluetooth Network
|
||||
* Encapsilation Protocol (BNEP).
|
||||
*
|
||||
******************************************************************************/
|
||||
#ifndef BNEP_API_H
|
||||
#define BNEP_API_H
|
||||
|
||||
#include "common/bt_target.h"
|
||||
|
||||
#if (BNEP_INCLUDED == TRUE)
|
||||
|
||||
#include "stack/l2c_api.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/*****************************************************************************
|
||||
* Constants
|
||||
****************************************************************************/
|
||||
|
||||
/* Define the minimum offset needed in a buffer for
|
||||
* sending BNEP packets. Note, we are currently not sending
|
||||
* extension headers, but may in the future, so allow
|
||||
* space for them. Callers of BNEP_WriteBuf must leave at
|
||||
* least this much headroom (p_buf->offset >= BNEP_MINIMUM_OFFSET).
|
||||
*/
|
||||
#define BNEP_MINIMUM_OFFSET (15 + L2CAP_MIN_OFFSET)
|
||||
#define BNEP_INVALID_HANDLE 0xFFFF
|
||||
|
||||
/*****************************************************************************
|
||||
* Type Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/* Define the result codes from BNEP */
|
||||
enum {
|
||||
BNEP_SUCCESS, /* Success */
|
||||
BNEP_CONN_DISCONNECTED, /* Connection terminated */
|
||||
BNEP_NO_RESOURCES, /* No resources */
|
||||
BNEP_MTU_EXCEDED, /* Attempt to write long data */
|
||||
BNEP_INVALID_OFFSET, /* Insufficient offset in buffer */
|
||||
BNEP_CONN_FAILED, /* Connection failed */
|
||||
BNEP_CONN_FAILED_CFG, /* Connection failed cos of config */
|
||||
BNEP_CONN_FAILED_SRC_UUID, /* Connection failed wrong source UUID */
|
||||
BNEP_CONN_FAILED_DST_UUID, /* Connection failed wrong destination UUID */
|
||||
BNEP_CONN_FAILED_UUID_SIZE, /* Connection failed wrong size UUID */
|
||||
BNEP_Q_SIZE_EXCEEDED, /* Too many buffers to dest */
|
||||
BNEP_TOO_MANY_FILTERS, /* Too many local filters specified */
|
||||
BNEP_SET_FILTER_FAIL, /* Set Filter failed */
|
||||
BNEP_WRONG_HANDLE, /* Wrong handle for the connection */
|
||||
BNEP_WRONG_STATE, /* Connection is in wrong state */
|
||||
BNEP_SECURITY_FAIL, /* Failed because of security */
|
||||
BNEP_IGNORE_CMD, /* To ignore the rcvd command */
|
||||
BNEP_TX_FLOW_ON, /* tx data flow enabled */
|
||||
BNEP_TX_FLOW_OFF /* tx data flow disabled */
|
||||
|
||||
};
|
||||
typedef UINT8 tBNEP_RESULT;
|
||||
|
||||
/***************************
|
||||
* Callback Functions
|
||||
***************************/
|
||||
|
||||
/* Connection state change callback prototype. Parameters are
|
||||
* Connection handle
|
||||
* BD Address of remote
|
||||
* Connection state change result
|
||||
* BNEP_SUCCESS indicates connection is success
|
||||
* All values are used to indicate the reason for failure
|
||||
* Flag to indicate if it is just a role change
|
||||
*/
|
||||
typedef void(tBNEP_CONN_STATE_CB)(UINT16 handle, BD_ADDR rem_bda,
|
||||
tBNEP_RESULT result, BOOLEAN is_role_change);
|
||||
|
||||
/* Connection indication callback prototype. Parameters are
|
||||
* BD Address of remote, remote UUID and local UUID
|
||||
* and flag to indicate role change and handle to the connection
|
||||
* When BNEP calls this function profile should
|
||||
* use BNEP_ConnectResp call to accept or reject the request
|
||||
*/
|
||||
typedef void(tBNEP_CONNECT_IND_CB)(UINT16 handle, BD_ADDR bd_addr,
|
||||
tBT_UUID *remote_uuid, tBT_UUID *local_uuid,
|
||||
BOOLEAN is_role_change);
|
||||
|
||||
/* Data buffer received indication callback prototype. Parameters are
|
||||
* Handle to the connection
|
||||
* Source BD/Ethernet Address
|
||||
* Dest BD/Ethernet address
|
||||
* Protocol
|
||||
* Pointer to the buffer
|
||||
* Flag to indicate whether extension headers to be forwarded are
|
||||
* present
|
||||
*/
|
||||
typedef void(tBNEP_DATA_BUF_CB)(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
BT_HDR *p_buf, BOOLEAN fw_ext_present);
|
||||
|
||||
/* Data received indication callback prototype. Parameters are
|
||||
* Handle to the connection
|
||||
* Source BD/Ethernet Address
|
||||
* Dest BD/Ethernet address
|
||||
* Protocol
|
||||
* Pointer to the beginning of the data
|
||||
* Length of data
|
||||
* Flag to indicate whether extension headers to be forwarded are
|
||||
* present
|
||||
*/
|
||||
typedef void(tBNEP_DATA_IND_CB)(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
UINT8 *p_data, UINT16 len,
|
||||
BOOLEAN fw_ext_present);
|
||||
|
||||
/* Flow control callback for TX data. Parameters are
|
||||
* Handle to the connection
|
||||
* Event flow status
|
||||
*/
|
||||
typedef void(tBNEP_TX_DATA_FLOW_CB)(UINT16 handle, tBNEP_RESULT event);
|
||||
|
||||
/* Filters received indication callback prototype. Parameters are
|
||||
* Handle to the connection
|
||||
* true if the cb is called for indication
|
||||
* Ignore this if it is indication, otherwise it is the result
|
||||
* for the filter set operation performed by the local
|
||||
* device
|
||||
* Number of protocol filters present
|
||||
* Pointer to the filters start. Filters are present in pairs
|
||||
* of start of the range and end of the range.
|
||||
* They will be present in big endian order. First
|
||||
* two bytes will be starting of the first range and
|
||||
* next two bytes will be ending of the range.
|
||||
*/
|
||||
typedef void(tBNEP_FILTER_IND_CB)(UINT16 handle, BOOLEAN indication,
|
||||
tBNEP_RESULT result, UINT16 num_filters,
|
||||
UINT8 *p_filters);
|
||||
|
||||
/* Multicast Filters received indication callback prototype. Parameters are
|
||||
* Handle to the connection
|
||||
* true if the cb is called for indication
|
||||
* Ignore this if it is indication, otherwise it is the result
|
||||
* for the filter set operation performed by the local
|
||||
* device
|
||||
* Number of multicast filters present
|
||||
* Pointer to the filters start. Filters are present in pairs
|
||||
* of start of the range and end of the range.
|
||||
* First six bytes will be starting of the first range and
|
||||
* next six bytes will be ending of the range.
|
||||
*/
|
||||
typedef void(tBNEP_MFILTER_IND_CB)(UINT16 handle, BOOLEAN indication,
|
||||
tBNEP_RESULT result, UINT16 num_mfilters,
|
||||
UINT8 *p_mfilters);
|
||||
|
||||
/* This is the structure used by profile to register with BNEP */
|
||||
typedef struct {
|
||||
tBNEP_CONNECT_IND_CB *p_conn_ind_cb; /* To indicate the conn request */
|
||||
tBNEP_CONN_STATE_CB *p_conn_state_cb; /* To indicate conn state change */
|
||||
tBNEP_DATA_IND_CB *p_data_ind_cb; /* To pass the data received */
|
||||
tBNEP_DATA_BUF_CB *p_data_buf_cb; /* To pass the data buffer received */
|
||||
tBNEP_TX_DATA_FLOW_CB *p_tx_data_flow_cb; /* data flow callback */
|
||||
tBNEP_FILTER_IND_CB *
|
||||
p_filter_ind_cb; /* To indicate that peer set protocol filters */
|
||||
tBNEP_MFILTER_IND_CB *
|
||||
p_mfilter_ind_cb; /* To indicate that peer set mcast filters */
|
||||
|
||||
} tBNEP_REGISTER;
|
||||
|
||||
/* This is the structure used by profile to get the status of BNEP */
|
||||
#define BNEP_STATUS_FAILED 0
|
||||
#define BNEP_STATUS_CONNECTED 1
|
||||
|
||||
typedef struct {
|
||||
UINT8 con_status;
|
||||
|
||||
UINT16 l2cap_cid;
|
||||
BD_ADDR rem_bda;
|
||||
UINT16 rem_mtu_size;
|
||||
UINT16 xmit_q_depth;
|
||||
|
||||
UINT16 sent_num_filters;
|
||||
UINT16 sent_mcast_filters;
|
||||
UINT16 rcvd_num_filters;
|
||||
UINT16 rcvd_mcast_filters;
|
||||
tBT_UUID src_uuid;
|
||||
tBT_UUID dst_uuid;
|
||||
|
||||
} tBNEP_STATUS;
|
||||
|
||||
/*****************************************************************************
|
||||
* External Function Declarations
|
||||
****************************************************************************/
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Register
|
||||
*
|
||||
* Description This function is called by the upper layer to register
|
||||
* its callbacks with BNEP
|
||||
*
|
||||
* Parameters: p_reg_info - contains all callback function pointers
|
||||
*
|
||||
*
|
||||
* Returns BNEP_SUCCESS if registered successfully
|
||||
* BNEP_FAILURE if connection state callback is missing
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_Register(tBNEP_REGISTER *p_reg_info);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Deregister
|
||||
*
|
||||
* Description This function is called by the upper layer to de-register
|
||||
* its callbacks.
|
||||
*
|
||||
* Parameters: void
|
||||
*
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
extern void BNEP_Deregister(void);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Connect
|
||||
*
|
||||
* Description This function creates a BNEP connection to a remote
|
||||
* device.
|
||||
*
|
||||
* Parameters: p_rem_addr - BD_ADDR of the peer
|
||||
* src_uuid - source uuid for the connection
|
||||
* dst_uuid - destination uuid for the connection
|
||||
* p_handle - pointer to return the handle for the connection
|
||||
*
|
||||
* Returns BNEP_SUCCESS if connection started
|
||||
* BNEP_NO_RESOURCES if no resources
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_Connect(BD_ADDR p_rem_bda,
|
||||
tBT_UUID *src_uuid, tBT_UUID *dst_uuid,
|
||||
UINT16 *p_handle);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_ConnectResp
|
||||
*
|
||||
* Description This function is called in response to connection indication
|
||||
*
|
||||
*
|
||||
* Parameters: handle - handle given in the connection indication
|
||||
* resp - response for the connection indication
|
||||
*
|
||||
* Returns BNEP_SUCCESS if connection started
|
||||
* BNEP_WRONG_HANDLE if the connection is not found
|
||||
* BNEP_WRONG_STATE if the response is not expected
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_ConnectResp(UINT16 handle, tBNEP_RESULT resp);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Disconnect
|
||||
*
|
||||
* Description This function is called to close the specified connection.
|
||||
*
|
||||
* Parameters: handle - handle of the connection
|
||||
*
|
||||
* Returns BNEP_SUCCESS if connection is disconnected
|
||||
* BNEP_WRONG_HANDLE if no connection is not found
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_Disconnect(UINT16 handle);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_WriteBuf
|
||||
*
|
||||
* Description This function sends data in a BT_HDR buffer on a BNEP
|
||||
* connection. The buffer must leave BNEP_MINIMUM_OFFSET bytes
|
||||
* of headroom (p_buf->offset >= BNEP_MINIMUM_OFFSET); payload
|
||||
* will not be shifted in place.
|
||||
*
|
||||
* Parameters: handle - handle of the connection to write
|
||||
* p_dest_addr - BD_ADDR/Ethernet addr of the destination
|
||||
* p_buf - pointer to address of buffer with data
|
||||
* protocol - protocol type of the packet
|
||||
* p_src_addr - (optional) BD_ADDR/ethernet address of the
|
||||
* source (should be NULL if it is the local BD
|
||||
* Addr)
|
||||
* fw_ext_present - forwarded extensions present
|
||||
*
|
||||
* Returns: BNEP_WRONG_HANDLE - if passed handle is not valid
|
||||
* BNEP_WRONG_STATE - if connection is not active
|
||||
* BNEP_MTU_EXCEDED - If the data length is greater
|
||||
* than MTU
|
||||
* BNEP_INVALID_OFFSET - If buffer headroom is insufficient
|
||||
* BNEP_IGNORE_CMD - If the packet is filtered out
|
||||
* BNEP_Q_SIZE_EXCEEDED - If the Tx Q is full
|
||||
* BNEP_SUCCESS - If written successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_WriteBuf(UINT16 handle,
|
||||
BD_ADDR p_dest_addr,
|
||||
BT_HDR *p_buf,
|
||||
UINT16 protocol,
|
||||
BD_ADDR p_src_addr,
|
||||
BOOLEAN fw_ext_present);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Write
|
||||
*
|
||||
* Description This function sends data over a BNEP connection
|
||||
*
|
||||
* Parameters: handle - handle of the connection to write
|
||||
* p_dest_addr - BD_ADDR/Ethernet addr of the destination
|
||||
* p_data - pointer to data start
|
||||
* protocol - protocol type of the packet
|
||||
* p_src_addr - (optional) BD_ADDR/ethernet address of the
|
||||
* source (should be NULL if it is the local BD
|
||||
* Addr)
|
||||
* fw_ext_present - forwarded extensions present
|
||||
*
|
||||
* Returns: BNEP_WRONG_HANDLE - if passed handle is not valid
|
||||
* BNEP_WRONG_STATE - if connection is not active
|
||||
* BNEP_MTU_EXCEDED - If the data length is greater than
|
||||
* the MTU
|
||||
* BNEP_IGNORE_CMD - If the packet is filtered out
|
||||
* BNEP_Q_SIZE_EXCEEDED - If the Tx Q is full
|
||||
* BNEP_NO_RESOURCES - If not able to allocate a buffer
|
||||
* BNEP_SUCCESS - If written successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_Write(UINT16 handle, BD_ADDR p_dest_addr,
|
||||
UINT8 *p_data, UINT16 len, UINT16 protocol,
|
||||
BD_ADDR p_src_addr,
|
||||
BOOLEAN fw_ext_present);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_SetProtocolFilters
|
||||
*
|
||||
* Description This function sets the protocol filters on peer device
|
||||
*
|
||||
* Parameters: handle - Handle for the connection
|
||||
* num_filters - total number of filter ranges
|
||||
* p_start_array - Array of beginnings of all protocol ranges
|
||||
* p_end_array - Array of ends of all protocol ranges
|
||||
*
|
||||
* Returns BNEP_WRONG_HANDLE - if the connection handle is
|
||||
* not valid
|
||||
* BNEP_SET_FILTER_FAIL - if the connection is in the
|
||||
* wrong state
|
||||
* BNEP_TOO_MANY_FILTERS - if too many filters
|
||||
* BNEP_SUCCESS - if request sent successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_SetProtocolFilters(UINT16 handle,
|
||||
UINT16 num_filters,
|
||||
UINT16 *p_start_array,
|
||||
UINT16 *p_end_array);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_SetMulticastFilters
|
||||
*
|
||||
* Description This function sets the filters for multicast addresses for
|
||||
* BNEP.
|
||||
*
|
||||
* Parameters: handle - Handle for the connection
|
||||
* num_filters - total number of filter ranges
|
||||
* p_start_array - Pointer to sequence of beginnings of all
|
||||
* multicast address ranges
|
||||
* p_end_array - Pointer to sequence of ends of all
|
||||
* multicast address ranges
|
||||
*
|
||||
* Returns BNEP_WRONG_HANDLE - if the connection handle is
|
||||
* not valid
|
||||
* BNEP_SET_FILTER_FAIL - if the connection is in the
|
||||
* wrong state
|
||||
* BNEP_TOO_MANY_FILTERS - if too many filters
|
||||
* BNEP_SUCCESS - if request sent successfully
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_SetMulticastFilters(UINT16 handle,
|
||||
UINT16 num_filters,
|
||||
UINT8 *p_start_array,
|
||||
UINT8 *p_end_array);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_SetTraceLevel
|
||||
*
|
||||
* Description This function sets the trace level for BNEP. If called with
|
||||
* a value of 0xFF, it simply reads the current trace level.
|
||||
*
|
||||
* Returns the new (current) trace level
|
||||
*
|
||||
******************************************************************************/
|
||||
extern UINT8 BNEP_SetTraceLevel(UINT8 new_level);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_Init
|
||||
*
|
||||
* Description This function initializes the BNEP unit. It should be called
|
||||
* before accessing any other APIs to initialize the control
|
||||
* block
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
extern void BNEP_Init(void);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function BNEP_GetStatus
|
||||
*
|
||||
* Description This function gets the status information for BNEP
|
||||
* connection
|
||||
*
|
||||
* Returns BNEP_SUCCESS - if the status is available
|
||||
* BNEP_NO_RESOURCES - if no structure is passed for
|
||||
* output
|
||||
* BNEP_WRONG_HANDLE - if the handle is invalid
|
||||
* BNEP_WRONG_STATE - if not in connected state
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tBNEP_RESULT BNEP_GetStatus(UINT16 handle, tBNEP_STATUS *p_status);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* (BNEP_INCLUDED == TRUE) */
|
||||
|
||||
#endif
|
||||
@@ -0,0 +1,449 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* Copyright (C) 2001-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 the PAN API definitions
|
||||
*
|
||||
******************************************************************************/
|
||||
#ifndef PAN_API_H
|
||||
#define PAN_API_H
|
||||
|
||||
#include "common/bt_target.h"
|
||||
|
||||
#if (PAN_INCLUDED == TRUE)
|
||||
|
||||
#include "stack/bnep_api.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/*****************************************************************************
|
||||
* Constants
|
||||
****************************************************************************/
|
||||
|
||||
/* Define the minimum offset needed in a GKI buffer for
|
||||
* sending PAN packets. Note, we are currently not sending
|
||||
* extension headers, but may in the future, so allow
|
||||
* space for them
|
||||
*/
|
||||
#define PAN_MINIMUM_OFFSET BNEP_MINIMUM_OFFSET
|
||||
|
||||
/* Maximum Ethernet payload length for PAN write into a PAN_BUF_SIZE buffer.
|
||||
* Data is copied at (sizeof(BT_HDR) + PAN_MINIMUM_OFFSET) within the buffer.
|
||||
*/
|
||||
#define PAN_MAX_WRITE_LEN (PAN_BUF_SIZE - sizeof(BT_HDR) - PAN_MINIMUM_OFFSET)
|
||||
|
||||
/*
|
||||
* The handle is passed from BNEP to PAN. The same handle is used
|
||||
* between PAN and application as well
|
||||
*/
|
||||
#define PAN_INVALID_HANDLE BNEP_INVALID_HANDLE
|
||||
|
||||
/* Bit map for PAN roles */
|
||||
#define PAN_ROLE_CLIENT 0x01 /* PANU role */
|
||||
#define PAN_ROLE_GN_SERVER 0x02 /* GN role */
|
||||
#define PAN_ROLE_NAP_SERVER 0x04 /* NAP role */
|
||||
|
||||
/* Bitmap to indicate the usage of the Data */
|
||||
#define PAN_DATA_TO_HOST 0x01
|
||||
#define PAN_DATA_TO_LAN 0x02
|
||||
|
||||
/*****************************************************************************
|
||||
* Type Definitions
|
||||
****************************************************************************/
|
||||
|
||||
/* Define the result codes from PAN */
|
||||
enum {
|
||||
PAN_SUCCESS, /* Success */
|
||||
PAN_DISCONNECTED = BNEP_CONN_DISCONNECTED, /* Connection terminated */
|
||||
PAN_CONN_FAILED = BNEP_CONN_FAILED, /* Connection failed */
|
||||
PAN_NO_RESOURCES = BNEP_NO_RESOURCES, /* No resources */
|
||||
PAN_MTU_EXCEDED = BNEP_MTU_EXCEDED, /* Attempt to write long data */
|
||||
PAN_INVALID_OFFSET =
|
||||
BNEP_INVALID_OFFSET, /* Insufficient offset in GKI buffer */
|
||||
PAN_CONN_FAILED_CFG =
|
||||
BNEP_CONN_FAILED_CFG, /* Connection failed cos of config */
|
||||
PAN_INVALID_SRC_ROLE =
|
||||
BNEP_CONN_FAILED_SRC_UUID, /* Connection failed wrong source UUID */
|
||||
PAN_INVALID_DST_ROLE =
|
||||
BNEP_CONN_FAILED_DST_UUID, /* Connection failed wrong destination UUID */
|
||||
PAN_CONN_FAILED_UUID_SIZE =
|
||||
BNEP_CONN_FAILED_UUID_SIZE, /* Connection failed wrong size UUID */
|
||||
PAN_Q_SIZE_EXCEEDED = BNEP_Q_SIZE_EXCEEDED, /* Too many buffers to dest */
|
||||
PAN_TOO_MANY_FILTERS =
|
||||
BNEP_TOO_MANY_FILTERS, /* Too many local filters specified */
|
||||
PAN_SET_FILTER_FAIL = BNEP_SET_FILTER_FAIL, /* Set Filter failed */
|
||||
PAN_WRONG_HANDLE = BNEP_WRONG_HANDLE, /* Wrong handle for the connection */
|
||||
PAN_WRONG_STATE = BNEP_WRONG_STATE, /* Connection is in wrong state */
|
||||
PAN_SECURITY_FAIL = BNEP_SECURITY_FAIL, /* Failed because of security */
|
||||
PAN_IGNORE_CMD = BNEP_IGNORE_CMD, /* To ignore the rcvd command */
|
||||
PAN_TX_FLOW_ON = BNEP_TX_FLOW_ON, /* tx data flow enabled */
|
||||
PAN_TX_FLOW_OFF = BNEP_TX_FLOW_OFF, /* tx data flow disabled */
|
||||
PAN_FAILURE /* Failure */
|
||||
|
||||
};
|
||||
typedef UINT8 tPAN_RESULT;
|
||||
|
||||
/*****************************************************************
|
||||
* Callback Function Prototypes
|
||||
****************************************************************/
|
||||
|
||||
/* This is call back function used to report connection status
|
||||
* to the application. The second parameter true means
|
||||
* to create the bridge and false means to remove it.
|
||||
*/
|
||||
typedef void (tPAN_CONN_STATE_CB)(UINT16 handle, BD_ADDR bd_addr,
|
||||
tPAN_RESULT state, BOOLEAN is_role_change,
|
||||
UINT8 src_role, UINT8 dst_role);
|
||||
|
||||
/* This is call back function used to create bridge for the
|
||||
* Connected device. The parameter "state" indicates
|
||||
* whether to create the bridge or remove it. true means
|
||||
* to create the bridge and false means to remove it.
|
||||
*/
|
||||
typedef void (tPAN_BRIDGE_REQ_CB)(BD_ADDR bd_addr, BOOLEAN state);
|
||||
|
||||
/* Data received indication callback prototype. Parameters are
|
||||
* Source BD/Ethernet Address
|
||||
* Dest BD/Ethernet address
|
||||
* Protocol
|
||||
* Address of buffer (or data if non-GKI)
|
||||
* Length of data (non-GKI)
|
||||
* ext is flag to indicate whether it has aby extension headers
|
||||
* Flag used to indicate to forward on LAN
|
||||
* false - Use it for internal stack
|
||||
* true - Send it across the ethernet as well
|
||||
*/
|
||||
typedef void (tPAN_DATA_IND_CB)(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
UINT8 *p_data, UINT16 len, BOOLEAN ext,
|
||||
BOOLEAN forward);
|
||||
|
||||
/* Data buffer received indication callback prototype. Parameters are
|
||||
* Source BD/Ethernet Address
|
||||
* Dest BD/Ethernet address
|
||||
* Protocol
|
||||
* pointer to the data buffer
|
||||
* ext is flag to indicate whether it has aby extension headers
|
||||
* Flag used to indicate to forward on LAN
|
||||
* false - Use it for internal stack
|
||||
* true - Send it across the ethernet as well
|
||||
*/
|
||||
typedef void (tPAN_DATA_BUF_IND_CB)(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
BT_HDR *p_buf, BOOLEAN ext, BOOLEAN forward);
|
||||
|
||||
/* Flow control callback for TX data. Parameters are
|
||||
* Handle to the connection
|
||||
* Event flow status
|
||||
*/
|
||||
typedef void (tPAN_TX_DATA_FLOW_CB)(UINT16 handle, tPAN_RESULT event);
|
||||
|
||||
/* Filters received indication callback prototype. Parameters are
|
||||
* Handle to the connection
|
||||
* true if the cb is called for indication
|
||||
* Ignore this if it is indication, otherwise it is the result
|
||||
* for the filter set operation performed by the local
|
||||
* device
|
||||
* Number of protocol filters present
|
||||
* Pointer to the filters start. Filters are present in pairs
|
||||
* of start of the range and end of the range.
|
||||
* They will be present in big endian order. First
|
||||
* two bytes will be starting of the first range and
|
||||
* next two bytes will be ending of the range.
|
||||
*/
|
||||
typedef void (tPAN_FILTER_IND_CB)(UINT16 handle, BOOLEAN indication,
|
||||
tPAN_RESULT result, UINT16 num_filters,
|
||||
UINT8 *p_filters);
|
||||
|
||||
/* Multicast Filters received indication callback prototype. Parameters are
|
||||
* Handle to the connection
|
||||
* true if the cb is called for indication
|
||||
* Ignore this if it is indication, otherwise it is the result
|
||||
* for the filter set operation performed by the local
|
||||
* device
|
||||
* Number of multicast filters present
|
||||
* Pointer to the filters start. Filters are present in pairs
|
||||
* of start of the range and end of the range.
|
||||
* First six bytes will be starting of the first range and
|
||||
* next six bytes will be ending of the range.
|
||||
*/
|
||||
typedef void (tPAN_MFILTER_IND_CB)(UINT16 handle, BOOLEAN indication,
|
||||
tPAN_RESULT result, UINT16 num_mfilters,
|
||||
UINT8 *p_mfilters);
|
||||
|
||||
/* This structure is used to register with PAN profile
|
||||
* It is passed as a parameter to PAN_Register call.
|
||||
*/
|
||||
typedef struct {
|
||||
tPAN_CONN_STATE_CB *pan_conn_state_cb; /* Connection state callback */
|
||||
tPAN_BRIDGE_REQ_CB *pan_bridge_req_cb; /* Bridge request callback */
|
||||
tPAN_DATA_IND_CB *pan_data_ind_cb; /* Data indication callback */
|
||||
tPAN_DATA_BUF_IND_CB *
|
||||
pan_data_buf_ind_cb; /* Data buffer indication callback */
|
||||
tPAN_FILTER_IND_CB *
|
||||
pan_pfilt_ind_cb; /* protocol filter indication callback */
|
||||
tPAN_MFILTER_IND_CB *
|
||||
pan_mfilt_ind_cb; /* multicast filter indication callback */
|
||||
tPAN_TX_DATA_FLOW_CB *pan_tx_data_flow_cb; /* data flow callback */
|
||||
char *user_service_name; /* Service name for PANU role */
|
||||
char *gn_service_name; /* Service name for GN role */
|
||||
char *nap_service_name; /* Service name for NAP role */
|
||||
|
||||
} tPAN_REGISTER;
|
||||
|
||||
/*****************************************************************************
|
||||
* External Function Declarations
|
||||
****************************************************************************/
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Register
|
||||
*
|
||||
* Description This function is called by the application to register
|
||||
* its callbacks with PAN profile. The application then
|
||||
* should set the PAN role explicitly.
|
||||
*
|
||||
* Parameters: p_register - contains all callback function pointers
|
||||
*
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
extern void PAN_Register(tPAN_REGISTER *p_register);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Deregister
|
||||
*
|
||||
* Description This function is called by the application to de-register
|
||||
* its callbacks with PAN profile. This will make the PAN to
|
||||
* become inactive. This will deregister PAN services from SDP
|
||||
* and close all active connections
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
extern void PAN_Deregister(void);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetRole
|
||||
*
|
||||
* Description This function is called by the application to set the PAN
|
||||
* profile role. This should be called after PAN_Register.
|
||||
* This can be called any time to change the PAN role
|
||||
*
|
||||
* Parameters: role - is bit map of roles to be active
|
||||
* PAN_ROLE_CLIENT is for PANU role
|
||||
* PAN_ROLE_GN_SERVER is for GN role
|
||||
* PAN_ROLE_NAP_SERVER is for NAP role
|
||||
* sec_mask - Security mask for different roles
|
||||
* It is array of UINT8. The bytes
|
||||
* represent the security for roles PANU,
|
||||
* GN and NAP in order
|
||||
*
|
||||
* p_user_name - Service name for PANU role
|
||||
* p_gn_name - Service name for GN role
|
||||
* p_nap_name - Service name for NAP role
|
||||
* Can be NULL if user wants it to be default
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the role is set successfully
|
||||
* PAN_FAILURE - if the role is not valid
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_SetRole(UINT8 role, UINT8 *sec_mask,
|
||||
const char *p_user_name, const char *p_gn_name,
|
||||
const char *p_nap_name);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Connect
|
||||
*
|
||||
* Description This function is called by the application to initiate a
|
||||
* connection to the remote device
|
||||
*
|
||||
* Parameters: rem_bda - BD Addr of the remote device
|
||||
* src_role - Role of the local device for the connection
|
||||
* dst_role - Role of the remote device for the connection
|
||||
* PAN_ROLE_CLIENT is for PANU role
|
||||
* PAN_ROLE_GN_SERVER is for GN role
|
||||
* PAN_ROLE_NAP_SERVER is for NAP role
|
||||
* *handle - Pointer for returning Handle to the connection
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the connection is initiated successfully
|
||||
* PAN_NO_RESOURCES - resources are not sufficient
|
||||
* PAN_FAILURE - if the connection cannot be initiated
|
||||
* this can be because of the combination of
|
||||
* src and dst roles may not be valid or
|
||||
* allowed at that point of time
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_Connect(BD_ADDR rem_bda, UINT8 src_role,
|
||||
UINT8 dst_role, UINT16 *handle);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Disconnect
|
||||
*
|
||||
* Description This is used to disconnect the connection
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the connection is closed successfully
|
||||
* PAN_FAILURE - if the connection is not found or
|
||||
* there is an error in disconnecting
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_Disconnect(UINT16 handle);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Write
|
||||
*
|
||||
* Description This sends data over the PAN connections. If this is called
|
||||
* on GN or NAP side and the packet is multicast or broadcast
|
||||
* it will be sent on all the links. Otherwise the correct link
|
||||
* is found based on the destination address and forwarded on
|
||||
* it. If the return value is not PAN_SUCCESS the application
|
||||
* should take care of releasing the message buffer
|
||||
*
|
||||
* Parameters: dst - MAC or BD Addr of the destination device
|
||||
* src - MAC or BD Addr of the source who sent this packet
|
||||
* protocol - protocol of the ethernet packet like IP or ARP
|
||||
* p_data - pointer to the data
|
||||
* len - length of the data
|
||||
* ext - to indicate that extension headers present
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the data is sent successfully
|
||||
* PAN_MTU_EXCEDED - if len exceeds PAN_MAX_WRITE_LEN
|
||||
* PAN_NO_RESOURCES - if buffer allocation fails
|
||||
* PAN_FAILURE - if the connection is not found or
|
||||
* there is an error in sending data
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_Write(UINT16 handle, BD_ADDR dst,
|
||||
BD_ADDR src, UINT16 protocol,
|
||||
UINT8 *p_data, UINT16 len, BOOLEAN ext);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_WriteBuf
|
||||
*
|
||||
* Description This sends data over the PAN connections. If this is called
|
||||
* on GN or NAP side and the packet is multicast or broadcast
|
||||
* it will be sent on all the links. Otherwise the correct link
|
||||
* is found based on the destination address and forwarded on
|
||||
* it. PAN_WriteBuf always takes ownership of p_buf: the buffer
|
||||
* is either freed or queued by this function (or by
|
||||
* BNEP_WriteBuf) regardless of the return value. The caller
|
||||
* must not access or free p_buf after the call. p_buf->offset
|
||||
* must be at least PAN_MINIMUM_OFFSET.
|
||||
*
|
||||
* Parameters: dst - MAC or BD Addr of the destination device
|
||||
* src - MAC or BD Addr of the source who sent this packet
|
||||
* protocol - protocol of the ethernet packet like IP or ARP
|
||||
* p_buf - pointer to the data buffer
|
||||
* ext - to indicate that extension headers present
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the data is sent successfully
|
||||
* PAN_FAILURE - if the connection is not found or
|
||||
* there is an error in sending data
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_WriteBuf(UINT16 handle, BD_ADDR dst,
|
||||
BD_ADDR src, UINT16 protocol,
|
||||
BT_HDR *p_buf, BOOLEAN ext);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetProtocolFilters
|
||||
*
|
||||
* Description This function is used to set protocol filters on the peer
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* num_filters - number of protocol filter ranges
|
||||
* start - array of starting protocol numbers
|
||||
* end - array of ending protocol numbers
|
||||
*
|
||||
*
|
||||
* Returns PAN_SUCCESS if protocol filters are set successfully
|
||||
* PAN_FAILURE if connection not found or error in setting
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_SetProtocolFilters(UINT16 handle, UINT16 num_filters,
|
||||
UINT16 *p_start_array,
|
||||
UINT16 *p_end_array);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetMulticastFilters
|
||||
*
|
||||
* Description This function is used to set multicast filters on the peer
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* num_filters - number of multicast filter ranges
|
||||
* p_start_array - Pointer to sequence of beginnings of all
|
||||
* multicast address ranges
|
||||
* p_end_array - Pointer to sequence of ends of all
|
||||
* multicast address ranges
|
||||
*
|
||||
*
|
||||
* Returns PAN_SUCCESS if multicast filters are set successfully
|
||||
* PAN_FAILURE if connection not found or error in setting
|
||||
*
|
||||
******************************************************************************/
|
||||
extern tPAN_RESULT PAN_SetMulticastFilters(UINT16 handle,
|
||||
UINT16 num_mcast_filters,
|
||||
UINT8 *p_start_array,
|
||||
UINT8 *p_end_array);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetTraceLevel
|
||||
*
|
||||
* Description This function sets the trace level for PAN. If called with
|
||||
* a value of 0xFF, it simply reads the current trace level.
|
||||
*
|
||||
* Returns the new (current) trace level
|
||||
*
|
||||
******************************************************************************/
|
||||
extern UINT8 PAN_SetTraceLevel(UINT8 new_level);
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Init
|
||||
*
|
||||
* Description This function initializes the PAN unit. It should be called
|
||||
* before accessing any other APIs to initialize the control
|
||||
* block.
|
||||
*
|
||||
* Returns void
|
||||
*
|
||||
******************************************************************************/
|
||||
extern void PAN_Init(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* (PAN_INCLUDED == TRUE) */
|
||||
|
||||
#endif /* PAN_API_H */
|
||||
@@ -0,0 +1,133 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* Copyright (C) 2001-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 internally used PAN definitions
|
||||
*
|
||||
******************************************************************************/
|
||||
|
||||
#ifndef PAN_INT_H
|
||||
#define PAN_INT_H
|
||||
|
||||
#include "common/bt_target.h"
|
||||
|
||||
#if (PAN_INCLUDED == TRUE)
|
||||
|
||||
#include "stack/pan_api.h"
|
||||
|
||||
/*
|
||||
* This role is used to shutdown the profile. Used internally
|
||||
* Applications should call PAN_Deregister to shutdown the profile
|
||||
*/
|
||||
#define PAN_ROLE_INACTIVE 0
|
||||
|
||||
/* Protocols supported by the host internal stack, are registered with SDP */
|
||||
#define PAN_PROTOCOL_IP 0x0800
|
||||
#define PAN_PROTOCOL_ARP 0x0806
|
||||
|
||||
#define PAN_PROFILE_VERSION 0x0100 /* Version 1.00 */
|
||||
|
||||
/* Define the PAN Connection Control Block
|
||||
*/
|
||||
typedef struct {
|
||||
#define PAN_STATE_IDLE 0
|
||||
#define PAN_STATE_CONN_START 1
|
||||
#define PAN_STATE_CONNECTED 2
|
||||
UINT8 con_state;
|
||||
|
||||
#define PAN_FLAGS_CONN_COMPLETED 0x01
|
||||
UINT8 con_flags;
|
||||
|
||||
UINT16 handle;
|
||||
BD_ADDR rem_bda;
|
||||
|
||||
UINT16 bad_pkts_rcvd;
|
||||
UINT16 src_uuid;
|
||||
UINT16 dst_uuid;
|
||||
UINT16 prv_src_uuid;
|
||||
UINT16 prv_dst_uuid;
|
||||
UINT16 ip_addr_known;
|
||||
UINT32 ip_addr;
|
||||
|
||||
} tPAN_CONN;
|
||||
|
||||
/* The main PAN control block
|
||||
*/
|
||||
typedef struct {
|
||||
UINT8 role;
|
||||
UINT8 active_role;
|
||||
UINT8 prv_active_role;
|
||||
tPAN_CONN pcb[MAX_PAN_CONNS];
|
||||
|
||||
tPAN_CONN_STATE_CB *pan_conn_state_cb; /* Connection state callback */
|
||||
tPAN_BRIDGE_REQ_CB *pan_bridge_req_cb;
|
||||
tPAN_DATA_IND_CB *pan_data_ind_cb;
|
||||
tPAN_DATA_BUF_IND_CB *pan_data_buf_ind_cb;
|
||||
tPAN_FILTER_IND_CB *pan_pfilt_ind_cb; /* protocol filter indication callback */
|
||||
tPAN_MFILTER_IND_CB *pan_mfilt_ind_cb; /* multicast filter indication callback */
|
||||
tPAN_TX_DATA_FLOW_CB *pan_tx_data_flow_cb;
|
||||
|
||||
char *user_service_name;
|
||||
char *gn_service_name;
|
||||
char *nap_service_name;
|
||||
UINT32 pan_user_sdp_handle;
|
||||
UINT32 pan_gn_sdp_handle;
|
||||
UINT32 pan_nap_sdp_handle;
|
||||
UINT8 num_conns;
|
||||
UINT8 trace_level;
|
||||
} tPAN_CB;
|
||||
|
||||
/* Global PAN data
|
||||
*/
|
||||
extern tPAN_CB pan_cb;
|
||||
|
||||
/******************************************************************************/
|
||||
extern void pan_register_with_bnep(void);
|
||||
extern void pan_conn_ind_cb(UINT16 handle, BD_ADDR p_bda,
|
||||
tBT_UUID *remote_uuid, tBT_UUID *local_uuid,
|
||||
BOOLEAN is_role_change);
|
||||
extern void pan_connect_state_cb(UINT16 handle, BD_ADDR rem_bda,
|
||||
tBNEP_RESULT result, BOOLEAN is_role_change);
|
||||
extern void pan_data_ind_cb(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
UINT8 *p_data, UINT16 len, BOOLEAN fw_ext_present);
|
||||
extern void pan_data_buf_ind_cb(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
BT_HDR *p_buf, BOOLEAN ext);
|
||||
extern void pan_tx_data_flow_cb(UINT16 handle, tBNEP_RESULT event);
|
||||
void pan_proto_filt_ind_cb(UINT16 handle, BOOLEAN indication,
|
||||
tBNEP_RESULT result, UINT16 num_filters,
|
||||
UINT8 *p_filters);
|
||||
void pan_mcast_filt_ind_cb(UINT16 handle, BOOLEAN indication,
|
||||
tBNEP_RESULT result, UINT16 num_filters,
|
||||
UINT8 *p_filters);
|
||||
extern UINT32 pan_register_with_sdp(UINT16 uuid, UINT8 sec_mask,
|
||||
const char *p_name, const char *p_desc);
|
||||
extern tPAN_CONN *pan_allocate_pcb(BD_ADDR p_bda, UINT16 handle);
|
||||
extern tPAN_CONN *pan_get_pcb_by_handle(UINT16 handle);
|
||||
extern tPAN_CONN *pan_get_pcb_by_addr(BD_ADDR p_bda);
|
||||
extern void pan_close_all_connections(void);
|
||||
extern void pan_release_pcb(tPAN_CONN *p_pcb);
|
||||
extern void pan_dump_status(void);
|
||||
|
||||
/******************************************************************************/
|
||||
|
||||
#endif /* (PAN_INCLUDED == TRUE) */
|
||||
|
||||
#endif
|
||||
@@ -0,0 +1,784 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* 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 "osi/allocator.h"
|
||||
#include "stack/pan_api.h"
|
||||
#include <string.h>
|
||||
#include "stack/bnep_api.h"
|
||||
#include "bt_common.h"
|
||||
#include "stack/bt_types.h"
|
||||
#include "bta/bta_sys.h"
|
||||
#include "stack/btm_api.h"
|
||||
#include "stack/hcidefs.h"
|
||||
#include "stack/l2c_api.h"
|
||||
#include "pan_int.h"
|
||||
#include "stack/sdp_api.h"
|
||||
#include "stack/sdpdefs.h"
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Register
|
||||
*
|
||||
* Description This function is called by the application to register
|
||||
* its callbacks with PAN profile. The application then
|
||||
* should set the PAN role explicitly.
|
||||
*
|
||||
* Parameters: p_register - contains all callback function pointers
|
||||
*
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void PAN_Register(tPAN_REGISTER *p_register)
|
||||
{
|
||||
pan_register_with_bnep();
|
||||
|
||||
if (!p_register) {
|
||||
return;
|
||||
}
|
||||
|
||||
pan_cb.pan_conn_state_cb = p_register->pan_conn_state_cb;
|
||||
pan_cb.pan_bridge_req_cb = p_register->pan_bridge_req_cb;
|
||||
pan_cb.pan_data_buf_ind_cb = p_register->pan_data_buf_ind_cb;
|
||||
pan_cb.pan_data_ind_cb = p_register->pan_data_ind_cb;
|
||||
pan_cb.pan_pfilt_ind_cb = p_register->pan_pfilt_ind_cb;
|
||||
pan_cb.pan_mfilt_ind_cb = p_register->pan_mfilt_ind_cb;
|
||||
pan_cb.pan_tx_data_flow_cb = p_register->pan_tx_data_flow_cb;
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Deregister
|
||||
*
|
||||
* Description This function is called by the application to de-register
|
||||
* its callbacks with PAN profile. This will make the PAN to
|
||||
* become inactive. This will deregister PAN services from SDP
|
||||
* and close all active connections
|
||||
*
|
||||
* Parameters: none
|
||||
*
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void PAN_Deregister(void)
|
||||
{
|
||||
pan_cb.pan_bridge_req_cb = NULL;
|
||||
pan_cb.pan_data_buf_ind_cb = NULL;
|
||||
pan_cb.pan_data_ind_cb = NULL;
|
||||
pan_cb.pan_conn_state_cb = NULL;
|
||||
pan_cb.pan_pfilt_ind_cb = NULL;
|
||||
pan_cb.pan_mfilt_ind_cb = NULL;
|
||||
pan_cb.pan_tx_data_flow_cb = NULL;
|
||||
|
||||
PAN_SetRole(PAN_ROLE_INACTIVE, NULL, NULL, NULL, NULL);
|
||||
BNEP_Deregister();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetRole
|
||||
*
|
||||
* Description This function is called by the application to set the PAN
|
||||
* profile role. This should be called after PAN_Register.
|
||||
* This can be called any time to change the PAN role
|
||||
*
|
||||
* Parameters: role - is bit map of roles to be active
|
||||
* PAN_ROLE_CLIENT is for PANU role
|
||||
* PAN_ROLE_GN_SERVER is for GN role
|
||||
* PAN_ROLE_NAP_SERVER is for NAP role
|
||||
* sec_mask - Security mask for different roles
|
||||
* It is array of uint8_t. The bytes
|
||||
* represent the security for roles PANU,
|
||||
* GN and NAP in order
|
||||
* p_user_name - Service name for PANU role
|
||||
* p_gn_name - Service name for GN role
|
||||
* p_nap_name - Service name for NAP role
|
||||
* Can be NULL if user wants the default
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the role is set successfully
|
||||
* PAN_FAILURE - if the role is not valid
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_SetRole(UINT8 role, UINT8 *sec_mask,
|
||||
const char *p_user_name, const char *p_gn_name,
|
||||
const char *p_nap_name)
|
||||
{
|
||||
const char *p_desc;
|
||||
UINT8 security[3] = {PAN_PANU_SECURITY_LEVEL, PAN_GN_SECURITY_LEVEL,
|
||||
PAN_NAP_SECURITY_LEVEL
|
||||
};
|
||||
UINT8 *p_sec;
|
||||
|
||||
/* If the role is not a valid combination reject it */
|
||||
if ((!(role &
|
||||
(PAN_ROLE_CLIENT | PAN_ROLE_GN_SERVER | PAN_ROLE_NAP_SERVER))) &&
|
||||
role != PAN_ROLE_INACTIVE) {
|
||||
PAN_TRACE_ERROR("PAN role %d is invalid", role);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
/* If the current active role is same as the role being set do nothing */
|
||||
if (pan_cb.role == role) {
|
||||
PAN_TRACE_EVENT("PAN role already was set to: %d", role);
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
if (!sec_mask) {
|
||||
p_sec = security;
|
||||
} else {
|
||||
p_sec = sec_mask;
|
||||
}
|
||||
|
||||
/* Register all the roles with SDP */
|
||||
PAN_TRACE_API("PAN_SetRole() called with role 0x%x", role);
|
||||
#if (PAN_SUPPORTS_ROLE_NAP == TRUE)
|
||||
if (role & PAN_ROLE_NAP_SERVER) {
|
||||
/* Check the service name */
|
||||
if ((p_nap_name == NULL) || (*p_nap_name == 0)) {
|
||||
p_nap_name = PAN_NAP_DEFAULT_SERVICE_NAME;
|
||||
}
|
||||
|
||||
/* Registering for NAP service with SDP */
|
||||
p_desc = PAN_NAP_DEFAULT_DESCRIPTION;
|
||||
|
||||
if (pan_cb.pan_nap_sdp_handle != 0) {
|
||||
SDP_DeleteRecord(pan_cb.pan_nap_sdp_handle);
|
||||
pan_cb.pan_nap_sdp_handle = 0;
|
||||
}
|
||||
|
||||
pan_cb.pan_nap_sdp_handle =
|
||||
pan_register_with_sdp(UUID_SERVCLASS_NAP, p_sec[2], p_nap_name, p_desc);
|
||||
/* Only advertise the UUID when SDP registration succeeds; otherwise
|
||||
* cleanup (gated on handle != 0) would skip bta_sys_remove_uuid. */
|
||||
if (pan_cb.pan_nap_sdp_handle != 0) {
|
||||
bta_sys_add_uuid(UUID_SERVCLASS_NAP);
|
||||
}
|
||||
}
|
||||
/* If the NAP role is already active and now being cleared delete the record
|
||||
*/
|
||||
else if (pan_cb.role & PAN_ROLE_NAP_SERVER) {
|
||||
if (pan_cb.pan_nap_sdp_handle != 0) {
|
||||
SDP_DeleteRecord(pan_cb.pan_nap_sdp_handle);
|
||||
pan_cb.pan_nap_sdp_handle = 0;
|
||||
bta_sys_remove_uuid(UUID_SERVCLASS_NAP);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
#if (PAN_SUPPORTS_ROLE_GN == TRUE)
|
||||
if (role & PAN_ROLE_GN_SERVER) {
|
||||
/* Check the service name */
|
||||
if ((p_gn_name == NULL) || (*p_gn_name == 0)) {
|
||||
p_gn_name = PAN_GN_DEFAULT_SERVICE_NAME;
|
||||
}
|
||||
|
||||
/* Registering for GN service with SDP */
|
||||
p_desc = PAN_GN_DEFAULT_DESCRIPTION;
|
||||
|
||||
if (pan_cb.pan_gn_sdp_handle != 0) {
|
||||
SDP_DeleteRecord(pan_cb.pan_gn_sdp_handle);
|
||||
pan_cb.pan_gn_sdp_handle = 0;
|
||||
}
|
||||
|
||||
pan_cb.pan_gn_sdp_handle =
|
||||
pan_register_with_sdp(UUID_SERVCLASS_GN, p_sec[1], p_gn_name, p_desc);
|
||||
if (pan_cb.pan_gn_sdp_handle != 0) {
|
||||
bta_sys_add_uuid(UUID_SERVCLASS_GN);
|
||||
}
|
||||
}
|
||||
/* If the GN role is already active and now being cleared delete the record */
|
||||
else if (pan_cb.role & PAN_ROLE_GN_SERVER) {
|
||||
if (pan_cb.pan_gn_sdp_handle != 0) {
|
||||
SDP_DeleteRecord(pan_cb.pan_gn_sdp_handle);
|
||||
pan_cb.pan_gn_sdp_handle = 0;
|
||||
bta_sys_remove_uuid(UUID_SERVCLASS_GN);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
#if (PAN_SUPPORTS_ROLE_PANU == TRUE)
|
||||
if (role & PAN_ROLE_CLIENT) {
|
||||
/* Check the service name */
|
||||
if ((p_user_name == NULL) || (*p_user_name == 0)) {
|
||||
p_user_name = PAN_PANU_DEFAULT_SERVICE_NAME;
|
||||
}
|
||||
|
||||
/* Registering for PANU service with SDP */
|
||||
p_desc = PAN_PANU_DEFAULT_DESCRIPTION;
|
||||
if (pan_cb.pan_user_sdp_handle != 0) {
|
||||
SDP_DeleteRecord(pan_cb.pan_user_sdp_handle);
|
||||
pan_cb.pan_user_sdp_handle = 0;
|
||||
}
|
||||
|
||||
pan_cb.pan_user_sdp_handle = pan_register_with_sdp(
|
||||
UUID_SERVCLASS_PANU, p_sec[0], p_user_name, p_desc);
|
||||
if (pan_cb.pan_user_sdp_handle != 0) {
|
||||
bta_sys_add_uuid(UUID_SERVCLASS_PANU);
|
||||
}
|
||||
}
|
||||
/* If the PANU role is already active and now being cleared delete the record
|
||||
*/
|
||||
else if (pan_cb.role & PAN_ROLE_CLIENT) {
|
||||
if (pan_cb.pan_user_sdp_handle != 0) {
|
||||
SDP_DeleteRecord(pan_cb.pan_user_sdp_handle);
|
||||
pan_cb.pan_user_sdp_handle = 0;
|
||||
bta_sys_remove_uuid(UUID_SERVCLASS_PANU);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
/* Check if it is a shutdown request */
|
||||
if (role == PAN_ROLE_INACTIVE) {
|
||||
pan_close_all_connections();
|
||||
}
|
||||
|
||||
pan_cb.role = role;
|
||||
PAN_TRACE_EVENT("PAN role set to: %d", role);
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Connect
|
||||
*
|
||||
* Description This function is called by the application to initiate a
|
||||
* connection to the remote device
|
||||
*
|
||||
* Parameters: rem_bda - BD Addr of the remote device
|
||||
* src_role - Role of the local device for the connection
|
||||
* dst_role - Role of the remote device for the connection
|
||||
* PAN_ROLE_CLIENT is for PANU role
|
||||
* PAN_ROLE_GN_SERVER is for GN role
|
||||
* PAN_ROLE_NAP_SERVER is for NAP role
|
||||
* *handle - Pointer for returning Handle to the connection
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the connection is initiated
|
||||
* successfully
|
||||
* PAN_NO_RESOURCES - resources are not sufficient
|
||||
* PAN_FAILURE - if the connection cannot be initiated
|
||||
* this can be because of the combination of
|
||||
* src and dst roles may not be valid or
|
||||
* allowed at that point of time
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_Connect(BD_ADDR rem_bda, UINT8 src_role,
|
||||
UINT8 dst_role, UINT16 *handle)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
tBNEP_RESULT result;
|
||||
tBT_UUID src_uuid, dst_uuid;
|
||||
UINT32 mx_chan_id;
|
||||
|
||||
/*
|
||||
** Initialize the handle so that in case of failure return values
|
||||
** the profile will not get confused
|
||||
*/
|
||||
*handle = BNEP_INVALID_HANDLE;
|
||||
|
||||
/* Check if PAN is active or not */
|
||||
if (!(pan_cb.role & src_role)) {
|
||||
PAN_TRACE_ERROR("PAN is not active for the role %d", src_role);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
/* Validate the parameters before proceeding */
|
||||
if ((src_role != PAN_ROLE_CLIENT && src_role != PAN_ROLE_GN_SERVER &&
|
||||
src_role != PAN_ROLE_NAP_SERVER) ||
|
||||
(dst_role != PAN_ROLE_CLIENT && dst_role != PAN_ROLE_GN_SERVER &&
|
||||
dst_role != PAN_ROLE_NAP_SERVER)) {
|
||||
PAN_TRACE_ERROR("Either source %d or destination role %d is invalid",
|
||||
src_role, dst_role);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
/* Check if connection exists for this remote device */
|
||||
pcb = pan_get_pcb_by_addr(rem_bda);
|
||||
|
||||
/* If we are PANU for this role validate destination role */
|
||||
if (src_role == PAN_ROLE_CLIENT) {
|
||||
if ((pan_cb.num_conns > 1) || (pan_cb.num_conns && (!pcb))) {
|
||||
/*
|
||||
** If the request is not for existing connection reject it
|
||||
** because if there is already a connection we cannot accept
|
||||
** another connection in PANU role
|
||||
*/
|
||||
PAN_TRACE_ERROR(
|
||||
"Cannot make PANU connections when there are more than one "
|
||||
"connection");
|
||||
return PAN_INVALID_SRC_ROLE;
|
||||
}
|
||||
|
||||
src_uuid.uu.uuid16 = UUID_SERVCLASS_PANU;
|
||||
if (dst_role == PAN_ROLE_CLIENT) {
|
||||
dst_uuid.uu.uuid16 = UUID_SERVCLASS_PANU;
|
||||
} else if (dst_role == PAN_ROLE_GN_SERVER) {
|
||||
dst_uuid.uu.uuid16 = UUID_SERVCLASS_GN;
|
||||
} else {
|
||||
dst_uuid.uu.uuid16 = UUID_SERVCLASS_NAP;
|
||||
}
|
||||
mx_chan_id = dst_uuid.uu.uuid16;
|
||||
}
|
||||
/* If destination is PANU role validate source role */
|
||||
else if (dst_role == PAN_ROLE_CLIENT) {
|
||||
if (pan_cb.num_conns && pan_cb.active_role == PAN_ROLE_CLIENT && !pcb) {
|
||||
PAN_TRACE_ERROR("Device already have a connection in PANU role");
|
||||
return PAN_INVALID_SRC_ROLE;
|
||||
}
|
||||
|
||||
dst_uuid.uu.uuid16 = UUID_SERVCLASS_PANU;
|
||||
if (src_role == PAN_ROLE_GN_SERVER) {
|
||||
src_uuid.uu.uuid16 = UUID_SERVCLASS_GN;
|
||||
} else {
|
||||
src_uuid.uu.uuid16 = UUID_SERVCLASS_NAP;
|
||||
}
|
||||
mx_chan_id = src_uuid.uu.uuid16;
|
||||
}
|
||||
/* The role combination is not valid */
|
||||
else {
|
||||
PAN_TRACE_ERROR(
|
||||
"Source %d and Destination roles %d are not valid combination",
|
||||
src_role, dst_role);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
/* Allocate control block and initiate connection */
|
||||
if (!pcb) {
|
||||
pcb = pan_allocate_pcb(rem_bda, BNEP_INVALID_HANDLE);
|
||||
}
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN Connection failed because of no resources");
|
||||
return PAN_NO_RESOURCES;
|
||||
}
|
||||
BTM_SetOutService(rem_bda, BTM_SEC_SERVICE_BNEP_PANU, mx_chan_id);
|
||||
|
||||
PAN_TRACE_DEBUG("%s for BD Addr: %02x:%02x:%02x:%02x:%02x:%02x", __func__,
|
||||
rem_bda[0], rem_bda[1], rem_bda[2], rem_bda[3], rem_bda[4],
|
||||
rem_bda[5]);
|
||||
if (pcb->con_state == PAN_STATE_IDLE) {
|
||||
pan_cb.num_conns++;
|
||||
} else if (pcb->con_state == PAN_STATE_CONNECTED) {
|
||||
pcb->con_flags |= PAN_FLAGS_CONN_COMPLETED;
|
||||
} else
|
||||
/* PAN connection is still in progress */
|
||||
{
|
||||
return PAN_WRONG_STATE;
|
||||
}
|
||||
|
||||
pcb->con_state = PAN_STATE_CONN_START;
|
||||
pcb->prv_src_uuid = pcb->src_uuid;
|
||||
pcb->prv_dst_uuid = pcb->dst_uuid;
|
||||
|
||||
pcb->src_uuid = src_uuid.uu.uuid16;
|
||||
pcb->dst_uuid = dst_uuid.uu.uuid16;
|
||||
|
||||
src_uuid.len = 2;
|
||||
dst_uuid.len = 2;
|
||||
|
||||
result = BNEP_Connect(rem_bda, &src_uuid, &dst_uuid, &(pcb->handle));
|
||||
if (result != BNEP_SUCCESS) {
|
||||
if (pcb->con_flags & PAN_FLAGS_CONN_COMPLETED) {
|
||||
/* Role renegotiation failed synchronously; BNEP/L2CAP are still up.
|
||||
* Restore the PCB like pan_connect_state_cb does for async failures. */
|
||||
PAN_TRACE_EVENT("PAN_Connect: restore active connection after renegotiation failure");
|
||||
pcb->con_state = PAN_STATE_CONNECTED;
|
||||
pcb->con_flags &= (~PAN_FLAGS_CONN_COMPLETED);
|
||||
pcb->src_uuid = pcb->prv_src_uuid;
|
||||
pcb->dst_uuid = pcb->prv_dst_uuid;
|
||||
} else {
|
||||
/* New connection failed before going active. */
|
||||
if (pan_cb.num_conns) {
|
||||
pan_cb.num_conns--;
|
||||
}
|
||||
pan_release_pcb(pcb);
|
||||
}
|
||||
return result;
|
||||
}
|
||||
|
||||
PAN_TRACE_DEBUG("PAN_Connect() current active role set to %d", src_role);
|
||||
pan_cb.prv_active_role = pan_cb.active_role;
|
||||
pan_cb.active_role = src_role;
|
||||
*handle = pcb->handle;
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Disconnect
|
||||
*
|
||||
* Description This is used to disconnect the connection
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the connection is closed successfully
|
||||
* PAN_FAILURE - if the connection is not found or
|
||||
* there is an error in disconnecting
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_Disconnect(UINT16 handle)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
tBNEP_RESULT result;
|
||||
|
||||
/* Check if the connection exists */
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN connection not found for the handle %d", handle);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
result = BNEP_Disconnect(pcb->handle);
|
||||
if (pcb->con_state != PAN_STATE_IDLE) {
|
||||
pan_cb.num_conns--;
|
||||
}
|
||||
|
||||
if (pan_cb.pan_bridge_req_cb && pcb->src_uuid == UUID_SERVCLASS_NAP) {
|
||||
(*pan_cb.pan_bridge_req_cb)(pcb->rem_bda, FALSE);
|
||||
}
|
||||
|
||||
pan_release_pcb(pcb);
|
||||
|
||||
if (result != BNEP_SUCCESS) {
|
||||
PAN_TRACE_EVENT("Error in closing PAN connection");
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
PAN_TRACE_EVENT("PAN connection closed");
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Write
|
||||
*
|
||||
* Description This sends data over the PAN connections. If this is called
|
||||
* on GN or NAP side and the packet is multicast or broadcast
|
||||
* it will be sent on all the links. Otherwise the correct link
|
||||
* is found based on the destination address and forwarded on
|
||||
* it.
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* dst - MAC or BD Addr of the destination device
|
||||
* src - MAC or BD Addr of the source who sent this packet
|
||||
* protocol - protocol of the ethernet packet like IP or ARP
|
||||
* p_data - pointer to the data
|
||||
* len - length of the data
|
||||
* ext - to indicate that extension headers present
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the data is sent successfully
|
||||
* PAN_MTU_EXCEDED - if len exceeds PAN_MAX_WRITE_LEN
|
||||
* PAN_NO_RESOURCES - if buffer allocation fails
|
||||
* PAN_FAILURE - if the connection is not found or
|
||||
* there is an error in sending data
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_Write(UINT16 handle, BD_ADDR dst,
|
||||
BD_ADDR src, UINT16 protocol, UINT8 *p_data,
|
||||
UINT16 len, BOOLEAN ext)
|
||||
{
|
||||
if (pan_cb.role == PAN_ROLE_INACTIVE || !pan_cb.num_conns) {
|
||||
PAN_TRACE_ERROR("%s PAN is not active, data write failed.", __func__);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
if ((len > 0 && p_data == NULL) || len > PAN_MAX_WRITE_LEN) {
|
||||
PAN_TRACE_ERROR("%s invalid args: p_data=%p len=%u max=%u", __func__,
|
||||
p_data, len, (unsigned)PAN_MAX_WRITE_LEN);
|
||||
return (len > PAN_MAX_WRITE_LEN) ? PAN_MTU_EXCEDED : PAN_FAILURE;
|
||||
}
|
||||
|
||||
// If the packet is broadcast or multicast, we're going to have to create
|
||||
// a copy of the packet for each connection. We can save one extra copy
|
||||
// by fast-pathing here and calling BNEP_Write instead of placing the packet
|
||||
// in a BT_HDR buffer, calling BNEP_Write, and then freeing the buffer.
|
||||
if (dst[0] & 0x01) {
|
||||
int i;
|
||||
for (i = 0; i < MAX_PAN_CONNS; ++i) {
|
||||
if (pan_cb.pcb[i].con_state == PAN_STATE_CONNECTED) {
|
||||
BNEP_Write(pan_cb.pcb[i].handle, dst, p_data, len, protocol, src, ext);
|
||||
}
|
||||
}
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
BT_HDR *buffer = (BT_HDR *)osi_malloc(PAN_BUF_SIZE);
|
||||
if (buffer == NULL) {
|
||||
PAN_TRACE_ERROR("%s: no resources", __func__);
|
||||
return PAN_NO_RESOURCES;
|
||||
}
|
||||
buffer->len = len;
|
||||
buffer->offset = PAN_MINIMUM_OFFSET;
|
||||
if (len > 0) {
|
||||
memcpy((UINT8 *)(buffer + 1) + buffer->offset, p_data, len);
|
||||
}
|
||||
|
||||
return PAN_WriteBuf(handle, dst, src, protocol, buffer, ext);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_WriteBuf
|
||||
*
|
||||
* Description This sends data over the PAN connections. If this is called
|
||||
* on GN or NAP side and the packet is multicast or broadcast
|
||||
* it will be sent on all the links. Otherwise the correct link
|
||||
* is found based on the destination address and forwarded on
|
||||
* it. PAN_WriteBuf always takes ownership of p_buf: the buffer
|
||||
* is either freed or queued by this function (or by
|
||||
* BNEP_WriteBuf) regardless of the return value. The caller
|
||||
* must not access or free p_buf after the call.
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* dst - MAC or BD Addr of the destination device
|
||||
* src - MAC or BD Addr of the source who sent this packet
|
||||
* protocol - protocol of the ethernet packet like IP or ARP
|
||||
* p_buf - pointer to the data buffer
|
||||
* ext - to indicate that extension headers present
|
||||
*
|
||||
* Returns PAN_SUCCESS - if the data is sent successfully
|
||||
* PAN_FAILURE - if the connection is not found or
|
||||
* there is an error in sending data
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_WriteBuf(UINT16 handle, BD_ADDR dst,
|
||||
BD_ADDR src, UINT16 protocol,
|
||||
BT_HDR *p_buf, BOOLEAN ext)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
UINT16 i;
|
||||
tBNEP_RESULT result;
|
||||
|
||||
if (pan_cb.role == PAN_ROLE_INACTIVE || (!(pan_cb.num_conns))) {
|
||||
PAN_TRACE_ERROR("PAN is not active Data write failed");
|
||||
osi_free(p_buf);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
/* Check if it is broadcast or multicast packet */
|
||||
if (dst[0] & 0x01) {
|
||||
UINT8 *data = (UINT8 *)p_buf + sizeof(BT_HDR) + p_buf->offset;
|
||||
for (i = 0; i < MAX_PAN_CONNS; ++i) {
|
||||
if (pan_cb.pcb[i].con_state == PAN_STATE_CONNECTED)
|
||||
BNEP_Write(pan_cb.pcb[i].handle, dst, data, p_buf->len, protocol, src,
|
||||
ext);
|
||||
}
|
||||
osi_free(p_buf);
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/* Check if the data write is on PANU side */
|
||||
if (pan_cb.active_role == PAN_ROLE_CLIENT) {
|
||||
/* Data write is on PANU connection */
|
||||
for (i = 0; i < MAX_PAN_CONNS; i++) {
|
||||
if (pan_cb.pcb[i].con_state == PAN_STATE_CONNECTED &&
|
||||
pan_cb.pcb[i].src_uuid == UUID_SERVCLASS_PANU) {
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (i == MAX_PAN_CONNS) {
|
||||
PAN_TRACE_ERROR("PAN Don't have any user connections");
|
||||
osi_free(p_buf);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
result =
|
||||
BNEP_WriteBuf(pan_cb.pcb[i].handle, dst, p_buf, protocol, src, ext);
|
||||
if (result == BNEP_IGNORE_CMD) {
|
||||
PAN_TRACE_DEBUG("PAN ignored data write for PANU connection");
|
||||
return result;
|
||||
} else if (result != BNEP_SUCCESS) {
|
||||
PAN_TRACE_ERROR("PAN failed to write data for the PANU connection");
|
||||
return result;
|
||||
}
|
||||
|
||||
PAN_TRACE_DEBUG("PAN successfully wrote data for the PANU connection");
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/* find out to which connection the data is meant for */
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN Buf write for wrong handle");
|
||||
osi_free(p_buf);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
if (pcb->con_state != PAN_STATE_CONNECTED) {
|
||||
PAN_TRACE_ERROR("PAN Buf write when conn is not active");
|
||||
osi_free(p_buf);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
result = BNEP_WriteBuf(pcb->handle, dst, p_buf, protocol, src, ext);
|
||||
if (result == BNEP_IGNORE_CMD) {
|
||||
PAN_TRACE_DEBUG("PAN ignored data buf write to PANU");
|
||||
return result;
|
||||
} else if (result != BNEP_SUCCESS) {
|
||||
PAN_TRACE_ERROR("PAN failed to send data buf to the PANU");
|
||||
return result;
|
||||
}
|
||||
|
||||
PAN_TRACE_DEBUG("PAN successfully sent data buf to the PANU");
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetProtocolFilters
|
||||
*
|
||||
* Description This function is used to set protocol filters on the peer
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* num_filters - number of protocol filter ranges
|
||||
* start - array of starting protocol numbers
|
||||
* end - array of ending protocol numbers
|
||||
*
|
||||
*
|
||||
* Returns PAN_SUCCESS if protocol filters are set successfully
|
||||
* PAN_FAILURE if connection not found or error in setting
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_SetProtocolFilters(UINT16 handle, UINT16 num_filters,
|
||||
UINT16 *p_start_array,
|
||||
UINT16 *p_end_array)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
tPAN_RESULT result;
|
||||
|
||||
/* Check if the connection exists */
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN connection not found for the handle %d", handle);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
result = BNEP_SetProtocolFilters(pcb->handle, num_filters, p_start_array,
|
||||
p_end_array);
|
||||
if (result != BNEP_SUCCESS) {
|
||||
PAN_TRACE_ERROR("PAN failed to set protocol filters for handle %d", handle);
|
||||
return result;
|
||||
}
|
||||
|
||||
PAN_TRACE_API("PAN successfully sent protocol filters for handle %d", handle);
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetMulticastFilters
|
||||
*
|
||||
* Description This function is used to set multicast filters on the peer
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* num_filters - number of multicast filter ranges
|
||||
* start - array of starting multicast filter addresses
|
||||
* end - array of ending multicast filter addresses
|
||||
*
|
||||
*
|
||||
* Returns PAN_SUCCESS if multicast filters are set successfully
|
||||
* PAN_FAILURE if connection not found or error in setting
|
||||
*
|
||||
******************************************************************************/
|
||||
tPAN_RESULT PAN_SetMulticastFilters(UINT16 handle,
|
||||
UINT16 num_mcast_filters,
|
||||
UINT8 *p_start_array,
|
||||
UINT8 *p_end_array)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
tPAN_RESULT result;
|
||||
|
||||
/* Check if the connection exists */
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN connection not found for the handle %d", handle);
|
||||
return PAN_FAILURE;
|
||||
}
|
||||
|
||||
result = BNEP_SetMulticastFilters(pcb->handle, num_mcast_filters,
|
||||
p_start_array, p_end_array);
|
||||
if (result != BNEP_SUCCESS) {
|
||||
PAN_TRACE_ERROR("PAN failed to set multicast filters for handle %d",
|
||||
handle);
|
||||
return result;
|
||||
}
|
||||
|
||||
PAN_TRACE_API("PAN successfully sent multicast filters for handle %d",
|
||||
handle);
|
||||
return PAN_SUCCESS;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_SetTraceLevel
|
||||
*
|
||||
* Description This function sets the trace level for PAN. If called with
|
||||
* a value of 0xFF, it simply reads the current trace level.
|
||||
*
|
||||
* Returns the new (current) trace level
|
||||
*
|
||||
******************************************************************************/
|
||||
UINT8 PAN_SetTraceLevel(UINT8 new_level)
|
||||
{
|
||||
if (new_level != 0xFF) {
|
||||
pan_cb.trace_level = new_level;
|
||||
} else {
|
||||
pan_dump_status();
|
||||
}
|
||||
|
||||
return (pan_cb.trace_level);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function PAN_Init
|
||||
*
|
||||
* Description This function initializes the PAN module variables
|
||||
*
|
||||
* Parameters: none
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void PAN_Init(void)
|
||||
{
|
||||
memset(&pan_cb, 0, sizeof(tPAN_CB));
|
||||
|
||||
#if defined(PAN_INITIAL_TRACE_LEVEL)
|
||||
pan_cb.trace_level = PAN_INITIAL_TRACE_LEVEL;
|
||||
#else
|
||||
pan_cb.trace_level = BT_TRACE_LEVEL_NONE; /* No traces */
|
||||
#endif
|
||||
}
|
||||
|
||||
#endif /* (PAN_INCLUDED == TRUE) */
|
||||
@@ -0,0 +1,724 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* 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 "osi/allocator.h"
|
||||
#include "stack/bnep_api.h"
|
||||
#include "bt_common.h"
|
||||
#include "stack/bt_types.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"
|
||||
|
||||
tPAN_CB pan_cb;
|
||||
|
||||
#define UUID_CONSTANT_PART 12
|
||||
UINT8 constant_pan_uuid[UUID_CONSTANT_PART] = {
|
||||
0, 0, 0x10, 0, 0x80, 0x00, 0x00, 0x80, 0x5f, 0x9b, 0x34, 0xfb
|
||||
};
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_register_with_bnep
|
||||
*
|
||||
* Description This function registers PAN profile with BNEP
|
||||
*
|
||||
* Parameters: none
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_register_with_bnep(void)
|
||||
{
|
||||
tBNEP_REGISTER reg_info;
|
||||
|
||||
memset(®_info, 0, sizeof(tBNEP_REGISTER));
|
||||
|
||||
reg_info.p_conn_ind_cb = pan_conn_ind_cb;
|
||||
reg_info.p_conn_state_cb = pan_connect_state_cb;
|
||||
reg_info.p_data_buf_cb = pan_data_buf_ind_cb;
|
||||
reg_info.p_data_ind_cb = NULL;
|
||||
reg_info.p_tx_data_flow_cb = pan_tx_data_flow_cb;
|
||||
reg_info.p_filter_ind_cb = pan_proto_filt_ind_cb;
|
||||
reg_info.p_mfilter_ind_cb = pan_mcast_filt_ind_cb;
|
||||
|
||||
BNEP_Register(®_info);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_conn_ind_cb
|
||||
*
|
||||
* Description This function is registered with BNEP as connection
|
||||
* indication callback. BNEP will call this when there is
|
||||
* connection request from the peer. PAN should call
|
||||
* BNEP_ConnectResp to indicate whether to accept the
|
||||
* connection or reject
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* p_bda - BD Addr of the peer requesting the connection
|
||||
* remote_uuid - UUID of the source role (peer device role)
|
||||
* local_uuid - UUID of the destination role (local device
|
||||
* role)
|
||||
* is_role_change - Flag to indicate that it is a role change
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_conn_ind_cb(UINT16 handle, BD_ADDR p_bda,
|
||||
tBT_UUID *remote_uuid, tBT_UUID *local_uuid,
|
||||
BOOLEAN is_role_change)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
UINT8 req_role;
|
||||
BOOLEAN wrong_uuid;
|
||||
|
||||
/*
|
||||
** If we are in GN or NAP role and have one or more
|
||||
** active connections and the received connection is
|
||||
** for user role reject it.
|
||||
** If we are in user role with one connection active
|
||||
** reject the connection.
|
||||
** Allocate PCB and store the parameters
|
||||
** Make bridge request to the host system if connection
|
||||
** is for NAP
|
||||
*/
|
||||
wrong_uuid = FALSE;
|
||||
if (remote_uuid->len == 16) {
|
||||
/*
|
||||
** If the UUID is 16 bytes first two bytes should be zeros
|
||||
** and last 12 bytes should match the spec defined constant value
|
||||
*/
|
||||
if (memcmp(constant_pan_uuid, remote_uuid->uu.uuid128 + 4,
|
||||
UUID_CONSTANT_PART)) {
|
||||
wrong_uuid = TRUE;
|
||||
}
|
||||
|
||||
if (remote_uuid->uu.uuid128[0] || remote_uuid->uu.uuid128[1]) {
|
||||
wrong_uuid = TRUE;
|
||||
}
|
||||
|
||||
/* Extract the 16 bit equivalent of the UUID */
|
||||
remote_uuid->uu.uuid16 = (UINT16)((remote_uuid->uu.uuid128[2] << 8) |
|
||||
remote_uuid->uu.uuid128[3]);
|
||||
remote_uuid->len = 2;
|
||||
}
|
||||
if (remote_uuid->len == 4) {
|
||||
/* First two bytes should be zeros */
|
||||
if (remote_uuid->uu.uuid32 & 0xFFFF0000) {
|
||||
wrong_uuid = true;
|
||||
}
|
||||
|
||||
remote_uuid->uu.uuid16 = (UINT16)remote_uuid->uu.uuid32;
|
||||
remote_uuid->len = 2;
|
||||
}
|
||||
|
||||
if (wrong_uuid) {
|
||||
PAN_TRACE_ERROR("PAN Connection failed because of wrong remote UUID ");
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_SRC_UUID);
|
||||
return;
|
||||
}
|
||||
|
||||
wrong_uuid = FALSE;
|
||||
if (local_uuid->len == 16) {
|
||||
/*
|
||||
** If the UUID is 16 bytes first two bytes should be zeros
|
||||
** and last 12 bytes should match the spec defined constant value
|
||||
*/
|
||||
if (memcmp(constant_pan_uuid, local_uuid->uu.uuid128 + 4,
|
||||
UUID_CONSTANT_PART)) {
|
||||
wrong_uuid = TRUE;
|
||||
}
|
||||
|
||||
if (local_uuid->uu.uuid128[0] || local_uuid->uu.uuid128[1]) {
|
||||
wrong_uuid = TRUE;
|
||||
}
|
||||
|
||||
/* Extract the 16 bit equivalent of the UUID */
|
||||
local_uuid->uu.uuid16 = (UINT16)((local_uuid->uu.uuid128[2] << 8) |
|
||||
local_uuid->uu.uuid128[3]);
|
||||
local_uuid->len = 2;
|
||||
}
|
||||
if (local_uuid->len == 4) {
|
||||
/* First two bytes should be zeros */
|
||||
if (local_uuid->uu.uuid32 & 0xFFFF0000) {
|
||||
wrong_uuid = true;
|
||||
}
|
||||
|
||||
local_uuid->uu.uuid16 = (UINT16)local_uuid->uu.uuid32;
|
||||
local_uuid->len = 2;
|
||||
}
|
||||
|
||||
if (wrong_uuid) {
|
||||
PAN_TRACE_ERROR("PAN Connection failed because of wrong local UUID ");
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_DST_UUID);
|
||||
return;
|
||||
}
|
||||
|
||||
PAN_TRACE_EVENT(
|
||||
"pan_conn_ind_cb - for handle %d, current role %d, dst uuid 0x%x, src "
|
||||
"uuid 0x%x, role change %s",
|
||||
handle, pan_cb.role, local_uuid->uu.uuid16, remote_uuid->uu.uuid16,
|
||||
is_role_change ? "YES" : "NO");
|
||||
/* The acceptable UUID size is only 2 */
|
||||
if (remote_uuid->len != 2) {
|
||||
PAN_TRACE_ERROR("PAN Connection failed because of wrong UUID size %d",
|
||||
remote_uuid->len);
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_UUID_SIZE);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check if the source UUID is a valid one */
|
||||
if (remote_uuid->uu.uuid16 != UUID_SERVCLASS_PANU &&
|
||||
remote_uuid->uu.uuid16 != UUID_SERVCLASS_NAP &&
|
||||
remote_uuid->uu.uuid16 != UUID_SERVCLASS_GN) {
|
||||
PAN_TRACE_ERROR("Src UUID 0x%x is not valid", remote_uuid->uu.uuid16);
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_SRC_UUID);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check if the destination UUID is a valid one */
|
||||
if (local_uuid->uu.uuid16 != UUID_SERVCLASS_PANU &&
|
||||
local_uuid->uu.uuid16 != UUID_SERVCLASS_NAP &&
|
||||
local_uuid->uu.uuid16 != UUID_SERVCLASS_GN) {
|
||||
PAN_TRACE_ERROR("Dst UUID 0x%x is not valid", local_uuid->uu.uuid16);
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_DST_UUID);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check if currently we support the destination role requested */
|
||||
if (((!(pan_cb.role & PAN_ROLE_CLIENT)) &&
|
||||
local_uuid->uu.uuid16 == UUID_SERVCLASS_PANU) ||
|
||||
((!(pan_cb.role & PAN_ROLE_GN_SERVER)) &&
|
||||
local_uuid->uu.uuid16 == UUID_SERVCLASS_GN) ||
|
||||
((!(pan_cb.role & PAN_ROLE_NAP_SERVER)) &&
|
||||
local_uuid->uu.uuid16 == UUID_SERVCLASS_NAP)) {
|
||||
PAN_TRACE_ERROR(
|
||||
"PAN Connection failed because of unsupported destination UUID 0x%x",
|
||||
local_uuid->uu.uuid16);
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_DST_UUID);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Requested destination role is */
|
||||
if (local_uuid->uu.uuid16 == UUID_SERVCLASS_PANU) {
|
||||
req_role = PAN_ROLE_CLIENT;
|
||||
} else if (local_uuid->uu.uuid16 == UUID_SERVCLASS_GN) {
|
||||
req_role = PAN_ROLE_GN_SERVER;
|
||||
} else {
|
||||
req_role = PAN_ROLE_NAP_SERVER;
|
||||
}
|
||||
|
||||
/* If the connection indication is for the existing connection
|
||||
** Check if the new destination role is acceptable
|
||||
*/
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (pcb) {
|
||||
if (pan_cb.num_conns > 1 && local_uuid->uu.uuid16 == UUID_SERVCLASS_PANU) {
|
||||
/* There are connections other than this one
|
||||
** so we can't accept PANU role. Reject
|
||||
*/
|
||||
PAN_TRACE_ERROR(
|
||||
"Dst UUID should be either GN or NAP only because there are other "
|
||||
"connections");
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_DST_UUID);
|
||||
return;
|
||||
}
|
||||
|
||||
/* If it is already in connected state check for bridging status */
|
||||
if (pcb->con_state == PAN_STATE_CONNECTED) {
|
||||
PAN_TRACE_EVENT("PAN Role changing New Src 0x%x Dst 0x%x",
|
||||
remote_uuid->uu.uuid16, local_uuid->uu.uuid16);
|
||||
|
||||
pcb->prv_src_uuid = pcb->src_uuid;
|
||||
pcb->prv_dst_uuid = pcb->dst_uuid;
|
||||
|
||||
if (pcb->src_uuid == UUID_SERVCLASS_NAP &&
|
||||
local_uuid->uu.uuid16 != UUID_SERVCLASS_NAP) {
|
||||
/* Remove bridging */
|
||||
if (pan_cb.pan_bridge_req_cb) {
|
||||
(*pan_cb.pan_bridge_req_cb)(pcb->rem_bda, FALSE);
|
||||
}
|
||||
}
|
||||
}
|
||||
/* Set the latest active PAN role */
|
||||
pan_cb.active_role = req_role;
|
||||
pcb->src_uuid = local_uuid->uu.uuid16;
|
||||
pcb->dst_uuid = remote_uuid->uu.uuid16;
|
||||
BNEP_ConnectResp(handle, BNEP_SUCCESS);
|
||||
return;
|
||||
} else {
|
||||
/* If this a new connection and destination is PANU role and
|
||||
** we already have a connection then reject the request.
|
||||
** If we have a connection in PANU role then reject it
|
||||
*/
|
||||
if (pan_cb.num_conns && (local_uuid->uu.uuid16 == UUID_SERVCLASS_PANU ||
|
||||
pan_cb.active_role == PAN_ROLE_CLIENT)) {
|
||||
PAN_TRACE_ERROR("PAN already have a connection and can't be user");
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED_DST_UUID);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
/* This is a new connection */
|
||||
PAN_TRACE_DEBUG("New connection indication for handle %d", handle);
|
||||
pcb = pan_allocate_pcb(p_bda, handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN no control block for new connection");
|
||||
BNEP_ConnectResp(handle, BNEP_CONN_FAILED);
|
||||
return;
|
||||
}
|
||||
|
||||
PAN_TRACE_EVENT("PAN connection destination UUID is 0x%x",
|
||||
local_uuid->uu.uuid16);
|
||||
/* Set the latest active PAN role */
|
||||
pan_cb.active_role = req_role;
|
||||
pcb->src_uuid = local_uuid->uu.uuid16;
|
||||
pcb->dst_uuid = remote_uuid->uu.uuid16;
|
||||
pcb->con_state = PAN_STATE_CONN_START;
|
||||
pan_cb.num_conns++;
|
||||
|
||||
BNEP_ConnectResp(handle, BNEP_SUCCESS);
|
||||
return;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_connect_state_cb
|
||||
*
|
||||
* Description This function is registered with BNEP as connection state
|
||||
* change callback. BNEP will call this when the connection
|
||||
* is established successfully or terminated
|
||||
*
|
||||
* Parameters: handle - handle for the connection given in the connection
|
||||
* indication callback
|
||||
* rem_bda - remote device bd addr
|
||||
* result - indicates whether the connection is up or down
|
||||
* BNEP_SUCCESS if the connection is up all other
|
||||
* values indicate appropriate errors.
|
||||
* is_role_change - flag to indicate that it is a role change
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_connect_state_cb(UINT16 handle, BD_ADDR rem_bda,
|
||||
tBNEP_RESULT result, BOOLEAN is_role_change)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
UINT8 peer_role;
|
||||
|
||||
PAN_TRACE_EVENT("pan_connect_state_cb - for handle %d, result %d", handle,
|
||||
result);
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN State change indication for wrong handle %d", handle);
|
||||
return;
|
||||
}
|
||||
|
||||
/* If the connection is getting terminated remove bridging */
|
||||
if (result != BNEP_SUCCESS) {
|
||||
/* Inform the application that connection is down */
|
||||
if (pan_cb.pan_conn_state_cb)
|
||||
(*pan_cb.pan_conn_state_cb)(pcb->handle, pcb->rem_bda, result,
|
||||
is_role_change, PAN_ROLE_INACTIVE,
|
||||
PAN_ROLE_INACTIVE);
|
||||
|
||||
/* Check if this failure is for role change only */
|
||||
if (pcb->con_state != PAN_STATE_CONNECTED &&
|
||||
(pcb->con_flags & PAN_FLAGS_CONN_COMPLETED)) {
|
||||
/* restore the original values */
|
||||
PAN_TRACE_EVENT("restoring the connection state to active");
|
||||
pcb->con_state = PAN_STATE_CONNECTED;
|
||||
pcb->con_flags &= (~PAN_FLAGS_CONN_COMPLETED);
|
||||
|
||||
pcb->src_uuid = pcb->prv_src_uuid;
|
||||
pcb->dst_uuid = pcb->prv_dst_uuid;
|
||||
pan_cb.active_role = pan_cb.prv_active_role;
|
||||
|
||||
if ((pcb->src_uuid == UUID_SERVCLASS_NAP) && pan_cb.pan_bridge_req_cb) {
|
||||
(*pan_cb.pan_bridge_req_cb)(pcb->rem_bda, TRUE);
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
if (pcb->con_state == PAN_STATE_CONNECTED) {
|
||||
/* If the connections destination role is NAP remove bridging */
|
||||
if ((pcb->src_uuid == UUID_SERVCLASS_NAP) && pan_cb.pan_bridge_req_cb) {
|
||||
(*pan_cb.pan_bridge_req_cb)(pcb->rem_bda, FALSE);
|
||||
}
|
||||
}
|
||||
|
||||
pan_cb.num_conns--;
|
||||
pan_release_pcb(pcb);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Requested destination role is */
|
||||
if (pcb->src_uuid == UUID_SERVCLASS_PANU) {
|
||||
pan_cb.active_role = PAN_ROLE_CLIENT;
|
||||
} else if (pcb->src_uuid == UUID_SERVCLASS_GN) {
|
||||
pan_cb.active_role = PAN_ROLE_GN_SERVER;
|
||||
} else {
|
||||
pan_cb.active_role = PAN_ROLE_NAP_SERVER;
|
||||
}
|
||||
|
||||
if (pcb->dst_uuid == UUID_SERVCLASS_PANU) {
|
||||
peer_role = PAN_ROLE_CLIENT;
|
||||
} else if (pcb->dst_uuid == UUID_SERVCLASS_GN) {
|
||||
peer_role = PAN_ROLE_GN_SERVER;
|
||||
} else {
|
||||
peer_role = PAN_ROLE_NAP_SERVER;
|
||||
}
|
||||
|
||||
pcb->con_state = PAN_STATE_CONNECTED;
|
||||
|
||||
/* Inform the application that connection is down */
|
||||
if (pan_cb.pan_conn_state_cb)
|
||||
(*pan_cb.pan_conn_state_cb)(pcb->handle, pcb->rem_bda, PAN_SUCCESS,
|
||||
is_role_change, pan_cb.active_role, peer_role);
|
||||
|
||||
/* Create bridge if the destination role is NAP */
|
||||
if (pan_cb.pan_bridge_req_cb && pcb->src_uuid == UUID_SERVCLASS_NAP) {
|
||||
PAN_TRACE_EVENT("PAN requesting for bridge");
|
||||
(*pan_cb.pan_bridge_req_cb)(pcb->rem_bda, TRUE);
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_data_ind_cb
|
||||
*
|
||||
* Description This function is registered with BNEP as data indication
|
||||
* callback. BNEP will call this when the peer sends any data
|
||||
* on this connection
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* src - source BD Addr
|
||||
* dst - destination BD Addr
|
||||
* protocol - Network protocol of the Eth packet
|
||||
* p_data - pointer to the data
|
||||
* len - length of the data
|
||||
* fw_ext_present - to indicate whether the data contains any
|
||||
* extension headers before the payload
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_data_ind_cb(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol, UINT8 *p_data,
|
||||
UINT16 len, BOOLEAN ext)
|
||||
{
|
||||
tPAN_CONN *pcb;
|
||||
UINT16 i;
|
||||
BOOLEAN forward;
|
||||
|
||||
/*
|
||||
** Check the connection status
|
||||
** If the destination address is MAC broadcast send on all links
|
||||
** except on the one received
|
||||
** If the destination uuid is for NAP send to host system also
|
||||
** If the destination address is one of the devices connected
|
||||
** send the packet to over that link
|
||||
** If the destination address is unknown and destination uuid is NAP
|
||||
** send it to the host system
|
||||
*/
|
||||
|
||||
PAN_TRACE_EVENT("pan_data_ind_cb - for handle %d", handle);
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN Data indication for wrong handle %d", handle);
|
||||
return;
|
||||
}
|
||||
|
||||
if (pcb->con_state != PAN_STATE_CONNECTED) {
|
||||
PAN_TRACE_ERROR("PAN Data indication in wrong state %d for handle %d",
|
||||
pcb->con_state, handle);
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check if it is broadcast packet */
|
||||
if (dst[0] & 0x01) {
|
||||
PAN_TRACE_DEBUG("PAN received broadcast packet on handle %d, src uuid 0x%x",
|
||||
handle, pcb->src_uuid);
|
||||
for (i = 0; i < MAX_PAN_CONNS; i++) {
|
||||
if (pan_cb.pcb[i].con_state == PAN_STATE_CONNECTED &&
|
||||
pan_cb.pcb[i].handle != handle &&
|
||||
pcb->src_uuid == pan_cb.pcb[i].src_uuid) {
|
||||
BNEP_Write(pan_cb.pcb[i].handle, dst, p_data, len, protocol, src, ext);
|
||||
}
|
||||
}
|
||||
|
||||
if (pan_cb.pan_data_ind_cb)
|
||||
(*pan_cb.pan_data_ind_cb)(pcb->handle, src, dst, protocol, p_data, len,
|
||||
ext, TRUE);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check if it is for any other PAN connection */
|
||||
for (i = 0; i < MAX_PAN_CONNS; i++) {
|
||||
if (pan_cb.pcb[i].con_state == PAN_STATE_CONNECTED &&
|
||||
pcb->src_uuid == pan_cb.pcb[i].src_uuid) {
|
||||
if (!bdcmp(pan_cb.pcb[i].rem_bda, dst)) {
|
||||
BNEP_Write(pan_cb.pcb[i].handle, dst, p_data, len, protocol, src, ext);
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (pcb->src_uuid == UUID_SERVCLASS_NAP) {
|
||||
forward = TRUE;
|
||||
} else {
|
||||
forward = FALSE;
|
||||
}
|
||||
|
||||
/* Send it over the LAN or give it to host software */
|
||||
if (pan_cb.pan_data_ind_cb)
|
||||
(*pan_cb.pan_data_ind_cb)(pcb->handle, src, dst, protocol, p_data, len, ext,
|
||||
forward);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_data_buf_ind_cb
|
||||
*
|
||||
* Description This function is registered with BNEP as data buffer
|
||||
* indication callback. BNEP will call this when the peer sends
|
||||
* any data on this connection. PAN is responsible to release
|
||||
* the buffer
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* src - source BD Addr
|
||||
* dst - destination BD Addr
|
||||
* protocol - Network protocol of the Eth packet
|
||||
* p_buf - pointer to the data buffer
|
||||
* ext - to indicate whether the data contains any
|
||||
* extension headers before the payload
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_data_buf_ind_cb(UINT16 handle, BD_ADDR src,
|
||||
BD_ADDR dst, UINT16 protocol,
|
||||
BT_HDR *p_buf, BOOLEAN ext)
|
||||
{
|
||||
tPAN_CONN *pcb, *dst_pcb;
|
||||
tBNEP_RESULT result;
|
||||
UINT16 i, len;
|
||||
UINT8 *p_data;
|
||||
BOOLEAN forward = FALSE;
|
||||
|
||||
/* Check if the connection is in right state */
|
||||
pcb = pan_get_pcb_by_handle(handle);
|
||||
if (!pcb) {
|
||||
PAN_TRACE_ERROR("PAN Data buffer indication for wrong handle %d", handle);
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
if (pcb->con_state != PAN_STATE_CONNECTED) {
|
||||
PAN_TRACE_ERROR("PAN Data indication in wrong state %d for handle %d",
|
||||
pcb->con_state, handle);
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
|
||||
p_data = (UINT8 *)(p_buf + 1) + p_buf->offset;
|
||||
len = p_buf->len;
|
||||
|
||||
PAN_TRACE_EVENT(
|
||||
"pan_data_buf_ind_cb - for handle %d, protocol 0x%x, length %d, ext %d",
|
||||
handle, protocol, len, ext);
|
||||
|
||||
if (pcb->src_uuid == UUID_SERVCLASS_NAP) {
|
||||
forward = TRUE;
|
||||
} else {
|
||||
forward = FALSE;
|
||||
}
|
||||
|
||||
/* Check if it is broadcast or multicast packet */
|
||||
if (pcb->src_uuid != UUID_SERVCLASS_PANU) {
|
||||
if (dst[0] & 0x01) {
|
||||
PAN_TRACE_DEBUG(
|
||||
"PAN received broadcast packet on handle %d, src uuid 0x%x", handle,
|
||||
pcb->src_uuid);
|
||||
for (i = 0; i < MAX_PAN_CONNS; i++) {
|
||||
if (pan_cb.pcb[i].con_state == PAN_STATE_CONNECTED &&
|
||||
pan_cb.pcb[i].handle != handle &&
|
||||
pcb->src_uuid == pan_cb.pcb[i].src_uuid) {
|
||||
BNEP_Write(pan_cb.pcb[i].handle, dst, p_data, len, protocol, src,
|
||||
ext);
|
||||
}
|
||||
}
|
||||
|
||||
if (pan_cb.pan_data_buf_ind_cb)
|
||||
(*pan_cb.pan_data_buf_ind_cb)(pcb->handle, src, dst, protocol, p_buf,
|
||||
ext, forward);
|
||||
else if (pan_cb.pan_data_ind_cb) {
|
||||
(*pan_cb.pan_data_ind_cb)(pcb->handle, src, dst, protocol, p_data, len,
|
||||
ext, forward);
|
||||
osi_free(p_buf);
|
||||
} else {
|
||||
osi_free(p_buf);
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/* Check if it is for any other PAN connection */
|
||||
dst_pcb = pan_get_pcb_by_addr(dst);
|
||||
if (dst_pcb) {
|
||||
PAN_TRACE_EVENT(
|
||||
"%s - destination PANU found on handle %d and sending data, len: %d",
|
||||
__func__, dst_pcb->handle, len);
|
||||
|
||||
result =
|
||||
BNEP_Write(dst_pcb->handle, dst, p_data, len, protocol, src, ext);
|
||||
if (result != BNEP_SUCCESS && result != BNEP_IGNORE_CMD)
|
||||
PAN_TRACE_ERROR("Failed to write data for PAN connection handle %d",
|
||||
dst_pcb->handle);
|
||||
osi_free(p_buf);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
/* Send it over the LAN or give it to host software */
|
||||
if (pan_cb.pan_data_buf_ind_cb)
|
||||
(*pan_cb.pan_data_buf_ind_cb)(pcb->handle, src, dst, protocol, p_buf, ext,
|
||||
forward);
|
||||
else if (pan_cb.pan_data_ind_cb) {
|
||||
(*pan_cb.pan_data_ind_cb)(pcb->handle, src, dst, protocol, p_data, len, ext,
|
||||
forward);
|
||||
osi_free(p_buf);
|
||||
} else {
|
||||
osi_free(p_buf);
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_proto_filt_ind_cb
|
||||
*
|
||||
* Description This function is registered with BNEP to receive tx data
|
||||
* flow status
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* event - flow status
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_tx_data_flow_cb(UINT16 handle, tBNEP_RESULT event)
|
||||
{
|
||||
if (pan_cb.pan_tx_data_flow_cb) {
|
||||
(*pan_cb.pan_tx_data_flow_cb)(handle, event);
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_proto_filt_ind_cb
|
||||
*
|
||||
* Description This function is registered with BNEP as proto filter
|
||||
* indication callback. BNEP will call this when the peer sends
|
||||
* any protocol filter set for the connection or to indicate
|
||||
* the result of the protocol filter set by the local device
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* indication - true if this is indication
|
||||
* false if it is called to give the result of
|
||||
* local device protocol filter set
|
||||
* result - This gives the result of the filter set
|
||||
* operation
|
||||
* num_filters - number of filters set by the peer device
|
||||
* p_filters - pointer to the filters set by the peer device
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_proto_filt_ind_cb(UINT16 handle, BOOLEAN indication,
|
||||
tBNEP_RESULT result, UINT16 num_filters,
|
||||
UINT8 *p_filters)
|
||||
{
|
||||
PAN_TRACE_EVENT(
|
||||
"pan_proto_filt_ind_cb - called for handle %d with ind %d, result %d, "
|
||||
"num %d",
|
||||
handle, indication, result, num_filters);
|
||||
|
||||
if (pan_cb.pan_pfilt_ind_cb)
|
||||
(*pan_cb.pan_pfilt_ind_cb)(handle, indication, (tPAN_RESULT)result,
|
||||
num_filters, p_filters);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
*
|
||||
* Function pan_mcast_filt_ind_cb
|
||||
*
|
||||
* Description This function is registered with BNEP as mcast filter
|
||||
* indication callback. BNEP will call this when the peer sends
|
||||
* any multicast filter set for the connection or to indicate
|
||||
* the result of the multicast filter set by the local device
|
||||
*
|
||||
* Parameters: handle - handle for the connection
|
||||
* indication - true if this is indication
|
||||
* false if it is called to give the result of
|
||||
* local device multicast filter set
|
||||
* result - This gives the result of the filter set
|
||||
* operation
|
||||
* num_filters - number of filters set by the peer device
|
||||
* p_filters - pointer to the filters set by the peer device
|
||||
*
|
||||
* Returns none
|
||||
*
|
||||
******************************************************************************/
|
||||
void pan_mcast_filt_ind_cb(UINT16 handle, BOOLEAN indication,
|
||||
tBNEP_RESULT result, UINT16 num_filters,
|
||||
UINT8 *p_filters)
|
||||
{
|
||||
PAN_TRACE_EVENT(
|
||||
"pan_mcast_filt_ind_cb - called for handle %d with ind %d, result %d, "
|
||||
"num %d",
|
||||
handle, indication, result, num_filters);
|
||||
|
||||
if (pan_cb.pan_mfilt_ind_cb)
|
||||
(*pan_cb.pan_mfilt_ind_cb)(handle, indication, (tPAN_RESULT)result,
|
||||
num_filters, p_filters);
|
||||
}
|
||||
|
||||
#endif /* (PAN_INCLUDED == TRUE) */
|
||||
@@ -0,0 +1,335 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* 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) */
|
||||
Reference in New Issue
Block a user