#include <gdbus.h>
#include <connman/plugin.h>
-#include <connman/device.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"
-static int bluetooth_probe(struct connman_device *device)
+#define ADAPTER_ADDED "AdapterAdded"
+#define ADAPTER_REMOVED "AdapterRemoved"
+#define PROPERTY_CHANGED "PropertyChanged"
+
+#define TIMEOUT 5000
+
+static int bluetooth_probe(struct connman_element *device)
{
- DBG("device %p", device);
+ DBG("device %p name %s", device, device->name);
return 0;
}
-static void bluetooth_remove(struct connman_device *device)
+static void bluetooth_remove(struct connman_element *device)
{
- DBG("device %p", device);
+ DBG("device %p name %s", device, device->name);
}
-static struct connman_device_driver bluetooth_driver = {
- .name = "bluetooth",
- .type = CONNMAN_DEVICE_TYPE_BLUETOOTH,
- .probe = bluetooth_probe,
- .remove = bluetooth_remove,
+static int bluetooth_enable(struct connman_element *device)
+{
+ DBG("device %p name %s", device, device->name);
+
+ return -EINVAL;
+}
+
+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",
+ .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);
+
+ 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 (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)
{
- int err;
+ int err = -EIO;
connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
if (connection == NULL)
return -EIO;
- err = connman_device_driver_register(&bluetooth_driver);
- if (err < 0) {
- dbus_connection_unref(connection);
- 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_device_driver_unregister(&bluetooth_driver);
- dbus_connection_unref(connection);
- return -EIO;
+ 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)
{
+ 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);
- connman_device_driver_unregister(&bluetooth_driver);
+ 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 technology plugin", VERSION,
+CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
bluetooth_init, bluetooth_exit)
projects / connman / blobdiff