5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
30 #include <netinet/ether.h>
34 #define CONNMAN_API_SUBJECT_TO_CHANGE
35 #include <connman/plugin.h>
36 #include <connman/device.h>
37 #include <connman/inet.h>
38 #include <connman/dbus.h>
39 #include <connman/log.h>
41 #define BLUEZ_SERVICE "org.bluez"
42 #define BLUEZ_MANAGER_INTERFACE BLUEZ_SERVICE ".Manager"
43 #define BLUEZ_ADAPTER_INTERFACE BLUEZ_SERVICE ".Adapter"
44 #define BLUEZ_DEVICE_INTERFACE BLUEZ_SERVICE ".Device"
45 #define BLUEZ_NETWORK_INTERFACE BLUEZ_SERVICE ".Network"
47 #define LIST_ADAPTERS "ListAdapters"
48 #define ADAPTER_ADDED "AdapterAdded"
49 #define ADAPTER_REMOVED "AdapterRemoved"
51 #define PROPERTY_CHANGED "PropertyChanged"
52 #define GET_PROPERTIES "GetProperties"
53 #define SET_PROPERTY "SetProperty"
55 #define CONNECT "Connect"
56 #define DISCONNECT "Disconnect"
58 #define UUID_NAP "00001116-0000-1000-8000-00805f9b34fb"
62 static DBusConnection *connection;
64 static GHashTable *bluetooth_devices = NULL;
66 static int pan_probe(struct connman_network *network)
68 DBG("network %p", network);
73 static void pan_remove(struct connman_network *network)
75 DBG("network %p", network);
78 static void connect_reply(DBusPendingCall *call, void *user_data)
80 struct connman_network *network = user_data;
83 const char *interface = NULL;
86 DBG("network %p", network);
88 reply = dbus_pending_call_steal_reply(call);
90 dbus_error_init(&error);
92 if (dbus_message_get_args(reply, &error,
93 DBUS_TYPE_STRING, &interface,
94 DBUS_TYPE_INVALID) == FALSE) {
95 if (dbus_error_is_set(&error) == TRUE) {
96 connman_error("%s", error.message);
97 dbus_error_free(&error);
99 connman_error("Wrong arguments for connect");
103 if (interface == NULL)
106 DBG("interface %s", interface);
108 index = connman_inet_ifindex(interface);
110 connman_network_set_index(network, index);
112 connman_network_set_method(network, CONNMAN_IPCONFIG_METHOD_DHCP);
114 connman_network_set_connected(network, TRUE);
117 dbus_message_unref(reply);
119 dbus_pending_call_unref(call);
122 static int pan_connect(struct connman_network *network)
124 const char *path = connman_network_get_string(network, "Path");
125 const char *uuid = "nap";
126 DBusMessage *message;
127 DBusPendingCall *call;
129 DBG("network %p", network);
134 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
135 BLUEZ_NETWORK_INTERFACE, CONNECT);
139 dbus_message_set_auto_start(message, FALSE);
141 dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid,
144 if (dbus_connection_send_with_reply(connection, message,
145 &call, TIMEOUT * 10) == FALSE) {
146 connman_error("Failed to connect service");
147 dbus_message_unref(message);
152 connman_error("D-Bus connection not available");
153 dbus_message_unref(message);
157 dbus_pending_call_set_notify(call, connect_reply, network, NULL);
159 dbus_message_unref(message);
164 static void disconnect_reply(DBusPendingCall *call, void *user_data)
166 struct connman_network *network = user_data;
170 DBG("network %p", network);
172 reply = dbus_pending_call_steal_reply(call);
174 dbus_error_init(&error);
176 if (dbus_message_get_args(reply, &error, DBUS_TYPE_INVALID) == FALSE) {
177 if (dbus_error_is_set(&error) == TRUE) {
178 connman_error("%s", error.message);
179 dbus_error_free(&error);
181 connman_error("Wrong arguments for disconnect");
185 connman_network_set_connected(network, FALSE);
188 dbus_message_unref(reply);
190 dbus_pending_call_unref(call);
193 static int pan_disconnect(struct connman_network *network)
195 const char *path = connman_network_get_string(network, "Path");
196 DBusMessage *message;
197 DBusPendingCall *call;
199 DBG("network %p", network);
204 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
205 BLUEZ_NETWORK_INTERFACE, DISCONNECT);
209 dbus_message_set_auto_start(message, FALSE);
211 dbus_message_append_args(message, DBUS_TYPE_INVALID);
213 if (dbus_connection_send_with_reply(connection, message,
214 &call, TIMEOUT) == FALSE) {
215 connman_error("Failed to disconnect service");
216 dbus_message_unref(message);
221 connman_error("D-Bus connection not available");
222 dbus_message_unref(message);
226 dbus_pending_call_set_notify(call, disconnect_reply, network, NULL);
228 dbus_message_unref(message);
233 static struct connman_network_driver pan_driver = {
234 .name = "bluetooth-pan",
235 .type = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN,
237 .remove = pan_remove,
238 .connect = pan_connect,
239 .disconnect = pan_disconnect,
242 static void extract_properties(DBusMessage *reply, const char **parent,
243 const char **address,
246 dbus_bool_t *powered,
247 dbus_bool_t *scanning,
248 DBusMessageIter *uuids,
249 DBusMessageIter *networks)
251 DBusMessageIter array, dict;
253 if (dbus_message_iter_init(reply, &array) == FALSE)
256 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
259 dbus_message_iter_recurse(&array, &dict);
261 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
262 DBusMessageIter entry, value;
265 dbus_message_iter_recurse(&dict, &entry);
266 dbus_message_iter_get_basic(&entry, &key);
268 dbus_message_iter_next(&entry);
269 dbus_message_iter_recurse(&entry, &value);
271 if (g_str_equal(key, "Adapter") == TRUE) {
273 dbus_message_iter_get_basic(&value, parent);
274 } else if (g_str_equal(key, "Address") == TRUE) {
276 dbus_message_iter_get_basic(&value, address);
277 } else if (g_str_equal(key, "Name") == TRUE) {
279 dbus_message_iter_get_basic(&value, name);
280 } else if (g_str_equal(key, "Alias") == TRUE) {
282 dbus_message_iter_get_basic(&value, alias);
283 } else if (g_str_equal(key, "Powered") == TRUE) {
285 dbus_message_iter_get_basic(&value, powered);
286 } else if (g_str_equal(key, "Discovering") == TRUE) {
287 if (scanning != NULL)
288 dbus_message_iter_get_basic(&value, scanning);
289 } else if (g_str_equal(key, "Devices") == TRUE) {
290 if (networks != NULL)
291 memcpy(networks, &value, sizeof(value));
292 } else if (g_str_equal(key, "UUIDs") == TRUE) {
294 memcpy(uuids, &value, sizeof(value));
297 dbus_message_iter_next(&dict);
301 static dbus_bool_t has_pan(DBusMessageIter *array)
303 DBusMessageIter value;
305 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
308 dbus_message_iter_recurse(array, &value);
310 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
313 dbus_message_iter_get_basic(&value, &uuid);
315 if (g_strcmp0(uuid, UUID_NAP) == 0)
318 dbus_message_iter_next(&value);
324 static void network_properties_reply(DBusPendingCall *call, void *user_data)
326 char *path = user_data;
327 struct connman_device *device;
328 struct connman_network *network;
330 DBusMessageIter uuids;
331 const char *parent = NULL, *address = NULL, *name = NULL;
332 struct ether_addr addr;
335 reply = dbus_pending_call_steal_reply(call);
337 extract_properties(reply, &parent, &address, NULL, &name,
338 NULL, NULL, &uuids, NULL);
343 device = g_hash_table_lookup(bluetooth_devices, parent);
350 ether_aton_r(address, &addr);
352 snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
353 addr.ether_addr_octet[0],
354 addr.ether_addr_octet[1],
355 addr.ether_addr_octet[2],
356 addr.ether_addr_octet[3],
357 addr.ether_addr_octet[4],
358 addr.ether_addr_octet[5]);
360 if (has_pan(&uuids) == FALSE)
363 network = connman_device_get_network(device, ident);
367 network = connman_network_create(ident,
368 CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN);
372 connman_network_set_string(network, "Path", path);
374 connman_network_set_protocol(network, CONNMAN_NETWORK_PROTOCOL_IP);
376 connman_network_set_name(network, name);
378 connman_device_add_network(device, network);
380 connman_network_set_group(network, ident);
383 dbus_message_unref(reply);
385 dbus_pending_call_unref(call);
388 static void add_network(struct connman_device *device, const char *path)
390 DBusMessage *message;
391 DBusPendingCall *call;
393 DBG("path %s", path);
395 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
396 BLUEZ_DEVICE_INTERFACE, GET_PROPERTIES);
400 dbus_message_set_auto_start(message, FALSE);
402 if (dbus_connection_send_with_reply(connection, message,
403 &call, TIMEOUT) == FALSE) {
404 connman_error("Failed to get network properties for %s", path);
409 connman_error("D-Bus connection not available");
413 dbus_pending_call_set_notify(call, network_properties_reply,
414 g_strdup(path), g_free);
417 dbus_message_unref(message);
420 static void check_networks(struct connman_device *device,
421 DBusMessageIter *array)
423 DBusMessageIter value;
425 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
428 dbus_message_iter_recurse(array, &value);
430 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_OBJECT_PATH) {
433 dbus_message_iter_get_basic(&value, &path);
435 add_network(device, path);
437 dbus_message_iter_next(&value);
441 static gboolean adapter_changed(DBusConnection *connection,
442 DBusMessage *message, void *user_data)
444 const char *path = dbus_message_get_path(message);
445 struct connman_device *device;
446 DBusMessageIter iter, value;
449 DBG("path %s", path);
451 device = g_hash_table_lookup(bluetooth_devices, path);
455 if (dbus_message_iter_init(message, &iter) == FALSE)
458 dbus_message_iter_get_basic(&iter, &key);
460 dbus_message_iter_next(&iter);
461 dbus_message_iter_recurse(&iter, &value);
463 if (g_str_equal(key, "Powered") == TRUE) {
466 dbus_message_iter_get_basic(&value, &val);
467 connman_device_set_powered(device, val);
468 } else if (g_str_equal(key, "Discovering") == TRUE) {
471 dbus_message_iter_get_basic(&value, &val);
472 connman_device_set_scanning(device, val);
473 } else if (g_str_equal(key, "Devices") == TRUE) {
474 check_networks(device, &value);
480 static void adapter_properties_reply(DBusPendingCall *call, void *user_data)
482 char *path = user_data;
483 struct connman_device *device;
485 DBusMessageIter networks;
486 const char *address = NULL, *name = NULL;
487 dbus_bool_t powered = FALSE, scanning = FALSE;
488 struct ether_addr addr;
491 DBG("path %s", path);
493 reply = dbus_pending_call_steal_reply(call);
498 extract_properties(reply, NULL, &address, &name, NULL,
499 &powered, &scanning, NULL, &networks);
504 device = g_hash_table_lookup(bluetooth_devices, path);
508 ether_aton_r(address, &addr);
510 snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
511 addr.ether_addr_octet[0],
512 addr.ether_addr_octet[1],
513 addr.ether_addr_octet[2],
514 addr.ether_addr_octet[3],
515 addr.ether_addr_octet[4],
516 addr.ether_addr_octet[5]);
518 device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_BLUETOOTH);
522 connman_device_set_ident(device, ident);
524 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
526 connman_device_set_string(device, "Path", path);
528 if (connman_device_register(device) < 0) {
529 connman_device_unref(device);
533 g_hash_table_insert(bluetooth_devices, g_strdup(path), device);
536 connman_device_set_string(device, "Address", address);
537 connman_device_set_string(device, "Name", name);
538 connman_device_set_string(device, "Path", path);
540 connman_device_set_powered(device, powered);
541 connman_device_set_scanning(device, scanning);
544 check_networks(device, &networks);
547 dbus_message_unref(reply);
549 dbus_pending_call_unref(call);
552 static void add_adapter(DBusConnection *connection, const char *path)
554 DBusMessage *message;
555 DBusPendingCall *call;
557 DBG("path %s", path);
559 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
560 BLUEZ_ADAPTER_INTERFACE, GET_PROPERTIES);
564 dbus_message_set_auto_start(message, FALSE);
566 if (dbus_connection_send_with_reply(connection, message,
567 &call, TIMEOUT) == FALSE) {
568 connman_error("Failed to get adapter properties for %s", path);
573 connman_error("D-Bus connection not available");
577 dbus_pending_call_set_notify(call, adapter_properties_reply,
578 g_strdup(path), g_free);
581 dbus_message_unref(message);
584 static gboolean adapter_added(DBusConnection *connection, DBusMessage *message,
589 dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
591 add_adapter(connection, path);
595 static void remove_adapter(DBusConnection *connection, const char *path)
597 DBG("path %s", path);
599 g_hash_table_remove(bluetooth_devices, path);
602 static gboolean adapter_removed(DBusConnection *connection, DBusMessage *message,
607 dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
609 remove_adapter(connection, path);
613 static void list_adapters_reply(DBusPendingCall *call, void *user_data)
622 reply = dbus_pending_call_steal_reply(call);
624 dbus_error_init(&error);
626 if (dbus_message_get_args(reply, &error,
627 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
628 &adapters, &num_adapters,
629 DBUS_TYPE_INVALID) == FALSE) {
630 if (dbus_error_is_set(&error) == TRUE) {
631 connman_error("%s", error.message);
632 dbus_error_free(&error);
634 connman_error("Wrong arguments for adapter list");
638 for (i = 0; i < num_adapters; i++)
639 add_adapter(connection, adapters[i]);
641 g_strfreev(adapters);
644 dbus_message_unref(reply);
646 dbus_pending_call_unref(call);
649 static void unregister_device(gpointer data)
651 struct connman_device *device = data;
655 connman_device_unregister(device);
656 connman_device_unref(device);
659 static void bluetooth_connect(DBusConnection *connection, void *user_data)
661 DBusMessage *message;
662 DBusPendingCall *call;
664 DBG("connection %p", connection);
666 bluetooth_devices = g_hash_table_new_full(g_str_hash, g_str_equal,
667 g_free, unregister_device);
669 message = dbus_message_new_method_call(BLUEZ_SERVICE, "/",
670 BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS);
674 dbus_message_set_auto_start(message, FALSE);
676 if (dbus_connection_send_with_reply(connection, message,
677 &call, TIMEOUT) == FALSE) {
678 connman_error("Failed to get Bluetooth adapters");
683 connman_error("D-Bus connection not available");
687 dbus_pending_call_set_notify(call, list_adapters_reply, NULL, NULL);
690 dbus_message_unref(message);
693 static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
695 DBG("connection %p", connection);
697 if (bluetooth_devices == NULL)
700 g_hash_table_destroy(bluetooth_devices);
701 bluetooth_devices = NULL;
704 static int bluetooth_probe(struct connman_device *device)
706 DBG("device %p", device);
711 static void bluetooth_remove(struct connman_device *device)
713 DBG("device %p", device);
716 static void powered_reply(DBusPendingCall *call, void *user_data)
722 reply = dbus_pending_call_steal_reply(call);
724 dbus_message_unref(reply);
726 dbus_pending_call_unref(call);
728 add_adapter(connection, user_data);
731 static int change_powered(DBusConnection *connection, const char *path,
734 DBusMessage *message;
735 DBusMessageIter iter;
736 DBusPendingCall *call;
743 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
744 BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY);
748 dbus_message_set_auto_start(message, FALSE);
750 dbus_message_iter_init_append(message, &iter);
751 connman_dbus_property_append_basic(&iter, "Powered",
752 DBUS_TYPE_BOOLEAN, &powered);
754 if (dbus_connection_send_with_reply(connection, message,
755 &call, TIMEOUT) == FALSE) {
756 connman_error("Failed to change Powered property");
757 dbus_message_unref(message);
762 connman_error("D-Bus connection not available");
763 dbus_message_unref(message);
767 dbus_pending_call_set_notify(call, powered_reply,
768 g_strdup(path), g_free);
770 dbus_message_unref(message);
775 static int bluetooth_enable(struct connman_device *device)
777 const char *path = connman_device_get_string(device, "Path");
779 DBG("device %p", device);
781 return change_powered(connection, path, TRUE);
784 static int bluetooth_disable(struct connman_device *device)
786 const char *path = connman_device_get_string(device, "Path");
788 DBG("device %p", device);
790 return change_powered(connection, path, FALSE);
793 static struct connman_device_driver bluetooth_driver = {
795 .type = CONNMAN_DEVICE_TYPE_BLUETOOTH,
796 .probe = bluetooth_probe,
797 .remove = bluetooth_remove,
798 .enable = bluetooth_enable,
799 .disable = bluetooth_disable,
803 static guint added_watch;
804 static guint removed_watch;
805 static guint adapter_watch;
807 static int bluetooth_init(void)
811 connection = connman_dbus_get_connection();
812 if (connection == NULL)
815 watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE,
816 bluetooth_connect, bluetooth_disconnect, NULL, NULL);
818 added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
819 BLUEZ_MANAGER_INTERFACE,
820 ADAPTER_ADDED, adapter_added,
823 removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
824 BLUEZ_MANAGER_INTERFACE,
825 ADAPTER_REMOVED, adapter_removed,
828 adapter_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
829 BLUEZ_MANAGER_INTERFACE,
830 PROPERTY_CHANGED, adapter_changed,
833 if (watch == 0 || added_watch == 0 || removed_watch == 0
834 || adapter_watch == 0) {
839 err = connman_network_driver_register(&pan_driver);
843 err = connman_device_driver_register(&bluetooth_driver);
845 connman_network_driver_unregister(&pan_driver);
852 g_dbus_remove_watch(connection, watch);
853 g_dbus_remove_watch(connection, added_watch);
854 g_dbus_remove_watch(connection, removed_watch);
855 g_dbus_remove_watch(connection, adapter_watch);
857 dbus_connection_unref(connection);
862 static void bluetooth_exit(void)
864 g_dbus_remove_watch(connection, watch);
865 g_dbus_remove_watch(connection, added_watch);
866 g_dbus_remove_watch(connection, removed_watch);
867 g_dbus_remove_watch(connection, adapter_watch);
869 bluetooth_disconnect(connection, NULL);
871 connman_device_driver_unregister(&bluetooth_driver);
872 connman_network_driver_unregister(&pan_driver);
874 dbus_connection_unref(connection);
877 CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
878 CONNMAN_PLUGIN_PRIORITY_DEFAULT, bluetooth_init, bluetooth_exit)