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 connman_network_set_associating(network, FALSE);
242 dbus_pending_call_set_notify(call, disconnect_reply, network, NULL);
244 dbus_message_unref(message);
249 static struct connman_network_driver pan_driver = {
250 .name = "bluetooth-pan",
251 .type = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN,
253 .remove = pan_remove,
254 .connect = pan_connect,
255 .disconnect = pan_disconnect,
258 static void extract_properties(DBusMessage *reply, const char **parent,
259 const char **address,
262 dbus_bool_t *powered,
263 dbus_bool_t *scanning,
264 DBusMessageIter *uuids,
265 DBusMessageIter *networks)
267 DBusMessageIter array, dict;
269 if (dbus_message_iter_init(reply, &array) == FALSE)
272 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
275 dbus_message_iter_recurse(&array, &dict);
277 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
278 DBusMessageIter entry, value;
281 dbus_message_iter_recurse(&dict, &entry);
282 dbus_message_iter_get_basic(&entry, &key);
284 dbus_message_iter_next(&entry);
285 dbus_message_iter_recurse(&entry, &value);
287 if (g_str_equal(key, "Adapter") == TRUE) {
289 dbus_message_iter_get_basic(&value, parent);
290 } else if (g_str_equal(key, "Address") == TRUE) {
292 dbus_message_iter_get_basic(&value, address);
293 } else if (g_str_equal(key, "Name") == TRUE) {
295 dbus_message_iter_get_basic(&value, name);
296 } else if (g_str_equal(key, "Alias") == TRUE) {
298 dbus_message_iter_get_basic(&value, alias);
299 } else if (g_str_equal(key, "Powered") == TRUE) {
301 dbus_message_iter_get_basic(&value, powered);
302 } else if (g_str_equal(key, "Discovering") == TRUE) {
303 if (scanning != NULL)
304 dbus_message_iter_get_basic(&value, scanning);
305 } else if (g_str_equal(key, "Devices") == TRUE) {
306 if (networks != NULL)
307 memcpy(networks, &value, sizeof(value));
308 } else if (g_str_equal(key, "UUIDs") == TRUE) {
310 memcpy(uuids, &value, sizeof(value));
313 dbus_message_iter_next(&dict);
317 static dbus_bool_t has_pan(DBusMessageIter *array)
319 DBusMessageIter value;
321 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
324 dbus_message_iter_recurse(array, &value);
326 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
329 dbus_message_iter_get_basic(&value, &uuid);
331 if (g_strcmp0(uuid, UUID_NAP) == 0)
334 dbus_message_iter_next(&value);
340 static void network_properties_reply(DBusPendingCall *call, void *user_data)
342 char *path = user_data;
343 struct connman_device *device;
344 struct connman_network *network;
346 DBusMessageIter uuids;
347 const char *parent = NULL, *address = NULL, *name = NULL;
348 struct ether_addr addr;
351 reply = dbus_pending_call_steal_reply(call);
353 extract_properties(reply, &parent, &address, NULL, &name,
354 NULL, NULL, &uuids, NULL);
359 device = g_hash_table_lookup(bluetooth_devices, parent);
366 ether_aton_r(address, &addr);
368 snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
369 addr.ether_addr_octet[0],
370 addr.ether_addr_octet[1],
371 addr.ether_addr_octet[2],
372 addr.ether_addr_octet[3],
373 addr.ether_addr_octet[4],
374 addr.ether_addr_octet[5]);
376 if (has_pan(&uuids) == FALSE)
379 network = connman_device_get_network(device, ident);
383 network = connman_network_create(ident,
384 CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN);
388 connman_network_set_string(network, "Path", path);
390 connman_network_set_protocol(network, CONNMAN_NETWORK_PROTOCOL_IP);
392 connman_network_set_name(network, name);
394 connman_device_add_network(device, network);
396 connman_network_set_group(network, ident);
399 dbus_message_unref(reply);
401 dbus_pending_call_unref(call);
404 static void add_network(struct connman_device *device, const char *path)
406 DBusMessage *message;
407 DBusPendingCall *call;
409 DBG("path %s", path);
411 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
412 BLUEZ_DEVICE_INTERFACE, GET_PROPERTIES);
416 dbus_message_set_auto_start(message, FALSE);
418 if (dbus_connection_send_with_reply(connection, message,
419 &call, TIMEOUT) == FALSE) {
420 connman_error("Failed to get network properties for %s", path);
425 connman_error("D-Bus connection not available");
429 dbus_pending_call_set_notify(call, network_properties_reply,
430 g_strdup(path), g_free);
433 dbus_message_unref(message);
436 static void check_networks(struct connman_device *device,
437 DBusMessageIter *array)
439 DBusMessageIter value;
441 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
444 dbus_message_iter_recurse(array, &value);
446 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_OBJECT_PATH) {
449 dbus_message_iter_get_basic(&value, &path);
451 add_network(device, path);
453 dbus_message_iter_next(&value);
457 static gboolean adapter_changed(DBusConnection *connection,
458 DBusMessage *message, void *user_data)
460 const char *path = dbus_message_get_path(message);
461 struct connman_device *device;
462 DBusMessageIter iter, value;
465 DBG("path %s", path);
467 device = g_hash_table_lookup(bluetooth_devices, path);
471 if (dbus_message_iter_init(message, &iter) == FALSE)
474 dbus_message_iter_get_basic(&iter, &key);
476 dbus_message_iter_next(&iter);
477 dbus_message_iter_recurse(&iter, &value);
479 if (g_str_equal(key, "Powered") == TRUE) {
482 dbus_message_iter_get_basic(&value, &val);
483 connman_device_set_powered(device, val);
484 } else if (g_str_equal(key, "Discovering") == TRUE) {
487 dbus_message_iter_get_basic(&value, &val);
488 connman_device_set_scanning(device, val);
489 } else if (g_str_equal(key, "Devices") == TRUE) {
490 check_networks(device, &value);
496 static void adapter_properties_reply(DBusPendingCall *call, void *user_data)
498 char *path = user_data;
499 struct connman_device *device;
501 DBusMessageIter networks;
502 const char *address = NULL, *name = NULL;
503 dbus_bool_t powered = FALSE, scanning = FALSE;
504 struct ether_addr addr;
507 DBG("path %s", path);
509 reply = dbus_pending_call_steal_reply(call);
514 extract_properties(reply, NULL, &address, &name, NULL,
515 &powered, &scanning, NULL, &networks);
520 device = g_hash_table_lookup(bluetooth_devices, path);
524 ether_aton_r(address, &addr);
526 snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
527 addr.ether_addr_octet[0],
528 addr.ether_addr_octet[1],
529 addr.ether_addr_octet[2],
530 addr.ether_addr_octet[3],
531 addr.ether_addr_octet[4],
532 addr.ether_addr_octet[5]);
534 device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_BLUETOOTH);
538 connman_device_set_ident(device, ident);
540 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
542 connman_device_set_string(device, "Path", path);
544 if (connman_device_register(device) < 0) {
545 connman_device_unref(device);
549 g_hash_table_insert(bluetooth_devices, g_strdup(path), device);
552 connman_device_set_string(device, "Address", address);
553 connman_device_set_string(device, "Name", name);
554 connman_device_set_string(device, "Path", path);
556 connman_device_set_powered(device, powered);
557 connman_device_set_scanning(device, scanning);
560 check_networks(device, &networks);
563 dbus_message_unref(reply);
565 dbus_pending_call_unref(call);
568 static void add_adapter(DBusConnection *connection, const char *path)
570 DBusMessage *message;
571 DBusPendingCall *call;
573 DBG("path %s", path);
575 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
576 BLUEZ_ADAPTER_INTERFACE, GET_PROPERTIES);
580 dbus_message_set_auto_start(message, FALSE);
582 if (dbus_connection_send_with_reply(connection, message,
583 &call, TIMEOUT) == FALSE) {
584 connman_error("Failed to get adapter properties for %s", path);
589 connman_error("D-Bus connection not available");
593 dbus_pending_call_set_notify(call, adapter_properties_reply,
594 g_strdup(path), g_free);
597 dbus_message_unref(message);
600 static gboolean adapter_added(DBusConnection *connection, DBusMessage *message,
605 dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
607 add_adapter(connection, path);
611 static void remove_adapter(DBusConnection *connection, const char *path)
613 DBG("path %s", path);
615 g_hash_table_remove(bluetooth_devices, path);
618 static gboolean adapter_removed(DBusConnection *connection, DBusMessage *message,
623 dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
625 remove_adapter(connection, path);
629 static void list_adapters_reply(DBusPendingCall *call, void *user_data)
638 reply = dbus_pending_call_steal_reply(call);
640 dbus_error_init(&error);
642 if (dbus_set_error_from_message(&error, reply) == TRUE) {
643 connman_error("%s", error.message);
644 dbus_error_free(&error);
648 if (dbus_message_get_args(reply, &error,
649 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
650 &adapters, &num_adapters,
651 DBUS_TYPE_INVALID) == FALSE) {
652 if (dbus_error_is_set(&error) == TRUE) {
653 connman_error("%s", error.message);
654 dbus_error_free(&error);
656 connman_error("Wrong arguments for adapter list");
660 for (i = 0; i < num_adapters; i++)
661 add_adapter(connection, adapters[i]);
663 g_strfreev(adapters);
666 dbus_message_unref(reply);
668 dbus_pending_call_unref(call);
671 static void unregister_device(gpointer data)
673 struct connman_device *device = data;
677 connman_device_unregister(device);
678 connman_device_unref(device);
681 static void bluetooth_connect(DBusConnection *connection, void *user_data)
683 DBusMessage *message;
684 DBusPendingCall *call;
686 DBG("connection %p", connection);
688 bluetooth_devices = g_hash_table_new_full(g_str_hash, g_str_equal,
689 g_free, unregister_device);
691 message = dbus_message_new_method_call(BLUEZ_SERVICE, "/",
692 BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS);
696 dbus_message_set_auto_start(message, FALSE);
698 if (dbus_connection_send_with_reply(connection, message,
699 &call, TIMEOUT) == FALSE) {
700 connman_error("Failed to get Bluetooth adapters");
705 connman_error("D-Bus connection not available");
709 dbus_pending_call_set_notify(call, list_adapters_reply, NULL, NULL);
712 dbus_message_unref(message);
715 static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
717 DBG("connection %p", connection);
719 if (bluetooth_devices == NULL)
722 g_hash_table_destroy(bluetooth_devices);
723 bluetooth_devices = NULL;
726 static int bluetooth_probe(struct connman_device *device)
728 DBG("device %p", device);
733 static void bluetooth_remove(struct connman_device *device)
735 DBG("device %p", device);
738 static void powered_reply(DBusPendingCall *call, void *user_data)
745 reply = dbus_pending_call_steal_reply(call);
747 dbus_error_init(&error);
749 if (dbus_set_error_from_message(&error, reply) == TRUE) {
750 connman_error("%s", error.message);
751 dbus_error_free(&error);
752 dbus_message_unref(reply);
753 dbus_pending_call_unref(call);
757 dbus_message_unref(reply);
758 dbus_pending_call_unref(call);
760 add_adapter(connection, user_data);
763 static int change_powered(DBusConnection *connection, const char *path,
766 DBusMessage *message;
767 DBusMessageIter iter;
768 DBusPendingCall *call;
775 message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
776 BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY);
780 dbus_message_set_auto_start(message, FALSE);
782 dbus_message_iter_init_append(message, &iter);
783 connman_dbus_property_append_basic(&iter, "Powered",
784 DBUS_TYPE_BOOLEAN, &powered);
786 if (dbus_connection_send_with_reply(connection, message,
787 &call, TIMEOUT) == FALSE) {
788 connman_error("Failed to change Powered property");
789 dbus_message_unref(message);
794 connman_error("D-Bus connection not available");
795 dbus_message_unref(message);
799 dbus_pending_call_set_notify(call, powered_reply,
800 g_strdup(path), g_free);
802 dbus_message_unref(message);
807 static int bluetooth_enable(struct connman_device *device)
809 const char *path = connman_device_get_string(device, "Path");
811 DBG("device %p", device);
813 return change_powered(connection, path, TRUE);
816 static int bluetooth_disable(struct connman_device *device)
818 const char *path = connman_device_get_string(device, "Path");
820 DBG("device %p", device);
822 return change_powered(connection, path, FALSE);
825 static struct connman_device_driver bluetooth_driver = {
827 .type = CONNMAN_DEVICE_TYPE_BLUETOOTH,
828 .probe = bluetooth_probe,
829 .remove = bluetooth_remove,
830 .enable = bluetooth_enable,
831 .disable = bluetooth_disable,
835 static guint added_watch;
836 static guint removed_watch;
837 static guint adapter_watch;
839 static int bluetooth_init(void)
843 connection = connman_dbus_get_connection();
844 if (connection == NULL)
847 watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE,
848 bluetooth_connect, bluetooth_disconnect, NULL, NULL);
850 added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
851 BLUEZ_MANAGER_INTERFACE,
852 ADAPTER_ADDED, adapter_added,
855 removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
856 BLUEZ_MANAGER_INTERFACE,
857 ADAPTER_REMOVED, adapter_removed,
860 adapter_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
861 BLUEZ_MANAGER_INTERFACE,
862 PROPERTY_CHANGED, adapter_changed,
865 if (watch == 0 || added_watch == 0 || removed_watch == 0
866 || adapter_watch == 0) {
871 err = connman_network_driver_register(&pan_driver);
875 err = connman_device_driver_register(&bluetooth_driver);
877 connman_network_driver_unregister(&pan_driver);
884 g_dbus_remove_watch(connection, watch);
885 g_dbus_remove_watch(connection, added_watch);
886 g_dbus_remove_watch(connection, removed_watch);
887 g_dbus_remove_watch(connection, adapter_watch);
889 dbus_connection_unref(connection);
894 static void bluetooth_exit(void)
896 g_dbus_remove_watch(connection, watch);
897 g_dbus_remove_watch(connection, added_watch);
898 g_dbus_remove_watch(connection, removed_watch);
899 g_dbus_remove_watch(connection, adapter_watch);
901 bluetooth_disconnect(connection, NULL);
903 connman_device_driver_unregister(&bluetooth_driver);
904 connman_network_driver_unregister(&pan_driver);
906 dbus_connection_unref(connection);
909 CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
910 CONNMAN_PLUGIN_PRIORITY_DEFAULT, bluetooth_init, bluetooth_exit)