bluez/android/main.c

/*
 *
 *  BlueZ - Bluetooth protocol stack for Linux
 *
 *  Copyright (C) 2013  Intel Corporation. All rights reserved.
 *
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */

#ifdef HAVE_CONFIG_H
#include <config.h>
#endif

#include <stdbool.h>
#include <signal.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <stdbool.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>

#include <sys/signalfd.h>
#include <sys/socket.h>
#include <sys/un.h>

#include <glib.h>

#include "log.h"
#include "src/sdpd.h"

#include "lib/bluetooth.h"
#include "lib/mgmt.h"
#include "src/shared/mgmt.h"

#include "adapter.h"
#include "socket.h"
#include "hidhost.h"
#include "hal-msg.h"
#include "ipc.h"
#include "a2dp.h"
#include "pan.h"

/* TODO: Consider to remove PLATFORM_SDKVERSION check if requirement
*  for minimal Android platform version increases. */
#if defined(ANDROID) && PLATFORM_SDK_VERSION >= 18
#include <sys/capability.h>
#endif

#define STARTUP_GRACE_SECONDS 5
#define SHUTDOWN_GRACE_SECONDS 10

static GMainLoop *event_loop;
static struct mgmt *mgmt_if = NULL;

static uint16_t adapter_index = MGMT_INDEX_NONE;
static guint adapter_timeout = 0;

static GIOChannel *hal_cmd_io = NULL;
static GIOChannel *hal_notif_io = NULL;

static bool services[HAL_SERVICE_ID_MAX + 1] = { false };

static void service_register(void *buf, uint16_t len)
{
	struct hal_cmd_register_module *m = buf;
	const bdaddr_t *adapter_bdaddr = bt_adapter_get_address();
	int sk = g_io_channel_unix_get_fd(hal_notif_io);

	if (m->service_id > HAL_SERVICE_ID_MAX || services[m->service_id])
		goto failed;

	switch (m->service_id) {
	case HAL_SERVICE_ID_BLUETOOTH:
		if (!bt_adapter_register(sk))
			goto failed;

		break;
	case HAL_SERVICE_ID_SOCK:
		if (!bt_socket_register(sk, adapter_bdaddr))
			goto failed;

		break;
	case HAL_SERVICE_ID_HIDHOST:
		if (!bt_hid_register(sk, adapter_bdaddr))
			goto failed;

		break;
	case HAL_SERVICE_ID_A2DP:
		if (!bt_a2dp_register(sk, adapter_bdaddr))
			goto failed;

		break;
	case HAL_SERVICE_ID_PAN:
		if (!bt_pan_register(sk, adapter_bdaddr))
			goto failed;

		break;
	default:
		DBG("service %u not supported", m->service_id);
		goto failed;
	}

	services[m->service_id] = true;

	ipc_send(g_io_channel_unix_get_fd(hal_cmd_io), HAL_SERVICE_ID_CORE,
					HAL_OP_REGISTER_MODULE, 0, NULL, -1);

	info("Service ID=%u registered", m->service_id);
	return;
failed:
	ipc_send_rsp(g_io_channel_unix_get_fd(hal_cmd_io),
				HAL_SERVICE_ID_CORE, HAL_STATUS_FAILED);
}

static void service_unregister(void *buf, uint16_t len)
{
	struct hal_cmd_unregister_module *m = buf;

	if (m->service_id > HAL_SERVICE_ID_MAX || !services[m->service_id])
		goto failed;

	switch (m->service_id) {
	case HAL_SERVICE_ID_BLUETOOTH:
		bt_adapter_unregister();
		break;
	case HAL_SERVICE_ID_SOCK:
		bt_socket_unregister();
		break;
	case HAL_SERVICE_ID_HIDHOST:
		bt_hid_unregister();
		break;
	case HAL_SERVICE_ID_A2DP:
		bt_a2dp_unregister();
		break;
	case HAL_SERVICE_ID_PAN:
		bt_pan_unregister();
		break;
	default:
		/* This would indicate bug in HAL, as unregister should not be
		 * called in init failed */
		DBG("service %u not supported", m->service_id);
		goto failed;
	}

	services[m->service_id] = false;

	ipc_send(g_io_channel_unix_get_fd(hal_cmd_io), HAL_SERVICE_ID_CORE,
					HAL_OP_UNREGISTER_MODULE, 0, NULL, -1);

	info("Service ID=%u unregistered", m->service_id);
	return;
failed:
	ipc_send_rsp(g_io_channel_unix_get_fd(hal_cmd_io),
				HAL_SERVICE_ID_CORE, HAL_STATUS_FAILED);
}

