15738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/****************************************************************************** 25738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 35738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * Copyright (C) 2001-2012 Broadcom Corporation 45738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 55738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * Licensed under the Apache License, Version 2.0 (the "License"); 65738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * you may not use this file except in compliance with the License. 75738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * You may obtain a copy of the License at: 85738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 95738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * http://www.apache.org/licenses/LICENSE-2.0 105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * Unless required by applicable law or agreed to in writing, software 125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * distributed under the License is distributed on an "AS IS" BASIS, 135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * See the License for the specific language governing permissions and 155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * limitations under the License. 165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ******************************************************************************/ 185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/****************************************************************************** 205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * this file contains the main BNEP functions 225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project * 235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ******************************************************************************/ 245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bt_target.h" 265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <stdlib.h> 275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <string.h> 285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <stdio.h> 295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 30258c2538e3b62a8cdb403f2730c45d721e5292b4Pavlin Radoslavov#include "bt_common.h" 315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bt_types.h" 325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "l2cdefs.h" 335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "hcidefs.h" 345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "hcimsgs.h" 355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "l2c_api.h" 375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "l2cdefs.h" 385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btu.h" 405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btm_api.h" 415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bnep_api.h" 435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bnep_int.h" 445cd8bff2dd0337cb52bf48f312e3d2d55a8882fbMike J. Chen#include "bt_utils.h" 455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4679ecab5d0418fde77e9afcdd451bd713af73e180Chris Manton#include "device/include/controller.h" 4739110ec88460421618330863807804e03594ef67Zach Johnson 485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4978bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavovextern fixed_queue_t *btu_general_alarm_queue; 5078bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov 515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/********************************************************************************/ 525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/* G L O B A L B N E P D A T A */ 535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/********************************************************************************/ 545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#if BNEP_DYNAMIC_MEMORY == FALSE 555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source ProjecttBNEP_CB bnep_cb; 565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#endif 575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectconst UINT16 bnep_frame_hdr_sizes[] = {14, 1, 2, 8, 8}; 595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/********************************************************************************/ 615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/* L O C A L F U N C T I O N P R O T O T Y P E S */ 625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/********************************************************************************/ 635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_connect_ind (BD_ADDR bd_addr, UINT16 l2cap_cid, UINT16 psm, UINT8 l2cap_id); 645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_connect_cfm (UINT16 l2cap_cid, UINT16 result); 655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_config_ind (UINT16 l2cap_cid, tL2CAP_CFG_INFO *p_cfg); 665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_config_cfm (UINT16 l2cap_cid, tL2CAP_CFG_INFO *p_cfg); 675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_disconnect_ind (UINT16 l2cap_cid, BOOLEAN ack_needed); 685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_disconnect_cfm (UINT16 l2cap_cid, UINT16 result); 695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_data_ind (UINT16 l2cap_cid, BT_HDR *p_msg); 705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_congestion_ind (UINT16 lcid, BOOLEAN is_congested); 715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_register_with_l2cap 765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function registers BNEP PSM with L2CAP 785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source ProjecttBNEP_RESULT bnep_register_with_l2cap (void) 835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Initialize the L2CAP configuration. We only care about MTU and flush */ 855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project memset(&bnep_cb.l2cap_my_cfg, 0, sizeof(tL2CAP_CFG_INFO)); 865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.l2cap_my_cfg.mtu_present = TRUE; 885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.l2cap_my_cfg.mtu = BNEP_MTU_SIZE; 895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.l2cap_my_cfg.flush_to_present = TRUE; 905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.l2cap_my_cfg.flush_to = BNEP_FLUSH_TO; 915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_ConnectInd_Cb = bnep_connect_ind; 935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_ConnectCfm_Cb = bnep_connect_cfm; 945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_ConfigInd_Cb = bnep_config_ind; 955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_ConfigCfm_Cb = bnep_config_cfm; 965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_DisconnectInd_Cb = bnep_disconnect_ind; 975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_DisconnectCfm_Cb = bnep_disconnect_cfm; 985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_DataInd_Cb = bnep_data_ind; 995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.reg_info.pL2CA_CongestionStatus_Cb = bnep_congestion_ind; 1005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Now, register with L2CAP */ 1025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (!L2CA_Register (BT_PSM_BNEP, &bnep_cb.reg_info)) 1035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 104d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_ERROR ("BNEP - Registration failed"); 1055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return BNEP_SECURITY_FAIL; 1065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 1075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return BNEP_SUCCESS; 1095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 1105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 1135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_connect_ind 1155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function handles an inbound connection indication 1175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** from L2CAP. This is the case where we are acting as a 1185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** server. 1195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 1215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 1235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_connect_ind (BD_ADDR bd_addr, UINT16 l2cap_cid, UINT16 psm, UINT8 l2cap_id) 1245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 1255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project tBNEP_CONN *p_bcb = bnepu_find_bcb_by_bd_addr (bd_addr); 1265cd8bff2dd0337cb52bf48f312e3d2d55a8882fbMike J. Chen UNUSED(psm); 1275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* If we are not acting as server, or already have a connection, or have */ 1295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* no more resources to handle the connection, reject the connection. */ 1305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (!(bnep_cb.profile_registered) || (p_bcb) 1315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project || ((p_bcb = bnepu_allocate_bcb(bd_addr)) == NULL)) 1325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 1335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_ConnectRsp (bd_addr, l2cap_id, l2cap_cid, L2CAP_CONN_NO_PSM, 0); 1345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 1355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 1365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Transition to the next appropriate state, waiting for config setup. */ 1385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state = BNEP_STATE_CFG_SETUP; 1395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Save the L2CAP Channel ID. */ 1415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->l2cap_cid = l2cap_cid; 1425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Send response to the L2CAP layer. */ 1445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_ConnectRsp (bd_addr, l2cap_id, l2cap_cid, L2CAP_CONN_OK, L2CAP_CONN_OK); 1455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Send a Configuration Request. */ 1475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_ConfigReq (l2cap_cid, &bnep_cb.l2cap_my_cfg); 1485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Start timer waiting for config setup */ 15078bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_CONN_TIMEOUT_MS, 15178bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 15278bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 1535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 154d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT("BNEP - Rcvd L2CAP conn ind, CID: 0x%x", p_bcb->l2cap_cid); 1555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 1575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 1605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_connect_cfm 1625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function handles the connect confirm events 1645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** from L2CAP. This is the case when we are acting as a 1655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** client and have sent a connect request. 1665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 1685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 1695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 1705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_connect_cfm (UINT16 l2cap_cid, UINT16 result) 1715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 17278bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov tBNEP_CONN *p_bcb; 1735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Find CCB based on CID */ 17578bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov if ((p_bcb = bnepu_find_bcb_by_cid (l2cap_cid)) == NULL) 1765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 177d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Rcvd conn cnf for unknown CID 0x%x", l2cap_cid); 1785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 1795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 1805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* If the connection response contains success status, then */ 1825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Transition to the next state and startup the timer. */ 18378bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov if ((result == L2CAP_CONN_OK) && (p_bcb->con_state == BNEP_STATE_CONN_START)) 1845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 18578bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov p_bcb->con_state = BNEP_STATE_CFG_SETUP; 1865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Send a Configuration Request. */ 1885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_ConfigReq (l2cap_cid, &bnep_cb.l2cap_my_cfg); 1895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 1905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Start timer waiting for config results */ 19178bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_CONN_TIMEOUT_MS, 19278bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 19378bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 1945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 19578bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov BNEP_TRACE_EVENT ("BNEP - got conn cnf, sent cfg req, CID: 0x%x", p_bcb->l2cap_cid); 1965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 1975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 1985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 19978bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov BNEP_TRACE_WARNING ("BNEP - Rcvd conn cnf with error: 0x%x CID 0x%x", result, p_bcb->l2cap_cid); 2005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the upper layer, if he has a callback */ 2025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (bnep_cb.p_conn_state_cb && 20378bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) 2045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 20578bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_CONN_FAILED, FALSE); 2065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 20878bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnepu_release_bcb (p_bcb); 2095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 2115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 2135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_config_ind 2155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function processes the L2CAP configuration indication 2175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** event. 2185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 2205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 2225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_config_ind (UINT16 l2cap_cid, tL2CAP_CFG_INFO *p_cfg) 2235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 2245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project tBNEP_CONN *p_bcb; 2255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT16 result, mtu = 0; 2265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Find CCB based on CID */ 2285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb = bnepu_find_bcb_by_cid (l2cap_cid)) == NULL) 2295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 230d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Rcvd L2CAP cfg ind, unknown CID: 0x%x", l2cap_cid); 2315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 2325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 234d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - Rcvd cfg ind, CID: 0x%x", l2cap_cid); 2355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Remember the remote MTU size */ 2375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((!p_cfg->mtu_present) || (p_cfg->mtu < BNEP_MIN_MTU_SIZE)) 2385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 2395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project mtu = p_cfg->mtu; 2405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->flush_to_present = FALSE; 2415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->mtu_present = TRUE; 2425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->mtu = BNEP_MIN_MTU_SIZE; 2435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->result = result = L2CAP_CFG_UNACCEPTABLE_PARAMS; 2445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 2465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 2475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_cfg->mtu > BNEP_MTU_SIZE) 2485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->rem_mtu_size = BNEP_MTU_SIZE; 2495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 2505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->rem_mtu_size = p_cfg->mtu; 2515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* For now, always accept configuration from the other side */ 2535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->flush_to_present = FALSE; 2545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->mtu_present = FALSE; 2555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_cfg->result = result = L2CAP_CFG_OK; 2565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_ConfigRsp (l2cap_cid, p_cfg); 2595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (result != L2CAP_CFG_OK) 2615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 262d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - Rcvd cfg ind with bad MTU %d, CID: 0x%x", mtu, l2cap_cid); 2635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 2645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_flags |= BNEP_FLAGS_HIS_CFG_DONE; 2675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_flags & BNEP_FLAGS_MY_CFG_DONE) 2695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 2705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state = BNEP_STATE_SEC_CHECKING; 2715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Start timer waiting for setup or response */ 27378bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_HOST_TIMEOUT_MS, 27478bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 27578bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 2765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) 2785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 2795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project btm_sec_mx_access_request (p_bcb->rem_bda, BT_PSM_BNEP, TRUE, 2805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BTM_SEC_PROTO_BNEP, 2815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_get_uuid32(&(p_bcb->src_uuid)), 2825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project &bnep_sec_check_complete, p_bcb); 2835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 2855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 2865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 2885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 2895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_config_cfm 2915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function processes the L2CAP configuration confirmation 2935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** event. 2945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 2965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 2975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 2985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_config_cfm (UINT16 l2cap_cid, tL2CAP_CFG_INFO *p_cfg) 2995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 3005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project tBNEP_CONN *p_bcb; 3015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 302d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - Rcvd cfg cfm, CID: 0x%x Result: %d", l2cap_cid, p_cfg->result); 3035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Find CCB based on CID */ 3055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb = bnepu_find_bcb_by_cid (l2cap_cid)) == NULL) 3065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 307d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Rcvd L2CAP cfg ind, unknown CID: 0x%x", l2cap_cid); 3085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 3095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* For now, always accept configuration from the other side */ 3125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_cfg->result == L2CAP_CFG_OK) 3135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_flags |= BNEP_FLAGS_MY_CFG_DONE; 3155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_flags & BNEP_FLAGS_HIS_CFG_DONE) 3175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state = BNEP_STATE_SEC_CHECKING; 3195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Start timer waiting for setup or response */ 32178bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_HOST_TIMEOUT_MS, 32278bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 32378bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 3245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) 3265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project btm_sec_mx_access_request (p_bcb->rem_bda, BT_PSM_BNEP, TRUE, 3285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BTM_SEC_PROTO_BNEP, 3295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_get_uuid32(&(p_bcb->src_uuid)), 3305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project &bnep_sec_check_complete, p_bcb); 3315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 3355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the upper layer, if he has a callback */ 3375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) && (bnep_cb.p_conn_state_cb)) 3385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_CONN_FAILED_CFG, FALSE); 3405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectReq (p_bcb->l2cap_cid); 3435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 3455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 3475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 3505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_disconnect_ind 3525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function handles a disconnect event from L2CAP. If 3545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** requested to, we ack the disconnect before dropping the CCB 3555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 3575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 3595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_disconnect_ind (UINT16 l2cap_cid, BOOLEAN ack_needed) 3605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 3615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project tBNEP_CONN *p_bcb; 3625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (ack_needed) 3645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectRsp (l2cap_cid); 3655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Find CCB based on CID */ 3675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb = bnepu_find_bcb_by_cid (l2cap_cid)) == NULL) 3685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 369d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Rcvd L2CAP disc, unknown CID: 0x%x", l2cap_cid); 3705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 3715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 373d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - Rcvd L2CAP disc, CID: 0x%x", l2cap_cid); 3745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the user if he has a callback */ 3765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_state == BNEP_STATE_CONNECTED) 3775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (bnep_cb.p_conn_state_cb) 3795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb)(p_bcb->handle, p_bcb->rem_bda, BNEP_CONN_DISCONNECTED, FALSE); 3805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 3825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 3836ba8fda60a9137a9f53f7e14edd87184610744fcHemant Gupta if ((bnep_cb.p_conn_state_cb) && ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) || 3846ba8fda60a9137a9f53f7e14edd87184610744fcHemant Gupta (p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED))) 3855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_CONN_FAILED, FALSE); 3865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 3875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 3895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 3905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 3935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 3945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_disconnect_cfm 3965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function gets the disconnect confirm event from L2CAP 3985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 3995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 4005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 4025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_disconnect_cfm (UINT16 l2cap_cid, UINT16 result) 4035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 404d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - Rcvd L2CAP disc cfm, CID: 0x%x, Result 0x%x", l2cap_cid, result); 4055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 4065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 4105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_congestion_ind 4125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This is a callback function called by L2CAP when 4145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** congestion status changes 4155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 4175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_congestion_ind (UINT16 l2cap_cid, BOOLEAN is_congested) 4185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 4195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project tBNEP_CONN *p_bcb; 4205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Find BCB based on CID */ 4225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb = bnepu_find_bcb_by_cid (l2cap_cid)) == NULL) 4235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 424d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Rcvd L2CAP cong, unknown CID: 0x%x", l2cap_cid); 4255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 4265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (is_congested) 4295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 4305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_flags |= BNEP_FLAGS_L2CAP_CONGESTED; 4315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if(bnep_cb.p_tx_data_flow_cb) 4325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 4335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.p_tx_data_flow_cb(p_bcb->handle, BNEP_TX_FLOW_OFF); 4345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 4375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 4385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_flags &= ~BNEP_FLAGS_L2CAP_CONGESTED; 4395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if(bnep_cb.p_tx_data_flow_cb) 4415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 4425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_cb.p_tx_data_flow_cb(p_bcb->handle, BNEP_TX_FLOW_ON); 4435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* While not congested, send as many buffers as we can */ 4465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project while (!(p_bcb->con_flags & BNEP_FLAGS_L2CAP_CONGESTED)) 4475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 4481a3844f933bd63c8a381371dabfb35c6a0249e3ePavlin Radoslavov BT_HDR *p_buf = (BT_HDR *)fixed_queue_try_dequeue(p_bcb->xmit_q); 4495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (!p_buf) 4515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 4525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DataWrite (l2cap_cid, p_buf); 4545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 4575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 4615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_data_ind 4635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function is called when data is received from L2CAP. 4655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** if we are the originator of the connection, we are the SDP 4665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** client, and the received message is queued up for the client. 4675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** If we are the destination of the connection, we are the SDP 4695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** server, so the message is passed to the server processing 4705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** function. 4715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 4735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 4745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 4755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bnep_data_ind (UINT16 l2cap_cid, BT_HDR *p_buf) 4765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 4775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project tBNEP_CONN *p_bcb; 4785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT8 *p = (UINT8 *)(p_buf + 1) + p_buf->offset; 4795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT16 rem_len = p_buf->len; 4805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT8 type, ctrl_type, ext_type = 0; 4815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BOOLEAN extension_present, fw_ext_present; 4825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT16 protocol = 0; 4835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT8 *p_src_addr, *p_dst_addr; 4845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Find CCB based on CID */ 4875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb = bnepu_find_bcb_by_cid (l2cap_cid)) == NULL) 4885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 489d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Rcvd L2CAP data, unknown CID: 0x%x", l2cap_cid); 490abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov osi_free(p_buf); 4915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 4925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 4935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 4945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Get the type and extension bits */ 4955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project type = *p++; 4965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project extension_present = type >> 7; 4975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project type &= 0x7f; 4985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((rem_len <= bnep_frame_hdr_sizes[type]) || (rem_len > BNEP_MTU_SIZE)) 4995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 500d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - rcvd frame, bad len: %d type: 0x%02x", p_buf->len, type); 501abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov osi_free(p_buf); 5025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 5035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 5045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project rem_len--; 5065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb->con_state != BNEP_STATE_CONNECTED) && 5085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (!(p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED)) && 5095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (type != BNEP_FRAME_CONTROL)) 5105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 511d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_WARNING ("BNEP - Ignored L2CAP data while in state: %d, CID: 0x%x", 5125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state, l2cap_cid); 5135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (extension_present) 5155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 5165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* 5175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ** When there is no connection if a data packet is received 5185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ** with unknown control extension headers then those should be processed 5195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ** according to complain/ignore law 5205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project */ 521f1c764fab01c929f71e185b97433bf40938026d3Sharvil Nanavati UINT8 ext, length; 5225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project UINT16 org_len, new_len; 5235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* parse the extension headers and process unknown control headers */ 5245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project org_len = rem_len; 5255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project new_len = 0; 5265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project do { 5275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ext = *p++; 5295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project length = *p++; 5305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p += length; 5315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((!(ext & 0x7F)) && (*p > BNEP_FILTER_MULTI_ADDR_RESPONSE_MSG)) 5335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_send_command_not_understood (p_bcb, *p); 5345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project new_len += (length + 2); 5365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (new_len > org_len) 5385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 5395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } while (ext & 0x80); 5415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 5425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 543abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov osi_free(p_buf); 5445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 5455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 5465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (type > BNEP_FRAME_COMPRESSED_ETHERNET_DEST_ONLY) 5485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 549d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - rcvd frame, unknown type: 0x%02x", type); 550abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov osi_free(p_buf); 5515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 5525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 5535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 554d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_DEBUG ("BNEP - rcv frame, type: %d len: %d Ext: %d", type, p_buf->len, extension_present); 5555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Initialize addresses to 'not supplied' */ 5575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_src_addr = p_dst_addr = NULL; 5585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project switch (type) 5605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 5615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project case BNEP_FRAME_GENERAL_ETHERNET: 5625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_dst_addr = p; 5635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p += BD_ADDR_LEN; 5645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_src_addr = p; 5655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p += BD_ADDR_LEN; 5665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BE_STREAM_TO_UINT16 (protocol, p); 5675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project rem_len -= 14; 5685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 5695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project case BNEP_FRAME_CONTROL: 5715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ctrl_type = *p; 5725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p = bnep_process_control_packet (p_bcb, p, &rem_len, FALSE); 5735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (ctrl_type == BNEP_SETUP_CONNECTION_REQUEST_MSG && 5755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state != BNEP_STATE_CONNECTED && 5765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project extension_present && p && rem_len) 5775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 578abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov p_bcb->p_pending_data = (BT_HDR *)osi_malloc(rem_len); 5795fe6f0cf6b223e3ed6be4912d55b3ed5b41ce0cdPavlin Radoslavov memcpy((UINT8 *)(p_bcb->p_pending_data + 1), p, rem_len); 5805fe6f0cf6b223e3ed6be4912d55b3ed5b41ce0cdPavlin Radoslavov p_bcb->p_pending_data->len = rem_len; 5815fe6f0cf6b223e3ed6be4912d55b3ed5b41ce0cdPavlin Radoslavov p_bcb->p_pending_data->offset = 0; 5825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 5835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 5845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 5855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project while (extension_present && p && rem_len) 5865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 5875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ext_type = *p++; 5885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project extension_present = ext_type >> 7; 5895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ext_type &= 0x7F; 5905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* if unknown extension present stop processing */ 5925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (ext_type) 5935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 5945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 5955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p = bnep_process_control_packet (p_bcb, p, &rem_len, TRUE); 5965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 5975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 598abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov osi_free(p_buf); 5995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 6005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project case BNEP_FRAME_COMPRESSED_ETHERNET: 6025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BE_STREAM_TO_UINT16 (protocol, p); 6035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project rem_len -= 2; 6045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 6055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project case BNEP_FRAME_COMPRESSED_ETHERNET_SRC_ONLY: 6075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_src_addr = p; 6085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p += BD_ADDR_LEN; 6095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BE_STREAM_TO_UINT16 (protocol, p); 6105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project rem_len -= 8; 6115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 6125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project case BNEP_FRAME_COMPRESSED_ETHERNET_DEST_ONLY: 6145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_dst_addr = p; 6155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p += BD_ADDR_LEN; 6165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BE_STREAM_TO_UINT16 (protocol, p); 6175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project rem_len -= 8; 6185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 6195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 6205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Process the header extension if there is one */ 6225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project while (extension_present && p && rem_len) 6235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 6245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ext_type = *p; 6255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project extension_present = ext_type >> 7; 6265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ext_type &= 0x7F; 6275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* if unknown extension present stop processing */ 6295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (ext_type) 6305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 631d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("Data extension type 0x%x found", ext_type); 6325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project break; 6335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 6345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p++; 6365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project rem_len--; 6375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p = bnep_process_control_packet (p_bcb, p, &rem_len, TRUE); 6385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 6395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_buf->offset += p_buf->len - rem_len; 6415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_buf->len = rem_len; 6425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Always give the upper layer MAC addresses */ 6445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (!p_src_addr) 6455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_src_addr = (UINT8 *) p_bcb->rem_bda; 6465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (!p_dst_addr) 64839110ec88460421618330863807804e03594ef67Zach Johnson p_dst_addr = (UINT8 *) controller_get_interface()->get_address(); 6495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* check whether there are any extensions to be forwarded */ 6515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (ext_type) 6525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project fw_ext_present = TRUE; 6535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 6545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project fw_ext_present = FALSE; 6555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (bnep_cb.p_data_buf_cb) 6575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 6585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_data_buf_cb)(p_bcb->handle, p_src_addr, p_dst_addr, protocol, p_buf, fw_ext_present); 6595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 6605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else if (bnep_cb.p_data_ind_cb) 6615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 6625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_data_ind_cb)(p_bcb->handle, p_src_addr, p_dst_addr, protocol, p, rem_len, fw_ext_present); 663abd70abb5e42c9431df94fe9d2c4a78a0d8d9af9Pavlin Radoslavov osi_free(p_buf); 6645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 6655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 6665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 6705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 67178bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov** Function bnep_conn_timer_timeout 6725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 6735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function processes a timeout. If it is a startup 6745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** timeout, we check for reading our BD address. If it 6755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** is an L2CAP timeout, we send a disconnect req to L2CAP. 6765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 6775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 6785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 6795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 68078bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavovvoid bnep_conn_timer_timeout(void *data) 6815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 68278bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov tBNEP_CONN *p_bcb = (tBNEP_CONN *)data; 6835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 684d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - CCB timeout in state: %d CID: 0x%x flags %x, re_transmit %d", 6855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state, p_bcb->l2cap_cid, p_bcb->con_flags, p_bcb->re_transmits); 6865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_state == BNEP_STATE_CONN_SETUP) 6885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 689d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - CCB timeout in state: %d CID: 0x%x", 6905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state, p_bcb->l2cap_cid); 6915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (!(p_bcb->con_flags & BNEP_FLAGS_IS_ORIG)) 6935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 6945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectReq (p_bcb->l2cap_cid); 6955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 6965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 6975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 6985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 6995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->re_transmits++ != BNEP_MAX_RETRANSMITS) 7015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnep_send_conn_req (p_bcb); 70378bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_CONN_TIMEOUT_MS, 70478bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 70578bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 7065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 7085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectReq (p_bcb->l2cap_cid); 7105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) && (bnep_cb.p_conn_state_cb)) 7125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_CONN_FAILED, FALSE); 7135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 7155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 7165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else if (p_bcb->con_state != BNEP_STATE_CONNECTED) 7195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 720d6e1b1ee17959461a80936f7308d8129615315d2Sharvil Nanavati BNEP_TRACE_EVENT ("BNEP - CCB timeout in state: %d CID: 0x%x", 7215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state, p_bcb->l2cap_cid); 7225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectReq (p_bcb->l2cap_cid); 7245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the user if he has a callback */ 7265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if ((p_bcb->con_flags & BNEP_FLAGS_IS_ORIG) && (bnep_cb.p_conn_state_cb)) 7275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_CONN_FAILED, FALSE); 7285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 7305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else if (p_bcb->con_flags & BNEP_FLAGS_FILTER_RESP_PEND) 7325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->re_transmits++ != BNEP_MAX_RETRANSMITS) 7345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_send_peer_our_filters (p_bcb); 73678bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_FILTER_SET_TIMEOUT_MS, 73778bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 73878bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 7395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 7415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectReq (p_bcb->l2cap_cid); 7435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the user if he has a callback */ 7455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (bnep_cb.p_conn_state_cb) 7465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_SET_FILTER_FAIL, FALSE); 7475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 7495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 7505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else if (p_bcb->con_flags & BNEP_FLAGS_MULTI_RESP_PEND) 7535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->re_transmits++ != BNEP_MAX_RETRANSMITS) 7555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_send_peer_our_multi_filters (p_bcb); 75778bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_set_on_queue(p_bcb->conn_timer, BNEP_FILTER_SET_TIMEOUT_MS, 75878bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov bnep_conn_timer_timeout, p_bcb, 75978bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov btu_general_alarm_queue); 7605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 7625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project { 7635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project L2CA_DisconnectReq (p_bcb->l2cap_cid); 7645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the user if he has a callback */ 7665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (bnep_cb.p_conn_state_cb) 7675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_SET_FILTER_FAIL, FALSE); 7685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project bnepu_release_bcb (p_bcb); 7705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project return; 7715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project } 7735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 7745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************* 7775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 7785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Function bnep_connected 7795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 7805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Description This function is called when a connection is established 7815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** (after config). 7825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 7835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** Returns void 7845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project** 7855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project*******************************************************************************/ 7865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectvoid bnep_connected (tBNEP_CONN *p_bcb) 7875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{ 7885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project BOOLEAN is_role_change; 7895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (p_bcb->con_flags & BNEP_FLAGS_CONN_COMPLETED) 7915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project is_role_change = TRUE; 7925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project else 7935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project is_role_change = FALSE; 7945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_state = BNEP_STATE_CONNECTED; 7965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_flags |= BNEP_FLAGS_CONN_COMPLETED; 7975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->con_flags &= (~BNEP_FLAGS_SETUP_RCVD); 7985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 7995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Ensure timer is stopped */ 80078bcff79e1b1f0efce436b33bdd6da88745bfc8aPavlin Radoslavov alarm_cancel(p_bcb->conn_timer); 8015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project p_bcb->re_transmits = 0; 8025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project 8035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project /* Tell the upper layer, if he has a callback */ 8045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project if (bnep_cb.p_conn_state_cb) 8055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project (*bnep_cb.p_conn_state_cb) (p_bcb->handle, p_bcb->rem_bda, BNEP_SUCCESS, is_role_change); 8065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project} 807