From e0581b5e29c71c4a0b429ebad671e9bb5583f8e0 Mon Sep 17 00:00:00 2001 From: Marcel Holtmann Date: Tue, 29 Jul 2008 20:35:12 +0200 Subject: Move hcid to src directory and rename it to bluetoothd --- src/manager.c | 547 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 547 insertions(+) create mode 100644 src/manager.c (limited to 'src/manager.c') diff --git a/src/manager.c b/src/manager.c new file mode 100644 index 00000000..4f638566 --- /dev/null +++ b/src/manager.c @@ -0,0 +1,547 @@ +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2006-2007 Nokia Corporation + * Copyright (C) 2004-2008 Marcel Holtmann + * + * + * 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 +#endif + +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include + +#include + +#include + +#include + +#include "logging.h" +#include "textfile.h" +#include "hcid.h" +#include "sdpd.h" +#include "adapter.h" +#include "dbus-common.h" +#include "error.h" +#include "dbus-hci.h" +#include "dbus-database.h" +#include "sdp-xml.h" +#include "oui.h" +#include "agent.h" +#include "device.h" +#include "glib-helper.h" + +#include "manager.h" + +static DBusConnection *connection = NULL; +static int default_adapter_id = -1; +static GSList *adapters = NULL; + +int manager_update_adapter(uint16_t dev_id) +{ + struct adapter *adapter; + + adapter = manager_find_adapter_by_id(dev_id); + if (!adapter) + return -EINVAL; + + return adapter_update(adapter); +} + +int manager_get_adapter_class(uint16_t dev_id, uint8_t *cls) +{ + struct adapter *adapter; + + adapter = manager_find_adapter_by_id(dev_id); + if (!adapter) + return -EINVAL; + + return adapter_get_class(adapter, cls); +} + +int manager_set_adapter_class(uint16_t dev_id, uint8_t *cls) +{ + struct adapter *adapter; + + adapter = manager_find_adapter_by_id(dev_id); + if (!adapter) + return -EINVAL; + + return adapter_set_class(adapter, cls); +} + +int get_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr, char *alias, size_t size) +{ + struct adapter *adapter = manager_find_adapter_by_id(dev_id); + char filename[PATH_MAX + 1], addr[18], *tmp; + int err; + const gchar *source = adapter_get_address(adapter); + + create_name(filename, PATH_MAX, STORAGEDIR, source, "aliases"); + + ba2str(bdaddr, addr); + + tmp = textfile_get(filename, addr); + if (!tmp) + return -ENXIO; + + err = snprintf(alias, size, "%s", tmp); + + free(tmp); + + return err; +} + +int set_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr, const char *alias) +{ + struct adapter *adapter = manager_find_adapter_by_id(dev_id); + const gchar *source = adapter_get_address(adapter); + char filename[PATH_MAX + 1], addr[18]; + + create_name(filename, PATH_MAX, STORAGEDIR, source, "aliases"); + + create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); + + ba2str(bdaddr, addr); + + return textfile_put(filename, addr, alias); +} + +static inline DBusMessage *invalid_args(DBusMessage *msg) +{ + return g_dbus_create_error(msg, + ERROR_INTERFACE ".InvalidArguments", + "Invalid arguments in method call"); +} + +static inline DBusMessage *no_such_adapter(DBusMessage *msg) +{ + return g_dbus_create_error(msg, + ERROR_INTERFACE ".NoSuchAdapter", + "No such adapter"); +} + +static inline DBusMessage *no_such_service(DBusMessage *msg) +{ + return g_dbus_create_error(msg, + ERROR_INTERFACE ".NoSuchService", + "No such service"); +} + +static inline DBusMessage *failed_strerror(DBusMessage *msg, int err) +{ + return g_dbus_create_error(msg, + ERROR_INTERFACE ".Failed", + strerror(err)); +} + +static int find_by_address(const char *str) +{ + struct hci_dev_list_req *dl; + struct hci_dev_req *dr; + bdaddr_t ba; + int i, sk; + int devid = -1; + + sk = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); + if (sk < 0) + return -1; + + dl = g_malloc0(HCI_MAX_DEV * sizeof(*dr) + sizeof(*dl)); + + dl->dev_num = HCI_MAX_DEV; + dr = dl->dev_req; + + if (ioctl(sk, HCIGETDEVLIST, dl) < 0) + goto out; + + dr = dl->dev_req; + str2ba(str, &ba); + + for (i = 0; i < dl->dev_num; i++, dr++) { + struct hci_dev_info di; + + if (hci_devinfo(dr->dev_id, &di) < 0) + continue; + + if (hci_test_bit(HCI_RAW, &di.flags)) + continue; + + if (!bacmp(&ba, &di.bdaddr)) { + devid = dr->dev_id; + break; + } + } + +out: + g_free(dl); + close(sk); + return devid; +} + +static DBusMessage *default_adapter(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + DBusMessage *reply; + struct adapter *adapter; + const gchar *path; + + adapter = manager_find_adapter_by_id(default_adapter_id); + if (!adapter) + return no_such_adapter(msg); + + reply = dbus_message_new_method_return(msg); + if (!reply) + return NULL; + + path = adapter_get_path(adapter); + + dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); + + return reply; +} + +static DBusMessage *find_adapter(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + DBusMessage *reply; + struct adapter *adapter; + struct hci_dev_info di; + const char *pattern; + int dev_id; + const gchar *path; + + if (!dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &pattern, + DBUS_TYPE_INVALID)) + return NULL; + + /* hci_devid() would make sense to use here, except it + is restricted to devices which are up */ + if (!strncmp(pattern, "hci", 3) && strlen(pattern) >= 4) + dev_id = atoi(pattern + 3); + else + dev_id = find_by_address(pattern); + + if (dev_id < 0) + return no_such_adapter(msg); + + if (hci_devinfo(dev_id, &di) < 0) + return no_such_adapter(msg); + + if (hci_test_bit(HCI_RAW, &di.flags)) + return no_such_adapter(msg); + + adapter = manager_find_adapter_by_id(dev_id); + if (!adapter) + return no_such_adapter(msg); + + reply = dbus_message_new_method_return(msg); + if (!reply) + return NULL; + + path = adapter_get_path(adapter); + + dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); + + return reply; +} + +static DBusMessage *list_adapters(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + DBusMessageIter iter; + DBusMessageIter array_iter; + DBusMessage *reply; + GSList *l; + uint16_t dev_id; + + reply = dbus_message_new_method_return(msg); + if (!reply) + return NULL; + + dbus_message_iter_init_append(reply, &iter); + + dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY, + DBUS_TYPE_OBJECT_PATH_AS_STRING, &array_iter); + + for (l = adapters; l; l = l->next) { + struct adapter *adapter = l->data; + struct hci_dev_info di; + dev_id = adapter_get_dev_id(adapter); + const gchar *path = adapter_get_path(adapter); + + if (hci_devinfo(dev_id, &di) < 0) + continue; + + if (hci_test_bit(HCI_RAW, &di.flags)) + continue; + + dbus_message_iter_append_basic(&array_iter, + DBUS_TYPE_OBJECT_PATH, &path); + } + + dbus_message_iter_close_container(&iter, &array_iter); + + return reply; +} + +static GDBusMethodTable manager_methods[] = { + { "DefaultAdapter", "", "o", default_adapter }, + { "FindAdapter", "s", "o", find_adapter }, + { "ListAdapters", "", "ao", list_adapters }, + { } +}; + +static GDBusSignalTable manager_signals[] = { + { "AdapterAdded", "o" }, + { "AdapterRemoved", "o" }, + { "DefaultAdapterChanged", "o" }, + { } +}; + +dbus_bool_t manager_init(DBusConnection *conn, const char *path) +{ + connection = conn; + + return g_dbus_register_interface(conn, "/", MANAGER_INTERFACE, + manager_methods, manager_signals, + NULL, NULL, NULL); +} + +void manager_cleanup(DBusConnection *conn, const char *path) +{ + g_dbus_unregister_interface(conn, "/", MANAGER_INTERFACE); +} + +static gint adapter_id_cmp(gconstpointer a, gconstpointer b) +{ + struct adapter *adapter = (struct adapter *) a; + uint16_t id = GPOINTER_TO_UINT(b); + uint16_t dev_id = adapter_get_dev_id(adapter); + + return dev_id == id ? 0 : -1; +} + +static gint adapter_path_cmp(gconstpointer a, gconstpointer b) +{ + struct adapter *adapter = (struct adapter *) a; + const char *path = b; + const gchar *adapter_path = adapter_get_path(adapter); + + return strcmp(adapter_path, path); +} + +static gint adapter_address_cmp(gconstpointer a, gconstpointer b) +{ + struct adapter *adapter = (struct adapter *) a; + const char *address = b; + const gchar *source = adapter_get_address(adapter); + + return strcmp(source, address); +} + +struct adapter *manager_find_adapter(const bdaddr_t *sba) +{ + GSList *match; + char address[18]; + + ba2str(sba, address); + + match = g_slist_find_custom(adapters, address, adapter_address_cmp); + if (!match) + return NULL; + + return match->data; +} + +struct adapter *manager_find_adapter_by_path(const char *path) +{ + GSList *match; + + match = g_slist_find_custom(adapters, path, adapter_path_cmp); + if (!match) + return NULL; + + return match->data; +} + +struct adapter *manager_find_adapter_by_id(int id) +{ + GSList *match; + + match = g_slist_find_custom(adapters, GINT_TO_POINTER(id), adapter_id_cmp); + if (!match) + return NULL; + + return match->data; +} + +static void manager_add_adapter(struct adapter *adapter) +{ + const gchar *path = adapter_get_path(adapter); + + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, "AdapterAdded", + DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); + + adapters = g_slist_append(adapters, adapter); +} + +static void manager_remove_adapter(struct adapter *adapter) +{ + uint16_t dev_id = adapter_get_dev_id(adapter); + const gchar *path = adapter_get_path(adapter); + + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, "AdapterRemoved", + DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); + + if ((default_adapter_id == dev_id || default_adapter_id < 0)) { + int new_default = hci_get_route(NULL); + + if (new_default >= 0) + manager_set_default_adapter(new_default); + } + + adapters = g_slist_remove(adapters, adapter); +} + +int manager_register_adapter(int id) +{ + struct adapter *adapter = adapter_create(id); + const gchar *path; + + if(!adapter) + return -1; + + path = adapter_get_path(adapter); + + if (!adapter_init(connection, path, adapter)) { + error("Adapter interface init failed on path %s", path); + adapter_free(adapter); + return -1; + } + + __probe_servers(path); + + manager_add_adapter(adapter); + + return 0; +} + +int manager_unregister_adapter(int id) +{ + struct adapter *adapter; + const gchar *path; + + adapter = manager_find_adapter_by_id(id); + if (!adapter) + return -1; + + path = adapter_get_path(adapter); + + info("Unregister path: %s", path); + + __remove_servers(path); + + adapter_stop(adapter); + + manager_remove_adapter(adapter); + + if (!adapter_cleanup(connection, path)) { + error("Failed to unregister adapter interface on %s object", + path); + return -1; + } + + adapter_free(adapter); + + return 0; +} + +int manager_start_adapter(int id) +{ + struct adapter* adapter; + int ret; + + adapter = manager_find_adapter_by_id(id); + if (!adapter) { + error("Getting device data failed: hci%d", id); + return -EINVAL; + } + + ret = adapter_start(adapter); + if (ret < 0) + return ret; + + if (manager_get_default_adapter() < 0) + manager_set_default_adapter(id); + + return 0; +} + +int manager_stop_adapter(int id) +{ + struct adapter *adapter; + + adapter = manager_find_adapter_by_id(id); + if (!adapter) { + error("Getting device data failed: hci%d", id); + return -EINVAL; + } + + return adapter_stop(adapter); +} + +int manager_get_default_adapter() +{ + return default_adapter_id; +} + +void manager_set_default_adapter(int id) +{ + struct adapter *adapter = manager_find_adapter_by_id(id); + const gchar *path = adapter_get_path(adapter); + + default_adapter_id = id; + + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, + "DefaultAdapterChanged", + DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); +} -- cgit