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_set_error_from_message(&error, reply) == TRUE) {
93 connman_error("%s", error.message);
94 dbus_error_free(&error);
98 if (dbus_message_get_args(reply, &error,
99 DBUS_TYPE_STRING, &interface,
100 DBUS_TYPE_INVALID) == FALSE) {
101 if (dbus_error_is_set(&error) == TRUE) {
102 connman_error("%s", error.message);
103 dbus_error_free(&error);
105 connman_error("Wrong arguments for connect");
109 if (interface == NULL)
112 DBG("interface %s", interface);
114 index = connman_inet_ifindex(interface);
116 connman_network_set_index(network, index);
118 connman_network_set_connected(network, TRUE);
121 dbus_message_unref(reply);
123 dbus_pending_call_unref(call);
126 static int pan_connect(struct connman_network *network)
128 const char *path = connman_network_get_string(network, "Path");
129 const char *uuid = "nap";
130 DBusMessage *message;
131 DBusPendingCall *call;
133 DBG("network %p", network);
138 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
139 BLUEZ_NETWORK_INTERFACE, CONNECT);
143 dbus_message_set_auto_start(message, FALSE);
145 dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid,
148 if (dbus_connection_send_with_reply(connection, message,
149 &call, TIMEOUT * 10) == FALSE) {
150 connman_error("Failed to connect service");
151 dbus_message_unref(message);
156 connman_error("D-Bus connection not available");
157 dbus_message_unref(message);
161 dbus_pending_call_set_notify(call, connect_reply, network, NULL);
163 dbus_message_unref(message);
168 static void disconnect_reply(DBusPendingCall *call, void *user_data)
170 struct connman_network *network = user_data;
174 DBG("network %p", network);
176 reply = dbus_pending_call_steal_reply(call);
178 dbus_error_init(&error);
180 if (dbus_set_error_from_message(&error, reply) == TRUE) {
181 connman_error("%s", error.message);
182 dbus_error_free(&error);
186 if (dbus_message_get_args(reply, &error, DBUS_TYPE_INVALID) == FALSE) {
187 if (dbus_error_is_set(&error) == TRUE) {
188 connman_error("%s", error.message);
189 dbus_error_free(&error);
191 connman_error("Wrong arguments for disconnect");
195 connman_network_set_connected(network, FALSE);
198 dbus_message_unref(reply);
200 dbus_pending_call_unref(call);
202 connman_network_unref(network);
205 static int pan_disconnect(struct connman_network *network)
207 const char *path = connman_network_get_string(network, "Path");
208 DBusMessage *message;
209 DBusPendingCall *call;
211 DBG("network %p", network);
216 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
217 BLUEZ_NETWORK_INTERFACE, DISCONNECT);
221 dbus_message_set_auto_start(message, FALSE);
223 dbus_message_append_args(message, DBUS_TYPE_INVALID);
225 if (dbus_connection_send_with_reply(connection, message,
226 &call, TIMEOUT) == FALSE) {
227 connman_error("Failed to disconnect service");
228 dbus_message_unref(message);
233 connman_error("D-Bus connection not available");
234 dbus_message_unref(message);
238 connman_network_ref(network);
240 dbus_pending_call_set_notify(call, disconnect_reply, network, NULL);
242 dbus_message_unref(message);
247 static struct connman_network_driver pan_driver = {
248 .name = "bluetooth-pan",
249 .type = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN,
251 .remove = pan_remove,
252 .connect = pan_connect,
253 .disconnect = pan_disconnect,
256 static void extract_properties(DBusMessage *reply, const char **parent,
257 const char **address,
260 dbus_bool_t *powered,
261 dbus_bool_t *scanning,
262 DBusMessageIter *uuids,
263 DBusMessageIter *networks)
265 DBusMessageIter array, dict;
267 if (dbus_message_iter_init(reply, &array) == FALSE)
270 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
273 dbus_message_iter_recurse(&array, &dict);
275 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
276 DBusMessageIter entry, value;
279 dbus_message_iter_recurse(&dict, &entry);
280 dbus_message_iter_get_basic(&entry, &key);
282 dbus_message_iter_next(&entry);
283 dbus_message_iter_recurse(&entry, &value);
285 if (g_str_equal(key, "Adapter") == TRUE) {
287 dbus_message_iter_get_basic(&value, parent);
288 } else if (g_str_equal(key, "Address") == TRUE) {
290 dbus_message_iter_get_basic(&value, address);
291 } else if (g_str_equal(key, "Name") == TRUE) {
293 dbus_message_iter_get_basic(&value, name);
294 } else if (g_str_equal(key, "Alias") == TRUE) {
296 dbus_message_iter_get_basic(&value, alias);
297 } else if (g_str_equal(key, "Powered") == TRUE) {
299 dbus_message_iter_get_basic(&value, powered);
300 } else if (g_str_equal(key, "Discovering") == TRUE) {
301 if (scanning != NULL)
302 dbus_message_iter_get_basic(&value, scanning);
303 } else if (g_str_equal(key, "Devices") == TRUE) {
304 if (networks != NULL)
305 memcpy(networks, &value, sizeof(value));
306 } else if (g_str_equal(key, "UUIDs") == TRUE) {
308 memcpy(uuids, &value, sizeof(value));
311 dbus_message_iter_next(&dict);
315 static dbus_bool_t has_pan(DBusMessageIter *array)
317 DBusMessageIter value;
319 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
322 dbus_message_iter_recurse(array, &value);
324 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
327 dbus_message_iter_get_basic(&value, &uuid);
329 if (g_strcmp0(uuid, UUID_NAP) == 0)
332 dbus_message_iter_next(&value);
338 static void network_properties_reply(DBusPendingCall *call, void *user_data)
340 char *path = user_data;
341 struct connman_device *device;
342 struct connman_network *network;
344 DBusMessageIter uuids;
345 const char *parent = NULL, *address = NULL, *name = NULL;
346 struct ether_addr addr;
349 reply = dbus_pending_call_steal_reply(call);
351 extract_properties(reply, &parent, &address, NULL, &name,
352 NULL, NULL, &uuids, NULL);
357 device = g_hash_table_lookup(bluetooth_devices, parent);
364 ether_aton_r(address, &addr);
366 snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
367 addr.ether_addr_octet[0],
368 addr.ether_addr_octet[1],
369 addr.ether_addr_octet[2],
370 addr.ether_addr_octet[3],
371 addr.ether_addr_octet[4],
372 addr.ether_addr_octet[5]);
374 if (has_pan(&uuids) == FALSE)
377 network = connman_device_get_network(device, ident);
381 network = connman_network_create(ident,
382 CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN);
386 connman_network_set_string(network, "Path", path);
388 connman_network_set_protocol(network, CONNMAN_NETWORK_PROTOCOL_IP);
390 connman_network_set_name(network, name);
392 connman_device_add_network(device, network);
394 connman_network_set_group(network, ident);
397 dbus_message_unref(reply);
399 dbus_pending_call_unref(call);
402 static void add_network(struct connman_device *device, const char *path)
404 DBusMessage *message;
405 DBusPendingCall *call;
407 DBG("path %s", path);
409 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
410 BLUEZ_DEVICE_INTERFACE, GET_PROPERTIES);
414 dbus_message_set_auto_start(message, FALSE);
416 if (dbus_connection_send_with_reply(connection, message,
417 &call, TIMEOUT) == FALSE) {
418 connman_error("Failed to get network properties for %s", path);
423 connman_error("D-Bus connection not available");
427 dbus_pending_call_set_notify(call, network_properties_reply,
428 g_strdup(path), g_free);
431 dbus_message_unref(message);
434 static void check_networks(struct connman_device *device,
435 DBusMessageIter *array)
437 DBusMessageIter value;
439 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
442 dbus_message_iter_recurse(array, &value);
444 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_OBJECT_PATH) {
447 dbus_message_iter_get_basic(&value, &path);
449 add_network(device, path);
451 dbus_message_iter_next(&value);
455 static gboolean adapter_changed(DBusConnection *connection,
456 DBusMessage *message, void *user_data)
458 const char *path = dbus_message_get_path(message);
459 struct connman_device *device;
460 DBusMessageIter iter, value;
463 DBG("path %s", path);
465 device = g_hash_table_lookup(bluetooth_devices, path);
469 if (dbus_message_iter_init(message, &iter) == FALSE)
472 dbus_message_iter_get_basic(&iter, &key);
474 dbus_message_iter_next(&iter);
475 dbus_message_iter_recurse(&iter, &value);
477 if (g_str_equal(key, "Powered") == TRUE) {
480 dbus_message_iter_get_basic(&value, &val);
481 connman_device_set_powered(device, val);
482 } else if (g_str_equal(key, "Discovering") == TRUE) {
485 dbus_message_iter_get_basic(&value, &val);
486 connman_device_set_scanning(device, val);
487 } else if (g_str_equal(key, "Devices") == TRUE) {
488 check_networks(device, &value);
494 static void adapter_properties_reply(DBusPendingCall *call, void *user_data)
496 char *path = user_data;
497 struct connman_device *device;
499 DBusMessageIter networks;
500 const char *address = NULL, *name = NULL;
501 dbus_bool_t powered = FALSE, scanning = FALSE;
502 struct ether_addr addr;
505 DBG("path %s", path);
507 reply = dbus_pending_call_steal_reply(call);
512 extract_properties(reply, NULL, &address, &name, NULL,
513 &powered, &scanning, NULL, &networks);
518 device = g_hash_table_lookup(bluetooth_devices, path);
522 ether_aton_r(address, &addr);
524 snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
525 addr.ether_addr_octet[0],
526 addr.ether_addr_octet[1],
527 addr.ether_addr_octet[2],
528 addr.ether_addr_octet[3],
529 addr.ether_addr_octet[4],
530 addr.ether_addr_octet[5]);
532 device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_BLUETOOTH);
536 connman_device_set_ident(device, ident);
538 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
540 connman_device_set_string(device, "Path", path);
542 if (connman_device_register(device) < 0) {
543 connman_device_unref(device);
547 g_hash_table_insert(bluetooth_devices, g_strdup(path), device);
550 connman_device_set_string(device, "Address", address);
551 connman_device_set_string(device, "Name", name);
552 connman_device_set_string(device, "Path", path);
554 connman_device_set_powered(device, powered);
555 connman_device_set_scanning(device, scanning);
558 check_networks(device, &networks);
561 dbus_message_unref(reply);
563 dbus_pending_call_unref(call);
566 static void add_adapter(DBusConnection *connection, const char *path)
568 DBusMessage *message;
569 DBusPendingCall *call;
571 DBG("path %s", path);
573 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
574 BLUEZ_ADAPTER_INTERFACE, GET_PROPERTIES);
578 dbus_message_set_auto_start(message, FALSE);
580 if (dbus_connection_send_with_reply(connection, message,
581 &call, TIMEOUT) == FALSE) {
582 connman_error("Failed to get adapter properties for %s", path);
587 connman_error("D-Bus connection not available");
591 dbus_pending_call_set_notify(call, adapter_properties_reply,
592 g_strdup(path), g_free);
595 dbus_message_unref(message);
598 static gboolean adapter_added(DBusConnection *connection, DBusMessage *message,
603 dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
605 add_adapter(connection, path);
609 static void remove_adapter(DBusConnection *connection, const char *path)
611 DBG("path %s", path);
613 g_hash_table_remove(bluetooth_devices, path);
616 static gboolean adapter_removed(DBusConnection *connection, DBusMessage *message,
621 dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
623 remove_adapter(connection, path);
627 static void list_adapters_reply(DBusPendingCall *call, void *user_data)
636 reply = dbus_pending_call_steal_reply(call);
638 dbus_error_init(&error);
640 if (dbus_set_error_from_message(&error, reply) == TRUE) {
641 connman_error("%s", error.message);
642 dbus_error_free(&error);
646 if (dbus_message_get_args(reply, &error,
647 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
648 &adapters, &num_adapters,
649 DBUS_TYPE_INVALID) == FALSE) {
650 if (dbus_error_is_set(&error) == TRUE) {
651 connman_error("%s", error.message);
652 dbus_error_free(&error);
654 connman_error("Wrong arguments for adapter list");
658 for (i = 0; i < num_adapters; i++)
659 add_adapter(connection, adapters[i]);
661 g_strfreev(adapters);
664 dbus_message_unref(reply);
666 dbus_pending_call_unref(call);
669 static void unregister_device(gpointer data)
671 struct connman_device *device = data;
675 connman_device_unregister(device);
676 connman_device_unref(device);
679 static void bluetooth_connect(DBusConnection *connection, void *user_data)
681 DBusMessage *message;
682 DBusPendingCall *call;
684 DBG("connection %p", connection);
686 bluetooth_devices = g_hash_table_new_full(g_str_hash, g_str_equal,
687 g_free, unregister_device);
689 message = dbus_message_new_method_call(BLUEZ_SERVICE, "/",
690 BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS);
694 dbus_message_set_auto_start(message, FALSE);
696 if (dbus_connection_send_with_reply(connection, message,
697 &call, TIMEOUT) == FALSE) {
698 connman_error("Failed to get Bluetooth adapters");
703 connman_error("D-Bus connection not available");
707 dbus_pending_call_set_notify(call, list_adapters_reply, NULL, NULL);
710 dbus_message_unref(message);
713 static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
715 DBG("connection %p", connection);
717 if (bluetooth_devices == NULL)
720 g_hash_table_destroy(bluetooth_devices);
721 bluetooth_devices = NULL;
724 static int bluetooth_probe(struct connman_device *device)
726 DBG("device %p", device);
731 static void bluetooth_remove(struct connman_device *device)
733 DBG("device %p", device);
736 static void powered_reply(DBusPendingCall *call, void *user_data)
743 reply = dbus_pending_call_steal_reply(call);
745 dbus_error_init(&error);
747 if (dbus_set_error_from_message(&error, reply) == TRUE) {
748 connman_error("%s", error.message);
749 dbus_error_free(&error);
750 dbus_message_unref(reply);
751 dbus_pending_call_unref(call);
755 dbus_message_unref(reply);
756 dbus_pending_call_unref(call);
758 add_adapter(connection, user_data);
761 static int change_powered(DBusConnection *connection, const char *path,
764 DBusMessage *message;
765 DBusMessageIter iter;
766 DBusPendingCall *call;
773 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
774 BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY);
778 dbus_message_set_auto_start(message, FALSE);
780 dbus_message_iter_init_append(message, &iter);
781 connman_dbus_property_append_basic(&iter, "Powered",
782 DBUS_TYPE_BOOLEAN, &powered);
784 if (dbus_connection_send_with_reply(connection, message,
785 &call, TIMEOUT) == FALSE) {
786 connman_error("Failed to change Powered property");
787 dbus_message_unref(message);
792 connman_error("D-Bus connection not available");
793 dbus_message_unref(message);
797 dbus_pending_call_set_notify(call, powered_reply,
798 g_strdup(path), g_free);
800 dbus_message_unref(message);
805 static int bluetooth_enable(struct connman_device *device)
807 const char *path = connman_device_get_string(device, "Path");
809 DBG("device %p", device);
811 return change_powered(connection, path, TRUE);
814 static int bluetooth_disable(struct connman_device *device)
816 const char *path = connman_device_get_string(device, "Path");
818 DBG("device %p", device);
820 return change_powered(connection, path, FALSE);
823 static struct connman_device_driver bluetooth_driver = {
825 .type = CONNMAN_DEVICE_TYPE_BLUETOOTH,
826 .probe = bluetooth_probe,
827 .remove = bluetooth_remove,
828 .enable = bluetooth_enable,
829 .disable = bluetooth_disable,
833 static guint added_watch;
834 static guint removed_watch;
835 static guint adapter_watch;
837 static int bluetooth_init(void)
841 connection = connman_dbus_get_connection();
842 if (connection == NULL)
845 watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE,
846 bluetooth_connect, bluetooth_disconnect, NULL, NULL);
848 added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
849 BLUEZ_MANAGER_INTERFACE,
850 ADAPTER_ADDED, adapter_added,
853 removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
854 BLUEZ_MANAGER_INTERFACE,
855 ADAPTER_REMOVED, adapter_removed,
858 adapter_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
859 BLUEZ_MANAGER_INTERFACE,
860 PROPERTY_CHANGED, adapter_changed,
863 if (watch == 0 || added_watch == 0 || removed_watch == 0
864 || adapter_watch == 0) {
869 err = connman_network_driver_register(&pan_driver);
873 err = connman_device_driver_register(&bluetooth_driver);
875 connman_network_driver_unregister(&pan_driver);
882 g_dbus_remove_watch(connection, watch);
883 g_dbus_remove_watch(connection, added_watch);
884 g_dbus_remove_watch(connection, removed_watch);
885 g_dbus_remove_watch(connection, adapter_watch);
887 dbus_connection_unref(connection);
892 static void bluetooth_exit(void)
894 g_dbus_remove_watch(connection, watch);
895 g_dbus_remove_watch(connection, added_watch);
896 g_dbus_remove_watch(connection, removed_watch);
897 g_dbus_remove_watch(connection, adapter_watch);
899 bluetooth_disconnect(connection, NULL);
901 connman_device_driver_unregister(&bluetooth_driver);
902 connman_network_driver_unregister(&pan_driver);
904 dbus_connection_unref(connection);
907 CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
908 CONNMAN_PLUGIN_PRIORITY_DEFAULT, bluetooth_init, bluetooth_exit)