static void handle_service_core(uint8_t opcode, void *buf, uint16_t len)
{
	switch (opcode) {
	case HAL_OP_REGISTER_MODULE:
		service_register(buf, len);
		break;
	case HAL_OP_UNREGISTER_MODULE:
		service_unregister(buf, len);
		break;
	default:
		ipc_send_rsp(g_io_channel_unix_get_fd(hal_cmd_io),
				HAL_SERVICE_ID_CORE, HAL_STATUS_FAILED);
		break;
	}
}

static void shutdown_complete(uint8_t status, uint16_t length,
					const void *param, void *user_data)
{
	if (status != MGMT_STATUS_SUCCESS)
		error("Clean controller shutdown failed");

	g_main_loop_quit(event_loop);
}

static void shutdown_controller(void)
{
	static bool __shutdown = false;
	struct mgmt_mode cp;

	if (__shutdown)
		return;

	__shutdown = true;

	info("Switching controller off");

	memset(&cp, 0, sizeof(cp));
	cp.val = 0x00;

	if (mgmt_send(mgmt_if, MGMT_OP_SET_POWERED, adapter_index,
			sizeof(cp), &cp, shutdown_complete, NULL, NULL) > 0)
		return;

	g_main_loop_quit(event_loop);
}

static gboolean cmd_watch_cb(GIOChannel *io, GIOCondition cond,
							gpointer user_data)
{
	char buf[BLUEZ_HAL_MTU];
	struct hal_hdr *msg = (void *) buf;
	ssize_t ret;
	int fd;

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
		info("HAL command socket closed, terminating");
		goto fail;
	}

	fd = g_io_channel_unix_get_fd(io);

	ret = read(fd, buf, sizeof(buf));
	if (ret < 0) {
		error("HAL command read failed, terminating (%s)",
							strerror(errno));
		goto fail;
	}

	if (ret < (ssize_t) sizeof(*msg)) {
		error("HAL command too small, terminating (%zd)", ret);
		goto fail;
	}

	if (ret != (ssize_t) (sizeof(*msg) + msg->len)) {
		error("Malformed HAL command (%zd bytes), terminating", ret);
		goto fail;
	}

	DBG("service_id %u opcode %u len %u", msg->service_id, msg->opcode,
								msg->len);

	switch (msg->service_id) {
	case HAL_SERVICE_ID_CORE:
		handle_service_core(msg->opcode, msg->payload, msg->len);
		break;
	case HAL_SERVICE_ID_BLUETOOTH:
		bt_adapter_handle_cmd(fd, msg->opcode, msg->payload, msg->len);
		break;
	case HAL_SERVICE_ID_HIDHOST:
		bt_hid_handle_cmd(fd, msg->opcode, msg->payload, msg->len);
		break;
	case HAL_SERVICE_ID_SOCK:
		bt_sock_handle_cmd(fd, msg->opcode, msg->payload, msg->len);
		break;
	case HAL_SERVICE_ID_A2DP:
		bt_a2dp_handle_cmd(fd, msg->opcode, msg->payload, msg->len);
		break;
	case HAL_SERVICE_ID_PAN:
		bt_pan_handle_cmd(fd, msg->opcode, msg->payload, msg->len);
		break;
	default:
		ipc_send_rsp(fd, msg->service_id, HAL_STATUS_FAILED);
		break;
	}

	return TRUE;

fail:
	shutdown_controller();
	return FALSE;
}

static gboolean notif_watch_cb(GIOChannel *io, GIOCondition cond,
							gpointer user_data)
{
	info("HAL notification socket closed, terminating");
	shutdown_controller();

	return FALSE;
}

