#include <config.h>
#endif
+#include <errno.h>
+
#include <gdbus.h>
#include <connman/plugin.h>
#include <connman/driver.h>
#include <connman/log.h>
-#define BLUEZ_SERVICE "org.bluez"
+#define BLUEZ_SERVICE "org.bluez"
+#define BLUEZ_MANAGER_INTERFACE BLUEZ_SERVICE ".Manager"
+#define BLUEZ_ADAPTER_INTERFACE BLUEZ_SERVICE ".Adapter"
-#define MANAGER_INTERFACE "org.bluez.Manager"
-#define MANAGER_PATH "/"
+#define ADAPTER_ADDED "AdapterAdded"
+#define ADAPTER_REMOVED "AdapterRemoved"
+#define PROPERTY_CHANGED "PropertyChanged"
-static GStaticMutex element_mutex = G_STATIC_MUTEX_INIT;
-static GSList *element_list = NULL;
+#define TIMEOUT 5000
-static void create_element(DBusConnection *conn, const char *path)
+static int bluetooth_probe(struct connman_element *device)
{
- struct connman_element *element;
-
- DBG("conn %p path %s", conn, path);
+ DBG("device %p name %s", device, device->name);
- element = connman_element_create();
+ return 0;
+}
- element->name = g_path_get_basename(path);
- element->type = CONNMAN_ELEMENT_TYPE_DEVICE;
- element->subtype = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH;
+static void bluetooth_remove(struct connman_element *device)
+{
+ DBG("device %p name %s", device, device->name);
+}
- g_static_mutex_lock(&element_mutex);
+static int bluetooth_enable(struct connman_element *device)
+{
+ DBG("device %p name %s", device, device->name);
- connman_element_register(element, NULL);
+ return -EINVAL;
+}
- element_list = g_slist_append(element_list, element);
+static int bluetooth_disable(struct connman_element *device)
+{
+ DBG("device %p name %s", device, device->name);
- g_static_mutex_unlock(&element_mutex);
+ return 0;
}
-static gboolean bluetooth_signal(DBusConnection *conn,
- DBusMessage *msg, void *data)
+static struct connman_driver bluetooth_driver = {
+ .name = "bluetooth",
+ .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 *sender, *interface, *member;
+ const char *devname = g_basename(path);
+ GSList *list;
- DBG("conn %p msg %p", conn, msg);
+ DBG("path %s", path);
- sender = dbus_message_get_sender(msg);
- interface = dbus_message_get_interface(msg);
- member = dbus_message_get_member(msg);
+ for (list = device_list; list; list = list->next) {
+ struct connman_element *device = list->data;
- DBG("sender %s name %s.%s", sender, interface, member);
+ if (g_str_equal(device->devname, devname) == TRUE)
+ return device;
+ }
- return TRUE;
+ return NULL;
}
-static void list_adapters(DBusConnection *conn)
+static void property_changed(DBusConnection *connection, DBusMessage *message)
{
- DBusMessage *msg, *reply;
- char **paths = NULL;
- int i, num = 0;
+ const char *path = dbus_message_get_path(message);
+ struct connman_element *device;
+ DBusMessageIter iter, value;
+ const char *key;
+
+ DBG("path %s", path);
- DBG("conn %p");
+ device = find_adapter(path);
+ if (device == NULL)
+ return;
- msg = dbus_message_new_method_call(BLUEZ_SERVICE, MANAGER_PATH,
- MANAGER_INTERFACE, "ListAdapters");
- if (!msg) {
- connman_error("ListAdpaters message alloction failed");
+ if (dbus_message_iter_init(message, &iter) == FALSE)
return;
+
+ dbus_message_iter_get_basic(&iter, &key);
+
+ if (g_str_equal(key, "Powered") == TRUE) {
+ gboolean val;
+
+ dbus_message_iter_next(&iter);
+ dbus_message_iter_recurse(&iter, &value);
+
+ dbus_message_iter_get_basic(&value, &val);
+ connman_element_set_enabled(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);
+
+ if (g_str_equal(key, "Powered") == TRUE) {
+ gboolean val;
+
+ dbus_message_iter_next(&entry);
+ dbus_message_iter_recurse(&entry, &value);
+
+ dbus_message_iter_get_basic(&value, &val);
+ connman_element_set_enabled(device, val);
+ }
+
+ dbus_message_iter_next(&dict);
+ }
+
+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;
- reply = dbus_connection_send_with_reply_and_block(conn, msg, -1, NULL);
+ device->name = g_path_get_basename(path);
- dbus_message_unref(msg);
+ connman_element_register(device, NULL);
+ 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 (!reply) {
- connman_error("ListAdapters method call failed");
+ if (dbus_connection_send_with_reply(connection, message,
+ &call, TIMEOUT) == FALSE) {
+ connman_error("Failed to get adapter properties");
+ dbus_message_unref(message);
return;
}
- dbus_message_get_args(reply, NULL, DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
- &paths, &num, DBUS_TYPE_INVALID);
+ dbus_pending_call_set_notify(call, properties_reply, message, NULL);
+}
- for (i = 0; i < num; i++)
- create_element(conn, paths[i]);
+static void remove_adapter(DBusConnection *connection, const char *path)
+{
+ struct connman_element *device;
- g_strfreev(paths);
+ 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 int bluetooth_probe(struct connman_element *element)
+static void bluetooth_connect(DBusConnection *connection, void *user_data)
{
- DBG("element %p name %s", element, element->name);
+ DBusMessage *message;
+ DBusPendingCall *call;
- return 0;
+ 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_remove(struct connman_element *element)
+static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
{
- DBG("element %p name %s", element, element->name);
+ 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 struct connman_driver bluetooth_driver = {
- .name = "bluetooth",
- .type = CONNMAN_ELEMENT_TYPE_DEVICE,
- .subtype = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH,
- .probe = bluetooth_probe,
- .remove = bluetooth_remove,
-};
+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 signal;
+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)
{
- int err;
+ int err = -EIO;
connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
if (connection == NULL)
return -EIO;
- signal = g_dbus_add_signal_watch(connection, "sender=org.bluez",
- bluetooth_signal, NULL, NULL);
+ if (dbus_connection_add_filter(connection, bluetooth_signal,
+ NULL, NULL) == FALSE)
+ goto unref;
err = connman_driver_register(&bluetooth_driver);
- if (err < 0) {
- dbus_connection_unref(connection);
- return err;
+ 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;
}
- list_adapters(connection);
+ 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)
{
+ 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);
- g_dbus_remove_watch(connection, signal);
+ dbus_connection_remove_filter(connection, bluetooth_signal, NULL);
dbus_connection_unref(connection);
}
-CONNMAN_PLUGIN_DEFINE("bluetooth", "Bluetooth technology plugin", VERSION,
+CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
bluetooth_init, bluetooth_exit)
projects / connman / blobdiff