/******************************************************************************
*
* Copyright 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 "bnep_api.h"
#include <string.h>
#include "bnep_int.h"
using bluetooth::Uuid;
/*******************************************************************************
*
* 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.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(const RawAddress& p_rem_bda, const Uuid& src_uuid,
const Uuid& dst_uuid, uint16_t* p_handle) {
uint16_t cid;
tBNEP_CONN* p_bcb = bnepu_find_bcb_by_bd_addr(p_rem_bda);
VLOG(0) << __func__ << " BDA:" << p_rem_bda;
if (!bnep_cb.profile_registered) return BNEP_WRONG_STATE;
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 */
p_bcb->prv_src_uuid = p_bcb->src_uuid;
p_bcb->prv_dst_uuid = p_bcb->dst_uuid;
}
/* We are the originator of this connection */
p_bcb->con_flags |= BNEP_FLAGS_IS_ORIG;
p_bcb->src_uuid = src_uuid;
p_bcb->dst_uuid = dst_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 %s",
p_bcb->src_uuid.ToString().c_str());
#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, src_uuid.As32Bit(),
&bnep_sec_check_complete, p_bcb);
#else
bnep_sec_check_complete(p_bcb->rem_bda, 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 */
alarm_set_on_mloop(p_bcb->conn_timer, BNEP_CONN_TIMEOUT_MS,
bnep_conn_timer_timeout, p_bcb);
}
*p_handle = p_bcb->handle;
return (BNEP_SUCCESS);
}
/*******************************************************************************
*
* Function BNEP_ConnectResp
*
* Description This function is called in responce to connection indication
*
*
* Parameters: handle - handle given in the connection indication
* resp - responce for the connection indication
*
* Returns BNEP_SUCCESS if connection started
* BNEP_WRONG_HANDLE if the connection is not found
* BNEP_WRONG_STATE if the responce is not expected
*
******************************************************************************/
tBNEP_RESULT BNEP_ConnectResp(uint16_t handle, tBNEP_RESULT resp) {
tBNEP_CONN* p_bcb;
uint16_t 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, responce %d", handle,
resp);
/* Form appropriate responce based on profile responce */
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);
p_bcb->src_uuid = p_bcb->prv_src_uuid;
p_bcb->dst_uuid = p_bcb->prv_dst_uuid;
}
/* Process remaining part of the setup message (extension headers) */
if (p_bcb->p_pending_data) {
uint8_t extension_present = true, *p, ext_type;
uint16_t rem_len;
rem_len = p_bcb->p_pending_data->len;
p = (uint8_t*)(p_bcb->p_pending_data + 1) + p_bcb->p_pending_data->offset;
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) break;
p = bnep_process_control_packet(p_bcb, p, &rem_len, true);
}
osi_free_and_reset((void**)&p_bcb->p_pending_data);
}
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_t 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_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_t handle, const RawAddress& p_dest_addr,
BT_HDR* p_buf, uint16_t protocol,
const RawAddress* p_src_addr, bool fw_ext_present) {
tBNEP_CONN* p_bcb;
uint8_t* p_data;
if ((!handle) || (handle > BNEP_MAX_CONNECTIONS)) {
osi_free(p_buf);
return (BNEP_WRONG_HANDLE);
}
p_bcb = &(bnep_cb.bcb[handle - 1]);
/* Check MTU size */
if (p_buf->len > BNEP_MTU_SIZE) {
BNEP_TRACE_ERROR("%s length %d exceeded MTU %d", __func__, 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_t*)(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_t ext, length;
uint16_t org_len, new_len;
/* parse the extension headers and findout the new packet len */
org_len = p_buf->len;
new_len = 0;
do {
if ((new_len + 2) > org_len) {
osi_free(p_buf);
return BNEP_IGNORE_CMD;
}
ext = *p_data++;
length = *p_data++;
p_data += length;
new_len += (length + 2);
if (new_len > org_len) {
osi_free(p_buf);
return BNEP_IGNORE_CMD;
}
} while (ext & 0x80);
if (protocol != BNEP_802_1_P_PROTOCOL)
protocol = 0;
else {
new_len += 4;
if (new_len > org_len) return BNEP_IGNORE_CMD;
p_data[2] = 0;
p_data[3] = 0;
}
p_buf->len = new_len;
} else {
osi_free(p_buf);
return BNEP_IGNORE_CMD;
}
}
/* 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_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_t handle, const RawAddress& p_dest_addr,
uint8_t* p_data, uint16_t len, uint16_t protocol,
const RawAddress* p_src_addr, bool fw_ext_present) {
tBNEP_CONN* p_bcb;
uint8_t* p;
/* Check MTU size. Consider the possibility of having extension headers */
if (len > BNEP_MTU_SIZE) {
BNEP_TRACE_ERROR("%s length %d exceeded MTU %d", __func__, 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 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_t ext, length;
uint16_t org_len, new_len;
/* parse the extension headers and findout the new packet len */
org_len = len;
new_len = 0;
p = p_data;
do {
if ((new_len + 2) > org_len) {
return BNEP_IGNORE_CMD;
}
ext = *p_data++;
length = *p_data++;
p_data += length;
new_len += (length + 2);
if (new_len > org_len) return BNEP_IGNORE_CMD;
} while (ext & 0x80);
if (protocol != BNEP_802_1_P_PROTOCOL)
protocol = 0;
else {
new_len += 4;
if (new_len > org_len) return BNEP_IGNORE_CMD;
p_data[2] = 0;
p_data[3] = 0;
}
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);
p_buf->len = len;
p_buf->offset = BNEP_MINIMUM_OFFSET;
p = (uint8_t*)(p_buf + 1) + BNEP_MINIMUM_OFFSET;
memcpy(p, p_data, len);
/* 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 beginings 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_t handle, uint16_t num_filters,
uint16_t* p_start_array,
uint16_t* p_end_array) {
uint16_t 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 connnection 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 beginings 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_t handle, uint16_t num_filters,
uint8_t* p_start_array,
uint8_t* p_end_array) {
uint16_t 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 connnection block */
for (xx = 0; xx < num_filters; xx++) {
memcpy(p_bcb->sent_mcast_filter_start[xx].address, p_start_array,
BD_ADDR_LEN);
memcpy(p_bcb->sent_mcast_filter_end[xx].address, 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_t BNEP_SetTraceLevel(uint8_t 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_t 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;
p_status->rem_bda = p_bcb->rem_bda;
p_status->src_uuid = p_bcb->src_uuid;
p_status->dst_uuid = p_bcb->dst_uuid;
return BNEP_SUCCESS;
#else
return (BNEP_IGNORE_CMD);
#endif
}