From cd0d951025cec18bdec82d7c0847668cc6a151d2 Mon Sep 17 00:00:00 2001 From: Patrik Flykt Date: Mon, 28 Jan 2013 17:44:34 +0200 Subject: bluetooth: Rename bluetooth plugin to bluetooth_legacy Set the plugin priority to CONNMAN_PLUGIN_PRIORITY_LOW and the technology priority to -10. Update strings to "bluetooth_legacy" and use ordinary string instead of ident. --- Makefile.plugins | 4 +- plugins/bluetooth.c | 1350 ------------------------------------------- plugins/bluetooth_legacy.c | 1353 ++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 1355 insertions(+), 1352 deletions(-) delete mode 100644 plugins/bluetooth.c create mode 100644 plugins/bluetooth_legacy.c diff --git a/Makefile.plugins b/Makefile.plugins index 4294a849..9271cac3 100644 --- a/Makefile.plugins +++ b/Makefile.plugins @@ -25,8 +25,8 @@ builtin_sources += plugins/wifi.c $(gsupplicant_sources) endif if BLUETOOTH -builtin_modules += bluetooth -builtin_sources += plugins/bluetooth.c +builtin_modules += bluetooth_legacy +builtin_sources += plugins/bluetooth_legacy.c endif if HH2SERIAL_GPS diff --git a/plugins/bluetooth.c b/plugins/bluetooth.c deleted file mode 100644 index 47343bb5..00000000 --- a/plugins/bluetooth.c +++ /dev/null @@ -1,1350 +0,0 @@ -/* - * - * Connection Manager - * - * Copyright (C) 2007-2012 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 - * published by the Free Software Foundation. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA - * - */ - -#ifdef HAVE_CONFIG_H -#include -#endif - -#include -#include -#include -#include -#include - -#include - -#define CONNMAN_API_SUBJECT_TO_CHANGE -#include -#include -#include -#include -#include -#include - -#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 BLUEZ_NETWORK_SERVER BLUEZ_SERVICE ".NetworkServer" - -#define LIST_ADAPTERS "ListAdapters" -#define ADAPTER_ADDED "AdapterAdded" -#define ADAPTER_REMOVED "AdapterRemoved" -#define DEVICE_REMOVED "DeviceRemoved" - -#define PROPERTY_CHANGED "PropertyChanged" -#define GET_PROPERTIES "GetProperties" -#define SET_PROPERTY "SetProperty" - -#define CONNECT "Connect" -#define DISCONNECT "Disconnect" - -#define REGISTER "Register" -#define UNREGISTER "Unregister" - -#define UUID_NAP "00001116-0000-1000-8000-00805f9b34fb" - -#define TIMEOUT 5000 - -static DBusConnection *connection; - -static GHashTable *bluetooth_devices = NULL; -static GHashTable *bluetooth_networks = NULL; -static GHashTable *pending_networks = NULL; - -static int pan_probe(struct connman_network *network) -{ - DBG("network %p", network); - - return 0; -} - -static void pan_remove(struct connman_network *network) -{ - DBG("network %p", network); -} - -static void connect_reply(DBusPendingCall *call, void *user_data) -{ - struct connman_network *network = user_data; - DBusMessage *reply; - DBusError error; - const char *interface = NULL; - int index; - - DBG("network %p", network); - - reply = dbus_pending_call_steal_reply(call); - - dbus_error_init(&error); - - if (dbus_set_error_from_message(&error, reply) == TRUE) { - connman_error("%s", error.message); - dbus_error_free(&error); - - goto err; - } - - 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 err; - } - - if (interface == NULL) - goto err; - - DBG("interface %s", interface); - - index = connman_inet_ifindex(interface); - - connman_network_set_index(network, index); - - connman_network_set_connected(network, TRUE); - - dbus_message_unref(reply); - - dbus_pending_call_unref(call); - - return; -err: - - connman_network_set_connected(network, FALSE); - - dbus_message_unref(reply); - - dbus_pending_call_unref(call); -} - -static int pan_connect(struct connman_network *network) -{ - const char *path = connman_network_get_string(network, "Path"); - const char *uuid = "nap"; - DBusMessage *message; - DBusPendingCall *call; - - DBG("network %p", network); - - if (path == NULL) - return -EINVAL; - - message = dbus_message_new_method_call(BLUEZ_SERVICE, path, - BLUEZ_NETWORK_INTERFACE, CONNECT); - if (message == NULL) - return -ENOMEM; - - dbus_message_set_auto_start(message, FALSE); - - dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid, - DBUS_TYPE_INVALID); - - if (dbus_connection_send_with_reply(connection, message, - &call, TIMEOUT * 10) == FALSE) { - connman_error("Failed to connect service"); - dbus_message_unref(message); - return -EINVAL; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - 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; - DBusMessage *reply; - DBusError error; - - DBG("network %p", network); - - reply = dbus_pending_call_steal_reply(call); - - dbus_error_init(&error); - - if (dbus_set_error_from_message(&error, reply) == TRUE) { - connman_error("%s", error.message); - dbus_error_free(&error); - goto done; - } - - 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; - } - - connman_network_set_connected(network, FALSE); - -done: - dbus_message_unref(reply); - - dbus_pending_call_unref(call); - - connman_network_unref(network); -} - -static int pan_disconnect(struct connman_network *network) -{ - const char *path = connman_network_get_string(network, "Path"); - DBusMessage *message; - DBusPendingCall *call; - - DBG("network %p", network); - - if (path == NULL) - return -EINVAL; - - message = dbus_message_new_method_call(BLUEZ_SERVICE, path, - BLUEZ_NETWORK_INTERFACE, DISCONNECT); - if (message == NULL) - return -ENOMEM; - - dbus_message_set_auto_start(message, FALSE); - - dbus_message_append_args(message, DBUS_TYPE_INVALID); - - if (dbus_connection_send_with_reply(connection, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to disconnect service"); - dbus_message_unref(message); - return -EINVAL; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - dbus_message_unref(message); - return -EINVAL; - } - - connman_network_ref(network); - - connman_network_set_associating(network, FALSE); - - dbus_pending_call_set_notify(call, disconnect_reply, network, NULL); - - dbus_message_unref(message); - - return 0; -} - -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 gboolean network_changed(DBusConnection *conn, - DBusMessage *message, void *user_data) -{ - const char *path = dbus_message_get_path(message); - struct connman_network *network; - DBusMessageIter iter, value; - const char *key; - - DBG("path %s", path); - - network = g_hash_table_lookup(bluetooth_networks, path); - if (network == NULL) - return TRUE; - - if (dbus_message_iter_init(message, &iter) == FALSE) - return TRUE; - - dbus_message_iter_get_basic(&iter, &key); - - dbus_message_iter_next(&iter); - dbus_message_iter_recurse(&iter, &value); - - if (g_str_equal(key, "Connected") == TRUE) { - dbus_bool_t connected; - - dbus_message_iter_get_basic(&value, &connected); - - if (connected == TRUE) - return TRUE; - - connman_network_set_associating(network, FALSE); - connman_network_set_connected(network, FALSE); - } - - return TRUE; -} - -static void extract_properties(DBusMessage *reply, const char **parent, - const char **address, - const char **name, - const char **alias, - dbus_bool_t *powered, - dbus_bool_t *scanning, - DBusMessageIter *uuids, - DBusMessageIter *networks) -{ - 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, "Adapter") == TRUE) { - if (parent != NULL) - dbus_message_iter_get_basic(&value, parent); - } else if (g_str_equal(key, "Address") == TRUE) { - if (address != NULL) - dbus_message_iter_get_basic(&value, address); - } else if (g_str_equal(key, "Name") == TRUE) { - if (name != NULL) - dbus_message_iter_get_basic(&value, name); - } else if (g_str_equal(key, "Alias") == TRUE) { - if (alias != NULL) - dbus_message_iter_get_basic(&value, alias); - } else if (g_str_equal(key, "Powered") == TRUE) { - if (powered != NULL) - dbus_message_iter_get_basic(&value, powered); - } else if (g_str_equal(key, "Discovering") == TRUE) { - if (scanning != NULL) - dbus_message_iter_get_basic(&value, scanning); - } else if (g_str_equal(key, "Devices") == TRUE) { - if (networks != NULL) - memcpy(networks, &value, sizeof(value)); - } else if (g_str_equal(key, "UUIDs") == TRUE) { - if (uuids != NULL) - memcpy(uuids, &value, sizeof(value)); - } - - dbus_message_iter_next(&dict); - } -} - -static dbus_bool_t has_pan(DBusMessageIter *array) -{ - DBusMessageIter value; - - if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) - return FALSE; - - dbus_message_iter_recurse(array, &value); - - while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) { - const char *uuid; - - dbus_message_iter_get_basic(&value, &uuid); - - if (g_strcmp0(uuid, UUID_NAP) == 0) - return TRUE; - - dbus_message_iter_next(&value); - } - - return FALSE; -} - -static void network_properties_reply(DBusPendingCall *call, void *user_data) -{ - char *path = user_data; - struct connman_device *device; - struct connman_network *network; - DBusMessage *reply; - DBusMessageIter uuids; - const char *parent = NULL, *address = NULL, *name = NULL; - struct ether_addr addr; - char ident[13]; - - reply = dbus_pending_call_steal_reply(call); - - extract_properties(reply, &parent, &address, NULL, &name, - NULL, NULL, &uuids, NULL); - - if (parent == NULL) - goto done; - - device = g_hash_table_lookup(bluetooth_devices, parent); - if (device == NULL) - goto done; - - if (address == NULL) - goto done; - - ether_aton_r(address, &addr); - - snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x", - addr.ether_addr_octet[0], - addr.ether_addr_octet[1], - addr.ether_addr_octet[2], - addr.ether_addr_octet[3], - addr.ether_addr_octet[4], - addr.ether_addr_octet[5]); - - if (has_pan(&uuids) == FALSE) - goto done; - - network = connman_device_get_network(device, ident); - if (network != NULL) - goto done; - - network = connman_network_create(ident, - CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN); - if (network == NULL) - goto done; - - connman_network_set_string(network, "Path", path); - - connman_network_set_name(network, name); - - connman_device_add_network(device, network); - - connman_network_set_group(network, ident); - - g_hash_table_replace(bluetooth_networks, g_strdup(path), network); - -done: - dbus_message_unref(reply); - - dbus_pending_call_unref(call); -} - -static void add_network(const char *path) -{ - DBusMessage *message; - DBusPendingCall *call; - - DBG("path %s", path); - - message = dbus_message_new_method_call(BLUEZ_SERVICE, path, - BLUEZ_DEVICE_INTERFACE, GET_PROPERTIES); - if (message == NULL) - return; - - dbus_message_set_auto_start(message, FALSE); - - if (dbus_connection_send_with_reply(connection, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to get network properties for %s", path); - goto done; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - goto done; - } - - dbus_pending_call_set_notify(call, network_properties_reply, - g_strdup(path), g_free); - -done: - dbus_message_unref(message); -} - -static void check_networks(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); - - add_network(path); - - dbus_message_iter_next(&value); - } -} - -static void check_pending_networks(const char *adapter) -{ - GSList *networks, *list; - - networks = g_hash_table_lookup(pending_networks, adapter); - if (networks == NULL) - return; - - for (list = networks; list != NULL; list = list->next) { - char *path = list->data; - - add_network(path); - } - - g_hash_table_remove(pending_networks, adapter); -} - -static gboolean adapter_changed(DBusConnection *conn, - DBusMessage *message, void *user_data) -{ - const char *path = dbus_message_get_path(message); - struct connman_device *device; - DBusMessageIter iter, value; - const char *key; - - DBG("path %s", path); - - device = g_hash_table_lookup(bluetooth_devices, path); - if (device == NULL) - return TRUE; - - if (dbus_message_iter_init(message, &iter) == FALSE) - return TRUE; - - 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) { - dbus_bool_t val; - - dbus_message_iter_get_basic(&value, &val); - connman_device_set_powered(device, val); - if (val == TRUE) - check_pending_networks(path); - } else if (g_str_equal(key, "Discovering") == TRUE) { - dbus_bool_t val; - - dbus_message_iter_get_basic(&value, &val); - connman_device_set_scanning(device, val); - } else if (g_str_equal(key, "Devices") == TRUE) { - check_networks(&value); - } - - return TRUE; -} - -static gboolean device_removed(DBusConnection *conn, - DBusMessage *message, void *user_data) -{ - const char *network_path; - struct connman_network *network; - struct connman_device *device; - DBusMessageIter iter; - - DBG(""); - - if (dbus_message_iter_init(message, &iter) == FALSE) - return TRUE; - - dbus_message_iter_get_basic(&iter, &network_path); - - network = g_hash_table_lookup(bluetooth_networks, network_path); - if (network == NULL) - return TRUE; - - device = connman_network_get_device(network); - if (device == NULL) - return TRUE; - - g_hash_table_remove(bluetooth_networks, network_path); - - return TRUE; -} - -static gboolean device_changed(DBusConnection *conn, - DBusMessage *message, void *user_data) -{ - const char *path = dbus_message_get_path(message); - DBusMessageIter iter, value; - const char *key; - - DBG("path %s", path); - - if (dbus_message_iter_init(message, &iter) == FALSE) - return TRUE; - - dbus_message_iter_get_basic(&iter, &key); - - dbus_message_iter_next(&iter); - dbus_message_iter_recurse(&iter, &value); - - DBG("key %s", key); - - if (g_str_equal(key, "UUIDs") == TRUE) - add_network(path); - - return TRUE; -} - -static void remove_device_networks(struct connman_device *device) -{ - GHashTableIter iter; - gpointer key, value; - GSList *key_list = NULL; - GSList *list; - - if (bluetooth_networks == NULL) - return; - - g_hash_table_iter_init(&iter, bluetooth_networks); - - while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) { - struct connman_network *network = value; - - if (connman_network_get_device(network) != device) - continue; - - key_list = g_slist_prepend(key_list, key); - } - - for (list = key_list; list != NULL; list = list->next) { - const char *network_path = list->data; - - g_hash_table_remove(bluetooth_networks, network_path); - } - - g_slist_free(key_list); -} - -static void add_pending_networks(const char *adapter, DBusMessageIter *array) -{ - DBusMessageIter value; - GSList *list = NULL; - - 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); - - list = g_slist_prepend(list, g_strdup(path)); - - dbus_message_iter_next(&value); - } - - if (list == NULL) - return; - - g_hash_table_replace(pending_networks, g_strdup(adapter), list); -} - -static void adapter_properties_reply(DBusPendingCall *call, void *user_data) -{ - char *path = user_data; - struct connman_device *device; - DBusMessage *reply; - DBusMessageIter networks; - const char *address = NULL, *name = NULL; - dbus_bool_t powered = FALSE, scanning = FALSE; - struct ether_addr addr; - char ident[13]; - - DBG("path %s", path); - - reply = dbus_pending_call_steal_reply(call); - - if (path == NULL) - goto done; - - extract_properties(reply, NULL, &address, &name, NULL, - &powered, &scanning, NULL, &networks); - - if (address == NULL) - goto done; - - if (g_strcmp0(address, "00:00:00:00:00:00") == 0) - goto done; - - device = g_hash_table_lookup(bluetooth_devices, path); - if (device != NULL) - goto update; - - ether_aton_r(address, &addr); - - snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x", - addr.ether_addr_octet[0], - addr.ether_addr_octet[1], - addr.ether_addr_octet[2], - addr.ether_addr_octet[3], - addr.ether_addr_octet[4], - addr.ether_addr_octet[5]); - - device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_BLUETOOTH); - if (device == NULL) - goto done; - - g_hash_table_insert(bluetooth_devices, g_strdup(path), device); - - connman_device_set_ident(device, ident); - - connman_device_set_string(device, "Path", path); - - if (connman_device_register(device) < 0) { - connman_device_unref(device); - g_hash_table_remove(bluetooth_devices, path); - goto done; - } - -update: - connman_device_set_string(device, "Address", address); - connman_device_set_string(device, "Name", name); - connman_device_set_string(device, "Path", path); - - connman_device_set_powered(device, powered); - connman_device_set_scanning(device, scanning); - - if (powered == FALSE) { - remove_device_networks(device); - add_pending_networks(path, &networks); - } else - check_networks(&networks); - -done: - dbus_message_unref(reply); - - dbus_pending_call_unref(call); -} - -static void add_adapter(DBusConnection *conn, const char *path) -{ - DBusMessage *message; - DBusPendingCall *call; - - DBG("path %s", path); - - message = dbus_message_new_method_call(BLUEZ_SERVICE, path, - BLUEZ_ADAPTER_INTERFACE, GET_PROPERTIES); - if (message == NULL) - return; - - dbus_message_set_auto_start(message, FALSE); - - if (dbus_connection_send_with_reply(conn, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to get adapter properties for %s", path); - goto done; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - goto done; - } - - dbus_pending_call_set_notify(call, adapter_properties_reply, - g_strdup(path), g_free); - -done: - dbus_message_unref(message); -} - -static gboolean adapter_added(DBusConnection *conn, DBusMessage *message, - void *user_data) -{ - const char *path; - - dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path, - DBUS_TYPE_INVALID); - add_adapter(conn, path); - return TRUE; -} - -static void remove_adapter(DBusConnection *conn, const char *path) -{ - DBG("path %s", path); - - g_hash_table_remove(bluetooth_devices, path); - g_hash_table_remove(pending_networks, path); -} - -static gboolean adapter_removed(DBusConnection *conn, DBusMessage *message, - void *user_data) -{ - const char *path; - - dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path, - DBUS_TYPE_INVALID); - remove_adapter(conn, path); - return TRUE; -} - -static void list_adapters_reply(DBusPendingCall *call, void *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_set_error_from_message(&error, reply) == TRUE) { - connman_error("%s", error.message); - dbus_error_free(&error); - goto done; - } - - 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); - - dbus_pending_call_unref(call); -} - -static void unregister_device(gpointer data) -{ - struct connman_device *device = data; - - DBG(""); - - remove_device_networks(device); - - connman_device_unregister(device); - connman_device_unref(device); -} - -static void remove_network(gpointer data) -{ - struct connman_network *network = data; - struct connman_device *device; - - DBG("network %p", network); - - device = connman_network_get_device(network); - if (device != NULL) - connman_device_remove_network(device, network); - - connman_network_unref(network); -} - -static void remove_pending_networks(gpointer data) -{ - GSList *list = data; - - g_slist_free_full(list, g_free); -} - -static void bluetooth_connect(DBusConnection *conn, void *user_data) -{ - DBusMessage *message; - DBusPendingCall *call; - - DBG("connection %p", conn); - - bluetooth_devices = g_hash_table_new_full(g_str_hash, g_str_equal, - g_free, unregister_device); - - bluetooth_networks = g_hash_table_new_full(g_str_hash, g_str_equal, - g_free, remove_network); - - pending_networks = g_hash_table_new_full(g_str_hash, g_str_equal, - g_free, remove_pending_networks); - - message = dbus_message_new_method_call(BLUEZ_SERVICE, "/", - BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS); - if (message == NULL) - return; - - dbus_message_set_auto_start(message, FALSE); - - if (dbus_connection_send_with_reply(conn, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to get Bluetooth adapters"); - goto done; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - goto done; - } - - dbus_pending_call_set_notify(call, list_adapters_reply, NULL, NULL); - -done: - dbus_message_unref(message); -} - -static void bluetooth_disconnect(DBusConnection *conn, void *user_data) -{ - DBG("connection %p", conn); - - if (bluetooth_devices == NULL) - return; - - g_hash_table_destroy(bluetooth_networks); - bluetooth_networks = NULL; - g_hash_table_destroy(bluetooth_devices); - bluetooth_devices = NULL; - g_hash_table_destroy(pending_networks); - pending_networks = NULL; -} - -static int bluetooth_probe(struct connman_device *device) -{ - GHashTableIter iter; - gpointer key, value; - - DBG("device %p", device); - - if (bluetooth_devices == NULL) - return -ENOTSUP; - - g_hash_table_iter_init(&iter, bluetooth_devices); - - while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) { - struct connman_device *device_pan = value; - - if (device == device_pan) - return 0; - } - - return -ENOTSUP; -} - -static void bluetooth_remove(struct connman_device *device) -{ - DBG("device %p", device); -} - -static void powered_reply(DBusPendingCall *call, void *user_data) -{ - DBusError error; - DBusMessage *reply; - - DBG(""); - - reply = dbus_pending_call_steal_reply(call); - - dbus_error_init(&error); - - if (dbus_set_error_from_message(&error, reply) == TRUE) { - connman_error("%s", error.message); - dbus_error_free(&error); - dbus_message_unref(reply); - dbus_pending_call_unref(call); - return; - } - - dbus_message_unref(reply); - dbus_pending_call_unref(call); - - add_adapter(connection, user_data); -} - -static int change_powered(DBusConnection *conn, const char *path, - dbus_bool_t powered) -{ - DBusMessage *message; - DBusMessageIter iter; - DBusPendingCall *call; - - DBG(""); - - if (path == NULL) - return -EINVAL; - - message = dbus_message_new_method_call(BLUEZ_SERVICE, path, - BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY); - if (message == NULL) - return -ENOMEM; - - dbus_message_set_auto_start(message, FALSE); - - dbus_message_iter_init_append(message, &iter); - connman_dbus_property_append_basic(&iter, "Powered", - DBUS_TYPE_BOOLEAN, &powered); - - if (dbus_connection_send_with_reply(conn, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to change Powered property"); - dbus_message_unref(message); - return -EINVAL; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - dbus_message_unref(message); - return -EINVAL; - } - - dbus_pending_call_set_notify(call, powered_reply, - g_strdup(path), g_free); - - dbus_message_unref(message); - - return -EINPROGRESS; -} - -static int bluetooth_enable(struct connman_device *device) -{ - const char *path = connman_device_get_string(device, "Path"); - - DBG("device %p", device); - - return change_powered(connection, path, TRUE); -} - -static int bluetooth_disable(struct connman_device *device) -{ - const char *path = connman_device_get_string(device, "Path"); - - DBG("device %p", device); - - return change_powered(connection, path, FALSE); -} - -static struct connman_device_driver bluetooth_driver = { - .name = "bluetooth", - .type = CONNMAN_DEVICE_TYPE_BLUETOOTH, - .probe = bluetooth_probe, - .remove = bluetooth_remove, - .enable = bluetooth_enable, - .disable = bluetooth_disable, -}; - -static int tech_probe(struct connman_technology *technology) -{ - return 0; -} - -static void tech_remove(struct connman_technology *technology) -{ -} - -static void server_register_reply(DBusPendingCall *call, void *user_data) -{ - struct connman_technology *technology = user_data; - DBusError error; - DBusMessage *reply; - - DBG(""); - - reply = dbus_pending_call_steal_reply(call); - - dbus_error_init(&error); - - if (dbus_set_error_from_message(&error, reply) == TRUE) { - connman_error("%s", error.message); - dbus_error_free(&error); - dbus_message_unref(reply); - dbus_pending_call_unref(call); - return; - } - - dbus_message_unref(reply); - dbus_pending_call_unref(call); - - connman_technology_tethering_notify(technology, TRUE); -} - -static void server_unregister_reply(DBusPendingCall *call, void *user_data) -{ - struct connman_technology *technology = user_data; - DBusError error; - DBusMessage *reply; - - DBG(""); - - reply = dbus_pending_call_steal_reply(call); - - dbus_error_init(&error); - - if (dbus_set_error_from_message(&error, reply) == TRUE) { - connman_error("%s", error.message); - dbus_error_free(&error); - dbus_message_unref(reply); - dbus_pending_call_unref(call); - return; - } - - dbus_message_unref(reply); - dbus_pending_call_unref(call); - - connman_technology_tethering_notify(technology, FALSE); -} - - -static void server_register(const char *path, const char *uuid, - struct connman_technology *technology, - const char *bridge, connman_bool_t enabled) -{ - DBusMessage *message; - DBusPendingCall *call; - char *command; - - DBG("path %s enabled %d", path, enabled); - - command = enabled ? REGISTER : UNREGISTER; - - message = dbus_message_new_method_call(BLUEZ_SERVICE, path, - BLUEZ_NETWORK_SERVER, command); - if (message == NULL) - return; - - dbus_message_set_auto_start(message, FALSE); - - dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid, - DBUS_TYPE_INVALID); - - if (enabled == TRUE) - dbus_message_append_args(message, DBUS_TYPE_STRING, &bridge, - DBUS_TYPE_INVALID); - - if (dbus_connection_send_with_reply(connection, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to enable PAN server"); - dbus_message_unref(message); - return; - } - - if (call == NULL) { - connman_error("D-Bus connection not available"); - dbus_message_unref(message); - return; - } - - if (enabled == TRUE) - dbus_pending_call_set_notify(call, server_register_reply, - technology, NULL); - else - dbus_pending_call_set_notify(call, server_unregister_reply, - technology, NULL); - - dbus_message_unref(message); -} - -struct tethering_info { - struct connman_technology *technology; - const char *bridge; -}; - -static void enable_nap(gpointer key, gpointer value, gpointer user_data) -{ - struct tethering_info *info = user_data; - struct connman_device *device = value; - const char *path; - - DBG(""); - - path = connman_device_get_string(device, "Path"); - - server_register(path, "nap", info->technology, info->bridge, TRUE); -} - -static void disable_nap(gpointer key, gpointer value, gpointer user_data) -{ - struct tethering_info *info = user_data; - struct connman_device *device = value; - const char *path; - - DBG(""); - - path = connman_device_get_string(device, "Path"); - - server_register(path, "nap", info->technology, info->bridge, FALSE); -} - -static int tech_set_tethering(struct connman_technology *technology, - const char *identifier, const char *passphrase, - const char *bridge, connman_bool_t enabled) -{ - struct tethering_info info = { - .technology = technology, - .bridge = bridge, - }; - - DBG("bridge %s", bridge); - - if (enabled) - g_hash_table_foreach(bluetooth_devices, enable_nap, &info); - else - g_hash_table_foreach(bluetooth_devices, disable_nap, &info); - - return 0; -} - -static struct connman_technology_driver tech_driver = { - .name = "bluetooth", - .type = CONNMAN_SERVICE_TYPE_BLUETOOTH, - .probe = tech_probe, - .remove = tech_remove, - .set_tethering = tech_set_tethering, -}; - -static guint watch; -static guint added_watch; -static guint removed_watch; -static guint adapter_watch; -static guint device_watch; -static guint device_removed_watch; -static guint network_watch; - -static int bluetooth_init(void) -{ - int err; - - connection = connman_dbus_get_connection(); - if (connection == NULL) - return -EIO; - - watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE, - bluetooth_connect, bluetooth_disconnect, NULL, NULL); - - added_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, NULL, - BLUEZ_MANAGER_INTERFACE, - ADAPTER_ADDED, adapter_added, - NULL, NULL); - - removed_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, NULL, - BLUEZ_MANAGER_INTERFACE, - ADAPTER_REMOVED, adapter_removed, - NULL, NULL); - - adapter_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, - NULL, BLUEZ_ADAPTER_INTERFACE, - PROPERTY_CHANGED, adapter_changed, - NULL, NULL); - - device_removed_watch = g_dbus_add_signal_watch(connection, - BLUEZ_SERVICE, NULL, - BLUEZ_ADAPTER_INTERFACE, - DEVICE_REMOVED, device_removed, - NULL, NULL); - - device_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, NULL, - BLUEZ_DEVICE_INTERFACE, - PROPERTY_CHANGED, device_changed, - NULL, NULL); - - network_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, - NULL, BLUEZ_NETWORK_INTERFACE, - PROPERTY_CHANGED, network_changed, - NULL, NULL); - - if (watch == 0 || added_watch == 0 || removed_watch == 0 - || adapter_watch == 0 || network_watch == 0 - || device_watch == 0 - || device_removed_watch == 0) { - err = -EIO; - goto remove; - } - - err = connman_network_driver_register(&pan_driver); - if (err < 0) - goto remove; - - err = connman_device_driver_register(&bluetooth_driver); - if (err < 0) { - connman_network_driver_unregister(&pan_driver); - goto remove; - } - - err = connman_technology_driver_register(&tech_driver); - if (err < 0) { - connman_device_driver_unregister(&bluetooth_driver); - connman_network_driver_unregister(&pan_driver); - goto remove; - } - - return 0; - -remove: - g_dbus_remove_watch(connection, watch); - g_dbus_remove_watch(connection, added_watch); - g_dbus_remove_watch(connection, removed_watch); - g_dbus_remove_watch(connection, adapter_watch); - g_dbus_remove_watch(connection, device_removed_watch); - g_dbus_remove_watch(connection, device_watch); - g_dbus_remove_watch(connection, network_watch); - - dbus_connection_unref(connection); - - return err; -} - -static void bluetooth_exit(void) -{ - g_dbus_remove_watch(connection, watch); - g_dbus_remove_watch(connection, added_watch); - g_dbus_remove_watch(connection, removed_watch); - g_dbus_remove_watch(connection, adapter_watch); - g_dbus_remove_watch(connection, device_removed_watch); - g_dbus_remove_watch(connection, device_watch); - g_dbus_remove_watch(connection, network_watch); - - bluetooth_disconnect(connection, NULL); - - connman_technology_driver_unregister(&tech_driver); - - connman_device_driver_unregister(&bluetooth_driver); - connman_network_driver_unregister(&pan_driver); - - dbus_connection_unref(connection); -} - -CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION, - CONNMAN_PLUGIN_PRIORITY_DEFAULT, bluetooth_init, bluetooth_exit) diff --git a/plugins/bluetooth_legacy.c b/plugins/bluetooth_legacy.c new file mode 100644 index 00000000..f03f2a00 --- /dev/null +++ b/plugins/bluetooth_legacy.c @@ -0,0 +1,1353 @@ +/* + * + * Connection Manager + * + * Copyright (C) 2007-2012 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 + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + * + */ + +#ifdef HAVE_CONFIG_H +#include +#endif + +#include +#include +#include +#include +#include + +#include + +#define CONNMAN_API_SUBJECT_TO_CHANGE +#include +#include +#include +#include +#include +#include + +#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 BLUEZ_NETWORK_SERVER BLUEZ_SERVICE ".NetworkServer" + +#define LIST_ADAPTERS "ListAdapters" +#define ADAPTER_ADDED "AdapterAdded" +#define ADAPTER_REMOVED "AdapterRemoved" +#define DEVICE_REMOVED "DeviceRemoved" + +#define PROPERTY_CHANGED "PropertyChanged" +#define GET_PROPERTIES "GetProperties" +#define SET_PROPERTY "SetProperty" + +#define CONNECT "Connect" +#define DISCONNECT "Disconnect" + +#define REGISTER "Register" +#define UNREGISTER "Unregister" + +#define UUID_NAP "00001116-0000-1000-8000-00805f9b34fb" + +#define TIMEOUT 5000 + +static DBusConnection *connection; + +static GHashTable *bluetooth_devices = NULL; +static GHashTable *bluetooth_networks = NULL; +static GHashTable *pending_networks = NULL; + +static int pan_probe(struct connman_network *network) +{ + DBG("network %p", network); + + return 0; +} + +static void pan_remove(struct connman_network *network) +{ + DBG("network %p", network); +} + +static void connect_reply(DBusPendingCall *call, void *user_data) +{ + struct connman_network *network = user_data; + DBusMessage *reply; + DBusError error; + const char *interface = NULL; + int index; + + DBG("network %p", network); + + reply = dbus_pending_call_steal_reply(call); + + dbus_error_init(&error); + + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + + goto err; + } + + 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 err; + } + + if (interface == NULL) + goto err; + + DBG("interface %s", interface); + + index = connman_inet_ifindex(interface); + + connman_network_set_index(network, index); + + connman_network_set_connected(network, TRUE); + + dbus_message_unref(reply); + + dbus_pending_call_unref(call); + + return; +err: + + connman_network_set_connected(network, FALSE); + + dbus_message_unref(reply); + + dbus_pending_call_unref(call); +} + +static int pan_connect(struct connman_network *network) +{ + const char *path = connman_network_get_string(network, "Path"); + const char *uuid = "nap"; + DBusMessage *message; + DBusPendingCall *call; + + DBG("network %p", network); + + if (path == NULL) + return -EINVAL; + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_NETWORK_INTERFACE, CONNECT); + if (message == NULL) + return -ENOMEM; + + dbus_message_set_auto_start(message, FALSE); + + dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid, + DBUS_TYPE_INVALID); + + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT * 10) == FALSE) { + connman_error("Failed to connect service"); + dbus_message_unref(message); + return -EINVAL; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + 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; + DBusMessage *reply; + DBusError error; + + DBG("network %p", network); + + reply = dbus_pending_call_steal_reply(call); + + dbus_error_init(&error); + + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + goto done; + } + + 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; + } + + connman_network_set_connected(network, FALSE); + +done: + dbus_message_unref(reply); + + dbus_pending_call_unref(call); + + connman_network_unref(network); +} + +static int pan_disconnect(struct connman_network *network) +{ + const char *path = connman_network_get_string(network, "Path"); + DBusMessage *message; + DBusPendingCall *call; + + DBG("network %p", network); + + if (path == NULL) + return -EINVAL; + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_NETWORK_INTERFACE, DISCONNECT); + if (message == NULL) + return -ENOMEM; + + dbus_message_set_auto_start(message, FALSE); + + dbus_message_append_args(message, DBUS_TYPE_INVALID); + + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to disconnect service"); + dbus_message_unref(message); + return -EINVAL; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + dbus_message_unref(message); + return -EINVAL; + } + + connman_network_ref(network); + + connman_network_set_associating(network, FALSE); + + dbus_pending_call_set_notify(call, disconnect_reply, network, NULL); + + dbus_message_unref(message); + + return 0; +} + +static struct connman_network_driver pan_driver = { + .name = "bluetooth_legacy-pan", + .type = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN, + .probe = pan_probe, + .remove = pan_remove, + .connect = pan_connect, + .disconnect = pan_disconnect, +}; + +static gboolean network_changed(DBusConnection *conn, + DBusMessage *message, void *user_data) +{ + const char *path = dbus_message_get_path(message); + struct connman_network *network; + DBusMessageIter iter, value; + const char *key; + + DBG("path %s", path); + + network = g_hash_table_lookup(bluetooth_networks, path); + if (network == NULL) + return TRUE; + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &key); + + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); + + if (g_str_equal(key, "Connected") == TRUE) { + dbus_bool_t connected; + + dbus_message_iter_get_basic(&value, &connected); + + if (connected == TRUE) + return TRUE; + + connman_network_set_associating(network, FALSE); + connman_network_set_connected(network, FALSE); + } + + return TRUE; +} + +static void extract_properties(DBusMessage *reply, const char **parent, + const char **address, + const char **name, + const char **alias, + dbus_bool_t *powered, + dbus_bool_t *scanning, + DBusMessageIter *uuids, + DBusMessageIter *networks) +{ + 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, "Adapter") == TRUE) { + if (parent != NULL) + dbus_message_iter_get_basic(&value, parent); + } else if (g_str_equal(key, "Address") == TRUE) { + if (address != NULL) + dbus_message_iter_get_basic(&value, address); + } else if (g_str_equal(key, "Name") == TRUE) { + if (name != NULL) + dbus_message_iter_get_basic(&value, name); + } else if (g_str_equal(key, "Alias") == TRUE) { + if (alias != NULL) + dbus_message_iter_get_basic(&value, alias); + } else if (g_str_equal(key, "Powered") == TRUE) { + if (powered != NULL) + dbus_message_iter_get_basic(&value, powered); + } else if (g_str_equal(key, "Discovering") == TRUE) { + if (scanning != NULL) + dbus_message_iter_get_basic(&value, scanning); + } else if (g_str_equal(key, "Devices") == TRUE) { + if (networks != NULL) + memcpy(networks, &value, sizeof(value)); + } else if (g_str_equal(key, "UUIDs") == TRUE) { + if (uuids != NULL) + memcpy(uuids, &value, sizeof(value)); + } + + dbus_message_iter_next(&dict); + } +} + +static dbus_bool_t has_pan(DBusMessageIter *array) +{ + DBusMessageIter value; + + if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) + return FALSE; + + dbus_message_iter_recurse(array, &value); + + while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) { + const char *uuid; + + dbus_message_iter_get_basic(&value, &uuid); + + if (g_strcmp0(uuid, UUID_NAP) == 0) + return TRUE; + + dbus_message_iter_next(&value); + } + + return FALSE; +} + +static void network_properties_reply(DBusPendingCall *call, void *user_data) +{ + char *path = user_data; + struct connman_device *device; + struct connman_network *network; + DBusMessage *reply; + DBusMessageIter uuids; + const char *parent = NULL, *address = NULL, *name = NULL; + struct ether_addr addr; + char ident[13]; + + reply = dbus_pending_call_steal_reply(call); + + extract_properties(reply, &parent, &address, NULL, &name, + NULL, NULL, &uuids, NULL); + + if (parent == NULL) + goto done; + + device = g_hash_table_lookup(bluetooth_devices, parent); + if (device == NULL) + goto done; + + if (address == NULL) + goto done; + + ether_aton_r(address, &addr); + + snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x", + addr.ether_addr_octet[0], + addr.ether_addr_octet[1], + addr.ether_addr_octet[2], + addr.ether_addr_octet[3], + addr.ether_addr_octet[4], + addr.ether_addr_octet[5]); + + if (has_pan(&uuids) == FALSE) + goto done; + + network = connman_device_get_network(device, ident); + if (network != NULL) + goto done; + + network = connman_network_create(ident, + CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN); + if (network == NULL) + goto done; + + connman_network_set_string(network, "Path", path); + + connman_network_set_name(network, name); + + connman_device_add_network(device, network); + + connman_network_set_group(network, ident); + + g_hash_table_replace(bluetooth_networks, g_strdup(path), network); + +done: + dbus_message_unref(reply); + + dbus_pending_call_unref(call); +} + +static void add_network(const char *path) +{ + DBusMessage *message; + DBusPendingCall *call; + + DBG("path %s", path); + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_DEVICE_INTERFACE, GET_PROPERTIES); + if (message == NULL) + return; + + dbus_message_set_auto_start(message, FALSE); + + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to get network properties for %s", path); + goto done; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + goto done; + } + + dbus_pending_call_set_notify(call, network_properties_reply, + g_strdup(path), g_free); + +done: + dbus_message_unref(message); +} + +static void check_networks(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); + + add_network(path); + + dbus_message_iter_next(&value); + } +} + +static void check_pending_networks(const char *adapter) +{ + GSList *networks, *list; + + networks = g_hash_table_lookup(pending_networks, adapter); + if (networks == NULL) + return; + + for (list = networks; list != NULL; list = list->next) { + char *path = list->data; + + add_network(path); + } + + g_hash_table_remove(pending_networks, adapter); +} + +static gboolean adapter_changed(DBusConnection *conn, + DBusMessage *message, void *user_data) +{ + const char *path = dbus_message_get_path(message); + struct connman_device *device; + DBusMessageIter iter, value; + const char *key; + + DBG("path %s", path); + + device = g_hash_table_lookup(bluetooth_devices, path); + if (device == NULL) + return TRUE; + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + 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) { + dbus_bool_t val; + + dbus_message_iter_get_basic(&value, &val); + connman_device_set_powered(device, val); + if (val == TRUE) + check_pending_networks(path); + } else if (g_str_equal(key, "Discovering") == TRUE) { + dbus_bool_t val; + + dbus_message_iter_get_basic(&value, &val); + connman_device_set_scanning(device, val); + } else if (g_str_equal(key, "Devices") == TRUE) { + check_networks(&value); + } + + return TRUE; +} + +static gboolean device_removed(DBusConnection *conn, + DBusMessage *message, void *user_data) +{ + const char *network_path; + struct connman_network *network; + struct connman_device *device; + DBusMessageIter iter; + + DBG(""); + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &network_path); + + network = g_hash_table_lookup(bluetooth_networks, network_path); + if (network == NULL) + return TRUE; + + device = connman_network_get_device(network); + if (device == NULL) + return TRUE; + + g_hash_table_remove(bluetooth_networks, network_path); + + return TRUE; +} + +static gboolean device_changed(DBusConnection *conn, + DBusMessage *message, void *user_data) +{ + const char *path = dbus_message_get_path(message); + DBusMessageIter iter, value; + const char *key; + + DBG("path %s", path); + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &key); + + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); + + DBG("key %s", key); + + if (g_str_equal(key, "UUIDs") == TRUE) + add_network(path); + + return TRUE; +} + +static void remove_device_networks(struct connman_device *device) +{ + GHashTableIter iter; + gpointer key, value; + GSList *key_list = NULL; + GSList *list; + + if (bluetooth_networks == NULL) + return; + + g_hash_table_iter_init(&iter, bluetooth_networks); + + while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) { + struct connman_network *network = value; + + if (connman_network_get_device(network) != device) + continue; + + key_list = g_slist_prepend(key_list, key); + } + + for (list = key_list; list != NULL; list = list->next) { + const char *network_path = list->data; + + g_hash_table_remove(bluetooth_networks, network_path); + } + + g_slist_free(key_list); +} + +static void add_pending_networks(const char *adapter, DBusMessageIter *array) +{ + DBusMessageIter value; + GSList *list = NULL; + + 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); + + list = g_slist_prepend(list, g_strdup(path)); + + dbus_message_iter_next(&value); + } + + if (list == NULL) + return; + + g_hash_table_replace(pending_networks, g_strdup(adapter), list); +} + +static void adapter_properties_reply(DBusPendingCall *call, void *user_data) +{ + char *path = user_data; + struct connman_device *device; + DBusMessage *reply; + DBusMessageIter networks; + const char *address = NULL, *name = NULL; + dbus_bool_t powered = FALSE, scanning = FALSE; + struct ether_addr addr; + char ident[13]; + + DBG("path %s", path); + + reply = dbus_pending_call_steal_reply(call); + + if (path == NULL) + goto done; + + extract_properties(reply, NULL, &address, &name, NULL, + &powered, &scanning, NULL, &networks); + + if (address == NULL) + goto done; + + if (g_strcmp0(address, "00:00:00:00:00:00") == 0) + goto done; + + device = g_hash_table_lookup(bluetooth_devices, path); + if (device != NULL) + goto update; + + ether_aton_r(address, &addr); + + snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x", + addr.ether_addr_octet[0], + addr.ether_addr_octet[1], + addr.ether_addr_octet[2], + addr.ether_addr_octet[3], + addr.ether_addr_octet[4], + addr.ether_addr_octet[5]); + + device = connman_device_create("bluetooth_legacy", + CONNMAN_DEVICE_TYPE_BLUETOOTH); + if (device == NULL) + goto done; + + g_hash_table_insert(bluetooth_devices, g_strdup(path), device); + + connman_device_set_ident(device, ident); + + connman_device_set_string(device, "Path", path); + + if (connman_device_register(device) < 0) { + connman_device_unref(device); + g_hash_table_remove(bluetooth_devices, path); + goto done; + } + +update: + connman_device_set_string(device, "Address", address); + connman_device_set_string(device, "Name", name); + connman_device_set_string(device, "Path", path); + + connman_device_set_powered(device, powered); + connman_device_set_scanning(device, scanning); + + if (powered == FALSE) { + remove_device_networks(device); + add_pending_networks(path, &networks); + } else + check_networks(&networks); + +done: + dbus_message_unref(reply); + + dbus_pending_call_unref(call); +} + +static void add_adapter(DBusConnection *conn, const char *path) +{ + DBusMessage *message; + DBusPendingCall *call; + + DBG("path %s", path); + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_ADAPTER_INTERFACE, GET_PROPERTIES); + if (message == NULL) + return; + + dbus_message_set_auto_start(message, FALSE); + + if (dbus_connection_send_with_reply(conn, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to get adapter properties for %s", path); + goto done; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + goto done; + } + + dbus_pending_call_set_notify(call, adapter_properties_reply, + g_strdup(path), g_free); + +done: + dbus_message_unref(message); +} + +static gboolean adapter_added(DBusConnection *conn, DBusMessage *message, + void *user_data) +{ + const char *path; + + dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); + add_adapter(conn, path); + return TRUE; +} + +static void remove_adapter(DBusConnection *conn, const char *path) +{ + DBG("path %s", path); + + g_hash_table_remove(bluetooth_devices, path); + g_hash_table_remove(pending_networks, path); +} + +static gboolean adapter_removed(DBusConnection *conn, DBusMessage *message, + void *user_data) +{ + const char *path; + + dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path, + DBUS_TYPE_INVALID); + remove_adapter(conn, path); + return TRUE; +} + +static void list_adapters_reply(DBusPendingCall *call, void *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_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + goto done; + } + + 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); + + dbus_pending_call_unref(call); +} + +static void unregister_device(gpointer data) +{ + struct connman_device *device = data; + + DBG(""); + + remove_device_networks(device); + + connman_device_unregister(device); + connman_device_unref(device); +} + +static void remove_network(gpointer data) +{ + struct connman_network *network = data; + struct connman_device *device; + + DBG("network %p", network); + + device = connman_network_get_device(network); + if (device != NULL) + connman_device_remove_network(device, network); + + connman_network_unref(network); +} + +static void remove_pending_networks(gpointer data) +{ + GSList *list = data; + + g_slist_free_full(list, g_free); +} + +static void bluetooth_connect(DBusConnection *conn, void *user_data) +{ + DBusMessage *message; + DBusPendingCall *call; + + DBG("connection %p", conn); + + bluetooth_devices = g_hash_table_new_full(g_str_hash, g_str_equal, + g_free, unregister_device); + + bluetooth_networks = g_hash_table_new_full(g_str_hash, g_str_equal, + g_free, remove_network); + + pending_networks = g_hash_table_new_full(g_str_hash, g_str_equal, + g_free, remove_pending_networks); + + message = dbus_message_new_method_call(BLUEZ_SERVICE, "/", + BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS); + if (message == NULL) + return; + + dbus_message_set_auto_start(message, FALSE); + + if (dbus_connection_send_with_reply(conn, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to get Bluetooth adapters"); + goto done; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + goto done; + } + + dbus_pending_call_set_notify(call, list_adapters_reply, NULL, NULL); + +done: + dbus_message_unref(message); +} + +static void bluetooth_disconnect(DBusConnection *conn, void *user_data) +{ + DBG("connection %p", conn); + + if (bluetooth_devices == NULL) + return; + + g_hash_table_destroy(bluetooth_networks); + bluetooth_networks = NULL; + g_hash_table_destroy(bluetooth_devices); + bluetooth_devices = NULL; + g_hash_table_destroy(pending_networks); + pending_networks = NULL; +} + +static int bluetooth_probe(struct connman_device *device) +{ + GHashTableIter iter; + gpointer key, value; + + DBG("device %p", device); + + if (bluetooth_devices == NULL) + return -ENOTSUP; + + g_hash_table_iter_init(&iter, bluetooth_devices); + + while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) { + struct connman_device *device_pan = value; + + if (device == device_pan) + return 0; + } + + return -ENOTSUP; +} + +static void bluetooth_remove(struct connman_device *device) +{ + DBG("device %p", device); +} + +static void powered_reply(DBusPendingCall *call, void *user_data) +{ + DBusError error; + DBusMessage *reply; + + DBG(""); + + reply = dbus_pending_call_steal_reply(call); + + dbus_error_init(&error); + + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + dbus_message_unref(reply); + dbus_pending_call_unref(call); + return; + } + + dbus_message_unref(reply); + dbus_pending_call_unref(call); + + add_adapter(connection, user_data); +} + +static int change_powered(DBusConnection *conn, const char *path, + dbus_bool_t powered) +{ + DBusMessage *message; + DBusMessageIter iter; + DBusPendingCall *call; + + DBG(""); + + if (path == NULL) + return -EINVAL; + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY); + if (message == NULL) + return -ENOMEM; + + dbus_message_set_auto_start(message, FALSE); + + dbus_message_iter_init_append(message, &iter); + connman_dbus_property_append_basic(&iter, "Powered", + DBUS_TYPE_BOOLEAN, &powered); + + if (dbus_connection_send_with_reply(conn, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to change Powered property"); + dbus_message_unref(message); + return -EINVAL; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + dbus_message_unref(message); + return -EINVAL; + } + + dbus_pending_call_set_notify(call, powered_reply, + g_strdup(path), g_free); + + dbus_message_unref(message); + + return -EINPROGRESS; +} + +static int bluetooth_enable(struct connman_device *device) +{ + const char *path = connman_device_get_string(device, "Path"); + + DBG("device %p", device); + + return change_powered(connection, path, TRUE); +} + +static int bluetooth_disable(struct connman_device *device) +{ + const char *path = connman_device_get_string(device, "Path"); + + DBG("device %p", device); + + return change_powered(connection, path, FALSE); +} + +static struct connman_device_driver bluetooth_driver = { + .name = "bluetooth_legacy", + .type = CONNMAN_DEVICE_TYPE_BLUETOOTH, + .probe = bluetooth_probe, + .remove = bluetooth_remove, + .enable = bluetooth_enable, + .disable = bluetooth_disable, +}; + +static int tech_probe(struct connman_technology *technology) +{ + return 0; +} + +static void tech_remove(struct connman_technology *technology) +{ +} + +static void server_register_reply(DBusPendingCall *call, void *user_data) +{ + struct connman_technology *technology = user_data; + DBusError error; + DBusMessage *reply; + + DBG(""); + + reply = dbus_pending_call_steal_reply(call); + + dbus_error_init(&error); + + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + dbus_message_unref(reply); + dbus_pending_call_unref(call); + return; + } + + dbus_message_unref(reply); + dbus_pending_call_unref(call); + + connman_technology_tethering_notify(technology, TRUE); +} + +static void server_unregister_reply(DBusPendingCall *call, void *user_data) +{ + struct connman_technology *technology = user_data; + DBusError error; + DBusMessage *reply; + + DBG(""); + + reply = dbus_pending_call_steal_reply(call); + + dbus_error_init(&error); + + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + dbus_message_unref(reply); + dbus_pending_call_unref(call); + return; + } + + dbus_message_unref(reply); + dbus_pending_call_unref(call); + + connman_technology_tethering_notify(technology, FALSE); +} + + +static void server_register(const char *path, const char *uuid, + struct connman_technology *technology, + const char *bridge, connman_bool_t enabled) +{ + DBusMessage *message; + DBusPendingCall *call; + char *command; + + DBG("path %s enabled %d", path, enabled); + + command = enabled ? REGISTER : UNREGISTER; + + message = dbus_message_new_method_call(BLUEZ_SERVICE, path, + BLUEZ_NETWORK_SERVER, command); + if (message == NULL) + return; + + dbus_message_set_auto_start(message, FALSE); + + dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid, + DBUS_TYPE_INVALID); + + if (enabled == TRUE) + dbus_message_append_args(message, DBUS_TYPE_STRING, &bridge, + DBUS_TYPE_INVALID); + + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to enable PAN server"); + dbus_message_unref(message); + return; + } + + if (call == NULL) { + connman_error("D-Bus connection not available"); + dbus_message_unref(message); + return; + } + + if (enabled == TRUE) + dbus_pending_call_set_notify(call, server_register_reply, + technology, NULL); + else + dbus_pending_call_set_notify(call, server_unregister_reply, + technology, NULL); + + dbus_message_unref(message); +} + +struct tethering_info { + struct connman_technology *technology; + const char *bridge; +}; + +static void enable_nap(gpointer key, gpointer value, gpointer user_data) +{ + struct tethering_info *info = user_data; + struct connman_device *device = value; + const char *path; + + DBG(""); + + path = connman_device_get_string(device, "Path"); + + server_register(path, "nap", info->technology, info->bridge, TRUE); +} + +static void disable_nap(gpointer key, gpointer value, gpointer user_data) +{ + struct tethering_info *info = user_data; + struct connman_device *device = value; + const char *path; + + DBG(""); + + path = connman_device_get_string(device, "Path"); + + server_register(path, "nap", info->technology, info->bridge, FALSE); +} + +static int tech_set_tethering(struct connman_technology *technology, + const char *identifier, const char *passphrase, + const char *bridge, connman_bool_t enabled) +{ + struct tethering_info info = { + .technology = technology, + .bridge = bridge, + }; + + DBG("bridge %s", bridge); + + if (enabled) + g_hash_table_foreach(bluetooth_devices, enable_nap, &info); + else + g_hash_table_foreach(bluetooth_devices, disable_nap, &info); + + return 0; +} + +static struct connman_technology_driver tech_driver = { + .name = "bluetooth_legacy", + .type = CONNMAN_SERVICE_TYPE_BLUETOOTH, + .priority = -10, + .probe = tech_probe, + .remove = tech_remove, + .set_tethering = tech_set_tethering, +}; + +static guint watch; +static guint added_watch; +static guint removed_watch; +static guint adapter_watch; +static guint device_watch; +static guint device_removed_watch; +static guint network_watch; + +static int bluetooth_init(void) +{ + int err; + + connection = connman_dbus_get_connection(); + if (connection == NULL) + return -EIO; + + watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE, + bluetooth_connect, bluetooth_disconnect, NULL, NULL); + + added_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, NULL, + BLUEZ_MANAGER_INTERFACE, + ADAPTER_ADDED, adapter_added, + NULL, NULL); + + removed_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, NULL, + BLUEZ_MANAGER_INTERFACE, + ADAPTER_REMOVED, adapter_removed, + NULL, NULL); + + adapter_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, + NULL, BLUEZ_ADAPTER_INTERFACE, + PROPERTY_CHANGED, adapter_changed, + NULL, NULL); + + device_removed_watch = g_dbus_add_signal_watch(connection, + BLUEZ_SERVICE, NULL, + BLUEZ_ADAPTER_INTERFACE, + DEVICE_REMOVED, device_removed, + NULL, NULL); + + device_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, NULL, + BLUEZ_DEVICE_INTERFACE, + PROPERTY_CHANGED, device_changed, + NULL, NULL); + + network_watch = g_dbus_add_signal_watch(connection, BLUEZ_SERVICE, + NULL, BLUEZ_NETWORK_INTERFACE, + PROPERTY_CHANGED, network_changed, + NULL, NULL); + + if (watch == 0 || added_watch == 0 || removed_watch == 0 + || adapter_watch == 0 || network_watch == 0 + || device_watch == 0 + || device_removed_watch == 0) { + err = -EIO; + goto remove; + } + + err = connman_network_driver_register(&pan_driver); + if (err < 0) + goto remove; + + err = connman_device_driver_register(&bluetooth_driver); + if (err < 0) { + connman_network_driver_unregister(&pan_driver); + goto remove; + } + + err = connman_technology_driver_register(&tech_driver); + if (err < 0) { + connman_device_driver_unregister(&bluetooth_driver); + connman_network_driver_unregister(&pan_driver); + goto remove; + } + + return 0; + +remove: + g_dbus_remove_watch(connection, watch); + g_dbus_remove_watch(connection, added_watch); + g_dbus_remove_watch(connection, removed_watch); + g_dbus_remove_watch(connection, adapter_watch); + g_dbus_remove_watch(connection, device_removed_watch); + g_dbus_remove_watch(connection, device_watch); + g_dbus_remove_watch(connection, network_watch); + + dbus_connection_unref(connection); + + return err; +} + +static void bluetooth_exit(void) +{ + g_dbus_remove_watch(connection, watch); + g_dbus_remove_watch(connection, added_watch); + g_dbus_remove_watch(connection, removed_watch); + g_dbus_remove_watch(connection, adapter_watch); + g_dbus_remove_watch(connection, device_removed_watch); + g_dbus_remove_watch(connection, device_watch); + g_dbus_remove_watch(connection, network_watch); + + bluetooth_disconnect(connection, NULL); + + connman_technology_driver_unregister(&tech_driver); + + connman_device_driver_unregister(&bluetooth_driver); + connman_network_driver_unregister(&pan_driver); + + dbus_connection_unref(connection); +} + +CONNMAN_PLUGIN_DEFINE(bluetooth_legacy, "Bluetooth technology plugin (legacy)", + VERSION, CONNMAN_PLUGIN_PRIORITY_LOW, + bluetooth_init, bluetooth_exit) -- cgit v1.2.3