5 * Copyright (C) 2013 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
29 #define CONNMAN_API_SUBJECT_TO_CHANGE
30 #include <connman/plugin.h>
31 #include <connman/dbus.h>
32 #include <connman/technology.h>
33 #include <connman/device.h>
34 #include <connman/inet.h>
37 #define BLUEZ_SERVICE "org.bluez"
38 #define BLUEZ_PATH "/org/bluez"
39 #define BLUETOOTH_PAN_PANU "00001115-0000-1000-8000-00805f9b34fb"
40 #define BLUETOOTH_PAN_NAP "00001116-0000-1000-8000-00805f9b34fb"
41 #define BLUETOOTH_PAN_GN "00001117-0000-1000-8000-00805f9b34fb"
43 #define BLUETOOTH_ADDR_LEN 6
45 static DBusConnection *connection;
46 static GDBusClient *client;
47 static GHashTable *devices;
48 static GHashTable *networks;
49 static bool bluetooth_tethering;
51 struct bluetooth_pan {
52 struct connman_network *network;
53 GDBusProxy *btdevice_proxy;
54 GDBusProxy *btnetwork_proxy;
58 static void address2ident(const char *address, char *ident)
62 for (i = 0; i < BLUETOOTH_ADDR_LEN; i++) {
63 ident[i * 2] = address[i * 3];
64 ident[i * 2 + 1] = address[i * 3 + 1];
66 ident[BLUETOOTH_ADDR_LEN * 2] = '\0';
69 static const char *proxy_get_string(GDBusProxy *proxy, const char *property)
74 if (!g_dbus_proxy_get_property(proxy, property, &iter))
76 dbus_message_iter_get_basic(&iter, &str);
80 static bool proxy_get_bool(GDBusProxy *proxy, const char *property)
85 if (!g_dbus_proxy_get_property(proxy, property, &iter))
87 dbus_message_iter_get_basic(&iter, &value);
91 static const char *proxy_get_role(GDBusProxy *proxy)
93 DBusMessageIter iter, value;
94 const char *pref = NULL;
99 if (!g_dbus_proxy_get_property(proxy, "UUIDs", &iter))
102 dbus_message_iter_recurse(&iter, &value);
103 while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
106 dbus_message_iter_get_basic(&value, &uuid);
108 * If a device offers more than one role, we prefer NAP,
109 * then GN, then PANU.
111 if (!strcmp(uuid, BLUETOOTH_PAN_NAP))
113 if (!strcmp(uuid, BLUETOOTH_PAN_GN))
115 if (!strcmp(uuid, BLUETOOTH_PAN_PANU) && !pref)
118 dbus_message_iter_next(&value);
124 static int bluetooth_pan_probe(struct connman_network *network)
129 DBG("network %p", network);
131 g_hash_table_iter_init(&iter, networks);
133 while (g_hash_table_iter_next(&iter, &key, &value)) {
134 struct bluetooth_pan *pan = value;
136 if (network == pan->network)
143 static void pan_remove_nap(struct bluetooth_pan *pan)
145 struct connman_device *device;
146 struct connman_network *network = pan->network;
148 DBG("network %p pan %p", pan->network, pan);
154 connman_network_set_data(network, NULL);
156 device = connman_network_get_device(network);
158 connman_device_remove_network(device, network);
160 connman_network_unref(network);
163 static void bluetooth_pan_remove(struct connman_network *network)
165 struct bluetooth_pan *pan = connman_network_get_data(network);
167 DBG("network %p pan %p", network, pan);
169 connman_network_set_data(network, NULL);
175 static bool pan_connect(struct bluetooth_pan *pan,
181 if (!proxy_get_bool(pan->btnetwork_proxy, "Connected"))
183 iface = proxy_get_string(pan->btnetwork_proxy, "Interface");
189 index = connman_inet_ifindex(iface);
191 DBG("network %p invalid index %d", pan->network, index);
195 connman_network_set_index(pan->network, index);
196 connman_network_set_connected(pan->network, true);
201 static void pan_connect_cb(DBusMessage *message, void *user_data)
203 const char *path = user_data;
204 const char *iface = NULL;
205 struct bluetooth_pan *pan;
206 DBusMessageIter iter;
208 pan = g_hash_table_lookup(networks, path);
210 DBG("network already removed");
214 if (dbus_message_get_type(message) == DBUS_MESSAGE_TYPE_ERROR) {
215 const char *dbus_error = dbus_message_get_error_name(message);
217 DBG("network %p %s", pan->network, dbus_error);
219 if (strcmp(dbus_error,
220 "org.bluez.Error.AlreadyConnected") != 0) {
221 connman_network_set_error(pan->network,
222 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
226 if (dbus_message_iter_init(message, &iter) &&
227 dbus_message_iter_get_arg_type(&iter) ==
229 dbus_message_iter_get_basic(&iter, &iface);
232 DBG("network %p interface %s", pan->network, iface);
234 pan_connect(pan, iface);
237 static void pan_connect_append(DBusMessageIter *iter,
240 const char *path = user_data;
241 struct bluetooth_pan *pan;
243 pan = g_hash_table_lookup(networks, path);
244 dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &pan->pan_role);
247 static int bluetooth_pan_connect(struct connman_network *network)
249 struct bluetooth_pan *pan = connman_network_get_data(network);
252 DBG("network %p", network);
257 path = g_dbus_proxy_get_path(pan->btnetwork_proxy);
259 if (!g_dbus_proxy_method_call(pan->btnetwork_proxy, "Connect",
260 pan_connect_append, pan_connect_cb,
261 g_strdup(path), g_free))
264 connman_network_set_associating(pan->network, true);
269 static void pan_disconnect_cb(DBusMessage *message, void *user_data)
271 const char *path = user_data;
272 struct bluetooth_pan *pan;
274 pan = g_hash_table_lookup(networks, path);
276 DBG("network already removed");
280 if (dbus_message_get_type(message) == DBUS_MESSAGE_TYPE_ERROR) {
281 const char *dbus_error = dbus_message_get_error_name(message);
283 DBG("network %p %s", pan->network, dbus_error);
286 DBG("network %p", pan->network);
288 connman_network_set_connected(pan->network, false);
291 static int bluetooth_pan_disconnect(struct connman_network *network)
293 struct bluetooth_pan *pan = connman_network_get_data(network);
296 DBG("network %p", network);
301 path = g_dbus_proxy_get_path(pan->btnetwork_proxy);
303 if (!g_dbus_proxy_method_call(pan->btnetwork_proxy, "Disconnect",
304 NULL, pan_disconnect_cb, g_strdup(path), g_free))
310 static void btnetwork_property_change(GDBusProxy *proxy, const char *name,
311 DBusMessageIter *iter, void *user_data)
313 struct bluetooth_pan *pan;
314 dbus_bool_t connected;
315 bool proxy_connected, network_connected;
317 if (strcmp(name, "Connected") != 0)
320 pan = g_hash_table_lookup(networks, g_dbus_proxy_get_path(proxy));
321 if (!pan || !pan->network)
324 dbus_message_iter_get_basic(iter, &connected);
325 proxy_connected = connected;
327 network_connected = connman_network_get_connected(pan->network);
329 DBG("network %p network connected %d proxy connected %d",
330 pan->network, network_connected, proxy_connected);
332 if (network_connected != proxy_connected)
333 connman_network_set_connected(pan->network, proxy_connected);
336 static void pan_create_nap(struct bluetooth_pan *pan)
338 struct connman_device *device;
341 role = proxy_get_role(pan->btdevice_proxy);
347 device = g_hash_table_lookup(devices,
348 proxy_get_string(pan->btdevice_proxy, "Adapter"));
350 if (!device || !connman_device_get_powered(device))
355 char ident[BLUETOOTH_ADDR_LEN * 2 + 1];
356 const char *name, *path;
358 address = proxy_get_string(pan->btdevice_proxy, "Address");
360 connman_warn("Bluetooth device address missing");
364 address2ident(address, ident);
366 pan->network = connman_network_create(ident,
367 CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN);
369 name = proxy_get_string(pan->btdevice_proxy, "Alias");
370 path = g_dbus_proxy_get_path(pan->btnetwork_proxy);
372 DBG("network %p %s %s", pan->network, path, name);
375 connman_warn("Bluetooth network %s creation failed",
380 connman_network_set_data(pan->network, pan);
381 connman_network_set_name(pan->network, name);
382 connman_network_set_group(pan->network, ident);
385 pan->pan_role = role;
386 connman_device_add_network(device, pan->network);
388 if (pan_connect(pan, NULL))
389 DBG("network %p already connected", pan->network);
392 static void btdevice_property_change(GDBusProxy *proxy, const char *name,
393 DBusMessageIter *iter, void *user_data)
395 struct bluetooth_pan *pan;
396 const char *old_role = NULL;
397 const char *new_role;
399 if (strcmp(name, "UUIDs"))
402 pan = g_hash_table_lookup(networks, g_dbus_proxy_get_path(proxy));
407 connman_network_get_device(pan->network))
408 old_role = pan->pan_role;
409 new_role = proxy_get_role(pan->btdevice_proxy);
411 DBG("network %p network role %s proxy role %s", pan->network, old_role,
414 if (old_role && new_role && !strcmp(old_role, new_role))
420 static void pan_free(gpointer data)
422 struct bluetooth_pan *pan = data;
424 if (pan->btnetwork_proxy) {
425 g_dbus_proxy_unref(pan->btnetwork_proxy);
426 pan->btnetwork_proxy = NULL;
429 if (pan->btdevice_proxy) {
430 g_dbus_proxy_unref(pan->btdevice_proxy);
431 pan->btdevice_proxy = NULL;
439 static void pan_create(GDBusProxy *network_proxy)
441 const char *path = g_dbus_proxy_get_path(network_proxy);
442 struct bluetooth_pan *pan;
444 pan = g_try_new0(struct bluetooth_pan, 1);
447 connman_error("Out of memory creating PAN NAP");
451 g_hash_table_replace(networks, g_strdup(path), pan);
453 pan->btnetwork_proxy = g_dbus_proxy_ref(network_proxy);
454 pan->btdevice_proxy = g_dbus_proxy_new(client, path,
455 "org.bluez.Device1");
457 if (!pan->btdevice_proxy) {
458 connman_error("Cannot create BT PAN watcher %s", path);
459 g_hash_table_remove(networks, path);
463 g_dbus_proxy_set_property_watch(pan->btnetwork_proxy,
464 btnetwork_property_change, NULL);
466 g_dbus_proxy_set_property_watch(pan->btdevice_proxy,
467 btdevice_property_change, NULL);
469 DBG("pan %p %s role %s", pan, path, proxy_get_role(pan->btdevice_proxy));
474 static struct connman_network_driver network_driver = {
476 .type = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN,
477 .probe = bluetooth_pan_probe,
478 .remove = bluetooth_pan_remove,
479 .connect = bluetooth_pan_connect,
480 .disconnect = bluetooth_pan_disconnect,
483 static void enable_device(struct connman_device *device, const char *path)
488 DBG("device %p %s", device, path);
489 connman_device_set_powered(device, true);
491 g_hash_table_iter_init(&iter, networks);
492 while (g_hash_table_iter_next(&iter, &key, &value)) {
493 struct bluetooth_pan *pan = value;
495 if (g_strcmp0(proxy_get_string(pan->btdevice_proxy, "Adapter"),
498 DBG("enable network %p", pan->network);
504 static void device_enable_cb(const DBusError *error, void *user_data)
506 char *path = user_data;
507 struct connman_device *device;
509 device = g_hash_table_lookup(devices, path);
511 DBG("device already removed");
515 if (dbus_error_is_set(error)) {
516 connman_warn("Bluetooth device %s not enabled %s",
517 path, error->message);
521 enable_device(device, path);
526 static int bluetooth_device_enable(struct connman_device *device)
528 GDBusProxy *proxy = connman_device_get_data(device);
529 dbus_bool_t device_powered = TRUE;
535 path = g_dbus_proxy_get_path(proxy);
537 if (proxy_get_bool(proxy, "Powered")) {
538 DBG("already enabled %p %s", device, path);
542 DBG("device %p %s", device, path);
544 g_dbus_proxy_set_property_basic(proxy, "Powered",
545 DBUS_TYPE_BOOLEAN, &device_powered,
546 device_enable_cb, g_strdup(path), NULL);
551 static void disable_device(struct connman_device *device, const char *path)
556 DBG("device %p %s", device, path);
557 connman_device_set_powered(device, false);
559 g_hash_table_iter_init(&iter, networks);
560 while (g_hash_table_iter_next(&iter, &key, &value)) {
561 struct bluetooth_pan *pan = value;
563 if (pan->network && connman_network_get_device(pan->network)
565 DBG("disable network %p", pan->network);
566 connman_device_remove_network(device, pan->network);
571 static void device_disable_cb(const DBusError *error, void *user_data)
573 char *path = user_data;
574 struct connman_device *device;
576 device = g_hash_table_lookup(devices, path);
578 DBG("device already removed");
582 if (dbus_error_is_set(error)) {
583 connman_warn("Bluetooth device %s not disabled: %s",
584 path, error->message);
588 disable_device(device, path);
594 static int bluetooth_device_disable(struct connman_device *device)
596 GDBusProxy *proxy = connman_device_get_data(device);
597 dbus_bool_t device_powered = FALSE;
603 path = g_dbus_proxy_get_path(proxy);
605 if (!proxy_get_bool(proxy, "Powered")) {
606 DBG("already disabled %p %s", device, path);
610 DBG("device %p %s", device, path);
612 g_dbus_proxy_set_property_basic(proxy, "Powered",
613 DBUS_TYPE_BOOLEAN, &device_powered,
614 device_disable_cb, g_strdup(path), NULL);
619 static void adapter_property_change(GDBusProxy *proxy, const char *name,
620 DBusMessageIter *iter, void *user_data)
622 struct connman_device *device;
624 bool adapter_powered, device_powered;
626 if (strcmp(name, "Powered") != 0)
629 path = g_dbus_proxy_get_path(proxy);
630 device = g_hash_table_lookup(devices, path);
632 adapter_powered = proxy_get_bool(proxy, "Powered");
633 device_powered = connman_device_get_powered(device);
635 DBG("device %p %s device powered %d adapter powered %d", device, path,
636 device_powered, adapter_powered);
638 if (device_powered != adapter_powered) {
640 enable_device(device, path);
642 disable_device(device, path);
646 static void device_free(gpointer data)
648 struct connman_device *device = data;
649 GDBusProxy *proxy = connman_device_get_data(device);
651 connman_device_set_data(device, NULL);
653 g_dbus_proxy_unref(proxy);
655 connman_device_unregister(device);
656 connman_device_unref(device);
659 struct tethering_info {
660 struct connman_technology *technology;
665 static void tethering_free(void *user_data)
667 struct tethering_info *tethering = user_data;
669 g_free(tethering->bridge);
673 static void tethering_create_cb(DBusMessage *message, void *user_data)
675 struct tethering_info *tethering = user_data;
677 if (dbus_message_get_type(message) == DBUS_MESSAGE_TYPE_ERROR) {
678 const char *dbus_error = dbus_message_get_error_name(message);
680 DBG("%s tethering failed: %s",
681 tethering->enable ? "enable" : "disable",
686 DBG("bridge %s %s", tethering->bridge, tethering->enable ?
687 "enabled": "disabled");
689 if (tethering->technology)
690 connman_technology_tethering_notify(tethering->technology,
694 static void tethering_append(DBusMessageIter *iter, void *user_data)
696 struct tethering_info *tethering = user_data;
697 const char *nap = "nap";
699 dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &nap);
700 if (tethering->enable)
701 dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING,
705 static bool tethering_create(const char *path,
706 struct connman_technology *technology, const char *bridge,
709 struct tethering_info *tethering = g_new0(struct tethering_info, 1);
714 DBG("path %s bridge %s", path, bridge);
719 proxy = g_dbus_proxy_new(client, path, "org.bluez.NetworkServer1");
723 tethering->technology = technology;
724 tethering->bridge = g_strdup(bridge);
725 tethering->enable = enabled;
727 if (tethering->enable)
730 method = "Unregister";
732 result = g_dbus_proxy_method_call(proxy, method, tethering_append,
733 tethering_create_cb, tethering, tethering_free);
735 g_dbus_proxy_unref(proxy);
740 static void device_create(GDBusProxy *proxy)
742 struct connman_device *device = NULL;
743 const char *path = g_dbus_proxy_get_path(proxy);
745 char ident[BLUETOOTH_ADDR_LEN * 2 + 1];
748 address = proxy_get_string(proxy, "Address");
752 address2ident(address, ident);
754 device = connman_device_create("bluetooth",
755 CONNMAN_DEVICE_TYPE_BLUETOOTH);
759 connman_device_set_data(device, g_dbus_proxy_ref(proxy));
760 connman_device_set_ident(device, ident);
762 g_hash_table_replace(devices, g_strdup(path), device);
764 DBG("device %p %s device powered %d adapter powered %d", device,
765 path, connman_device_get_powered(device),
766 proxy_get_bool(proxy, "Powered"));
768 if (connman_device_register(device) < 0) {
769 g_hash_table_remove(devices, device);
773 g_dbus_proxy_set_property_watch(proxy, adapter_property_change, NULL);
775 powered = proxy_get_bool(proxy, "Powered");
776 connman_device_set_powered(device, powered);
778 if (proxy_get_role(proxy) && !bluetooth_tethering)
779 tethering_create(path, NULL, NULL, false);
782 static void object_added(GDBusProxy *proxy, void *user_data)
784 const char *interface;
786 interface = g_dbus_proxy_get_interface(proxy);
788 connman_warn("Interface or proxy missing when adding "
793 if (strcmp(interface, "org.bluez.Adapter1") == 0) {
794 DBG("%s %s", interface, g_dbus_proxy_get_path(proxy));
795 device_create(proxy);
799 if (strcmp(interface, "org.bluez.Network1") == 0) {
800 DBG("%s %s", interface, g_dbus_proxy_get_path(proxy));
806 static void object_removed(GDBusProxy *proxy, void *user_data)
808 const char *interface, *path;
810 interface = g_dbus_proxy_get_interface(proxy);
812 connman_warn("Interface or proxy missing when removing "
817 if (strcmp(interface, "org.bluez.Adapter1") == 0) {
818 path = g_dbus_proxy_get_path(proxy);
819 DBG("%s %s", interface, path);
821 g_hash_table_remove(devices, path);
824 if (strcmp(interface, "org.bluez.Network1") == 0) {
825 path = g_dbus_proxy_get_path(proxy);
826 DBG("%s %s", interface, path);
828 g_hash_table_remove(networks, path);
833 static int bluetooth_device_probe(struct connman_device *device)
838 g_hash_table_iter_init(&iter, devices);
840 while (g_hash_table_iter_next(&iter, &key, &value)) {
841 struct connman_device *known = value;
850 static void bluetooth_device_remove(struct connman_device *device)
855 static struct connman_device_driver device_driver = {
857 .type = CONNMAN_DEVICE_TYPE_BLUETOOTH,
858 .probe = bluetooth_device_probe,
859 .remove = bluetooth_device_remove,
860 .enable = bluetooth_device_enable,
861 .disable = bluetooth_device_disable,
864 static int bluetooth_tech_probe(struct connman_technology *technology)
869 static void bluetooth_tech_remove(struct connman_technology *technology)
874 static int bluetooth_tech_set_tethering(struct connman_technology *technology,
875 const char *identifier, const char *passphrase,
876 const char *bridge, bool enabled)
878 GHashTableIter hash_iter;
882 bluetooth_tethering = enabled;
884 g_hash_table_iter_init(&hash_iter, devices);
886 while (g_hash_table_iter_next(&hash_iter, &key, &value)) {
887 const char *path = key;
888 struct connman_device *device = value;
890 DBG("device %p", device);
892 if (tethering_create(path, technology, bridge, enabled)
897 DBG("%s %d device(s)", enabled ? "enabled" : "disabled", i);
905 static struct connman_technology_driver tech_driver = {
907 .type = CONNMAN_SERVICE_TYPE_BLUETOOTH,
908 .probe = bluetooth_tech_probe,
909 .remove = bluetooth_tech_remove,
910 .set_tethering = bluetooth_tech_set_tethering,
913 static int bluetooth_init(void)
915 connection = connman_dbus_get_connection();
919 if (connman_technology_driver_register(&tech_driver) < 0) {
920 connman_warn("Failed to initialize technology for Bluez 5");
924 devices = g_hash_table_new_full(g_str_hash, g_str_equal, g_free,
927 if (connman_device_driver_register(&device_driver) < 0) {
928 connman_warn("Failed to initialize device driver for "
930 connman_technology_driver_unregister(&tech_driver);
934 if (connman_network_driver_register(&network_driver) < 0) {
935 connman_technology_driver_unregister(&tech_driver);
936 connman_device_driver_unregister(&device_driver);
940 networks = g_hash_table_new_full(g_str_hash, g_str_equal, g_free,
943 client = g_dbus_client_new(connection, BLUEZ_SERVICE, BLUEZ_PATH);
945 connman_warn("Failed to initialize D-Bus client for "
950 g_dbus_client_set_proxy_handlers(client, object_added, object_removed,
957 g_hash_table_destroy(networks);
960 g_hash_table_destroy(devices);
963 g_dbus_client_unref(client);
966 dbus_connection_unref(connection);
971 static void bluetooth_exit(void)
974 * We unset the disabling of the Bluetooth device when shutting down
975 * so that non-PAN BT connections are not affected.
977 device_driver.disable = NULL;
979 g_dbus_client_unref(client);
981 connman_network_driver_unregister(&network_driver);
982 g_hash_table_destroy(networks);
984 connman_device_driver_unregister(&device_driver);
985 g_hash_table_destroy(devices);
987 connman_technology_driver_unregister(&tech_driver);
988 dbus_connection_unref(connection);
991 CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
992 CONNMAN_PLUGIN_PRIORITY_DEFAULT, bluetooth_init, bluetooth_exit)