static GIOChannel *connect_hal(GIOFunc connect_cb)
{
	struct sockaddr_un addr;
	GIOCondition cond;
	GIOChannel *io;
	int sk;

	sk = socket(PF_LOCAL, SOCK_SEQPACKET, 0);
	if (sk < 0) {
		error("Failed to create socket: %d (%s)", errno,
							strerror(errno));
		return NULL;
	}

	io = g_io_channel_unix_new(sk);

	g_io_channel_set_close_on_unref(io, TRUE);
	g_io_channel_set_flags(io, G_IO_FLAG_NONBLOCK, NULL);

	memset(&addr, 0, sizeof(addr));
	addr.sun_family = AF_UNIX;

	memcpy(addr.sun_path, BLUEZ_HAL_SK_PATH, sizeof(BLUEZ_HAL_SK_PATH));

	if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
		error("Failed to connect HAL socket: %d (%s)", errno,
							strerror(errno));
		g_io_channel_unref(io);
		return NULL;
	}

	cond = G_IO_OUT | G_IO_ERR | G_IO_HUP | G_IO_NVAL;

	g_io_add_watch(io, cond, connect_cb, NULL);

	return io;
}

static gboolean notif_connect_cb(GIOChannel *io, GIOCondition cond,
							gpointer user_data)
{
	DBG("");

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
		g_main_loop_quit(event_loop);
		return FALSE;
	}

	cond = G_IO_ERR | G_IO_HUP | G_IO_NVAL;

	g_io_add_watch(io, cond, notif_watch_cb, NULL);

	cond = G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL;

	g_io_add_watch(hal_cmd_io, cond, cmd_watch_cb, NULL);

	info("Successfully connected to HAL");

	return FALSE;
}

static gboolean cmd_connect_cb(GIOChannel *io, GIOCondition cond,
							gpointer user_data)
{
	DBG("");

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP)) {
		g_main_loop_quit(event_loop);
		return FALSE;
	}

	hal_notif_io = connect_hal(notif_connect_cb);
	if (!hal_notif_io) {
		error("Cannot connect to HAL, terminating");
		g_main_loop_quit(event_loop);
	}

	return FALSE;
}

static gboolean quit_eventloop(gpointer user_data)
{
	g_main_loop_quit(event_loop);
	return FALSE;
}

static gboolean signal_handler(GIOChannel *channel, GIOCondition cond,
							gpointer user_data)
{
	static bool __terminated = false;
	struct signalfd_siginfo si;
	ssize_t result;
	int fd;

	if (cond & (G_IO_NVAL | G_IO_ERR | G_IO_HUP))
		return FALSE;

	fd = g_io_channel_unix_get_fd(channel);

	result = read(fd, &si, sizeof(si));
	if (result != sizeof(si))
		return FALSE;

	switch (si.ssi_signo) {
	case SIGINT:
	case SIGTERM:
		if (!__terminated) {
			info("Terminating");
			if (adapter_index != MGMT_INDEX_NONE) {
				g_timeout_add_seconds(SHUTDOWN_GRACE_SECONDS,
							quit_eventloop, NULL);
				shutdown_controller();
			} else
				g_main_loop_quit(event_loop);
		}

		__terminated = true;
		break;
	}

	return TRUE;
}

static guint setup_signalfd(void)
{
	GIOChannel *channel;
	guint source;
	sigset_t mask;
	int fd;

	sigemptyset(&mask);
	sigaddset(&mask, SIGINT);
	sigaddset(&mask, SIGTERM);

	if (sigprocmask(SIG_BLOCK, &mask, NULL) < 0) {
		perror("Failed to set signal mask");
		return 0;
	}

	fd = signalfd(-1, &mask, 0);
	if (fd < 0) {
		perror("Failed to create signal descriptor");
		return 0;
	}

	channel = g_io_channel_unix_new(fd);

	g_io_channel_set_close_on_unref(channel, TRUE);
	g_io_channel_set_encoding(channel, NULL, NULL);
	g_io_channel_set_buffered(channel, FALSE);

	source = g_io_add_watch(channel,
				G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
				signal_handler, NULL);

	g_io_channel_unref(channel);

	return source;
}

static gboolean option_version = FALSE;
static gint option_index = MGMT_INDEX_NONE;

static GOptionEntry options[] = {
	{ "version", 'v', 0, G_OPTION_ARG_NONE, &option_version,
				"Show version information and exit", NULL },
	{ "index", 'i', 0, G_OPTION_ARG_INT, &option_index,
				"Use specified controller", "INDEX"},
	{ NULL }
};

