X-Git-Url: http://git.maemo.org/git/?a=blobdiff_plain;f=plugins%2Fbluetooth.c;h=200c3ff3a7e168c814afbff43cb171093e8c8afa;hb=8024e614794792da8f346d34ff329ba2d244b37e;hp=978f2577eb90c15969403b8fe4c516a88d89782d;hpb=cf87ef5c131af32de16b51d47ecd55f26d2b991c;p=connman diff --git a/plugins/bluetooth.c b/plugins/bluetooth.c index 978f257..200c3ff 100644 --- a/plugins/bluetooth.c +++ b/plugins/bluetooth.c @@ -2,7 +2,7 @@ * * Connection Manager * - * Copyright (C) 2007-2008 Intel Corporation. All rights reserved. + * Copyright (C) 2007-2009 Intel Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as @@ -24,40 +24,650 @@ #endif #include +#include #include +#define CONNMAN_API_SUBJECT_TO_CHANGE #include #include +#include #include -#define BLUEZ_SERVICE "org.bluez" +#include "inet.h" + +#define BLUEZ_SERVICE "org.bluez" +#define BLUEZ_MANAGER_INTERFACE BLUEZ_SERVICE ".Manager" +#define BLUEZ_ADAPTER_INTERFACE BLUEZ_SERVICE ".Adapter" +#define BLUEZ_DEVICE_INTERFACE BLUEZ_SERVICE ".Device" +#define BLUEZ_NETWORK_INTERFACE BLUEZ_SERVICE ".Network" + +#define LIST_ADAPTERS "ListAdapters" +#define ADAPTER_ADDED "AdapterAdded" +#define ADAPTER_REMOVED "AdapterRemoved" + +#define PROPERTY_CHANGED "PropertyChanged" +#define GET_PROPERTIES "GetProperties" +#define SET_PROPERTY "SetProperty" + +#define CONNECT "Connect" +#define DISCONNECT "Disconnect" #define TIMEOUT 5000 -static int bluetooth_probe(struct connman_device *device) +typedef void (* properties_callback_t) (DBusConnection *connection, + const char *path, + DBusMessage *message, + void *user_data); + +struct properties_data { + DBusConnection *connection; + DBusMessage *message; + properties_callback_t callback; + void *user_data; +}; + +static void get_properties_reply(DBusPendingCall *call, void *user_data) +{ + struct properties_data *data = user_data; + DBusMessage *reply; + const char *path; + + reply = dbus_pending_call_steal_reply(call); + if (reply == NULL) + goto done; + + path = dbus_message_get_path(data->message); + + data->callback(data->connection, path, reply, data->user_data); + + dbus_message_unref(reply); + +done: + dbus_message_unref(data->message); + g_free(data); +} + +static void get_properties(DBusConnection *connection, + const char *path, const char *interface, + properties_callback_t callback, void *user_data) { - DBG("device %p", device); + struct properties_data *data; + DBusMessage *message; + DBusPendingCall *call; + + DBG("path %s interface %s", path, interface); + + data = g_try_new0(struct properties_data, 1); + if (data == NULL) + return; + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + interface, GET_PROPERTIES); + if (message == NULL) { + g_free(data); + return; + } + + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to get properties for %s", interface); + dbus_message_unref(message); + g_free(data); + return; + } + + data->connection = connection; + data->message = message; + data->callback = callback; + data->user_data = user_data; + + dbus_pending_call_set_notify(call, get_properties_reply, data, NULL); +} + +struct adapter_data { + DBusConnection *connection; +}; + +struct network_data { + DBusConnection *connection; + char *interface; +}; + +static int pan_probe(struct connman_network *network) +{ + struct connman_device *device = connman_network_get_device(network); + struct adapter_data *adapter; + struct network_data *data; + + DBG("network %p", network); + + if (device == NULL) + return -EINVAL; + + adapter = connman_device_get_data(device); + if (adapter == NULL) + return -EINVAL; + + data = g_try_new0(struct network_data, 1); + if (data == NULL) + return -ENOMEM; + + data->connection = adapter->connection; + + connman_network_set_data(network, data); return 0; } -static void bluetooth_remove(struct connman_device *device) +static void pan_remove(struct connman_network *network) { - DBG("device %p", device); + struct network_data *data = connman_network_get_data(network); + + DBG("network %p", network); + + connman_network_set_data(network, NULL); + + g_free(data); +} + +static void connect_reply(DBusPendingCall *call, void *user_data) +{ + struct connman_network *network = user_data; + struct network_data *data = connman_network_get_data(network); + DBusMessage *reply; + DBusError error; + const char *interface = NULL; + int index; + + DBG("network %p", network); + + reply = dbus_pending_call_steal_reply(call); + if (reply == NULL) + return; + + dbus_error_init(&error); + + if (dbus_message_get_args(reply, &error, + DBUS_TYPE_STRING, &interface, + 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 connect"); + goto done; + } + + if (interface == NULL) + goto done; + + DBG("interface %s", interface); + + data->interface = g_strdup(interface); + + index = inet_name2index(interface); + + connman_network_set_index(network, index); + connman_network_set_connected(network, TRUE); + +done: + dbus_message_unref(reply); +} + +static int pan_connect(struct connman_network *network) +{ + struct network_data *data = connman_network_get_data(network); + const char *path = connman_network_get_string(network, "Node"); + const char *uuid = "nap"; + DBusMessage *message; + DBusPendingCall *call; + + DBG("network %p", network); + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_NETWORK_INTERFACE, CONNECT); + if (message == NULL) + return -ENOMEM; + + dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid, + DBUS_TYPE_INVALID); + + if (dbus_connection_send_with_reply(data->connection, message, + &call, TIMEOUT * 10) == FALSE) { + connman_error("Failed to connect service"); + dbus_message_unref(message); + return -EINVAL; + } + + dbus_pending_call_set_notify(call, connect_reply, network, NULL); + + dbus_message_unref(message); + + return -EINPROGRESS; +} + +static void disconnect_reply(DBusPendingCall *call, void *user_data) +{ + struct connman_network *network = user_data; + struct network_data *data = connman_network_get_data(network); + DBusMessage *reply; + DBusError error; + + DBG("network %p", network); + + reply = dbus_pending_call_steal_reply(call); + if (reply == NULL) + return; + + dbus_error_init(&error); + + if (dbus_message_get_args(reply, &error, 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 disconnect"); + goto done; + } + + g_free(data->interface); + data->interface = NULL; + + connman_network_set_connected(network, FALSE); + connman_network_set_index(network, -1); + +done: + dbus_message_unref(reply); +} + +static int pan_disconnect(struct connman_network *network) +{ + struct network_data *data = connman_network_get_data(network); + const char *path = connman_network_get_string(network, "Node"); + DBusMessage *message; + DBusPendingCall *call; + + DBG("network %p", network); + + if (data->interface == NULL) + return -EINVAL; + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_NETWORK_INTERFACE, DISCONNECT); + if (message == NULL) + return -ENOMEM; + + dbus_message_append_args(message, DBUS_TYPE_STRING, &data->interface, + DBUS_TYPE_INVALID); + + if (dbus_connection_send_with_reply(data->connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to disconnect service"); + dbus_message_unref(message); + return -EINVAL; + } + + dbus_pending_call_set_notify(call, disconnect_reply, network, NULL); + + dbus_message_unref(message); + + return -EINPROGRESS; +} + +static struct connman_network_driver pan_driver = { + .name = "bluetooth-pan", + .type = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN, + .probe = pan_probe, + .remove = pan_remove, + .connect = pan_connect, + .disconnect = pan_disconnect, +}; + +static int bluetooth_probe(struct connman_device *adapter) +{ + struct adapter_data *data; + + DBG("adapter %p", adapter); + + data = g_try_new0(struct adapter_data, 1); + if (data == NULL) + return -ENOMEM; + + data->connection = connman_dbus_get_connection(); + if (data->connection == NULL) { + g_free(data); + return -EIO; + } + + connman_device_set_data(adapter, data); + + return 0; +} + +static void bluetooth_remove(struct connman_device *adapter) +{ + struct adapter_data *data = connman_device_get_data(adapter); + + DBG("adapter %p", adapter); + + connman_device_set_data(adapter, NULL); + + dbus_connection_unref(data->connection); + + g_free(data); +} + +static void powered_reply(DBusPendingCall *call, void *user_data) +{ + DBusMessage *reply; + + DBG(""); + + reply = dbus_pending_call_steal_reply(call); + + dbus_message_unref(reply); +} + +static int change_powered(DBusConnection *connection, const char *path, + dbus_bool_t powered) +{ + DBusMessage *message; + DBusMessageIter iter; + DBusPendingCall *call; + + DBG(""); + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY); + if (message == NULL) + return -ENOMEM; + + dbus_message_iter_init_append(message, &iter); + connman_dbus_property_append_variant(&iter, "Powered", + DBUS_TYPE_BOOLEAN, &powered); + + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to change Powered property"); + dbus_message_unref(message); + return -EINVAL; + } + + dbus_pending_call_set_notify(call, powered_reply, NULL, NULL); + + dbus_message_unref(message); + + return -EINPROGRESS; +} + +static int bluetooth_enable(struct connman_device *adapter) +{ + struct adapter_data *data = connman_device_get_data(adapter); + const char *path = connman_device_get_string(adapter, "Node"); + + DBG("adapter %p", adapter); + + return change_powered(data->connection, path, TRUE); +} + +static int bluetooth_disable(struct connman_device *adapter) +{ + struct adapter_data *data = connman_device_get_data(adapter); + const char *path = connman_device_get_string(adapter, "Node"); + + DBG("adapter %p", adapter); + + return change_powered(data->connection, path, FALSE); +} + +static int bluetooth_scan(struct connman_device *adapter) +{ + DBG("adapter %p", adapter); + + return -EIO; } static struct connman_device_driver bluetooth_driver = { - .name = "bluetooth", - .type = CONNMAN_DEVICE_TYPE_BLUETOOTH, - .probe = bluetooth_probe, - .remove = bluetooth_remove, + .name = "bluetooth", + .type = CONNMAN_DEVICE_TYPE_BLUETOOTH, + .probe = bluetooth_probe, + .remove = bluetooth_remove, + .enable = bluetooth_enable, + .disable = bluetooth_disable, + .scan = bluetooth_scan, }; -static GSList *device_list = NULL; +static GSList *adapter_list = NULL; + +static void free_adapters(void) +{ + GSList *list; + + DBG(""); + + for (list = adapter_list; list; list = list->next) { + struct connman_device *adapter = list->data; + + connman_device_unregister(adapter); + connman_device_unref(adapter); + } + + g_slist_free(adapter_list); + adapter_list = NULL; +} + +static struct connman_device *find_adapter(const char *path) +{ + GSList *list; + + DBG("path %s", path); + + for (list = adapter_list; list; list = list->next) { + struct connman_device *adapter = list->data; + const char *adapter_path = connman_device_get_string(adapter, + "Node"); + + if (adapter_path == NULL) + continue; + + if (g_str_equal(adapter_path, path) == TRUE) + return adapter; + } + + return NULL; +} + +static void device_properties(DBusConnection *connection, const char *path, + DBusMessage *message, void *user_data) +{ + struct connman_device *device = user_data; + const char *node = g_basename(path); + struct connman_network *network; + + DBG("path %s", path); + + network = connman_device_get_network(device, node); + if (network != NULL) + return; + + network = connman_network_create(node, + CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN); + if (network == NULL) + return; + + connman_network_set_string(network, "Node", path); + + connman_device_add_network(device, network); +} + +static void check_devices(struct connman_device *adapter, + DBusConnection *connection, DBusMessageIter *array) +{ + DBusMessageIter value; + + if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) + return; + + dbus_message_iter_recurse(array, &value); + + while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_OBJECT_PATH) { + const char *path; + + dbus_message_iter_get_basic(&value, &path); + + get_properties(connection, path, BLUEZ_DEVICE_INTERFACE, + device_properties, adapter); + + dbus_message_iter_next(&value); + } +} + +static void property_changed(DBusConnection *connection, DBusMessage *message) +{ + const char *path = dbus_message_get_path(message); + struct connman_device *adapter; + DBusMessageIter iter, value; + const char *key; + + DBG("path %s", path); + + adapter = find_adapter(path); + if (adapter == 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_device_set_powered(adapter, val); + } else if (g_str_equal(key, "Discovering") == TRUE) { + gboolean val; + + dbus_message_iter_get_basic(&value, &val); + connman_device_set_scanning(adapter, val); + } +} + +static void parse_adapter_properties(struct connman_device *adapter, + DBusConnection *connection, + DBusMessage *reply) +{ + DBusMessageIter array, dict; + + if (dbus_message_iter_init(reply, &array) == FALSE) + return; + + if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY) + return; + + 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_device_set_powered(adapter, val); + } else if (g_str_equal(key, "Discovering") == TRUE) { + gboolean val; + + dbus_message_iter_get_basic(&value, &val); + connman_device_set_scanning(adapter, val); + } else if (g_str_equal(key, "Devices") == TRUE) { + check_devices(adapter, connection, &value); + } + + dbus_message_iter_next(&dict); + } +} + +static void adapter_properties(DBusConnection *connection, const char *path, + DBusMessage *message, void *user_data) +{ + const char *node = g_basename(path); + struct connman_device *adapter; + + DBG("path %s", path); + + adapter = find_adapter(path); + if (adapter != NULL) + goto done; + + adapter = connman_device_create(node, CONNMAN_DEVICE_TYPE_BLUETOOTH); + if (adapter == NULL) + return; + + connman_device_set_string(adapter, "Node", path); + + if (node != NULL && g_str_has_prefix(node, "hci") == TRUE) { + int index; + errno = 0; + index = atoi(node + 3); + if (errno == 0) + connman_device_set_index(adapter, index); + } + + connman_device_set_interface(adapter, node); + + connman_device_set_policy(adapter, CONNMAN_DEVICE_POLICY_MANUAL); + connman_device_set_mode(adapter, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE); + + if (connman_device_register(adapter) < 0) { + connman_device_unref(adapter); + return; + } -static void adapters_reply(DBusPendingCall *call, void *user_data) + adapter_list = g_slist_append(adapter_list, adapter); + +done: + parse_adapter_properties(adapter, connection, message); +} + +static void add_adapter(DBusConnection *connection, const char *path) { + DBG("path %s", path); + + get_properties(connection, path, BLUEZ_ADAPTER_INTERFACE, + adapter_properties, NULL); +} + +static void remove_adapter(DBusConnection *connection, const char *path) +{ + struct connman_device *adapter; + + DBG("path %s", path); + + adapter = find_adapter(path); + if (adapter == NULL) + return; + + adapter_list = g_slist_remove(adapter_list, adapter); + + connman_device_unregister(adapter); + connman_device_unref(adapter); +} + +static void list_adapters_reply(DBusPendingCall *call, void *user_data) +{ + DBusConnection *connection = user_data; DBusMessage *reply; DBusError error; char **adapters; @@ -81,18 +691,10 @@ static void adapters_reply(DBusPendingCall *call, void *user_data) goto done; } - for (i = 0; i < num_adapters; i++) { - struct connman_element *device; - - device = connman_element_create(NULL); - device->type = CONNMAN_ELEMENT_TYPE_DEVICE; - device->subtype = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH; - - device->name = g_path_get_basename(adapters[i]); - - connman_element_register(device, NULL); - device_list = g_slist_append(device_list, device); - } + for (i = 0; i < num_adapters; i++) + get_properties(connection, adapters[i], + BLUEZ_ADAPTER_INTERFACE, + adapter_properties, NULL); g_strfreev(adapters); @@ -108,7 +710,7 @@ static void bluetooth_connect(DBusConnection *connection, void *user_data) DBG("connection %p", connection); message = dbus_message_new_method_call(BLUEZ_SERVICE, "/", - "org.bluez.Manager", "ListAdapters"); + BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS); if (message == NULL) return; @@ -119,67 +721,131 @@ static void bluetooth_connect(DBusConnection *connection, void *user_data) return; } - dbus_pending_call_set_notify(call, adapters_reply, NULL, NULL); + dbus_pending_call_set_notify(call, list_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; + free_adapters(); +} + +static DBusHandlerResult bluetooth_signal(DBusConnection *connection, + DBusMessage *message, void *user_data) +{ + if (dbus_message_has_interface(message, + BLUEZ_MANAGER_INTERFACE) == FALSE && + dbus_message_has_interface(message, + BLUEZ_ADAPTER_INTERFACE) == FALSE) + return DBUS_HANDLER_RESULT_NOT_YET_HANDLED; + + DBG("connection %p", connection); - connman_element_unregister(device); - connman_element_unref(device); + 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); } - g_slist_free(device_list); - device_list = NULL; + 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); + connection = connman_dbus_get_connection(); if (connection == NULL) return -EIO; + if (dbus_connection_add_filter(connection, bluetooth_signal, + NULL, NULL) == FALSE) + goto unref; + + err = connman_network_driver_register(&pan_driver); + if (err < 0) + goto remove; + err = connman_device_driver_register(&bluetooth_driver); if (err < 0) { - dbus_connection_unref(connection); - return -EIO; + connman_network_driver_unregister(&pan_driver); + 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_network_driver_unregister(&pan_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); + free_adapters(); + connman_device_driver_unregister(&bluetooth_driver); + connman_network_driver_unregister(&pan_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)