diff options
Diffstat (limited to 'stack/smp/smp_l2c.c')
| -rw-r--r-- | stack/smp/smp_l2c.c | 148 |
1 files changed, 148 insertions, 0 deletions
diff --git a/stack/smp/smp_l2c.c b/stack/smp/smp_l2c.c new file mode 100644 index 0000000..0356612 --- /dev/null +++ b/stack/smp/smp_l2c.c @@ -0,0 +1,148 @@ +/***************************************************************************** +** * +** Name: smp_l2c.c * +** * +** Description: This file contains functions for the SMP L2Cap interface * +** * +** * +** Copyright (c) 1999-2009, Broadcom Corp., All Rights Reserved. * +** Broadcom Bluetooth Core. Proprietary and confidential. * +******************************************************************************/ + +#include "bt_target.h" + +#if SMP_INCLUDED == TRUE + +#include <string.h> +#include "btm_ble_api.h" +#include "l2c_api.h" + +#include "smp_int.h" + + + +static void smp_connect_cback (BD_ADDR bd_addr, BOOLEAN connected, UINT16 reason); +static void smp_data_ind (BD_ADDR bd_addr, BT_HDR *p_buf); + +/******************************************************************************* +** +** Function smp_l2cap_if_init +** +** Description This function is called during the SMP task startup +** to register interface functions with L2CAP. +** +*******************************************************************************/ +void smp_l2cap_if_init (void) +{ + tL2CAP_FIXED_CHNL_REG fixed_reg; + SMP_TRACE_EVENT0 ("SMDBG l2c smp_l2cap_if_init"); + fixed_reg.fixed_chnl_opts.mode = L2CAP_FCR_BASIC_MODE; + fixed_reg.fixed_chnl_opts.max_transmit = 0; + fixed_reg.fixed_chnl_opts.rtrans_tout = 0; + fixed_reg.fixed_chnl_opts.mon_tout = 0; + fixed_reg.fixed_chnl_opts.mps = 0; + fixed_reg.fixed_chnl_opts.tx_win_sz = 0; + + fixed_reg.pL2CA_FixedConn_Cb = smp_connect_cback; + fixed_reg.pL2CA_FixedData_Cb = smp_data_ind; + fixed_reg.default_idle_tout = 60; /* set 60 seconds timeout, 0xffff default idle timeout */ + + /* Now, register with L2CAP */ + L2CA_RegisterFixedChannel (L2CAP_SMP_CID, &fixed_reg); +} + +/******************************************************************************* +** +** Function smp_connect_cback +** +** Description This callback function is called by L2CAP to indicate that +** SMP channel is +** connected (conn = TRUE)/disconnected (conn = FALSE). +** +*******************************************************************************/ +static void smp_connect_cback (BD_ADDR bd_addr, BOOLEAN connected, UINT16 reason) +{ + tSMP_CB *p_cb = &smp_cb; + tSMP_INT_DATA int_data; + + SMP_TRACE_EVENT0 ("SMDBG l2c smp_connect_cback "); + + if (memcmp(bd_addr, p_cb->pairing_bda, BD_ADDR_LEN) == 0) + { + SMP_TRACE_EVENT3 ("smp_connect_cback() for pairing BDA: %08x%04x Event: %s", + (bd_addr[0]<<24)+(bd_addr[1]<<16)+(bd_addr[2]<<8) + bd_addr[3], + (bd_addr[4]<<8)+bd_addr[5], (connected) ? "connected" : "disconnected"); + + if (connected) + { + if(!p_cb->connect_initialized) + { + p_cb->connect_initialized = TRUE; + /* initiating connection established */ + p_cb->role = L2CA_GetBleConnRole(bd_addr); + + /* initialize local i/r key to be default keys */ + p_cb->loc_r_key = p_cb->loc_i_key = SMP_SEC_DEFAULT_KEY; + p_cb->loc_auth_req = p_cb->peer_auth_req = SMP_DEFAULT_AUTH_REQ; + p_cb->cb_evt = SMP_IO_CAP_REQ_EVT; + smp_sm_event(p_cb, SMP_L2CAP_CONN_EVT, NULL); + + BTM_ReadConnectionAddr(p_cb->local_bda); + } + } + else + { + int_data.reason = reason; + /* Disconnected while doing security */ + smp_sm_event(p_cb, SMP_L2CAP_DISCONN_EVT, &int_data); + } + } +} + +/******************************************************************************* +** +** Function smp_data_ind +** +** Description This function is called when data is received from L2CAP on +** SMP channel. +** +** +** Returns void +** +*******************************************************************************/ +static void smp_data_ind (BD_ADDR bd_addr, BT_HDR *p_buf) +{ + tSMP_CB *p_cb = &smp_cb; + UINT8 *p = (UINT8 *)(p_buf + 1) + p_buf->offset; + UINT8 cmd ; + SMP_TRACE_EVENT0 ("SMDBG l2c smp_data_ind"); + + SMP_TRACE_EVENT0 ("Got smp_data_ind"); + + STREAM_TO_UINT8(cmd, p); + + + /* reject the pairing request if there is an on-going SMP pairing */ + if (SMP_OPCODE_PAIRING_REQ == cmd || SMP_OPCODE_SEC_REQ == cmd) + { + if (p_cb->state == SMP_ST_IDLE) + { + p_cb->role = L2CA_GetBleConnRole(bd_addr); + memcpy(&p_cb->pairing_bda[0], bd_addr, BD_ADDR_LEN); + } + else if (memcmp(&bd_addr[0], p_cb->pairing_bda, BD_ADDR_LEN)) + { + p_cb->failure = SMP_PAIR_NOT_SUPPORT; + smp_send_cmd(SMP_OPCODE_PAIRING_FAILED, p_cb); + } + } + + if (memcmp(&bd_addr[0], p_cb->pairing_bda, BD_ADDR_LEN) == 0) + { + btu_stop_timer (&p_cb->rsp_timer_ent); + smp_sm_event(p_cb, cmd, p); + } + + GKI_freebuf (p_buf); +} +#endif |