static void adapter_ready(int err)
{
	if (err) {
		error("Adapter initialization failed: %s", strerror(err));
		exit(EXIT_FAILURE);
	}

	info("Adapter initialized");

	hal_cmd_io = connect_hal(cmd_connect_cb);
	if (!hal_cmd_io) {
		error("Cannot connect to HAL, terminating");
		g_main_loop_quit(event_loop);
	}
}

static void mgmt_index_added_event(uint16_t index, uint16_t length,
					const void *param, void *user_data)
{
	uint16_t opt_index = option_index;

	DBG("index %u", index);

	if (adapter_index != MGMT_INDEX_NONE) {
		DBG("skip event for index %u", index);
		return;
	}

	if (opt_index != MGMT_INDEX_NONE && opt_index != index) {
		DBG("skip event for index %u (option %u)", index, opt_index);
		return;
	}

	if (adapter_timeout > 0) {
		g_source_remove(adapter_timeout);
		adapter_timeout = 0;
	}

	adapter_index = index;
	bt_adapter_init(index, mgmt_if, adapter_ready);
}

static void mgmt_index_removed_event(uint16_t index, uint16_t length,
					const void *param, void *user_data)
{
	DBG("index %u", index);

	if (index != adapter_index)
		return;

	error("Adapter was removed. Exiting.");
	g_main_loop_quit(event_loop);
}

static gboolean adapter_timeout_handler(gpointer user_data)
{
	adapter_timeout = 0;
	g_main_loop_quit(event_loop);

	return FALSE;
}

static void read_index_list_complete(uint8_t status, uint16_t length,
					const void *param, void *user_data)
{
	const struct mgmt_rp_read_index_list *rp = param;
	uint16_t opt_index = option_index;
	uint16_t num;
	int i;

	DBG("");

	if (status) {
		error("%s: Failed to read index list: %s (0x%02x)",
					__func__, mgmt_errstr(status), status);
		goto failed;
	}

	if (length < sizeof(*rp)) {
		error("%s: Wrong size of read index list response", __func__);
		goto failed;
	}

	num = btohs(rp->num_controllers);

	DBG("Number of controllers: %u", num);

	if (num * sizeof(uint16_t) + sizeof(*rp) != length) {
		error("%s: Incorrect pkt size for index list rsp", __func__);
		goto failed;
	}

	if (adapter_index != MGMT_INDEX_NONE)
		return;

	for (i = 0; i < num; i++) {
		uint16_t index = btohs(rp->index[i]);

		if (opt_index != MGMT_INDEX_NONE && opt_index != index)
			continue;

		adapter_index = index;
		bt_adapter_init(adapter_index, mgmt_if, adapter_ready);
		return;
	}

	if (adapter_index != MGMT_INDEX_NONE)
		return;

	adapter_timeout = g_timeout_add_seconds(STARTUP_GRACE_SECONDS,
					adapter_timeout_handler, NULL);
	if (adapter_timeout > 0)
		return;

	error("%s: Failed init timeout", __func__);

failed:
	g_main_loop_quit(event_loop);
}

static void read_commands_complete(uint8_t status, uint16_t length,
					const void *param, void *user_data)
{
	const struct mgmt_rp_read_commands *rp = param;

	DBG("");

	if (status) {
		error("Failed to read supported commands: %s (0x%02x)",
						mgmt_errstr(status), status);
		return;
	}

	if (length < sizeof(*rp)) {
		error("Wrong size response");
		return;
	}
}

static void read_version_complete(uint8_t status, uint16_t length,
					const void *param, void *user_data)
{
	const struct mgmt_rp_read_version *rp = param;
	uint8_t mgmt_version, mgmt_revision;

	DBG("");

	if (status) {
		error("Failed to read version information: %s (0x%02x)",
						mgmt_errstr(status), status);
		goto failed;
	}

	if (length < sizeof(*rp)) {
		error("Wrong size response");
		goto failed;
	}

	mgmt_version = rp->version;
	mgmt_revision = btohs(rp->revision);

	info("Bluetooth management interface %u.%u initialized",
						mgmt_version, mgmt_revision);

	if (MGMT_VERSION(mgmt_version, mgmt_revision) < MGMT_VERSION(1, 3)) {
		error("Version 1.3 or later of management interface required");
		goto failed;
	}

	mgmt_send(mgmt_if, MGMT_OP_READ_COMMANDS, MGMT_INDEX_NONE, 0, NULL,
					read_commands_complete, NULL, NULL);

	mgmt_register(mgmt_if, MGMT_EV_INDEX_ADDED, MGMT_INDEX_NONE,
					mgmt_index_added_event, NULL, NULL);
	mgmt_register(mgmt_if, MGMT_EV_INDEX_REMOVED, MGMT_INDEX_NONE,
					mgmt_index_removed_event, NULL, NULL);

	if (mgmt_send(mgmt_if, MGMT_OP_READ_INDEX_LIST, MGMT_INDEX_NONE, 0,
			NULL, read_index_list_complete, NULL, NULL) > 0)
		return;

	error("Failed to read controller index list");

failed:
	g_main_loop_quit(event_loop);
}

