ofono/dundee/bluez5.c

/*
 *  oFono - Open Source Telephony
 *
 *  Copyright (C) 2013  Instituto Nokia de Tecnologia - INdT
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 *
 *  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 <stdint.h>
#include <sys/socket.h>
#include <gdbus.h>
#include <errno.h>

#include "dundee.h"
#include "plugins/bluez5.h"

#define DUN_DT_PROFILE_PATH   "/bluetooth/profile/dun_dt"

static GDBusClient *bluez;
static GHashTable *registered_devices;

struct bluetooth_device {
	struct dundee_device *device;

	char *path;
	char *address;
	char *name;

	struct cb_data *connect_cbd;

	int fd;
};

static DBusMessage *profile_new_connection(DBusConnection *conn,
					DBusMessage *msg, void *user_data)
{
	struct bluetooth_device *bt_device;
	dundee_device_connect_cb_t cb;
	DBusMessageIter iter;
	const char *path;
	int fd;

	if (!dbus_message_iter_init(msg, &iter))
		goto error;

	if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_OBJECT_PATH)
		goto error;

	dbus_message_iter_get_basic(&iter, &path);

	bt_device = g_hash_table_lookup(registered_devices, path);
	if (bt_device == NULL)
		goto error;

	cb = bt_device->connect_cbd->cb;

	dbus_message_iter_next(&iter);
	if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_UNIX_FD)
		goto call_failure;

	dbus_message_iter_get_basic(&iter, &fd);
	if (fd < 0)
		goto call_failure;

	DBG("%s %d", bt_device->path, fd);

	bt_device->fd = fd;

	CALLBACK_WITH_SUCCESS(cb, fd, bt_device->connect_cbd->data);

	g_free(bt_device->connect_cbd);
	bt_device->connect_cbd = NULL;

	return dbus_message_new_method_return(msg);

call_failure:
	CALLBACK_WITH_FAILURE(cb, -1, bt_device->connect_cbd->data);

	g_free(bt_device->connect_cbd);
	bt_device->connect_cbd = NULL;

error:
	return g_dbus_create_error(msg, BLUEZ_ERROR_INTERFACE ".Rejected",
					"Invalid arguments in method call");
}

static DBusMessage *profile_release(DBusConnection *conn,
					DBusMessage *msg, void *user_data)
{
	DBG("");

	return g_dbus_create_error(msg, BLUEZ_ERROR_INTERFACE
						".NotImplemented",
						"Implementation not provided");
}

static DBusMessage *profile_cancel(DBusConnection *conn,
					DBusMessage *msg, void *user_data)
{
	DBG("");

	return g_dbus_create_error(msg, BLUEZ_ERROR_INTERFACE
						".NotImplemented",
						"Implementation not provided");
}

static DBusMessage *profile_disconnection(DBusConnection *conn,
					DBusMessage *msg, void *user_data)
{
	struct bluetooth_device *bt_device;
	DBusMessageIter iter;
	const char *path;

	if (!dbus_message_iter_init(msg, &iter))
		goto error;

	if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_OBJECT_PATH)
		goto error;

	dbus_message_iter_get_basic(&iter, &path);

	bt_device = g_hash_table_lookup(registered_devices, path);
	if (bt_device == NULL)
		goto error;

	DBG("%s", bt_device->path);

	CALLBACK_WITH_SUCCESS(dundee_device_disconnect, bt_device->device);

	return dbus_message_new_method_return(msg);

error:
	return g_dbus_create_error(msg, BLUEZ_ERROR_INTERFACE ".Rejected",
					"Invalid arguments in method call");
}

static const GDBusMethodTable profile_methods[] = {
	{ GDBUS_ASYNC_METHOD("NewConnection",
				GDBUS_ARGS({ "device", "o"}, { "fd", "h"},
						{ "fd_properties", "a{sv}" }),
				NULL, profile_new_connection) },
	{ GDBUS_METHOD("Release", NULL, NULL, profile_release) },
	{ GDBUS_METHOD("Cancel", NULL, NULL, profile_cancel) },
	{ GDBUS_METHOD("RequestDisconnection",
				GDBUS_ARGS({"device", "o"}), NULL,
				profile_disconnection) },
	{ }
};

static void bluetooth_device_destroy(gpointer user_data)
{
	struct bluetooth_device *bt_device = user_data;

	DBG("%s", bt_device->path);

	if (bt_device->device != NULL)
		dundee_device_unregister(bt_device->device);

	if (bt_device->connect_cbd != NULL)
		g_free(bt_device->connect_cbd);

	g_free(bt_device->path);
	g_free(bt_device->address);
	g_free(bt_device->name);
	g_free(bt_device);
}

static void bluetooth_device_connect_callback(gboolean success,
							gpointer user_data)
{
	struct bluetooth_device *bt_device = user_data;

	if (success) {
		DBG("Success");
		return;
	}

	DBG("ConnectProfile() returned an error");

	g_free(bt_device->connect_cbd);
	bt_device->connect_cbd = NULL;
}

static void bluetooth_device_connect(struct dundee_device *device,
			dundee_device_connect_cb_t cb, void *data)
{
	struct bluetooth_device *bt_device = dundee_device_get_data(device);
	struct cb_data *cbd = cb_data_new(cb, data);

	DBG("%s", bt_device->path);

	cbd->user = bt_device;
	bt_device->connect_cbd = cbd;

	bt_connect_profile(ofono_dbus_get_connection(), bt_device->path,
		DUN_GW_UUID, bluetooth_device_connect_callback, bt_device);
}

static void bluetooth_device_disconnect(struct dundee_device *device,
				dundee_device_disconnect_cb_t cb, void *data)
{
	struct bluetooth_device *bt_device = dundee_device_get_data(device);

	DBG("%s", bt_device->path);

	shutdown(bt_device->fd, SHUT_RDWR);
	CALLBACK_WITH_SUCCESS(cb, data);
}

struct dundee_device_driver bluetooth_driver = {
	.name = "bluetooth",
	.connect = bluetooth_device_connect,
	.disconnect = bluetooth_device_disconnect,
};

static struct bluetooth_device *bluetooth_device_create(const char *path,
					const char *address, const char *alias)
{
	struct bluetooth_device *bt_device;

	DBG("%s %s %s", path, address, alias);

	bt_device = g_try_new0(struct bluetooth_device, 1);
	if (bt_device == NULL)
		return NULL;

	bt_device->path = g_strdup(path);
	bt_device->address = g_strdup(address);
	bt_device->name = g_strdup(alias);

	return bt_device;
}

static struct bluetooth_device *bluetooth_device_register(GDBusProxy *proxy)
{
	const char *path = g_dbus_proxy_get_path(proxy);
	const char *alias, *address;
	struct bluetooth_device *bt_device;
	struct dundee_device *device;
	DBusMessageIter iter;

	DBG("%s", path);

	if (g_hash_table_lookup(registered_devices, path) != NULL)
		return NULL;

	if (!g_dbus_proxy_get_property(proxy, "Address", &iter))
		return NULL;

	dbus_message_iter_get_basic(&iter, &address);

	if (!g_dbus_proxy_get_property(proxy, "Alias", &iter))
		return NULL;

	dbus_message_iter_get_basic(&iter, &alias);

	bt_device = bluetooth_device_create(path, address, alias);
	if (bt_device == NULL) {
		ofono_error("Register bluetooth device failed");
		return NULL;
	}

	device = dundee_device_create(&bluetooth_driver);
	if (device == NULL)
		goto free;

	dundee_device_set_data(device, bt_device);
	dundee_device_set_name(device, bt_device->name);

	if (dundee_device_register(device) < 0) {
		g_free(device);
		goto free;
	}

	bt_device->device = device;
	g_hash_table_insert(registered_devices, g_strdup(path), bt_device);

	return bt_device;

free:
	bluetooth_device_destroy(bt_device);
	return NULL;
}

static void bluetooth_device_unregister(const char *path)
{
	DBG("");

	g_hash_table_remove(registered_devices, path);
}

static gboolean has_dun_uuid(DBusMessageIter *array)
{
	DBusMessageIter value;

	if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
		return FALSE;

	dbus_message_iter_recurse(array, &value);

	while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
		const char *uuid;

		dbus_message_iter_get_basic(&value, &uuid);

		if (g_str_equal(uuid, DUN_GW_UUID))
			return TRUE;

		dbus_message_iter_next(&value);
	}

	return FALSE;
}

static void alias_changed(GDBusProxy *proxy, const char *name,
					DBusMessageIter *iter, void *user_data)
{
	const char *alias;
	struct bluetooth_device *bt_device = user_data;

	if (!g_str_equal("Alias", name))
		return;

	dbus_message_iter_get_basic(iter, &alias);

	bt_device->name = g_strdup(alias);
}

static void bluetooth_device_removed(GDBusProxy *proxy, void *user_data)
{
	struct bluetooth_device *bt_device = user_data;

	DBG("%s", bt_device->path);

	bluetooth_device_unregister(bt_device->path);
}

static void proxy_added(GDBusProxy *proxy, void *user_data)
{
	const char *path = g_dbus_proxy_get_path(proxy);
	const char *interface = g_dbus_proxy_get_interface(proxy);
	struct bluetooth_device *bt_device;
	DBusMessageIter iter;

	if (!g_str_equal(BLUEZ_DEVICE_INTERFACE, interface))
		return;

	if (!g_dbus_proxy_get_property(proxy, "UUIDs", &iter))
		return;

	DBG("%s %s", path, interface);

	if (!has_dun_uuid(&iter))
		return;

	bt_device = bluetooth_device_register(proxy);
	g_dbus_proxy_set_property_watch(proxy, alias_changed, bt_device);
	g_dbus_proxy_set_removed_watch(proxy, bluetooth_device_removed,
								bt_device);
}

static void connect_handler(DBusConnection *conn, void *user_data)
{
	DBG("");

	bt_register_profile_with_role(conn, DUN_GW_UUID, DUN_VERSION_1_2,
				"dun_dt", DUN_DT_PROFILE_PATH, "client");
}

int __dundee_bluetooth_init(void)
{
	DBusConnection *conn = ofono_dbus_get_connection();

	DBG("");

	if (!g_dbus_register_interface(conn, DUN_DT_PROFILE_PATH,
					BLUEZ_PROFILE_INTERFACE,
					profile_methods, NULL,
					NULL, NULL, NULL)) {
		ofono_error("Register Profile interface failed: %s",
						DUN_DT_PROFILE_PATH);
		return -EIO;
	}

	bluez = g_dbus_client_new(conn, BLUEZ_SERVICE, BLUEZ_MANAGER_PATH);
	g_dbus_client_set_connect_watch(bluez, connect_handler, NULL);
	g_dbus_client_set_proxy_handlers(bluez, proxy_added, NULL, NULL, NULL);

	registered_devices = g_hash_table_new_full(g_str_hash, g_str_equal,
					g_free, bluetooth_device_destroy);

	return 0;
}

void __dundee_bluetooth_cleanup(void)
{
	DBusConnection *conn = ofono_dbus_get_connection();

	DBG("");

	g_dbus_unregister_interface(conn, DUN_DT_PROFILE_PATH,
						BLUEZ_PROFILE_INTERFACE);

	g_dbus_client_unref(bluez);
	g_hash_table_destroy(registered_devices);
}