15738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project/******************************************************************************
25738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project *
35738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project *  Copyright (C) 2009-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 *  Filename:      btif_pan.c
225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project *
235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project *  Description:   PAN Profile Bluetooth Interface
245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project *
255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project *
265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project ***********************************************************************************/
275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <hardware/bluetooth.h>
285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <hardware/bt_pan.h>
294186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#include <assert.h>
305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <signal.h>
315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <ctype.h>
325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <sys/select.h>
335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <sys/poll.h>
345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <sys/ioctl.h>
355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <netinet/in.h>
365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <netdb.h>
375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <stdio.h>
385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <errno.h>
395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <fcntl.h>
405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <sys/socket.h>
415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <sys/wait.h>
425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <net/if.h>
435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <linux/sockios.h>
445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <sys/prctl.h>
455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <linux/if.h>
465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <linux/if_tun.h>
475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include <linux/if_ether.h>
485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#define LOG_TAG "BTIF_PAN"
505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btif_common.h"
515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btif_util.h"
525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btm_api.h"
535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bd.h"
545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bta_api.h"
565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "bta_pan_api.h"
575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btif_sock_thread.h"
585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btif_sock_util.h"
595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#include "btif_pan_internal.h"
604186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#include "gki.h"
615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
624186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#define FORWARD_IGNORE        1
634186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#define FORWARD_SUCCESS       0
644186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#define FORWARD_FAILURE     (-1)
654186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#define FORWARD_CONGEST     (-2)
665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project//#define PANU_DISABLED TRUE
675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#if (PAN_NAP_DISABLED == TRUE) && (PANU_DISABLED == TRUE)
695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#define BTPAN_LOCAL_ROLE BTPAN_ROLE_NONE
705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#elif PAN_NAP_DISABLED == TRUE
715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#define BTPAN_LOCAL_ROLE BTPAN_ROLE_PANU
725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#elif PANU_DISABLED == TRUE
735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#define BTPAN_LOCAL_ROLE BTPAN_ROLE_PANNAP
745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#else
755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#define BTPAN_LOCAL_ROLE (BTPAN_ROLE_PANU | BTPAN_ROLE_PANNAP)
765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project#endif
775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
78e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati#define asrt(s) if(!(s)) BTIF_TRACE_ERROR("btif_pan: ## %s assert %s failed at line:%d ##",__FUNCTION__, #s, __LINE__)
795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
804186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#define MIN(x, y) (((x) < (y)) ? (x) : (y))
814186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectbtpan_cb_t btpan_cb;
835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source ProjectBD_ADDR local_addr;
855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic int jni_initialized, stack_initialized;
865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_jni_init(const btpan_callbacks_t* callbacks);
875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void btpan_jni_cleanup();
885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_connect(const bt_bdaddr_t *bd_addr, int local_role, int remote_role);
895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_disconnect(const bt_bdaddr_t *bd_addr);
905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_enable(int local_role);
915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic int btpan_get_local_role(void);
925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void btpan_tap_fd_signaled(int fd, int type, int flags, uint32_t user_id);
945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void btpan_cleanup_conn(btpan_conn_t* conn);
955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bta_pan_callback(tBTA_PAN_EVT event, tBTA_PAN *p_data);
964186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavatistatic void btu_exec_tap_fd_read(void *p_param);
974186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic btpan_interface_t pan_if = {
995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    sizeof(pan_if),
1005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_jni_init,
1015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_enable,
1025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_get_local_role,
1035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_connect,
1045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_disconnect,
1055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_jni_cleanup
1065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project};
1074186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
1085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectbtpan_interface_t *btif_pan_get_interface()
1095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
1105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return &pan_if;
1115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1124186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
1134186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati/*******************************************************************************
1144186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati **
1154186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati ** Function        btif_pan_init
1164186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati **
1174186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati ** Description     initializes the pan interface
1184186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati **
1194186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati ** Returns         bt_status_t
1204186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati **
1214186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati *******************************************************************************/
1225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectvoid btif_pan_init()
1235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
124e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("jni_initialized = %d, btpan_cb.enabled:%d", jni_initialized, btpan_cb.enabled);
1255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    stack_initialized = TRUE;
1265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if (jni_initialized && !btpan_cb.enabled)
1275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
128e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_DEBUG("Enabling PAN....");
1295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memset(&btpan_cb, 0, sizeof(btpan_cb));
1305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btpan_cb.tap_fd = -1;
1314186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btpan_cb.flow = 1;
1325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        int i;
1335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        for(i = 0; i < MAX_PAN_CONNS; i++)
1345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_cleanup_conn(&btpan_cb.conns[i]);
1355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        BTA_PanEnable(bta_pan_callback);
1365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btpan_cb.enabled = 1;
1375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btpan_enable(BTPAN_LOCAL_ROLE);
1385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
1395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1404186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
1415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void pan_disable()
1425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
1435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(btpan_cb.enabled)
1445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
1455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btpan_cb.enabled = 0;
1465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        BTA_PanDisable();
1475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        if(btpan_cb.tap_fd != -1)
1485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        {
1495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_tap_close(btpan_cb.tap_fd);
1505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_cb.tap_fd = -1;
1515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        }
1525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
1535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1544186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
1555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectvoid btif_pan_cleanup()
1565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
1575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(stack_initialized)
1585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
1595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        //bt is shuting down, invalid all bta pan handles
1605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        int i;
1615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        for(i = 0; i < MAX_PAN_CONNS; i++)
1625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_cleanup_conn(&btpan_cb.conns[i]);
1635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        pan_disable();
1645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
1655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    stack_initialized = FALSE;
1665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
1685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic btpan_callbacks_t callback;
1695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_jni_init(const btpan_callbacks_t* callbacks)
1705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
171e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("stack_initialized = %d, btpan_cb.enabled:%d", stack_initialized, btpan_cb.enabled);
1725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    jni_initialized = TRUE;
1735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(stack_initialized && !btpan_cb.enabled)
1745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btif_pan_init();
1755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    callback = *callbacks;
1765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return BT_STATUS_SUCCESS;
1775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
1795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void btpan_jni_cleanup()
1805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
1815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    pan_disable();
1825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    jni_initialized = FALSE;
1835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1844186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
1855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic inline int bta_role_to_btpan(int bta_pan_role)
1865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
1875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int btpan_role = 0;
188e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("bta_pan_role:0x%x", bta_pan_role);
1895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(bta_pan_role & PAN_ROLE_NAP_SERVER)
1905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
1915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btpan_role |= BTPAN_ROLE_PANNAP;
1925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
1935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(bta_pan_role & PAN_ROLE_CLIENT)
1945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
1955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btpan_role |= BTPAN_ROLE_PANU;
1965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
1975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return btpan_role;
1985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
1994186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic inline int btpan_role_to_bta(int btpan_role)
2015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
2025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int bta_pan_role = PAN_ROLE_INACTIVE;
203e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("btpan_role:0x%x", btpan_role);
2045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(btpan_role & BTPAN_ROLE_PANNAP)
2055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
2065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        bta_pan_role |= PAN_ROLE_NAP_SERVER;
2075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
2085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(btpan_role & BTPAN_ROLE_PANU)
2095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
2105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        bta_pan_role |= PAN_ROLE_CLIENT;
2115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
2125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return bta_pan_role;
2135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2144186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic volatile int btpan_dev_local_role;
2165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic tBTA_PAN_ROLE_INFO bta_panu_info = {PANU_SERVICE_NAME, 0, PAN_SECURITY};
21736f43cc4b0ce38007c29d573f251ec594d95b180Nitin Shivpurestatic tBTA_PAN_ROLE_INFO bta_pan_nap_info = {PAN_NAP_SERVICE_NAME, 1, PAN_SECURITY};
2185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
2195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_enable(int local_role)
2205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
2215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int bta_pan_role;
222e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("local_role:%d", local_role);
2235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    bta_pan_role = btpan_role_to_bta(local_role);
2243576c564b33c20b5e2e90fdd3bca7ce24392ca50Mike J. Chen#if BTA_PAN_INCLUDED == TRUE
2255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    BTA_PanSetRole(bta_pan_role, &bta_panu_info, NULL, &bta_pan_nap_info);
2265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_dev_local_role = local_role;
2275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return BT_STATUS_SUCCESS;
2283576c564b33c20b5e2e90fdd3bca7ce24392ca50Mike J. Chen#else
2293576c564b33c20b5e2e90fdd3bca7ce24392ca50Mike J. Chen    return BT_STATUS_FAIL;
2303576c564b33c20b5e2e90fdd3bca7ce24392ca50Mike J. Chen#endif
2315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2324186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic int btpan_get_local_role()
2345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
235e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("btpan_dev_local_role:%d", btpan_dev_local_role);
2365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return btpan_dev_local_role;
2375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2384186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_connect(const bt_bdaddr_t *bd_addr, int local_role, int remote_role)
2405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
241e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("local_role:%d, remote_role:%d", local_role, remote_role);
2425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int bta_local_role = btpan_role_to_bta(local_role);
2435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int bta_remote_role = btpan_role_to_bta(remote_role);
2445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_new_conn(-1, bd_addr->address, bta_local_role, bta_remote_role);
2455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    BTA_PanOpen((UINT8*)bd_addr->address, bta_local_role, bta_remote_role);
2465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return BT_STATUS_SUCCESS;
2475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2484186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void btif_in_pan_generic_evt(UINT16 event, char *p_param)
2505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
251e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_EVENT("%s: event=%d", __FUNCTION__, event);
2525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    switch (event) {
2535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        case BTIF_PAN_CB_DISCONNECTING:
2545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        {
2555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            bt_bdaddr_t *bd_addr = (bt_bdaddr_t*)p_param;
2565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_conn_t* conn = btpan_find_conn_addr(bd_addr->address);
2575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            int btpan_conn_local_role;
2585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            int btpan_remote_role;
2595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            asrt(conn != NULL);
2605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            if (conn) {
2615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                btpan_conn_local_role = bta_role_to_btpan(conn->local_role);
2625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                btpan_remote_role = bta_role_to_btpan(conn->remote_role);
2635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                callback.connection_state_cb(BTPAN_STATE_DISCONNECTING, BT_STATUS_SUCCESS,
2645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                        (const bt_bdaddr_t*)conn->peer, btpan_conn_local_role, btpan_remote_role);
2655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            }
2665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        } break;
2675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        default:
2685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        {
269e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati            BTIF_TRACE_WARNING("%s : Unknown event 0x%x", __FUNCTION__, event);
2705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        }
2715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        break;
2725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
2735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2744186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic bt_status_t btpan_disconnect(const bt_bdaddr_t *bd_addr)
2765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
2775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btpan_conn_t* conn = btpan_find_conn_addr(bd_addr->address);
2785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(conn && conn->handle >= 0)
2795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
2805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        BTA_PanClose(conn->handle);
2815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        /* Inform the application that the disconnect has been initiated successfully */
2825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        btif_transfer_context(btif_in_pan_generic_evt, BTIF_PAN_CB_DISCONNECTING,
2835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                              (char *)bd_addr, sizeof(bt_bdaddr_t), NULL);
2845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return BT_STATUS_SUCCESS;
2855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
2865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return BT_STATUS_FAIL;
2875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2884186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2894186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavatistatic int pan_pth = -1;
2905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectvoid create_tap_read_thread(int tap_fd)
2915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
2924186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if(pan_pth < 0)
2934186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        pan_pth = btsock_thread_create(btpan_tap_fd_signaled, NULL);
2944186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if(pan_pth >= 0)
2954186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btsock_thread_add_fd(pan_pth, tap_fd, 0, SOCK_THREAD_FD_RD, 0);
2965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
2974186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
2985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectvoid destroy_tap_read_thread(void)
2995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
3004186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if(pan_pth >= 0)
3015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
3024186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btsock_thread_exit(pan_pth);
3034186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        pan_pth = -1;
3045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
3055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
3064186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
3075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic int tap_if_up(const char *devname, BD_ADDR addr)
3085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
3095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    struct ifreq ifr;
3105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int sk, err;
3115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    sk = socket(AF_INET, SOCK_DGRAM, 0);
3135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    //set mac addr
3155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    memset(&ifr, 0, sizeof(ifr));
3165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    strncpy(ifr.ifr_name, devname, IFNAMSIZ - 1);
3175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    err = ioctl(sk, SIOCGIFHWADDR, &ifr);
3185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(err < 0)
3195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
320e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_ERROR("Could not get network hardware for interface:%s, errno:%s", devname, strerror(errno));
3215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        close(sk);
3225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return -1;
3235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
324689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project    /* debug("found mac address for interface:%s = %02x:%02x:%02x:%02x:%02x:%02x", devname, */
325689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project    /*         ifr.ifr_hwaddr.sa_data[0], ifr.ifr_hwaddr.sa_data[1], ifr.ifr_hwaddr.sa_data[2], */
326689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project    /*         ifr.ifr_hwaddr.sa_data[3], ifr.ifr_hwaddr.sa_data[4], ifr.ifr_hwaddr.sa_data[5]); */
3275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    strncpy(ifr.ifr_name, devname, IFNAMSIZ - 1);
3285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    memcpy(ifr.ifr_hwaddr.sa_data, addr, 6);
329689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project    /* debug("setting bt address for interface:%s = %02x:%02x:%02x:%02x:%02x:%02x", devname, */
330689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project    /*         ifr.ifr_hwaddr.sa_data[0], ifr.ifr_hwaddr.sa_data[1], ifr.ifr_hwaddr.sa_data[2], */
331689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project    /*         ifr.ifr_hwaddr.sa_data[3], ifr.ifr_hwaddr.sa_data[4], ifr.ifr_hwaddr.sa_data[5]); */
3325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
33301364c729dd8f94be9959300188c94324960e0dfLoic Poulain    /* The IEEE has specified that the most significant bit of the most significant byte is used to
33401364c729dd8f94be9959300188c94324960e0dfLoic Poulain     * determine a multicast address. If its a 1, that means multicast, 0 means unicast.
33501364c729dd8f94be9959300188c94324960e0dfLoic Poulain     * Kernel returns an error if we try to set a multicast address for the tun-tap ethernet interface.
33601364c729dd8f94be9959300188c94324960e0dfLoic Poulain     * Mask this bit to avoid any issue with auto generated address.
33701364c729dd8f94be9959300188c94324960e0dfLoic Poulain     */
33801364c729dd8f94be9959300188c94324960e0dfLoic Poulain    if (ifr.ifr_hwaddr.sa_data[0] & 0x01) {
339afa6e1abbedaad8fe854b0f43999b8aeb801af91Matthew Xie        BTIF_TRACE_WARNING("Not a unicast MAC address, force multicast bit flipping");
34001364c729dd8f94be9959300188c94324960e0dfLoic Poulain        ifr.ifr_hwaddr.sa_data[0] &= ~0x01;
34101364c729dd8f94be9959300188c94324960e0dfLoic Poulain    }
34201364c729dd8f94be9959300188c94324960e0dfLoic Poulain
3435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    err = ioctl(sk, SIOCSIFHWADDR, (caddr_t)&ifr);
3445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if (err < 0) {
346e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_ERROR("Could not set bt address for interface:%s, errno:%s", devname, strerror(errno));
3475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        close(sk);
3485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return -1;
3495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
3505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    //bring it up
3525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    memset(&ifr, 0, sizeof(ifr));
3535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    strncpy(ifr.ifr_name, devname, IF_NAMESIZE - 1);
3545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    ifr.ifr_flags |= IFF_UP;
3565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    ifr.ifr_flags |= IFF_MULTICAST;
3575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    err = ioctl(sk, SIOCSIFFLAGS, (caddr_t) &ifr);
3595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if (err < 0) {
362e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_ERROR("Could not bring up network interface:%s, errno:%d", devname, errno);
3635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        close(sk);
3645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return -1;
3655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
3665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    close(sk);
367e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("network interface: %s is up", devname);
3685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return 0;
3695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
3705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic int tap_if_down(const char *devname)
3725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
3735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    struct ifreq ifr;
3745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int sk, err;
3755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    sk = socket(AF_INET, SOCK_DGRAM, 0);
3775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    memset(&ifr, 0, sizeof(ifr));
3795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    strncpy(ifr.ifr_name, devname, IF_NAMESIZE - 1);
3805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    ifr.ifr_flags &= ~IFF_UP;
3825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    err = ioctl(sk, SIOCSIFFLAGS, (caddr_t) &ifr);
3845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    close(sk);
3865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
3875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return 0;
3885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
3894186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
3904186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavativoid btpan_set_flow_control(BOOLEAN enable) {
3914186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if (btpan_cb.tap_fd == -1)
3924186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        return;
3934186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
3944186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    btpan_cb.flow = enable;
3954186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if (enable) {
3964186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btsock_thread_add_fd(pan_pth, btpan_cb.tap_fd, 0, SOCK_THREAD_FD_RD, 0);
3974186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        bta_dmexecutecallback(btu_exec_tap_fd_read, (void *)btpan_cb.tap_fd);
3984186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    }
3994186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati}
4004186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
4015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectint btpan_tap_open()
4025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
4035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    struct ifreq ifr;
4045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int fd, err;
4055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    const char *clonedev = "/dev/tun";
4065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    /* open the clone device */
4085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    //system("insmod /system/lib/modules/tun.ko");
4105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if( (fd = open(clonedev, O_RDWR)) < 0 ) {
4115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
412e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_DEBUG("could not open %s, err:%d", clonedev, errno);
4135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return fd;
4145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
4155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    memset(&ifr, 0, sizeof(ifr));
4175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
4185738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    strncpy(ifr.ifr_name, TAP_IF_NAME, IFNAMSIZ);
4205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    /* try to create the device */
4225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if( (err = ioctl(fd, TUNSETIFF, (void *) &ifr)) < 0 )//|| tap_setup_ip(TAP_IF_NAME) == FALSE)
4235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
424e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_DEBUG("ioctl error:%d, errno:%s", err, strerror(errno));
4255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        close(fd);
4265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return err;
4275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
4285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    BTM_GetLocalDeviceAddr (local_addr);
4295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(tap_if_up(TAP_IF_NAME, local_addr) == 0)
4305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
43195ca3c43eae763465bbd7bddc927279f17b16106Zhenye Zhu        int flags = fcntl(fd, F_GETFL, 0);
43295ca3c43eae763465bbd7bddc927279f17b16106Zhenye Zhu        fcntl(fd, F_SETFL, flags | O_NONBLOCK);
4335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return fd;
4345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
435e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_ERROR("can not bring up tap interface:%s", TAP_IF_NAME);
4365738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    close(fd);
4375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return -1;
4385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
4394186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
4405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectint btpan_tap_send(int tap_fd, const BD_ADDR src, const BD_ADDR dst, UINT16 proto, const char* buf,
4415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    UINT16 len, BOOLEAN ext, BOOLEAN forward)
4425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
4435cd8bff2dd0337cb52bf48f312e3d2d55a8882fbMike J. Chen    UNUSED(ext);
4445cd8bff2dd0337cb52bf48f312e3d2d55a8882fbMike J. Chen    UNUSED(forward);
4455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(tap_fd != -1)
4465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
4475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        tETH_HDR eth_hdr;
4485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        //if(is_empty_eth_addr(dst))
4495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        //    memcpy(&eth_hdr.h_dest, local_addr, ETH_ADDR_LEN);
4505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        //else
4515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memcpy(&eth_hdr.h_dest, dst, ETH_ADDR_LEN);
4525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memcpy(&eth_hdr.h_src, src, ETH_ADDR_LEN);
4535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        eth_hdr.h_proto = htons(proto);
4545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        char packet[2000];
4555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memcpy(packet, &eth_hdr, sizeof(tETH_HDR));
4565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        if(len > 2000)
4575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        {
4585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            ALOGE("btpan_tap_send eth packet size:%d is exceeded limit!", len);
4595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            return -1;
4605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        }
4615738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memcpy(packet + sizeof(tETH_HDR), buf, len);
4625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        /* Send data to network interface */
4645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        //btnet_send(btpan_cb.conn[i].sock.sock, &buffer, (len + sizeof(tETH_HDR)));
4655738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        //dump_bin("packet to network", packet, len + sizeof(tETH_HDR));
4665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        int ret = write(tap_fd, packet, len + sizeof(tETH_HDR));
467e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_DEBUG("ret:%d", ret);
4685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        return ret;
4695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
4705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return -1;
4715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
4725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
4734186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
4745738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectint btpan_tap_close(int fd)
4755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
4765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    tap_if_down(TAP_IF_NAME);
4775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    close(fd);
4784186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if(pan_pth >= 0)
4794186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btsock_thread_wakeup(pan_pth);
4805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return 0;
4815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
4824186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
4835738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectbtpan_conn_t * btpan_find_conn_handle(UINT16 handle)
4845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
4855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int i;
4865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    for(i = 0; i < MAX_PAN_CONNS; i++)
4875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        if(btpan_cb.conns[i].handle == handle)
4885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            return &btpan_cb.conns[i];
4895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return NULL;
4905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
4914186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
4925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectbtpan_conn_t* btpan_find_conn_addr(const BD_ADDR addr)
4935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
4945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int i;
4955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    for(i = 0; i < MAX_PAN_CONNS; i++)
4965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        if(memcmp(btpan_cb.conns[i].peer, addr, sizeof(BD_ADDR)) == 0)
4975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            return &btpan_cb.conns[i];
4985738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return NULL;
4995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
5004186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
5015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void btpan_cleanup_conn(btpan_conn_t* conn)
5025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
5035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    if(conn)
5045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
5055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        conn->handle = -1;
5065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        conn->state = -1;
5075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memset(&conn->peer, 0, sizeof(conn->peer));
5085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        memset(&conn->eth_addr, 0, sizeof(conn->eth_addr));
5095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        conn->local_role = conn->remote_role = 0;
5105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
5115738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
5124186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
5135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectbtpan_conn_t* btpan_new_conn(int handle, const BD_ADDR addr, int local_role, int remote_role )
5145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
5155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int i;
5165738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    for(i = 0; i < MAX_PAN_CONNS; i++)
5175738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
518e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati        BTIF_TRACE_DEBUG("conns[%d]:%d", i, btpan_cb.conns[i].handle);
5195738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        if(btpan_cb.conns[i].handle == -1)
5205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        {
521e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati            BTIF_TRACE_DEBUG("handle:%d, local_role:%d, remote_role:%d", handle, local_role, remote_role);
5225738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
5235738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_cb.conns[i].handle = handle;
5245738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            bdcpy(btpan_cb.conns[i].peer, addr);
5255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_cb.conns[i].local_role = local_role;
5265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            btpan_cb.conns[i].remote_role = remote_role;
5275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            return &btpan_cb.conns[i];
5285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        }
5295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
530e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("MAX_PAN_CONNS:%d exceeded, return NULL as failed", MAX_PAN_CONNS);
5315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    return NULL;
5325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
5335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
5345738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectvoid btpan_close_handle(btpan_conn_t *p)
5355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
536e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("btpan_close_handle : close handle %d", p->handle);
5375738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    p->handle = -1;
5385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    p->local_role = -1;
5395738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    p->remote_role = -1;
5405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    memset(&p->peer, 0, 6);
5415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
5424186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
543da271ee4a0afcf5516208dc8df18a4da41a47124Sharvil Nanavatistatic inline bool should_forward(tETH_HDR* hdr)
5445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
545da271ee4a0afcf5516208dc8df18a4da41a47124Sharvil Nanavati    uint16_t proto = ntohs(hdr->h_proto);
546da271ee4a0afcf5516208dc8df18a4da41a47124Sharvil Nanavati    if(proto == ETH_P_IP || proto == ETH_P_ARP || proto == ETH_P_IPV6)
547da271ee4a0afcf5516208dc8df18a4da41a47124Sharvil Nanavati        return true;
548e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati    BTIF_TRACE_DEBUG("unknown proto:%x", proto);
549da271ee4a0afcf5516208dc8df18a4da41a47124Sharvil Nanavati    return false;
5505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
5514186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
5524186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavatistatic int forward_bnep(tETH_HDR* eth_hdr, BT_HDR *hdr) {
5535738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int broadcast = eth_hdr->h_dest[0] & 1;
5545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    int i;
5554186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
5564186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    // Find the right connection to send this frame over.
5574186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    for (i = 0; i < MAX_PAN_CONNS; i++) {
5585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        UINT16 handle = btpan_cb.conns[i].handle;
5594186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        if (handle != (UINT16)-1 &&
5605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                (broadcast || memcmp(btpan_cb.conns[i].eth_addr, eth_hdr->h_dest, sizeof(BD_ADDR)) == 0
5614186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                 || memcmp(btpan_cb.conns[i].peer, eth_hdr->h_dest, sizeof(BD_ADDR)) == 0)) {
5624186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            int result = PAN_WriteBuf(handle, eth_hdr->h_dest, eth_hdr->h_src, ntohs(eth_hdr->h_proto), hdr, 0);
5634186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            switch (result) {
5644186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                case PAN_Q_SIZE_EXCEEDED:
5654186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    return FORWARD_CONGEST;
5664186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                case PAN_SUCCESS:
5674186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    return FORWARD_SUCCESS;
5684186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                default:
5694186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    return FORWARD_FAILURE;
5704186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            }
5715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        }
5725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
5734186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    GKI_freebuf(hdr);
5744186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    return FORWARD_IGNORE;
5755738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
5765738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
5775738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bta_pan_callback_transfer(UINT16 event, char *p_param)
5785738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
5795738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    tBTA_PAN *p_data = (tBTA_PAN *)p_param;
5805738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    switch(event)
5815738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    {
5825738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        case BTA_PAN_ENABLE_EVT:
583e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati            BTIF_TRACE_DEBUG("BTA_PAN_ENABLE_EVT");
5845738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            break;
5855738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        case BTA_PAN_SET_ROLE_EVT:
5865738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            {
5875738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                int btpan_role = bta_role_to_btpan(p_data->set_role.role);
5885738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                bt_status_t status = p_data->set_role.status == BTA_PAN_SUCCESS ? BT_STATUS_SUCCESS : BT_STATUS_FAIL;
5895738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                btpan_control_state_t state = btpan_role == 0 ? BTPAN_STATE_DISABLED : BTPAN_STATE_ENABLED;
5905738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                callback.control_state_cb(state, btpan_role, status, TAP_IF_NAME);
5915738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                break;
5925738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            }
5935738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        case BTA_PAN_OPENING_EVT:
5945738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            {
5955738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                btpan_conn_t* conn;
5965738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                bdstr_t bds;
5975738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                bd2str((bt_bdaddr_t*)p_data->opening.bd_addr, &bds);
598e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati                BTIF_TRACE_DEBUG("BTA_PAN_OPENING_EVT handle %d, addr: %s", p_data->opening.handle, bds);
5995738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                conn = btpan_find_conn_addr(p_data->opening.bd_addr);
6005738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
6015738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                asrt(conn != NULL);
6025738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                if (conn)
6035738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                {
6045738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    conn->handle = p_data->opening.handle;
6055738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    int btpan_conn_local_role = bta_role_to_btpan(conn->local_role);
6065738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    int btpan_remote_role = bta_role_to_btpan(conn->remote_role);
6075738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    callback.connection_state_cb(BTPAN_STATE_CONNECTING, BT_STATUS_SUCCESS,
6085738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                            (const bt_bdaddr_t*)p_data->opening.bd_addr, btpan_conn_local_role, btpan_remote_role);
6095738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                }
6105738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                else
611e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati                    BTIF_TRACE_ERROR("connection not found");
6125738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                break;
6135738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            }
6145738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        case BTA_PAN_OPEN_EVT:
6155738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            {
616689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /* debug("BTA_PAN_OPEN_EVT, open status:%d, bd_addr = [%02X:%02X:%02X:%02X:%02X:%02X]", */
617689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /*         p_data->open.status, */
618689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /*         p_data->open.bd_addr[0], p_data->open.bd_addr[1], p_data->open.bd_addr[2], */
619689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /*         p_data->open.bd_addr[3], p_data->open.bd_addr[4], p_data->open.bd_addr[5]); */
6205738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                btpan_connection_state_t state;
6215738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                bt_status_t status;
622e85eb5a7c3ea7eaca09cbb33920435d809b4dd3dNitin Shivpure                btpan_conn_t *conn = btpan_find_conn_handle(p_data->open.handle);
623e85eb5a7c3ea7eaca09cbb33920435d809b4dd3dNitin Shivpure
624e85eb5a7c3ea7eaca09cbb33920435d809b4dd3dNitin Shivpure                ALOGV("%s pan connection open status: %d", __func__, p_data->open.status);
6255738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                if(p_data->open.status == BTA_PAN_SUCCESS)
6265738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                {
6275738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    state = BTPAN_STATE_CONNECTED;
6285738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    status = BT_STATUS_SUCCESS;
6295738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                }
6305738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                else
6315738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                {
6325738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    state = BTPAN_STATE_DISCONNECTED;
6335738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    status = BT_STATUS_FAIL;
634e85eb5a7c3ea7eaca09cbb33920435d809b4dd3dNitin Shivpure                    btpan_cleanup_conn(conn);
6355738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                }
636689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /* debug("BTA_PAN_OPEN_EVT handle:%d, conn:%p",  p_data->open.handle, conn); */
637689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /* debug("conn bta local_role:%d, bta remote role:%d", conn->local_role, conn->remote_role); */
6385738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                int btpan_conn_local_role = bta_role_to_btpan(p_data->open.local_role);
639689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                /* debug("bta local_role:%d, bta remote role:%d", p_data->open.local_role, p_data->open.peer_role); */
6405738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                int btpan_remote_role = bta_role_to_btpan(p_data->open.peer_role);
6415738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                callback.connection_state_cb(state, status, (const bt_bdaddr_t*)p_data->open.bd_addr,
6425738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                        btpan_conn_local_role, btpan_remote_role);
6435738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                break;
6445738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            }
6455738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        case BTA_PAN_CLOSE_EVT:
6465738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            {
6475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                btpan_conn_t* conn = btpan_find_conn_handle(p_data->close.handle);
6485738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
6495738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                ALOGI("%s: event = BTA_PAN_CLOSE_EVT handle %d", __FUNCTION__, p_data->close.handle);
6505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
6515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                if(conn && conn->handle >= 0)
6525738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                {
653689d66b6559dcb3a0ad7f6cc33b6129e50910253The Android Open Source Project                    /* debug("BTA_PAN_CLOSE_EVT, conn local_role:%d, remote_role:%d", conn->local_role, conn->remote_role); */
6545738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    int btpan_conn_local_role = bta_role_to_btpan(conn->local_role);
6555738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    int btpan_remote_role = bta_role_to_btpan(conn->remote_role);
6565738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    callback.connection_state_cb(BTPAN_STATE_DISCONNECTED, 0, (const bt_bdaddr_t*)conn->peer,
6575738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                            btpan_conn_local_role, btpan_remote_role);
6585738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                    btpan_cleanup_conn(conn);
6595738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                }
6605738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                else
661e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati                    BTIF_TRACE_ERROR("pan handle not found (%d)", p_data->close.handle);
6625738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project                break;
6635738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            }
6645738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project        default:
665e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati            BTIF_TRACE_WARNING("Unknown pan event %d", event);
6665738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project            break;
6675738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
6685738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
6695738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
6705738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Projectstatic void bta_pan_callback(tBTA_PAN_EVT event, tBTA_PAN *p_data)
6715738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project{
6725738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    btif_transfer_context(bta_pan_callback_transfer, event, (char*)p_data, sizeof(tBTA_PAN), NULL);
6735738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
6745cd8bff2dd0337cb52bf48f312e3d2d55a8882fbMike J. Chen
6754186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati#define IS_EXCEPTION(e) ((e) & (POLLHUP | POLLRDHUP | POLLERR | POLLNVAL))
6764186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavatistatic void btu_exec_tap_fd_read(void *p_param) {
6774186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    struct pollfd ufd;
6784186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    int fd = (int)p_param;
6794186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
6804186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if (fd == -1 || fd != btpan_cb.tap_fd)
6814186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        return;
6824186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
68395ca3c43eae763465bbd7bddc927279f17b16106Zhenye Zhu    // Don't occupy BTU context too long, avoid GKI buffer overruns and
68495ca3c43eae763465bbd7bddc927279f17b16106Zhenye Zhu    // give other profiles a chance to run by limiting the amount of memory
68595ca3c43eae763465bbd7bddc927279f17b16106Zhenye Zhu    // PAN can use from the shared pool buffer.
68695ca3c43eae763465bbd7bddc927279f17b16106Zhenye Zhu    for(int i = 0; i < PAN_POOL_MAX && btif_is_enabled() && btpan_cb.flow; i++) {
6874186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        BT_HDR *buffer = (BT_HDR *)GKI_getpoolbuf(PAN_POOL_ID);
6884186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        if (!buffer) {
689e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati            BTIF_TRACE_WARNING("%s unable to allocate buffer for packet.", __func__);
6904186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            break;
6914186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        }
6924186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        buffer->offset = PAN_MINIMUM_OFFSET;
6934186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        buffer->len = GKI_get_buf_size(buffer) - sizeof(BT_HDR) - buffer->offset;
6944186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
6954186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        UINT8 *packet = (UINT8 *)buffer + sizeof(BT_HDR) + buffer->offset;
6964186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
6974186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        // If we don't have an undelivered packet left over, pull one from the TAP driver.
6984186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        // We save it in the congest_packet right away in case we can't deliver it in this
6994186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        // attempt.
7004186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        if (!btpan_cb.congest_packet_size) {
7014186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            ssize_t ret = read(fd, btpan_cb.congest_packet, sizeof(btpan_cb.congest_packet));
7024186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            switch (ret) {
7034186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                case -1:
704e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati                    BTIF_TRACE_ERROR("%s unable to read from driver: %s", __func__, strerror(errno));
7054186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    GKI_freebuf(buffer);
706285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu                    //add fd back to monitor thread to try it again later
707285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu                    btsock_thread_add_fd(pan_pth, fd, 0, SOCK_THREAD_FD_RD, 0);
7084186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    return;
7094186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                case 0:
710e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati                    BTIF_TRACE_WARNING("%s end of file reached.", __func__);
7114186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    GKI_freebuf(buffer);
712285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu                    //add fd back to monitor thread to process the exception
713285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu                    btsock_thread_add_fd(pan_pth, fd, 0, SOCK_THREAD_FD_RD, 0);
7144186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    return;
7154186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                default:
7164186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    btpan_cb.congest_packet_size = ret;
7174186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                    break;
7184186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            }
7194186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        }
7204186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7214186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        memcpy(packet, btpan_cb.congest_packet, MIN(btpan_cb.congest_packet_size, buffer->len));
7224186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        buffer->len = MIN(btpan_cb.congest_packet_size, buffer->len);
7234186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7244186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        if (buffer->len > sizeof(tETH_HDR) && should_forward((tETH_HDR *)packet)) {
7254186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            // Extract the ethernet header from the buffer since the PAN_WriteBuf inside
7264186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            // forward_bnep can't handle two pointers that point inside the same GKI buffer.
7274186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            tETH_HDR hdr;
7284186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            memcpy(&hdr, packet, sizeof(tETH_HDR));
7294186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7304186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            // Skip the ethernet header.
7314186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            buffer->len -= sizeof(tETH_HDR);
7324186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            buffer->offset += sizeof(tETH_HDR);
7334186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            if (forward_bnep(&hdr, buffer) != FORWARD_CONGEST)
7344186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati                btpan_cb.congest_packet_size = 0;
7354186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        } else {
736e8c3d75b75493911ebf0f99c83676359657178f7Sharvil Nanavati            BTIF_TRACE_WARNING("%s dropping packet of length %d", __func__, buffer->len);
7374186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            btpan_cb.congest_packet_size = 0;
7384186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            GKI_freebuf(buffer);
7394186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        }
7404186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7414186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        // Bail out of the loop if reading from the TAP fd would block.
7424186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        ufd.fd = fd;
7434186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        ufd.events = POLLIN;
7444186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        ufd.revents = 0;
745285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu        if(poll(&ufd, 1, 0) <= 0 || IS_EXCEPTION(ufd.revents))
746285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu            break;
7475738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project    }
748285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu    //add fd back to monitor thread
749285f7c6527244c749aafdc1edec39787e12bd871Zhenye Zhu    btsock_thread_add_fd(pan_pth, fd, 0, SOCK_THREAD_FD_RD, 0);
7505738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project}
7515738f83aeb59361a0a2eda2460113f6dc919427The Android Open Source Project
7524186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavatistatic void btif_pan_close_all_conns() {
7534186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    int i;
7544186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if (!stack_initialized)
7554186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        return;
7564186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7574186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    for (i = 0; i < MAX_PAN_CONNS; ++i)
7584186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        if (btpan_cb.conns[i].handle != -1)
7594186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati            BTA_PanClose(btpan_cb.conns[i].handle);
7604186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati}
7614186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7624186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavatistatic void btpan_tap_fd_signaled(int fd, int type, int flags, uint32_t user_id) {
7634186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    assert(btpan_cb.tap_fd == fd);
7644186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7654186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if (btpan_cb.tap_fd != fd)
7664186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        return;
7674186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati
7684186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    if(flags & SOCK_THREAD_FD_EXCEPTION) {
7694186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btpan_cb.tap_fd = -1;
7704186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btpan_tap_close(fd);
7714186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        btif_pan_close_all_conns();
7724186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati    } else if(flags & SOCK_THREAD_FD_RD)
7734186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati        bta_dmexecutecallback(btu_exec_tap_fd_read, (void *)fd);
7744186b0ec7e0b7efe17c3b7cb8546ff359e099408Sharvil Nanavati}
775