static bool init_mgmt_interface(void)
{
	mgmt_if = mgmt_new_default();
	if (!mgmt_if) {
		error("Failed to access management interface");
		return false;
	}

	if (mgmt_send(mgmt_if, MGMT_OP_READ_VERSION, MGMT_INDEX_NONE, 0, NULL,
				read_version_complete, NULL, NULL) == 0) {
		error("Error sending READ_VERSION mgmt command");
		return false;
	}

	return true;
}

static void cleanup_mgmt_interface(void)
{
	mgmt_unref(mgmt_if);
	mgmt_if = NULL;
}

static void cleanup_hal_connection(void)
{
	if (hal_cmd_io) {
		g_io_channel_shutdown(hal_cmd_io, TRUE, NULL);
		g_io_channel_unref(hal_cmd_io);
		hal_cmd_io = NULL;
	}

	if (hal_notif_io) {
		g_io_channel_shutdown(hal_notif_io, TRUE, NULL);
		g_io_channel_unref(hal_notif_io);
		hal_notif_io = NULL;
	}
}

static bool set_capabilities(void)
{
#if defined(ANDROID)
	struct __user_cap_header_struct header;
	struct __user_cap_data_struct cap;

	header.version = _LINUX_CAPABILITY_VERSION;
	header.pid = 0;

	cap.effective = cap.permitted =
		CAP_TO_MASK(CAP_NET_ADMIN) |
		CAP_TO_MASK(CAP_NET_BIND_SERVICE);
	cap.inheritable = 0;

	/* TODO: Move to cap_set_proc once bionic support it */
	if (capset(&header, &cap) < 0) {
		error("%s: capset(): %s", __func__, strerror(errno));
		return false;
	}

	/* TODO: Move to cap_get_proc once bionic support it */
	if (capget(&header, &cap) < 0) {
		error("%s: capget(): %s", __func__, strerror(errno));
		return false;
	}

	DBG("Caps: eff: 0x%x, perm: 0x%x, inh: 0x%x", cap.effective,
					cap.permitted, cap.inheritable);

#endif
	return true;
}

int main(int argc, char *argv[])
{
	GOptionContext *context;
	GError *err = NULL;
	guint signal;

	context = g_option_context_new(NULL);
	g_option_context_add_main_entries(context, options, NULL);

	if (g_option_context_parse(context, &argc, &argv, &err) == FALSE) {
		if (err != NULL) {
			g_printerr("%s\n", err->message);
			g_error_free(err);
		} else
			g_printerr("An unknown error occurred\n");

		exit(EXIT_FAILURE);
	}

	g_option_context_free(context);

	if (option_version == TRUE) {
		printf("%s\n", VERSION);
		exit(EXIT_SUCCESS);
	}

	event_loop = g_main_loop_new(NULL, FALSE);
	signal = setup_signalfd();
	if (!signal)
		return EXIT_FAILURE;

	__btd_log_init("*", 0);

	if (!set_capabilities())
		return EXIT_FAILURE;

	if (!init_mgmt_interface())
		return EXIT_FAILURE;

	/* Use params: mtu = 0, flags = 0 */
	start_sdp_server(0, 0);

	DBG("Entering main loop");

	g_main_loop_run(event_loop);

	g_source_remove(signal);

	cleanup_hal_connection();
	stop_sdp_server();
	cleanup_mgmt_interface();
	g_main_loop_unref(event_loop);

	info("Exit");

	__btd_log_cleanup();

	return EXIT_SUCCESS;
}