diff options
Diffstat (limited to 'stack/pan/pan_utils.c')
| -rw-r--r-- | stack/pan/pan_utils.c | 351 |
1 files changed, 351 insertions, 0 deletions
diff --git a/stack/pan/pan_utils.c b/stack/pan/pan_utils.c new file mode 100644 index 0000000..9ebbb75 --- /dev/null +++ b/stack/pan/pan_utils.c @@ -0,0 +1,351 @@ +/****************************************************************************** + * + * 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 <stdio.h> +#include "gki.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" + + +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 seqence 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, char *p_name, char *p_desc) +{ + UINT32 sdp_handle; + UINT16 browse_list = UUID_SERVCLASS_PUBLIC_BROWSE_GROUP; + UINT16 security = 0; + UINT8 availability; + UINT32 proto_len = (UINT32)pan_proto_elem_data[1]; + + /* Create a record */ + sdp_handle = SDP_CreateRecord (); + + if (sdp_handle == 0) + { + PAN_TRACE_ERROR0 ("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)); + +// btla-specific ++ +#if 0 + availability = 0xFF; + SDP_AddAttribute (sdp_handle, ATTR_ID_SERVICE_AVAILABILITY, UINT_DESC_TYPE, 1, &availability); +#endif +// btla-specific -- + + /* 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, + (UINT8) (strlen(p_name) + 1), (UINT8 *)p_name); + + /* Service description */ + SDP_AddAttribute (sdp_handle, ATTR_ID_SERVICE_DESCRIPTION, TEXT_STR_DESC_TYPE, + (UINT8) (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 (defined (PAN_SUPPORTS_ROLE_NAP) && 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_ERROR0 ("PAN Security Registration failed for PANU"); + } + } +#endif +#if (defined (PAN_SUPPORTS_ROLE_GN) && 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_ERROR0 ("PAN Security Registration failed for GN"); + } + } +#endif +#if (defined (PAN_SUPPORTS_ROLE_PANU) && 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_ERROR0 ("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 && + memcmp (pan_cb.pcb[i].rem_bda, p_bda, BD_ADDR_LEN) == 0) + 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)); + memcpy (pan_cb.pcb[i].rem_bda, p_bda, BD_ADDR_LEN); + 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 (memcmp (pan_cb.pcb[i].rem_bda, p_bda, BD_ADDR_LEN) == 0) + return &(pan_cb.pcb[i]); + + /* + if (pan_cb.pcb[i].mfilter_present && + (memcmp (p_bda, pan_cb.pcb[i].multi_cast_bridge, BD_ADDR_LEN) == 0)) + 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 (defined (PAN_SUPPORTS_DEBUG_DUMP) && PAN_SUPPORTS_DEBUG_DUMP == TRUE) + UINT16 i; + char buff[200]; + tPAN_CONN *p_pcb; + + PAN_TRACE_DEBUG3 ("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++) + { + sprintf (buff, "%d state %d, handle %d, src 0x%x, dst 0x%x, BD %x.%x.%x.%x.%x.%x", + i, p_pcb->con_state, p_pcb->handle, p_pcb->src_uuid, p_pcb->dst_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]); + + PAN_TRACE_DEBUG0 (buff); + } +#endif +} + + + |