Handle failure of device registration
[connman] / plugins / bluetooth.c
index 7c75529..6b0f05c 100644 (file)
 #include <config.h>
 #endif
 
+#include <errno.h>
+
+#include <gdbus.h>
+
 #include <connman/plugin.h>
-#include <connman/iface.h>
+#include <connman/driver.h>
 #include <connman/log.h>
 
-static int bluetooth_probe(struct connman_iface *iface)
-{
-       DBG("iface %p", iface);
+#define BLUEZ_SERVICE                  "org.bluez"
+#define BLUEZ_MANAGER_INTERFACE                BLUEZ_SERVICE ".Manager"
+#define BLUEZ_ADAPTER_INTERFACE                BLUEZ_SERVICE ".Adapter"
 
-       iface->type = CONNMAN_IFACE_TYPE_BLUETOOTH;
+#define ADAPTER_ADDED                  "AdapterAdded"
+#define ADAPTER_REMOVED                        "AdapterRemoved"
+#define PROPERTY_CHANGED               "PropertyChanged"
 
-       iface->flags = CONNMAN_IFACE_FLAG_RTNL |
-                               CONNMAN_IFACE_FLAG_IPV4;
+#define TIMEOUT 5000
+
+static int bluetooth_probe(struct connman_element *device)
+{
+       DBG("device %p name %s", device, device->name);
 
        return 0;
 }
 
-static void bluetooth_remove(struct connman_iface *iface)
+static void bluetooth_remove(struct connman_element *device)
 {
-       DBG("iface %p", iface);
+       DBG("device %p name %s", device, device->name);
+}
+
+static int bluetooth_enable(struct connman_element *device)
+{
+       DBG("device %p name %s", device, device->name);
+
+       return -EINVAL;
 }
 
-static struct connman_iface_driver bluetooth_driver = {
+static int bluetooth_disable(struct connman_element *device)
+{
+       DBG("device %p name %s", device, device->name);
+
+       return 0;
+}
+
+static struct connman_driver bluetooth_driver = {
        .name           = "bluetooth",
-       .capability     = "bluetooth_hci",
+       .type           = CONNMAN_ELEMENT_TYPE_DEVICE,
+       .subtype        = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH,
        .probe          = bluetooth_probe,
        .remove         = bluetooth_remove,
+       .enable         = bluetooth_enable,
+       .disable        = bluetooth_disable,
 };
 
+static GSList *device_list = NULL;
+
+static struct connman_element *find_adapter(const char *path)
+{
+       const char *devname = g_basename(path);
+       GSList *list;
+
+       DBG("path %s", path);
+
+       for (list = device_list; list; list = list->next) {
+               struct connman_element *device = list->data;
+
+               if (g_str_equal(device->devname, devname) == TRUE)
+                       return device;
+       }
+
+       return NULL;
+}
+
+static void property_changed(DBusConnection *connection, DBusMessage *message)
+{
+       const char *path = dbus_message_get_path(message);
+       struct connman_element *device;
+       DBusMessageIter iter, value;
+       const char *key;
+
+       DBG("path %s", path);
+
+       device = find_adapter(path);
+       if (device == NULL)
+               return;
+
+       if (dbus_message_iter_init(message, &iter) == FALSE)
+               return;
+
+       dbus_message_iter_get_basic(&iter, &key);
+
+       dbus_message_iter_next(&iter);
+       dbus_message_iter_recurse(&iter, &value);
+
+       if (g_str_equal(key, "Powered") == TRUE) {
+               gboolean val;
+
+               dbus_message_iter_get_basic(&value, &val);
+               connman_element_set_enabled(device, val);
+       } else if (g_str_equal(key, "Discovering") == TRUE) {
+               gboolean val;
+
+               dbus_message_iter_get_basic(&value, &val);
+               connman_element_set_scanning(device, val);
+       }
+}
+
+static void properties_reply(DBusPendingCall *call, void *user_data)
+{
+       DBusMessage *message = user_data;
+       const char *path = dbus_message_get_path(message);
+       struct connman_element *device;
+       DBusMessageIter array, dict;
+       DBusMessage *reply;
+
+       DBG("path %s", path);
+
+       device = find_adapter(path);
+
+       dbus_message_unref(message);
+
+       reply = dbus_pending_call_steal_reply(call);
+
+       if (device == NULL)
+               goto done;
+
+       if (dbus_message_iter_init(reply, &array) == FALSE)
+               goto done;
+
+       if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
+               goto done;
+
+       dbus_message_iter_recurse(&array, &dict);
+       while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
+               DBusMessageIter entry, value;
+               const char *key;
+
+               dbus_message_iter_recurse(&dict, &entry);
+               dbus_message_iter_get_basic(&entry, &key);
+
+               dbus_message_iter_next(&entry);
+               dbus_message_iter_recurse(&entry, &value);
+
+               if (g_str_equal(key, "Powered") == TRUE) {
+                       gboolean val;
+
+                       dbus_message_iter_get_basic(&value, &val);
+                       connman_element_set_enabled(device, val);
+               } else if (g_str_equal(key, "Discovering") == TRUE) {
+                       gboolean val;
+
+                       dbus_message_iter_get_basic(&value, &val);
+                       connman_element_set_scanning(device, val);
+               }
+
+               dbus_message_iter_next(&dict);
+       }
+
+done:
+       dbus_message_unref(reply);
+}
+
+static void devices_reply(DBusPendingCall *call, void *user_data)
+{
+       DBusMessage *message = user_data;
+       const char *path = dbus_message_get_path(message);
+       DBusMessage *reply;
+       DBusError error;
+       char **devices;
+       int i, num_devices;
+
+       DBG("path %s", path);
+
+       dbus_message_unref(message);
+
+       reply = dbus_pending_call_steal_reply(call);
+
+       dbus_error_init(&error);
+
+       if (dbus_message_get_args(reply, &error,
+                               DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
+                                               &devices, &num_devices,
+                                               DBUS_TYPE_INVALID) == FALSE) {
+               if (dbus_error_is_set(&error) == TRUE) {
+                       connman_error("%s", error.message);
+                       dbus_error_free(&error);
+               } else
+                       connman_error("Wrong arguments for device list");
+               goto done;
+       }
+
+       for (i = 0; i < num_devices; i++) {
+               DBG("device %s", devices[i]);
+       }
+
+       g_strfreev(devices);
+
+done:
+       dbus_message_unref(reply);
+}
+
+static void add_adapter(DBusConnection *connection, const char *path)
+{
+       struct connman_element *device;
+       DBusMessage *message;
+       DBusPendingCall *call;
+
+       DBG("path %s", path);
+
+       device = find_adapter(path);
+       if (device != NULL)
+               return;
+
+       device = connman_element_create(NULL);
+       device->type = CONNMAN_ELEMENT_TYPE_DEVICE;
+       device->subtype = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH;
+       device->policy = CONNMAN_ELEMENT_POLICY_IGNORE;
+
+       device->name = g_path_get_basename(path);
+
+       if (connman_element_register(device, NULL) < 0) {
+               connman_element_unref(device);
+               return;
+       }
+
+       device_list = g_slist_append(device_list, device);
+
+       message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
+                               BLUEZ_ADAPTER_INTERFACE, "GetProperties");
+       if (message == NULL)
+               return;
+
+       if (dbus_connection_send_with_reply(connection, message,
+                                               &call, TIMEOUT) == FALSE) {
+               connman_error("Failed to get adapter properties");
+               dbus_message_unref(message);
+               return;
+       }
+
+       dbus_pending_call_set_notify(call, properties_reply, message, NULL);
+
+       message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
+                               BLUEZ_ADAPTER_INTERFACE, "ListDevices");
+       if (message == NULL)
+               return;
+
+       if (dbus_connection_send_with_reply(connection, message,
+                                               &call, TIMEOUT) == FALSE) {
+               connman_error("Failed to get Bluetooth devices");
+               dbus_message_unref(message);
+               return;
+       }
+
+       dbus_pending_call_set_notify(call, devices_reply, message, NULL);
+}
+
+static void remove_adapter(DBusConnection *connection, const char *path)
+{
+       struct connman_element *device;
+
+       DBG("path %s", path);
+
+       device = find_adapter(path);
+       if (device == NULL)
+               return;
+
+       device_list = g_slist_remove(device_list, device);
+
+       connman_element_unregister(device);
+       connman_element_unref(device);
+}
+
+static void adapters_reply(DBusPendingCall *call, void *user_data)
+{
+       DBusConnection *connection = user_data;
+       DBusMessage *reply;
+       DBusError error;
+       char **adapters;
+       int i, num_adapters;
+
+       DBG("");
+
+       reply = dbus_pending_call_steal_reply(call);
+
+       dbus_error_init(&error);
+
+       if (dbus_message_get_args(reply, &error,
+                               DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
+                                               &adapters, &num_adapters,
+                                               DBUS_TYPE_INVALID) == FALSE) {
+               if (dbus_error_is_set(&error) == TRUE) {
+                       connman_error("%s", error.message);
+                       dbus_error_free(&error);
+               } else
+                       connman_error("Wrong arguments for adapter list");
+               goto done;
+       }
+
+       for (i = 0; i < num_adapters; i++)
+               add_adapter(connection, adapters[i]);
+
+       g_strfreev(adapters);
+
+done:
+       dbus_message_unref(reply);
+}
+
+static void bluetooth_connect(DBusConnection *connection, void *user_data)
+{
+       DBusMessage *message;
+       DBusPendingCall *call;
+
+       DBG("connection %p", connection);
+
+       message = dbus_message_new_method_call(BLUEZ_SERVICE, "/",
+                               BLUEZ_MANAGER_INTERFACE, "ListAdapters");
+       if (message == NULL)
+               return;
+
+       if (dbus_connection_send_with_reply(connection, message,
+                                               &call, TIMEOUT) == FALSE) {
+               connman_error("Failed to get Bluetooth adapters");
+               dbus_message_unref(message);
+               return;
+       }
+
+       dbus_pending_call_set_notify(call, adapters_reply, connection, NULL);
+
+       dbus_message_unref(message);
+}
+
+static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
+{
+       GSList *list;
+
+       DBG("connection %p", connection);
+
+       for (list = device_list; list; list = list->next) {
+               struct connman_element *device = list->data;
+
+               connman_element_unregister(device);
+               connman_element_unref(device);
+       }
+
+       g_slist_free(device_list);
+       device_list = NULL;
+}
+
+static DBusHandlerResult bluetooth_signal(DBusConnection *connection,
+                                       DBusMessage *message, void *user_data)
+{
+       DBG("connection %p", connection);
+
+       if (dbus_message_is_signal(message, BLUEZ_ADAPTER_INTERFACE,
+                                               PROPERTY_CHANGED) == TRUE) {
+               property_changed(connection, message);
+       } else if (dbus_message_is_signal(message, BLUEZ_MANAGER_INTERFACE,
+                                               ADAPTER_ADDED) == TRUE) {
+               const char *path;
+               dbus_message_get_args(message, NULL,
+                                       DBUS_TYPE_OBJECT_PATH, &path,
+                                                       DBUS_TYPE_INVALID);
+               add_adapter(connection, path);
+       } else if (dbus_message_is_signal(message, BLUEZ_MANAGER_INTERFACE,
+                                               ADAPTER_REMOVED) == TRUE) {
+               const char *path;
+               dbus_message_get_args(message, NULL,
+                                       DBUS_TYPE_OBJECT_PATH, &path,
+                                                       DBUS_TYPE_INVALID);
+               remove_adapter(connection, path);
+       }
+
+       return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+}
+
+static DBusConnection *connection;
+static guint watch;
+
+static const char *added_rule = "type=signal,member=" ADAPTER_ADDED
+                                       ",interface=" BLUEZ_MANAGER_INTERFACE;
+static const char *removed_rule = "type=signal,member=" ADAPTER_REMOVED
+                                       ",interface=" BLUEZ_MANAGER_INTERFACE;
+
+static const char *adapter_rule = "type=signal,member=" PROPERTY_CHANGED
+                                       ",interface=" BLUEZ_ADAPTER_INTERFACE;
+
 static int bluetooth_init(void)
 {
-       return connman_iface_register(&bluetooth_driver);
+       int err = -EIO;
+
+       connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
+       if (connection == NULL)
+               return -EIO;
+
+       if (dbus_connection_add_filter(connection, bluetooth_signal,
+                                                       NULL, NULL) == FALSE)
+               goto unref;
+
+       err = connman_driver_register(&bluetooth_driver);
+       if (err < 0)
+               goto remove;
+
+       watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE,
+                       bluetooth_connect, bluetooth_disconnect, NULL, NULL);
+       if (watch == 0) {
+               connman_driver_unregister(&bluetooth_driver);
+               err = -EIO;
+               goto remove;
+       }
+
+       if (g_dbus_check_service(connection, BLUEZ_SERVICE) == TRUE)
+               bluetooth_connect(connection, NULL);
+
+       dbus_bus_add_match(connection, added_rule, NULL);
+       dbus_bus_add_match(connection, removed_rule, NULL);
+       dbus_bus_add_match(connection, adapter_rule, NULL);
+       dbus_connection_flush(connection);
+
+       return 0;
+
+remove:
+       dbus_connection_remove_filter(connection, bluetooth_signal, NULL);
+
+unref:
+       dbus_connection_unref(connection);
+
+       return err;
 }
 
 static void bluetooth_exit(void)
 {
-       connman_iface_unregister(&bluetooth_driver);
+       dbus_bus_remove_match(connection, adapter_rule, NULL);
+       dbus_bus_remove_match(connection, removed_rule, NULL);
+       dbus_bus_remove_match(connection, added_rule, NULL);
+       dbus_connection_flush(connection);
+
+       g_dbus_remove_watch(connection, watch);
+
+       bluetooth_disconnect(connection, NULL);
+
+       connman_driver_unregister(&bluetooth_driver);
+
+       dbus_connection_remove_filter(connection, bluetooth_signal, NULL);
+
+       dbus_connection_unref(connection);
 }
 
-CONNMAN_PLUGIN_DEFINE("bluetooth", "Bluetooth interface plugin", VERSION,
+CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
                                                bluetooth_init, bluetooth_exit)