diff options
Diffstat (limited to 'hcid/manager.c')
-rw-r--r-- | hcid/manager.c | 217 |
1 files changed, 171 insertions, 46 deletions
diff --git a/hcid/manager.c b/hcid/manager.c index 24ce93a9..c2d5fdf1 100644 --- a/hcid/manager.c +++ b/hcid/manager.c @@ -59,7 +59,9 @@ #include "manager.h" +static DBusConnection *connection = NULL; static int default_adapter_id = -1; +static GSList *adapters = NULL; static inline DBusMessage *invalid_args(DBusMessage *msg) { @@ -388,19 +390,21 @@ static DBusMessage *default_adapter(DBusConnection *conn, DBusMessage *msg, void *data) { DBusMessage *reply; - char path[MAX_PATH_LENGTH], *path_ptr = path; + struct adapter *adapter; + char *path; - if (default_adapter_id < 0) + 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; - snprintf(path, sizeof(path), "/hci%d", default_adapter_id); + path = adapter->path + ADAPTER_PATH_INDEX; - dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path_ptr, - DBUS_TYPE_INVALID); + dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); return reply; } @@ -409,7 +413,8 @@ static DBusMessage *find_adapter(DBusConnection *conn, DBusMessage *msg, void *data) { DBusMessage *reply; - char path[MAX_PATH_LENGTH], *path_ptr = path; + struct adapter *adapter; + char *path; struct hci_dev_info di; const char *pattern; int dev_id; @@ -434,14 +439,18 @@ static DBusMessage *find_adapter(DBusConnection *conn, 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; - snprintf(path, sizeof(path), "/hci%d", dev_id); + path = adapter->path + ADAPTER_PATH_INDEX; - dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path_ptr, - DBUS_TYPE_INVALID); + dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); return reply; } @@ -452,62 +461,36 @@ static DBusMessage *list_adapters(DBusConnection *conn, DBusMessageIter iter; DBusMessageIter array_iter; DBusMessage *reply; - struct hci_dev_list_req *dl; - struct hci_dev_req *dr; - int i, sk; - - sk = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); - if (sk < 0) - return create_errno_message(msg, errno); - - 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) { - int err = errno; - close(sk); - g_free(dl); - return create_errno_message(msg, err); - } - - dr = dl->dev_req; + GSList *l; reply = dbus_message_new_method_return(msg); - if (!reply) { - close(sk); - g_free(dl); + 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 (i = 0; i < dl->dev_num; i++, dr++) { - char path[MAX_PATH_LENGTH], *path_ptr = path; + for (l = adapters; l; l = l->next) { + struct adapter *adapter = l->data; + char *path; struct hci_dev_info di; - if (hci_devinfo(dr->dev_id, &di) < 0) + if (hci_devinfo(adapter->dev_id, &di) < 0) continue; if (hci_test_bit(HCI_RAW, &di.flags)) continue; - snprintf(path, sizeof(path), "/hci%d", di.dev_id); + path = adapter->path + ADAPTER_PATH_INDEX; dbus_message_iter_append_basic(&array_iter, - DBUS_TYPE_OBJECT_PATH, &path_ptr); + DBUS_TYPE_OBJECT_PATH, &path); } dbus_message_iter_close_container(&iter, &array_iter); - g_free(dl); - - close(sk); - return reply; } @@ -527,6 +510,8 @@ static GDBusSignalTable manager_signals[] = { dbus_bool_t manager_init(DBusConnection *conn, const char *path) { + connection = conn; + if (hcid_dbus_use_experimental()) { debug("Registering experimental manager interface"); g_dbus_register_interface(conn, "/", MANAGER_INTERFACE, @@ -547,12 +532,152 @@ void manager_cleanup(DBusConnection *conn, const char *path) g_dbus_unregister_interface(conn, "/", MANAGER_INTERFACE); } -int get_default_adapter(void) +static gint adapter_id_cmp(gconstpointer a, gconstpointer b) +{ + const struct adapter *adapter = a; + uint16_t id = GPOINTER_TO_UINT(b); + + return adapter->dev_id == id ? 0 : -1; +} + +static gint adapter_path_cmp(gconstpointer a, gconstpointer b) +{ + const struct adapter *adapter = a; + const char *path = b; + + return strcmp(adapter->path, path); +} + +static gint adapter_address_cmp(gconstpointer a, gconstpointer b) +{ + const struct adapter *adapter = a; + const char *address = b; + + return strcmp(adapter->address, 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; +} + +void manager_add_adapter(struct adapter *adapter) +{ + const char *ptr = adapter->path + ADAPTER_PATH_INDEX; + + if (hcid_dbus_use_experimental()) { + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, "AdapterAdded", + DBUS_TYPE_OBJECT_PATH, &ptr, + DBUS_TYPE_INVALID); + } + + g_dbus_emit_signal(connection, BASE_PATH, + MANAGER_INTERFACE, "AdapterAdded", + DBUS_TYPE_STRING, &adapter->path, + DBUS_TYPE_INVALID); + + adapters = g_slist_append(adapters, adapter); +} + +void manager_remove_adapter(struct adapter *adapter) +{ + const char *ptr = adapter->path + ADAPTER_PATH_INDEX; + + if (hcid_dbus_use_experimental()) { + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, "AdapterRemoved", + DBUS_TYPE_OBJECT_PATH, &ptr, + DBUS_TYPE_INVALID); + } + + g_dbus_emit_signal(connection, BASE_PATH, + MANAGER_INTERFACE, "AdapterRemoved", + DBUS_TYPE_STRING, &adapter->path, + DBUS_TYPE_INVALID); + + if ((default_adapter_id == adapter->dev_id || default_adapter_id < 0)) { + int new_default = hci_get_route(NULL); + + default_adapter_id = new_default; + if (new_default >= 0) { + if (hcid_dbus_use_experimental()) { + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, + "DefaultAdapterChanged", + DBUS_TYPE_OBJECT_PATH, &ptr, + DBUS_TYPE_INVALID); + } + g_dbus_emit_signal(connection, BASE_PATH, + MANAGER_INTERFACE, + "DefaultAdapterChanged", + DBUS_TYPE_STRING, &adapter->path, + DBUS_TYPE_INVALID); + } else { + g_dbus_emit_signal(connection, BASE_PATH, + MANAGER_INTERFACE, + "DefaultAdapterChanged", + DBUS_TYPE_STRING, &adapter->path, + DBUS_TYPE_INVALID); + } + } + + adapters = g_slist_remove(adapters, adapter); +} + +int manager_get_default_adapter() { return default_adapter_id; } -void set_default_adapter(int new_default) +void manager_set_default_adapter(int id) { - default_adapter_id = new_default; + struct adapter *adapter = manager_find_adapter_by_id(id); + const char *ptr = adapter->path + ADAPTER_PATH_INDEX; + + default_adapter_id = id; + + if (hcid_dbus_use_experimental()) + g_dbus_emit_signal(connection, "/", + MANAGER_INTERFACE, + "DefaultAdapterChanged", + DBUS_TYPE_OBJECT_PATH, &ptr, + DBUS_TYPE_INVALID); + + g_dbus_emit_signal(connection, BASE_PATH, + MANAGER_INTERFACE, + "DefaultAdapterChanged", + DBUS_TYPE_STRING, &adapter->path, + DBUS_TYPE_INVALID); } |