| /****************************************************************************** |
| * |
| * 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 <string.h> |
| #include "gki.h" |
| #include "bt_types.h" |
| #include "bnep_api.h" |
| #include "pan_api.h" |
| #include "pan_int.h" |
| #include "sdp_api.h" |
| #include "sdpdefs.h" |
| #include "l2c_api.h" |
| #include "hcidefs.h" |
| #include "btm_api.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) |
| { |
| BTM_SetDiscoverability (BTM_GENERAL_DISCOVERABLE, 0, 0); |
| BTM_SetConnectability (BTM_CONNECTABLE, 0, 0); |
| |
| 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_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. The byte 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 |
| ** |
| *******************************************************************************/ |
| tPAN_RESULT PAN_SetRole (UINT8 role, |
| UINT8 *sec_mask, |
| char *p_user_name, |
| char *p_gn_name, |
| char *p_nap_name) |
| { |
| 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_ERROR1 ("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_EVENT1 ("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_API1 ("PAN_SetRole() called with role 0x%x", role); |
| #if (defined (PAN_SUPPORTS_ROLE_NAP) && PAN_SUPPORTS_ROLE_NAP == TRUE) |
| /* Check the service name */ |
| if ((p_nap_name == NULL) || (*p_nap_name == 0)) |
| p_nap_name = PAN_NAP_DEFAULT_SERVICE_NAME; |
| |
| if (role & PAN_ROLE_NAP_SERVER) |
| { |
| /* 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 = pan_register_with_sdp (UUID_SERVCLASS_NAP, p_sec[2], p_nap_name, p_desc); |
| // btla-specific ++ |
| bta_sys_add_uuid(UUID_SERVCLASS_NAP); |
| // btla-specific -- |
| } |
| /* 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; |
| // btla-specific ++ |
| bta_sys_remove_uuid(UUID_SERVCLASS_NAP); |
| // btla-specific -- |
| } |
| } |
| #endif |
| |
| #if (defined (PAN_SUPPORTS_ROLE_GN) && PAN_SUPPORTS_ROLE_GN == TRUE) |
| /* Check the service name */ |
| if ((p_gn_name == NULL) || (*p_gn_name == 0)) |
| p_gn_name = PAN_GN_DEFAULT_SERVICE_NAME; |
| |
| if (role & PAN_ROLE_GN_SERVER) |
| { |
| /* 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 = pan_register_with_sdp (UUID_SERVCLASS_GN, p_sec[1], p_gn_name, p_desc); |
| // btla-specific ++ |
| bta_sys_add_uuid(UUID_SERVCLASS_GN); |
| // btla-specific -- |
| } |
| /* 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; |
| // btla-specific ++ |
| bta_sys_remove_uuid(UUID_SERVCLASS_GN); |
| // btla-specific -- |
| } |
| } |
| #endif |
| |
| #if (defined (PAN_SUPPORTS_ROLE_PANU) && PAN_SUPPORTS_ROLE_PANU == TRUE) |
| /* Check the service name */ |
| if ((p_user_name == NULL) || (*p_user_name == 0)) |
| p_user_name = PAN_PANU_DEFAULT_SERVICE_NAME; |
| |
| if (role & PAN_ROLE_CLIENT) |
| { |
| /* 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 = pan_register_with_sdp (UUID_SERVCLASS_PANU, p_sec[0], p_user_name, p_desc); |
| // btla-specific ++ |
| bta_sys_add_uuid(UUID_SERVCLASS_PANU); |
| // btla-specific -- |
| } |
| /* 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; |
| // btla-specific ++ |
| bta_sys_remove_uuid(UUID_SERVCLASS_PANU); |
| // btla-specific -- |
| } |
| } |
| #endif |
| |
| /* Check if it is a shutdown request */ |
| if (role == PAN_ROLE_INACTIVE) |
| pan_close_all_connections (); |
| |
| pan_cb.role = role; |
| PAN_TRACE_EVENT1 ("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 sufficent |
| ** 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; |
| UINT8 service_id; |
| 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_ERROR1 ("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_ERROR2 ("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_ERROR0 ("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) |
| { |
| service_id = BTM_SEC_SERVICE_BNEP_PANU; |
| dst_uuid.uu.uuid16 = UUID_SERVCLASS_PANU; |
| } |
| else if (dst_role == PAN_ROLE_GN_SERVER) |
| { |
| service_id = BTM_SEC_SERVICE_BNEP_GN; |
| dst_uuid.uu.uuid16 = UUID_SERVCLASS_GN; |
| } |
| else |
| { |
| service_id = BTM_SEC_SERVICE_BNEP_NAP; |
| 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_ERROR0 ("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) |
| { |
| service_id = BTM_SEC_SERVICE_BNEP_GN; |
| src_uuid.uu.uuid16 = UUID_SERVCLASS_GN; |
| } |
| else |
| { |
| service_id = BTM_SEC_SERVICE_BNEP_NAP; |
| src_uuid.uu.uuid16 = UUID_SERVCLASS_NAP; |
| } |
| mx_chan_id = src_uuid.uu.uuid16; |
| } |
| /* The role combination is not valid */ |
| else |
| { |
| PAN_TRACE_ERROR2 ("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_ERROR0 ("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_API6 ("PAN_Connect() for BD Addr %x.%x.%x.%x.%x.%x", |
| 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) |
| { |
| pan_release_pcb (pcb); |
| return result; |
| } |
| |
| PAN_TRACE_DEBUG1 ("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_ERROR1 ("PAN connection not found for the handle %d", handle); |
| return PAN_FAILURE; |
| } |
| |
| result = BNEP_Disconnect (pcb->handle); |
| if (pcb->con_state == PAN_STATE_CONNECTED) |
| 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_EVENT0 ("Error in closing PAN connection"); |
| return PAN_FAILURE; |
| } |
| |
| PAN_TRACE_EVENT0 ("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 |
| ** If the return value is not PAN_SUCCESS the application should |
| ** take care of releasing the message buffer |
| ** |
| ** 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_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) |
| { |
| tPAN_CONN *pcb; |
| UINT16 i; |
| tBNEP_RESULT result; |
| |
| if (pan_cb.role == PAN_ROLE_INACTIVE || (!(pan_cb.num_conns))) |
| { |
| PAN_TRACE_ERROR0 ("PAN is not active Data write failed"); |
| return PAN_FAILURE; |
| } |
| |
| /* Check if it is broadcast or multicast packet */ |
| if (dst[0] & 0x01) |
| { |
| 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; |
| } |
| |
| 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_ERROR0 ("PAN Don't have any user connections"); |
| return PAN_FAILURE; |
| } |
| |
| result = BNEP_Write (pan_cb.pcb[i].handle, dst, p_data, len, protocol, src, ext); |
| if (result == BNEP_IGNORE_CMD) |
| { |
| PAN_TRACE_DEBUG0 ("PAN ignored data for PANU connection"); |
| return result; |
| } |
| else if (result != BNEP_SUCCESS) |
| { |
| PAN_TRACE_ERROR0 ("PAN failed to write data for the PANU connection"); |
| return result; |
| } |
| |
| PAN_TRACE_DEBUG0 ("PAN successfully wrote data for the PANU connection"); |
| return PAN_SUCCESS; |
| } |
| |
| pcb = pan_get_pcb_by_handle (handle); |
| if (!pcb) |
| { |
| PAN_TRACE_ERROR0 ("PAN Data write for wrong addr"); |
| return PAN_FAILURE; |
| } |
| |
| if (pcb->con_state != PAN_STATE_CONNECTED) |
| { |
| PAN_TRACE_ERROR0 ("PAN Data write when conn is not active"); |
| return PAN_FAILURE; |
| } |
| |
| result = BNEP_Write (pcb->handle, dst, p_data, len, protocol, src, ext); |
| if (result == BNEP_IGNORE_CMD) |
| { |
| PAN_TRACE_DEBUG0 ("PAN ignored data write to PANU"); |
| return result; |
| } |
| else if (result != BNEP_SUCCESS) |
| { |
| PAN_TRACE_ERROR0 ("PAN failed to send data to the PANU"); |
| return result; |
| } |
| |
| PAN_TRACE_DEBUG0 ("PAN successfully sent data to the PANU"); |
| return PAN_SUCCESS; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** 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 |
| ** If the return value is not PAN_SUCCESS the application should |
| ** take care of releasing the message buffer |
| ** |
| ** 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; |
| |
| /* Check if it is broadcast or multicast packet */ |
| if (dst[0] & 0x01) |
| { |
| UINT8 *p_data; |
| UINT16 len; |
| |
| p_data = (UINT8 *)(p_buf + 1) + p_buf->offset; |
| len = p_buf->len; |
| PAN_Write (handle, dst, src, protocol, p_data, len, ext); |
| GKI_freebuf (p_buf); |
| return PAN_SUCCESS; |
| } |
| |
| if (pan_cb.role == PAN_ROLE_INACTIVE || (!(pan_cb.num_conns))) |
| { |
| PAN_TRACE_ERROR0 ("PAN is not active Data write failed"); |
| GKI_freebuf (p_buf); |
| return PAN_FAILURE; |
| } |
| |
| /* 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_ERROR0 ("PAN Don't have any user connections"); |
| GKI_freebuf (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_DEBUG0 ("PAN ignored data write for PANU connection"); |
| return result; |
| } |
| else if (result != BNEP_SUCCESS) |
| { |
| PAN_TRACE_ERROR0 ("PAN failed to write data for the PANU connection"); |
| return result; |
| } |
| |
| PAN_TRACE_DEBUG0 ("PAN successfully wrote data for the PANU connection"); |
| return PAN_SUCCESS; |
| } |
| |
| /* findout to which connection the data is meant for */ |
| pcb = pan_get_pcb_by_handle (handle); |
| if (!pcb) |
| { |
| PAN_TRACE_ERROR0 ("PAN Buf write for wrong handle"); |
| GKI_freebuf (p_buf); |
| return PAN_FAILURE; |
| } |
| |
| if (pcb->con_state != PAN_STATE_CONNECTED) |
| { |
| PAN_TRACE_ERROR0 ("PAN Buf write when conn is not active"); |
| GKI_freebuf (p_buf); |
| return PAN_FAILURE; |
| } |
| |
| result = BNEP_WriteBuf (pcb->handle, dst, p_buf, protocol, src, ext); |
| if (result == BNEP_IGNORE_CMD) |
| { |
| PAN_TRACE_DEBUG0 ("PAN ignored data buf write to PANU"); |
| return result; |
| } |
| else if (result != BNEP_SUCCESS) |
| { |
| PAN_TRACE_ERROR0 ("PAN failed to send data buf to the PANU"); |
| return result; |
| } |
| |
| PAN_TRACE_DEBUG0 ("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) |
| { |
| #if (defined (BNEP_SUPPORTS_PROT_FILTERS) && BNEP_SUPPORTS_PROT_FILTERS == TRUE) |
| tPAN_CONN *pcb; |
| tPAN_RESULT result; |
| |
| /* Check if the connection exists */ |
| pcb = pan_get_pcb_by_handle (handle); |
| if(!pcb) |
| { |
| PAN_TRACE_ERROR1 ("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_ERROR1 ("PAN failed to set protocol filters for handle %d", handle); |
| return result; |
| } |
| |
| PAN_TRACE_API1 ("PAN successfully sent protocol filters for handle %d", handle); |
| return PAN_SUCCESS; |
| #else |
| return PAN_FAILURE; |
| #endif |
| } |
| |
| |
| |
| /******************************************************************************* |
| ** |
| ** 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 |
| ** |
| *******************************************************************************/ |
| tBNEP_RESULT PAN_SetMulticastFilters (UINT16 handle, |
| UINT16 num_mcast_filters, |
| UINT8 *p_start_array, |
| UINT8 *p_end_array) |
| { |
| #if (defined (BNEP_SUPPORTS_MULTI_FILTERS) && BNEP_SUPPORTS_MULTI_FILTERS == TRUE) |
| tPAN_CONN *pcb; |
| tPAN_RESULT result; |
| |
| /* Check if the connection exists */ |
| pcb = pan_get_pcb_by_handle (handle); |
| if(!pcb) |
| { |
| PAN_TRACE_ERROR1 ("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_ERROR1 ("PAN failed to set multicast filters for handle %d", handle); |
| return result; |
| } |
| |
| PAN_TRACE_API1 ("PAN successfully sent multicast filters for handle %d", handle); |
| return PAN_SUCCESS; |
| #else |
| return PAN_FAILURE; |
| #endif |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** 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 |
| } |
| |
| |
