Blame android/pan.c

Packit 34410b
/*
Packit 34410b
 *
Packit 34410b
 *  BlueZ - Bluetooth protocol stack for Linux
Packit 34410b
 *
Packit 34410b
 *  Copyright (C) 2013-2014  Intel Corporation. All rights reserved.
Packit 34410b
 *
Packit 34410b
 *
Packit 34410b
 *  This library is free software; you can redistribute it and/or
Packit 34410b
 *  modify it under the terms of the GNU Lesser General Public
Packit 34410b
 *  License as published by the Free Software Foundation; either
Packit 34410b
 *  version 2.1 of the License, or (at your option) any later version.
Packit 34410b
 *
Packit 34410b
 *  This library is distributed in the hope that it will be useful,
Packit 34410b
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
Packit 34410b
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
Packit 34410b
 *  Lesser General Public License for more details.
Packit 34410b
 *
Packit 34410b
 *  You should have received a copy of the GNU Lesser General Public
Packit 34410b
 *  License along with this library; if not, write to the Free Software
Packit 34410b
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
Packit 34410b
 *
Packit 34410b
 */
Packit 34410b
Packit 34410b
#ifdef HAVE_CONFIG_H
Packit 34410b
#include <config.h>
Packit 34410b
#endif
Packit 34410b
Packit 34410b
#define _GNU_SOURCE
Packit 34410b
#include <stdint.h>
Packit 34410b
#include <stdbool.h>
Packit 34410b
#include <errno.h>
Packit 34410b
#include <unistd.h>
Packit 34410b
#include <fcntl.h>
Packit 34410b
#include <glib.h>
Packit 34410b
#include <sys/ioctl.h>
Packit 34410b
#include <sys/socket.h>
Packit 34410b
#include <sys/wait.h>
Packit 34410b
#include <sys/types.h>
Packit 34410b
#include <net/if.h>
Packit 34410b
#include <linux/sockios.h>
Packit 34410b
#include <netinet/in.h>
Packit 34410b
#include <netinet/ip6.h>
Packit 34410b
#include <linux/if_bridge.h>
Packit 34410b
Packit 34410b
#include "btio/btio.h"
Packit 34410b
#include "lib/bluetooth.h"
Packit 34410b
#include "lib/bnep.h"
Packit 34410b
#include "lib/sdp.h"
Packit 34410b
#include "lib/sdp_lib.h"
Packit 34410b
#include "src/uuid-helper.h"
Packit 34410b
#include "profiles/network/bnep.h"
Packit 34410b
#include "src/log.h"
Packit 34410b
Packit 34410b
#include "hal-msg.h"
Packit 34410b
#include "ipc-common.h"
Packit 34410b
#include "ipc.h"
Packit 34410b
#include "utils.h"
Packit 34410b
#include "bluetooth.h"
Packit 34410b
#include "pan.h"
Packit 34410b
Packit 34410b
#define SVC_HINT_NETWORKING 0x02
Packit 34410b
Packit 34410b
#define BNEP_BRIDGE "bt-pan"
Packit 34410b
#define BNEP_PANU_INTERFACE "bt-pan"
Packit 34410b
#define BNEP_NAP_INTERFACE "bt-pan%d"
Packit 34410b
Packit 34410b
struct pan_device {
Packit 34410b
	char		iface[16];
Packit 34410b
	bdaddr_t	dst;
Packit 34410b
	uint8_t		conn_state;
Packit 34410b
	uint8_t		role;
Packit 34410b
	GIOChannel	*io;
Packit 34410b
	struct bnep	*session;
Packit 34410b
	guint		watch;
Packit 34410b
};
Packit 34410b
Packit 34410b
static bdaddr_t adapter_addr;
Packit 34410b
static GSList *devices = NULL;
Packit 34410b
static uint8_t local_role = HAL_PAN_ROLE_NONE;
Packit 34410b
static uint32_t nap_rec_id = 0;
Packit 34410b
static uint32_t panu_rec_id = 0;
Packit 34410b
static GIOChannel *nap_io = NULL;
Packit 34410b
static bool nap_bridge_mode = false;
Packit 34410b
static struct ipc *hal_ipc = NULL;
Packit 34410b
Packit 34410b
static int set_forward_delay(int sk)
Packit 34410b
{
Packit 34410b
	unsigned long args[4] = { BRCTL_SET_BRIDGE_FORWARD_DELAY, 0 , 0, 0 };
Packit 34410b
	struct ifreq ifr;
Packit 34410b
Packit 34410b
	memset(&ifr, 0, sizeof(ifr));
Packit 34410b
	strncpy(ifr.ifr_name, BNEP_BRIDGE, IFNAMSIZ - 1);
Packit 34410b
	ifr.ifr_data = (char *) args;
Packit 34410b
Packit 34410b
	if (ioctl(sk, SIOCDEVPRIVATE, &ifr) < 0) {
Packit 34410b
		error("pan: setting forward delay failed: %d (%s)",
Packit 34410b
							errno, strerror(errno));
Packit 34410b
		return -1;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return 0;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int nap_create_bridge(void)
Packit 34410b
{
Packit 34410b
	int sk, err;
Packit 34410b
Packit 34410b
	DBG("%s", BNEP_BRIDGE);
Packit 34410b
Packit 34410b
	if (nap_bridge_mode)
Packit 34410b
		return 0;
Packit 34410b
Packit 34410b
	sk = socket(AF_INET, SOCK_STREAM | SOCK_CLOEXEC, 0);
Packit 34410b
	if (sk < 0)
Packit 34410b
		return -EOPNOTSUPP;
Packit 34410b
Packit 34410b
	if (ioctl(sk, SIOCBRADDBR, BNEP_BRIDGE) < 0) {
Packit 34410b
		err = -errno;
Packit 34410b
		if (err != -EEXIST) {
Packit 34410b
			close(sk);
Packit 34410b
			return -EOPNOTSUPP;
Packit 34410b
		}
Packit 34410b
	}
Packit 34410b
Packit 34410b
	err = set_forward_delay(sk);
Packit 34410b
	if (err < 0)
Packit 34410b
		ioctl(sk, SIOCBRDELBR, BNEP_BRIDGE);
Packit 34410b
Packit 34410b
	close(sk);
Packit 34410b
Packit 34410b
	nap_bridge_mode = err == 0;
Packit 34410b
Packit 34410b
	return err;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int bridge_if_down(void)
Packit 34410b
{
Packit 34410b
	struct ifreq ifr;
Packit 34410b
	int sk, err;
Packit 34410b
Packit 34410b
	sk = socket(AF_INET, SOCK_DGRAM, 0);
Packit 34410b
Packit 34410b
	memset(&ifr, 0, sizeof(ifr));
Packit 34410b
	strncpy(ifr.ifr_name, BNEP_BRIDGE, IF_NAMESIZE - 1);
Packit 34410b
Packit 34410b
	ifr.ifr_flags &= ~IFF_UP;
Packit 34410b
Packit 34410b
	/* Bring down the interface */
Packit 34410b
	err = ioctl(sk, SIOCSIFFLAGS, (caddr_t) &ifr);
Packit 34410b
Packit 34410b
	close(sk);
Packit 34410b
Packit 34410b
	if (err < 0) {
Packit 34410b
		error("pan: Could not bring down %s", BNEP_BRIDGE);
Packit 34410b
		return err;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return 0;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int nap_remove_bridge(void)
Packit 34410b
{
Packit 34410b
	int sk, err;
Packit 34410b
Packit 34410b
	DBG("%s", BNEP_BRIDGE);
Packit 34410b
Packit 34410b
	if (!nap_bridge_mode)
Packit 34410b
		return 0;
Packit 34410b
Packit 34410b
	bridge_if_down();
Packit 34410b
Packit 34410b
	sk = socket(AF_INET, SOCK_STREAM | SOCK_CLOEXEC, 0);
Packit 34410b
	if (sk < 0)
Packit 34410b
		return -EOPNOTSUPP;
Packit 34410b
Packit 34410b
	err = ioctl(sk, SIOCBRDELBR, BNEP_BRIDGE);
Packit 34410b
	if (err < 0)
Packit 34410b
		err = -errno;
Packit 34410b
Packit 34410b
	close(sk);
Packit 34410b
Packit 34410b
	if (err < 0)
Packit 34410b
		return err;
Packit 34410b
Packit 34410b
	nap_bridge_mode = false;
Packit 34410b
Packit 34410b
	return 0;
Packit 34410b
}
Packit 34410b
Packit 34410b
static int device_cmp(gconstpointer s, gconstpointer user_data)
Packit 34410b
{
Packit 34410b
	const struct pan_device *dev = s;
Packit 34410b
	const bdaddr_t *dst = user_data;
Packit 34410b
Packit 34410b
	return bacmp(&dev->dst, dst);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void pan_device_free(void *data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = data;
Packit 34410b
Packit 34410b
	if (dev->watch > 0) {
Packit 34410b
		bnep_server_delete(BNEP_BRIDGE, dev->iface, &dev->dst);
Packit 34410b
		g_source_remove(dev->watch);
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (dev->io) {
Packit 34410b
		g_io_channel_shutdown(dev->io, FALSE, NULL);
Packit 34410b
		g_io_channel_unref(dev->io);
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (dev->session)
Packit 34410b
		bnep_free(dev->session);
Packit 34410b
Packit 34410b
	g_free(dev);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void pan_device_remove(struct pan_device *dev)
Packit 34410b
{
Packit 34410b
	devices = g_slist_remove(devices, dev);
Packit 34410b
Packit 34410b
	if (g_slist_length(devices) == 0) {
Packit 34410b
		local_role = HAL_PAN_ROLE_NONE;
Packit 34410b
		nap_remove_bridge();
Packit 34410b
	}
Packit 34410b
Packit 34410b
	pan_device_free(dev);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bt_pan_notify_conn_state(struct pan_device *dev, uint8_t state)
Packit 34410b
{
Packit 34410b
	struct hal_ev_pan_conn_state ev;
Packit 34410b
	char addr[18];
Packit 34410b
Packit 34410b
	if (dev->conn_state == state)
Packit 34410b
		return;
Packit 34410b
Packit 34410b
	dev->conn_state = state;
Packit 34410b
	ba2str(&dev->dst, addr);
Packit 34410b
	DBG("device %s state %u", addr, state);
Packit 34410b
Packit 34410b
	bdaddr2android(&dev->dst, ev.bdaddr);
Packit 34410b
	ev.state = state;
Packit 34410b
	ev.local_role = local_role;
Packit 34410b
	ev.remote_role = dev->role;
Packit 34410b
	ev.status = HAL_STATUS_SUCCESS;
Packit 34410b
Packit 34410b
	ipc_send_notif(hal_ipc, HAL_SERVICE_ID_PAN, HAL_EV_PAN_CONN_STATE,
Packit 34410b
							sizeof(ev), &ev;;
Packit 34410b
	if (dev->conn_state == HAL_PAN_STATE_DISCONNECTED)
Packit 34410b
		pan_device_remove(dev);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bt_pan_notify_ctrl_state(struct pan_device *dev, uint8_t state,
Packit 34410b
								uint8_t status)
Packit 34410b
{
Packit 34410b
	struct hal_ev_pan_ctrl_state ev;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	ev.state = state;
Packit 34410b
	ev.local_role = local_role;
Packit 34410b
	ev.status = status;
Packit 34410b
Packit 34410b
	memset(ev.name, 0, sizeof(ev.name));
Packit 34410b
Packit 34410b
	if (local_role == HAL_PAN_ROLE_NAP)
Packit 34410b
		memcpy(ev.name, BNEP_BRIDGE, sizeof(BNEP_BRIDGE));
Packit 34410b
	else if (local_role == HAL_PAN_ROLE_PANU)
Packit 34410b
		memcpy(ev.name, dev->iface, sizeof(dev->iface));
Packit 34410b
Packit 34410b
	ipc_send_notif(hal_ipc, HAL_SERVICE_ID_PAN, HAL_EV_PAN_CTRL_STATE,
Packit 34410b
							sizeof(ev), &ev;;
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bnep_disconn_cb(void *data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = data;
Packit 34410b
Packit 34410b
	DBG("%s disconnected", dev->iface);
Packit 34410b
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bnep_conn_cb(char *iface, int err, void *data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = data;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (err < 0) {
Packit 34410b
		error("bnep connect req failed: %s", strerror(-err));
Packit 34410b
		bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
		return;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	memcpy(dev->iface, iface, sizeof(dev->iface));
Packit 34410b
Packit 34410b
	DBG("%s connected", dev->iface);
Packit 34410b
Packit 34410b
	bt_pan_notify_ctrl_state(dev, HAL_PAN_CTRL_ENABLED, HAL_STATUS_SUCCESS);
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_CONNECTED);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void connect_cb(GIOChannel *chan, GError *err, gpointer data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = data;
Packit 34410b
	uint16_t l_role, r_role;
Packit 34410b
	int perr, sk;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (err) {
Packit 34410b
		error("%s", err->message);
Packit 34410b
		goto fail;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	l_role = (local_role == HAL_PAN_ROLE_NAP) ? BNEP_SVC_NAP :
Packit 34410b
								BNEP_SVC_PANU;
Packit 34410b
	r_role = (dev->role == HAL_PAN_ROLE_NAP) ? BNEP_SVC_NAP : BNEP_SVC_PANU;
Packit 34410b
Packit 34410b
	sk = g_io_channel_unix_get_fd(dev->io);
Packit 34410b
Packit 34410b
	dev->session = bnep_new(sk, l_role, r_role, BNEP_PANU_INTERFACE);
Packit 34410b
	if (!dev->session)
Packit 34410b
		goto fail;
Packit 34410b
Packit 34410b
	perr = bnep_connect(dev->session, bnep_conn_cb, bnep_disconn_cb, dev,
Packit 34410b
									dev);
Packit 34410b
	if (perr < 0) {
Packit 34410b
		error("bnep connect req failed: %s", strerror(-perr));
Packit 34410b
		goto fail;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (dev->io) {
Packit 34410b
		g_io_channel_unref(dev->io);
Packit 34410b
		dev->io = NULL;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return;
Packit 34410b
Packit 34410b
fail:
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bt_pan_connect(const void *buf, uint16_t len)
Packit 34410b
{
Packit 34410b
	const struct hal_cmd_pan_connect *cmd = buf;
Packit 34410b
	struct pan_device *dev;
Packit 34410b
	uint8_t status;
Packit 34410b
	bdaddr_t dst;
Packit 34410b
	char addr[18];
Packit 34410b
	GSList *l;
Packit 34410b
	GError *gerr = NULL;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	switch (cmd->local_role) {
Packit 34410b
	case HAL_PAN_ROLE_NAP:
Packit 34410b
		if (cmd->remote_role != HAL_PAN_ROLE_PANU) {
Packit 34410b
			status = HAL_STATUS_UNSUPPORTED;
Packit 34410b
			goto failed;
Packit 34410b
		}
Packit 34410b
		break;
Packit 34410b
	case HAL_PAN_ROLE_PANU:
Packit 34410b
		if (cmd->remote_role != HAL_PAN_ROLE_NAP &&
Packit 34410b
					cmd->remote_role != HAL_PAN_ROLE_PANU) {
Packit 34410b
			status = HAL_STATUS_UNSUPPORTED;
Packit 34410b
			goto failed;
Packit 34410b
		}
Packit 34410b
		break;
Packit 34410b
	default:
Packit 34410b
		status = HAL_STATUS_UNSUPPORTED;
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	android2bdaddr(&cmd->bdaddr, &dst);
Packit 34410b
Packit 34410b
	l = g_slist_find_custom(devices, &dst, device_cmp);
Packit 34410b
	if (l) {
Packit 34410b
		status = HAL_STATUS_FAILED;
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	dev = g_new0(struct pan_device, 1);
Packit 34410b
	bacpy(&dev->dst, &dst);
Packit 34410b
	local_role = cmd->local_role;
Packit 34410b
	dev->role = cmd->remote_role;
Packit 34410b
Packit 34410b
	ba2str(&dev->dst, addr);
Packit 34410b
	DBG("connecting to %s %s", addr, dev->iface);
Packit 34410b
Packit 34410b
	dev->io = bt_io_connect(connect_cb, dev, NULL, &gerr,
Packit 34410b
					BT_IO_OPT_SOURCE_BDADDR, &adapter_addr,
Packit 34410b
					BT_IO_OPT_DEST_BDADDR, &dev->dst,
Packit 34410b
					BT_IO_OPT_PSM, BNEP_PSM,
Packit 34410b
					BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_MEDIUM,
Packit 34410b
					BT_IO_OPT_OMTU, BNEP_MTU,
Packit 34410b
					BT_IO_OPT_IMTU, BNEP_MTU,
Packit 34410b
					BT_IO_OPT_INVALID);
Packit 34410b
	if (!dev->io) {
Packit 34410b
		error("%s", gerr->message);
Packit 34410b
		g_error_free(gerr);
Packit 34410b
		g_free(dev);
Packit 34410b
		status = HAL_STATUS_FAILED;
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	devices = g_slist_append(devices, dev);
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_CONNECTING);
Packit 34410b
Packit 34410b
	status = HAL_STATUS_SUCCESS;
Packit 34410b
Packit 34410b
failed:
Packit 34410b
	ipc_send_rsp(hal_ipc, HAL_SERVICE_ID_PAN, HAL_OP_PAN_CONNECT, status);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bt_pan_disconnect(const void *buf, uint16_t len)
Packit 34410b
{
Packit 34410b
	const struct hal_cmd_pan_disconnect *cmd = buf;
Packit 34410b
	struct pan_device *dev;
Packit 34410b
	uint8_t status;
Packit 34410b
	GSList *l;
Packit 34410b
	bdaddr_t dst;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	android2bdaddr(&cmd->bdaddr, &dst);
Packit 34410b
Packit 34410b
	l = g_slist_find_custom(devices, &dst, device_cmp);
Packit 34410b
	if (!l) {
Packit 34410b
		status = HAL_STATUS_FAILED;
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	dev = l->data;
Packit 34410b
Packit 34410b
	if (dev->conn_state == HAL_PAN_STATE_CONNECTED && dev->session)
Packit 34410b
		bnep_disconnect(dev->session);
Packit 34410b
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
	status = HAL_STATUS_SUCCESS;
Packit 34410b
Packit 34410b
failed:
Packit 34410b
	ipc_send_rsp(hal_ipc, HAL_SERVICE_ID_PAN, HAL_OP_PAN_DISCONNECT,
Packit 34410b
									status);
Packit 34410b
}
Packit 34410b
Packit 34410b
static gboolean nap_watchdog_cb(GIOChannel *chan, GIOCondition cond,
Packit 34410b
							gpointer user_data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = user_data;
Packit 34410b
Packit 34410b
	DBG("disconnected");
Packit 34410b
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
Packit 34410b
	return FALSE;
Packit 34410b
}
Packit 34410b
Packit 34410b
static gboolean nap_setup_cb(GIOChannel *chan, GIOCondition cond,
Packit 34410b
							gpointer user_data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = user_data;
Packit 34410b
	uint8_t packet[BNEP_MTU];
Packit 34410b
	int sk, n, err;
Packit 34410b
Packit 34410b
	if (cond & (G_IO_ERR | G_IO_HUP | G_IO_NVAL)) {
Packit 34410b
		error("Hangup or error or inval on BNEP socket");
Packit 34410b
		return FALSE;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	sk = g_io_channel_unix_get_fd(chan);
Packit 34410b
Packit 34410b
	/*
Packit 34410b
	 * BNEP_SETUP_CONNECTION_REQUEST_MSG should be read and left in case
Packit 34410b
	 * of kernel setup connection msg handling.
Packit 34410b
	 */
Packit 34410b
	n = recv(sk, packet, sizeof(packet), MSG_PEEK);
Packit 34410b
	if (n  < 0) {
Packit 34410b
		error("read(): %s(%d)", strerror(errno), errno);
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	if (n < 3) {
Packit 34410b
		error("pan: to few setup connection request data received");
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	err = nap_create_bridge();
Packit 34410b
	if (err < 0)
Packit 34410b
		error("pan: Failed to create bridge: %s (%d)", strerror(-err),
Packit 34410b
									-err);
Packit 34410b
Packit 34410b
	if (bnep_server_add(sk, (err < 0) ? NULL : BNEP_BRIDGE, dev->iface,
Packit 34410b
						&dev->dst, packet, n) < 0) {
Packit 34410b
		error("pan: server_connadd failed");
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	dev->watch = g_io_add_watch(chan, G_IO_HUP | G_IO_ERR | G_IO_NVAL,
Packit 34410b
							nap_watchdog_cb, dev);
Packit 34410b
	g_io_channel_unref(dev->io);
Packit 34410b
	dev->io = NULL;
Packit 34410b
Packit 34410b
	bt_pan_notify_ctrl_state(dev, HAL_PAN_CTRL_ENABLED, HAL_STATUS_SUCCESS);
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_CONNECTED);
Packit 34410b
Packit 34410b
	return FALSE;
Packit 34410b
Packit 34410b
failed:
Packit 34410b
	pan_device_remove(dev);
Packit 34410b
Packit 34410b
	return FALSE;
Packit 34410b
}
Packit 34410b
Packit 34410b
static void nap_connect_cb(GIOChannel *chan, GError *err, gpointer user_data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev = user_data;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (err) {
Packit 34410b
		error("%s", err->message);
Packit 34410b
		bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
		return;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	g_io_channel_set_close_on_unref(chan, TRUE);
Packit 34410b
	dev->watch = g_io_add_watch(chan,
Packit 34410b
				G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
Packit 34410b
				nap_setup_cb, dev);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void nap_confirm_cb(GIOChannel *chan, gpointer data)
Packit 34410b
{
Packit 34410b
	struct pan_device *dev;
Packit 34410b
	bdaddr_t dst;
Packit 34410b
	char address[18];
Packit 34410b
	GError *err = NULL;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	bt_io_get(chan, &err, BT_IO_OPT_DEST_BDADDR, &dst,
Packit 34410b
			BT_IO_OPT_DEST, address, BT_IO_OPT_INVALID);
Packit 34410b
	if (err) {
Packit 34410b
		error("%s", err->message);
Packit 34410b
		g_error_free(err);
Packit 34410b
		return;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	DBG("incoming connect request from %s", address);
Packit 34410b
	dev = g_new0(struct pan_device, 1);
Packit 34410b
	bacpy(&dev->dst, &dst);
Packit 34410b
	local_role = HAL_PAN_ROLE_NAP;
Packit 34410b
	dev->role = HAL_PAN_ROLE_PANU;
Packit 34410b
Packit 34410b
	strncpy(dev->iface, BNEP_NAP_INTERFACE, 16);
Packit 34410b
	dev->iface[15] = '\0';
Packit 34410b
Packit 34410b
	dev->io = g_io_channel_ref(chan);
Packit 34410b
	g_io_channel_set_close_on_unref(dev->io, TRUE);
Packit 34410b
Packit 34410b
	if (!bt_io_accept(dev->io, nap_connect_cb, dev, NULL, &err)) {
Packit 34410b
		error("bt_io_accept: %s", err->message);
Packit 34410b
		g_error_free(err);
Packit 34410b
		goto failed;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	devices = g_slist_append(devices, dev);
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_CONNECTING);
Packit 34410b
Packit 34410b
	return;
Packit 34410b
Packit 34410b
failed:
Packit 34410b
	bt_pan_notify_conn_state(dev, HAL_PAN_STATE_DISCONNECTED);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void destroy_nap_device(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	nap_remove_bridge();
Packit 34410b
Packit 34410b
	if (nap_io) {
Packit 34410b
		g_io_channel_shutdown(nap_io, FALSE, NULL);
Packit 34410b
		g_io_channel_unref(nap_io);
Packit 34410b
		nap_io = NULL;
Packit 34410b
	}
Packit 34410b
}
Packit 34410b
Packit 34410b
static int register_nap_server(void)
Packit 34410b
{
Packit 34410b
	GError *gerr = NULL;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	nap_io = bt_io_listen(NULL, nap_confirm_cb, NULL, NULL, &gerr,
Packit 34410b
					BT_IO_OPT_SOURCE_BDADDR, &adapter_addr,
Packit 34410b
					BT_IO_OPT_PSM, BNEP_PSM,
Packit 34410b
					BT_IO_OPT_SEC_LEVEL, BT_IO_SEC_MEDIUM,
Packit 34410b
					BT_IO_OPT_OMTU, BNEP_MTU,
Packit 34410b
					BT_IO_OPT_IMTU, BNEP_MTU,
Packit 34410b
					BT_IO_OPT_INVALID);
Packit 34410b
Packit 34410b
	if (!nap_io) {
Packit 34410b
		destroy_nap_device();
Packit 34410b
		error("%s", gerr->message);
Packit 34410b
		g_error_free(gerr);
Packit 34410b
		return -EIO;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	return 0;
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bt_pan_enable(const void *buf, uint16_t len)
Packit 34410b
{
Packit 34410b
	const struct hal_cmd_pan_enable *cmd = buf;
Packit 34410b
	uint8_t status, state;
Packit 34410b
	int err;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	if (local_role == cmd->local_role) {
Packit 34410b
		status = HAL_STATUS_SUCCESS;
Packit 34410b
		goto reply;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	/* destroy existing server */
Packit 34410b
	destroy_nap_device();
Packit 34410b
Packit 34410b
	switch (cmd->local_role) {
Packit 34410b
	case HAL_PAN_ROLE_NAP:
Packit 34410b
		break;
Packit 34410b
	case HAL_PAN_ROLE_NONE:
Packit 34410b
		local_role = HAL_PAN_ROLE_NONE;
Packit 34410b
		status = HAL_STATUS_SUCCESS;
Packit 34410b
		state = HAL_PAN_CTRL_DISABLED;
Packit 34410b
		goto notify;
Packit 34410b
	default:
Packit 34410b
		status = HAL_STATUS_UNSUPPORTED;
Packit 34410b
		goto reply;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	local_role = cmd->local_role;
Packit 34410b
	err = register_nap_server();
Packit 34410b
	if (err < 0) {
Packit 34410b
		status = HAL_STATUS_FAILED;
Packit 34410b
		destroy_nap_device();
Packit 34410b
		goto reply;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	status = HAL_STATUS_SUCCESS;
Packit 34410b
	state = HAL_PAN_CTRL_ENABLED;
Packit 34410b
Packit 34410b
notify:
Packit 34410b
	bt_pan_notify_ctrl_state(NULL, state, status);
Packit 34410b
Packit 34410b
reply:
Packit 34410b
	ipc_send_rsp(hal_ipc, HAL_SERVICE_ID_PAN, HAL_OP_PAN_ENABLE, status);
Packit 34410b
}
Packit 34410b
Packit 34410b
static void bt_pan_get_role(const void *buf, uint16_t len)
Packit 34410b
{
Packit 34410b
	struct hal_rsp_pan_get_role rsp;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	rsp.local_role = local_role;
Packit 34410b
	ipc_send_rsp_full(hal_ipc, HAL_SERVICE_ID_PAN, HAL_OP_PAN_GET_ROLE,
Packit 34410b
							sizeof(rsp), &rsp, -1);
Packit 34410b
}
Packit 34410b
Packit 34410b
static const struct ipc_handler cmd_handlers[] = {
Packit 34410b
	/* HAL_OP_PAN_ENABLE */
Packit 34410b
	{ bt_pan_enable, false, sizeof(struct hal_cmd_pan_enable) },
Packit 34410b
	/* HAL_OP_PAN_GET_ROLE */
Packit 34410b
	{ bt_pan_get_role, false, 0 },
Packit 34410b
	/* HAL_OP_PAN_CONNECT */
Packit 34410b
	{ bt_pan_connect, false, sizeof(struct hal_cmd_pan_connect) },
Packit 34410b
	/* HAL_OP_PAN_DISCONNECT */
Packit 34410b
	{ bt_pan_disconnect, false, sizeof(struct hal_cmd_pan_disconnect) },
Packit 34410b
};
Packit 34410b
Packit 34410b
static sdp_record_t *nap_record(void)
Packit 34410b
{
Packit 34410b
	sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto;
Packit 34410b
	uuid_t root_uuid, nap, l2cap, bnep;
Packit 34410b
	sdp_profile_desc_t profile[1];
Packit 34410b
	sdp_list_t *proto[2];
Packit 34410b
	sdp_data_t *v, *p;
Packit 34410b
	uint16_t psm = BNEP_PSM, version = 0x0100;
Packit 34410b
	uint16_t security = 0x0001, type = 0xfffe;
Packit 34410b
	uint32_t rate = 0;
Packit 34410b
	const char *desc = "Network Access Point", *name = "Network Service";
Packit 34410b
	sdp_record_t *record;
Packit 34410b
	uint16_t ptype[] = { 0x0800, /* IPv4 */ 0x0806,  /* ARP */ };
Packit 34410b
	sdp_data_t *head, *pseq, *data;
Packit 34410b
Packit 34410b
	record = sdp_record_alloc();
Packit 34410b
	if (!record)
Packit 34410b
		return NULL;
Packit 34410b
Packit 34410b
	record->attrlist = NULL;
Packit 34410b
	record->pattern = NULL;
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&nap, NAP_SVCLASS_ID);
Packit 34410b
	svclass = sdp_list_append(NULL, &nap);
Packit 34410b
	sdp_set_service_classes(record, svclass);
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&profile[0].uuid, NAP_PROFILE_ID);
Packit 34410b
	profile[0].version = 0x0100;
Packit 34410b
	pfseq = sdp_list_append(NULL, &profile[0]);
Packit 34410b
	sdp_set_profile_descs(record, pfseq);
Packit 34410b
	sdp_set_info_attr(record, name, NULL, desc);
Packit 34410b
	sdp_attr_add_new(record, SDP_ATTR_NET_ACCESS_TYPE, SDP_UINT16, &type);
Packit 34410b
	sdp_attr_add_new(record, SDP_ATTR_MAX_NET_ACCESSRATE,
Packit 34410b
							SDP_UINT32, &rate;;
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
Packit 34410b
	root = sdp_list_append(NULL, &root_uuid);
Packit 34410b
	sdp_set_browse_groups(record, root);
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&l2cap, L2CAP_UUID);
Packit 34410b
	proto[0] = sdp_list_append(NULL, &l2cap);
Packit 34410b
	p = sdp_data_alloc(SDP_UINT16, &psm;;
Packit 34410b
	proto[0] = sdp_list_append(proto[0], p);
Packit 34410b
	apseq = sdp_list_append(NULL, proto[0]);
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&bnep, BNEP_UUID);
Packit 34410b
	proto[1] = sdp_list_append(NULL, &bnep;;
Packit 34410b
	v = sdp_data_alloc(SDP_UINT16, &version);
Packit 34410b
	proto[1] = sdp_list_append(proto[1], v);
Packit 34410b
Packit 34410b
	head = sdp_data_alloc(SDP_UINT16, &ptype[0]);
Packit 34410b
	data = sdp_data_alloc(SDP_UINT16, &ptype[1]);
Packit 34410b
	sdp_seq_append(head, data);
Packit 34410b
Packit 34410b
	pseq = sdp_data_alloc(SDP_SEQ16, head);
Packit 34410b
	proto[1] = sdp_list_append(proto[1], pseq);
Packit 34410b
	apseq = sdp_list_append(apseq, proto[1]);
Packit 34410b
	aproto = sdp_list_append(NULL, apseq);
Packit 34410b
	sdp_set_access_protos(record, aproto);
Packit 34410b
	sdp_add_lang_attr(record);
Packit 34410b
	sdp_attr_add_new(record, SDP_ATTR_SECURITY_DESC, SDP_UINT16, &security);
Packit 34410b
Packit 34410b
	sdp_data_free(p);
Packit 34410b
	sdp_data_free(v);
Packit 34410b
	sdp_list_free(apseq, NULL);
Packit 34410b
	sdp_list_free(root, NULL);
Packit 34410b
	sdp_list_free(aproto, NULL);
Packit 34410b
	sdp_list_free(proto[0], NULL);
Packit 34410b
	sdp_list_free(proto[1], NULL);
Packit 34410b
	sdp_list_free(svclass, NULL);
Packit 34410b
	sdp_list_free(pfseq, NULL);
Packit 34410b
Packit 34410b
	return record;
Packit 34410b
}
Packit 34410b
Packit 34410b
static sdp_record_t *panu_record(void)
Packit 34410b
{
Packit 34410b
	sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto;
Packit 34410b
	uuid_t root_uuid, panu, l2cap, bnep;
Packit 34410b
	sdp_profile_desc_t profile[1];
Packit 34410b
	sdp_list_t *proto[2];
Packit 34410b
	sdp_data_t *v, *p;
Packit 34410b
	uint16_t psm = BNEP_PSM, version = 0x0100;
Packit 34410b
	uint16_t security = 0x0001, type = 0xfffe;
Packit 34410b
	uint32_t rate = 0;
Packit 34410b
	const char *desc = "PAN User", *name = "Network Service";
Packit 34410b
	sdp_record_t *record;
Packit 34410b
	uint16_t ptype[] = { 0x0800, /* IPv4 */ 0x0806,  /* ARP */ };
Packit 34410b
	sdp_data_t *head, *pseq, *data;
Packit 34410b
Packit 34410b
	record = sdp_record_alloc();
Packit 34410b
	if (!record)
Packit 34410b
		return NULL;
Packit 34410b
Packit 34410b
	record->attrlist = NULL;
Packit 34410b
	record->pattern = NULL;
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&panu, PANU_SVCLASS_ID);
Packit 34410b
	svclass = sdp_list_append(NULL, &panu);
Packit 34410b
	sdp_set_service_classes(record, svclass);
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&profile[0].uuid, PANU_PROFILE_ID);
Packit 34410b
	profile[0].version = 0x0100;
Packit 34410b
	pfseq = sdp_list_append(NULL, &profile[0]);
Packit 34410b
	sdp_set_profile_descs(record, pfseq);
Packit 34410b
	sdp_set_info_attr(record, name, NULL, desc);
Packit 34410b
	sdp_attr_add_new(record, SDP_ATTR_NET_ACCESS_TYPE, SDP_UINT16, &type);
Packit 34410b
	sdp_attr_add_new(record, SDP_ATTR_MAX_NET_ACCESSRATE,
Packit 34410b
							SDP_UINT32, &rate;;
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
Packit 34410b
	root = sdp_list_append(NULL, &root_uuid);
Packit 34410b
	sdp_set_browse_groups(record, root);
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&l2cap, L2CAP_UUID);
Packit 34410b
	proto[0] = sdp_list_append(NULL, &l2cap);
Packit 34410b
	p = sdp_data_alloc(SDP_UINT16, &psm;;
Packit 34410b
	proto[0] = sdp_list_append(proto[0], p);
Packit 34410b
	apseq = sdp_list_append(NULL, proto[0]);
Packit 34410b
Packit 34410b
	sdp_uuid16_create(&bnep, BNEP_UUID);
Packit 34410b
	proto[1] = sdp_list_append(NULL, &bnep;;
Packit 34410b
	v = sdp_data_alloc(SDP_UINT16, &version);
Packit 34410b
	proto[1] = sdp_list_append(proto[1], v);
Packit 34410b
Packit 34410b
	head = sdp_data_alloc(SDP_UINT16, &ptype[0]);
Packit 34410b
	data = sdp_data_alloc(SDP_UINT16, &ptype[1]);
Packit 34410b
	sdp_seq_append(head, data);
Packit 34410b
Packit 34410b
	pseq = sdp_data_alloc(SDP_SEQ16, head);
Packit 34410b
	proto[1] = sdp_list_append(proto[1], pseq);
Packit 34410b
	apseq = sdp_list_append(apseq, proto[1]);
Packit 34410b
	aproto = sdp_list_append(NULL, apseq);
Packit 34410b
	sdp_set_access_protos(record, aproto);
Packit 34410b
	sdp_add_lang_attr(record);
Packit 34410b
	sdp_attr_add_new(record, SDP_ATTR_SECURITY_DESC, SDP_UINT16, &security);
Packit 34410b
Packit 34410b
	sdp_data_free(p);
Packit 34410b
	sdp_data_free(v);
Packit 34410b
	sdp_list_free(apseq, NULL);
Packit 34410b
	sdp_list_free(root, NULL);
Packit 34410b
	sdp_list_free(aproto, NULL);
Packit 34410b
	sdp_list_free(proto[0], NULL);
Packit 34410b
	sdp_list_free(proto[1], NULL);
Packit 34410b
	sdp_list_free(svclass, NULL);
Packit 34410b
	sdp_list_free(pfseq, NULL);
Packit 34410b
Packit 34410b
	return record;
Packit 34410b
}
Packit 34410b
Packit 34410b
bool bt_pan_register(struct ipc *ipc, const bdaddr_t *addr, uint8_t mode)
Packit 34410b
{
Packit 34410b
	sdp_record_t *nap_rec, *panu_rec;
Packit 34410b
	int err;
Packit 34410b
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	bacpy(&adapter_addr, addr);
Packit 34410b
Packit 34410b
	nap_rec = nap_record();
Packit 34410b
	if (bt_adapter_add_record(nap_rec, SVC_HINT_NETWORKING) < 0) {
Packit 34410b
		sdp_record_free(nap_rec);
Packit 34410b
		error("Failed to allocate PAN-NAP sdp record");
Packit 34410b
		return false;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	panu_rec = panu_record();
Packit 34410b
	if (bt_adapter_add_record(panu_rec, SVC_HINT_NETWORKING) < 0) {
Packit 34410b
		sdp_record_free(nap_rec);
Packit 34410b
		sdp_record_free(panu_rec);
Packit 34410b
		error("Failed to allocate PAN-PANU sdp record");
Packit 34410b
		return false;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	err = bnep_init();
Packit 34410b
	if (err < 0) {
Packit 34410b
		error("Failed to init BNEP");
Packit 34410b
		bt_adapter_remove_record(nap_rec->handle);
Packit 34410b
		bt_adapter_remove_record(panu_rec->handle);
Packit 34410b
		return false;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	err = register_nap_server();
Packit 34410b
	if (err < 0) {
Packit 34410b
		error("Failed to register NAP server");
Packit 34410b
		bt_adapter_remove_record(nap_rec->handle);
Packit 34410b
		bt_adapter_remove_record(panu_rec->handle);
Packit 34410b
		bnep_cleanup();
Packit 34410b
		return false;
Packit 34410b
	}
Packit 34410b
Packit 34410b
	nap_rec_id = nap_rec->handle;
Packit 34410b
	panu_rec_id = panu_rec->handle;
Packit 34410b
Packit 34410b
	hal_ipc = ipc;
Packit 34410b
	ipc_register(hal_ipc, HAL_SERVICE_ID_PAN, cmd_handlers,
Packit 34410b
						G_N_ELEMENTS(cmd_handlers));
Packit 34410b
Packit 34410b
	return true;
Packit 34410b
}
Packit 34410b
Packit 34410b
void bt_pan_unregister(void)
Packit 34410b
{
Packit 34410b
	DBG("");
Packit 34410b
Packit 34410b
	g_slist_free_full(devices, pan_device_free);
Packit 34410b
	devices = NULL;
Packit 34410b
	local_role = HAL_PAN_ROLE_NONE;
Packit 34410b
Packit 34410b
	bnep_cleanup();
Packit 34410b
Packit 34410b
	ipc_unregister(hal_ipc, HAL_SERVICE_ID_PAN);
Packit 34410b
	hal_ipc = NULL;
Packit 34410b
Packit 34410b
	bt_adapter_remove_record(nap_rec_id);
Packit 34410b
	nap_rec_id = 0;
Packit 34410b
	bt_adapter_remove_record(panu_rec_id);
Packit 34410b
	panu_rec_id = 0;
Packit 34410b
	destroy_nap_device();
Packit 34410b
}