plugins/bluetooth.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2010  Intel Corporation. All rights reserved.
   6  *
   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.
  10  *
  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.
  15  *
  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
  19  *
  20  */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <stdio.h>
  27 #include <errno.h>
  28 #include <stdlib.h>
  29 #include <string.h>
  30 #include <netinet/ether.h>
  31
  32 #include <gdbus.h>
  33
  34 #define CONNMAN_API_SUBJECT_TO_CHANGE
  35 #include <connman/plugin.h>
  36 #include <connman/technology.h>
  37 #include <connman/device.h>
  38 #include <connman/inet.h>
  39 #include <connman/dbus.h>
  40 #include <connman/log.h>
  41
  42 #define BLUEZ_SERVICE                   "org.bluez"
  43 #define BLUEZ_MANAGER_INTERFACE         BLUEZ_SERVICE ".Manager"
  44 #define BLUEZ_ADAPTER_INTERFACE         BLUEZ_SERVICE ".Adapter"
  45 #define BLUEZ_DEVICE_INTERFACE          BLUEZ_SERVICE ".Device"
  46 #define BLUEZ_NETWORK_INTERFACE         BLUEZ_SERVICE ".Network"
  47 #define BLUEZ_NETWORK_SERVER            BLUEZ_SERVICE ".NetworkServer"
  48
  49 #define LIST_ADAPTERS                   "ListAdapters"
  50 #define ADAPTER_ADDED                   "AdapterAdded"
  51 #define ADAPTER_REMOVED                 "AdapterRemoved"
  52 #define DEVICE_REMOVED                  "DeviceRemoved"
  53
  54 #define PROPERTY_CHANGED                "PropertyChanged"
  55 #define GET_PROPERTIES                  "GetProperties"
  56 #define SET_PROPERTY                    "SetProperty"
  57
  58 #define CONNECT                         "Connect"
  59 #define DISCONNECT                      "Disconnect"
  60
  61 #define REGISTER                        "Register"
  62 #define UNREGISTER                      "Unregister"
  63
  64 #define UUID_NAP        "00001116-0000-1000-8000-00805f9b34fb"
  65
  66 #define TIMEOUT 5000
  67
  68 static DBusConnection *connection;
  69
  70 static GHashTable *bluetooth_devices = NULL;
  71 static GHashTable *bluetooth_networks = NULL;
  72
  73 static int pan_probe(struct connman_network *network)
  74 {
  75         DBG("network %p", network);
  76
  77         return 0;
  78 }
  79
  80 static void pan_remove(struct connman_network *network)
  81 {
  82         DBG("network %p", network);
  83 }
  84
  85 static void connect_reply(DBusPendingCall *call, void *user_data)
  86 {
  87         struct connman_network *network = user_data;
  88         DBusMessage *reply;
  89         DBusError error;
  90         const char *interface = NULL;
  91         int index;
  92
  93         DBG("network %p", network);
  94
  95         reply = dbus_pending_call_steal_reply(call);
  96
  97         dbus_error_init(&error);
  98
  99         if (dbus_set_error_from_message(&error, reply) == TRUE) {
 100                 connman_error("%s", error.message);
 101                 dbus_error_free(&error);
 102
 103                 goto err;
 104         }
 105
 106         if (dbus_message_get_args(reply, &error,
 107                                         DBUS_TYPE_STRING, &interface,
 108                                                 DBUS_TYPE_INVALID) == FALSE) {
 109                 if (dbus_error_is_set(&error) == TRUE) {
 110                         connman_error("%s", error.message);
 111                         dbus_error_free(&error);
 112                 } else
 113                         connman_error("Wrong arguments for connect");
 114                 goto err;
 115         }
 116
 117         if (interface == NULL)
 118                 goto err;
 119
 120         DBG("interface %s", interface);
 121
 122         index = connman_inet_ifindex(interface);
 123
 124         connman_network_set_index(network, index);
 125
 126         connman_network_set_connected(network, TRUE);
 127
 128         dbus_message_unref(reply);
 129
 130         dbus_pending_call_unref(call);
 131
 132         return;
 133 err:
 134
 135         connman_network_set_connected(network, FALSE);
 136
 137         dbus_message_unref(reply);
 138
 139         dbus_pending_call_unref(call);
 140 }
 141
 142 static int pan_connect(struct connman_network *network)
 143 {
 144         const char *path = connman_network_get_string(network, "Path");
 145         const char *uuid = "nap";
 146         DBusMessage *message;
 147         DBusPendingCall *call;
 148
 149         DBG("network %p", network);
 150
 151         if (path == NULL)
 152                 return -EINVAL;
 153
 154         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
 155                                         BLUEZ_NETWORK_INTERFACE, CONNECT);
 156         if (message == NULL)
 157                 return -ENOMEM;
 158
 159         dbus_message_set_auto_start(message, FALSE);
 160
 161         dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid,
 162                                                         DBUS_TYPE_INVALID);
 163
 164         if (dbus_connection_send_with_reply(connection, message,
 165                                         &call, TIMEOUT * 10) == FALSE) {
 166                 connman_error("Failed to connect service");
 167                 dbus_message_unref(message);
 168                 return -EINVAL;
 169         }
 170
 171         if (call == NULL) {
 172                 connman_error("D-Bus connection not available");
 173                 dbus_message_unref(message);
 174                 return -EINVAL;
 175         }
 176
 177         dbus_pending_call_set_notify(call, connect_reply, network, NULL);
 178
 179         dbus_message_unref(message);
 180
 181         return -EINPROGRESS;
 182 }
 183
 184 static void disconnect_reply(DBusPendingCall *call, void *user_data)
 185 {
 186         struct connman_network *network = user_data;
 187         DBusMessage *reply;
 188         DBusError error;
 189
 190         DBG("network %p", network);
 191
 192         reply = dbus_pending_call_steal_reply(call);
 193
 194         dbus_error_init(&error);
 195
 196         if (dbus_set_error_from_message(&error, reply) == TRUE) {
 197                 connman_error("%s", error.message);
 198                 dbus_error_free(&error);
 199                 goto done;
 200         }
 201
 202         if (dbus_message_get_args(reply, &error, DBUS_TYPE_INVALID) == FALSE) {
 203                 if (dbus_error_is_set(&error) == TRUE) {
 204                         connman_error("%s", error.message);
 205                         dbus_error_free(&error);
 206                 } else
 207                         connman_error("Wrong arguments for disconnect");
 208                 goto done;
 209         }
 210
 211         connman_network_set_connected(network, FALSE);
 212
 213 done:
 214         dbus_message_unref(reply);
 215
 216         dbus_pending_call_unref(call);
 217
 218         connman_network_unref(network);
 219 }
 220
 221 static int pan_disconnect(struct connman_network *network)
 222 {
 223         const char *path = connman_network_get_string(network, "Path");
 224         DBusMessage *message;
 225         DBusPendingCall *call;
 226
 227         DBG("network %p", network);
 228
 229         if (path == NULL)
 230                 return -EINVAL;
 231
 232         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
 233                                         BLUEZ_NETWORK_INTERFACE, DISCONNECT);
 234         if (message == NULL)
 235                 return -ENOMEM;
 236
 237         dbus_message_set_auto_start(message, FALSE);
 238
 239         dbus_message_append_args(message, DBUS_TYPE_INVALID);
 240
 241         if (dbus_connection_send_with_reply(connection, message,
 242                                                 &call, TIMEOUT) == FALSE) {
 243                 connman_error("Failed to disconnect service");
 244                 dbus_message_unref(message);
 245                 return -EINVAL;
 246         }
 247
 248         if (call == NULL) {
 249                 connman_error("D-Bus connection not available");
 250                 dbus_message_unref(message);
 251                 return -EINVAL;
 252         }
 253
 254         connman_network_ref(network);
 255
 256         connman_network_set_associating(network, FALSE);
 257
 258         dbus_pending_call_set_notify(call, disconnect_reply, network, NULL);
 259
 260         dbus_message_unref(message);
 261
 262         return 0;
 263 }
 264
 265 static struct connman_network_driver pan_driver = {
 266         .name           = "bluetooth-pan",
 267         .type           = CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN,
 268         .probe          = pan_probe,
 269         .remove         = pan_remove,
 270         .connect        = pan_connect,
 271         .disconnect     = pan_disconnect,
 272 };
 273
 274 static gboolean network_changed(DBusConnection *connection,
 275                                 DBusMessage *message, void *user_data)
 276 {
 277         const char *path = dbus_message_get_path(message);
 278         struct connman_network *network;
 279         DBusMessageIter iter, value;
 280         const char *key;
 281
 282         DBG("path %s", path);
 283
 284         network = g_hash_table_lookup(bluetooth_networks, path);
 285         if (network == NULL)
 286                 return TRUE;
 287
 288         if (dbus_message_iter_init(message, &iter) == FALSE)
 289                 return TRUE;
 290
 291         dbus_message_iter_get_basic(&iter, &key);
 292
 293         dbus_message_iter_next(&iter);
 294         dbus_message_iter_recurse(&iter, &value);
 295
 296         if (g_str_equal(key, "Connected") == TRUE) {
 297                 dbus_bool_t connected;
 298
 299                 dbus_message_iter_get_basic(&value, &connected);
 300
 301                 if (connected == TRUE)
 302                         return TRUE;
 303
 304                 connman_network_set_associating(network, FALSE);
 305                 connman_network_set_connected(network, FALSE);
 306         }
 307
 308         return TRUE;
 309 }
 310
 311 static void extract_properties(DBusMessage *reply, const char **parent,
 312                                                 const char **address,
 313                                                 const char **name,
 314                                                 const char **alias,
 315                                                 dbus_bool_t *powered,
 316                                                 dbus_bool_t *scanning,
 317                                                 DBusMessageIter *uuids,
 318                                                 DBusMessageIter *networks)
 319 {
 320         DBusMessageIter array, dict;
 321
 322         if (dbus_message_iter_init(reply, &array) == FALSE)
 323                 return;
 324
 325         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 326                 return;
 327
 328         dbus_message_iter_recurse(&array, &dict);
 329
 330         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 331                 DBusMessageIter entry, value;
 332                 const char *key;
 333
 334                 dbus_message_iter_recurse(&dict, &entry);
 335                 dbus_message_iter_get_basic(&entry, &key);
 336
 337                 dbus_message_iter_next(&entry);
 338                 dbus_message_iter_recurse(&entry, &value);
 339
 340                 if (g_str_equal(key, "Adapter") == TRUE) {
 341                         if (parent != NULL)
 342                                 dbus_message_iter_get_basic(&value, parent);
 343                 } else if (g_str_equal(key, "Address") == TRUE) {
 344                         if (address != NULL)
 345                                 dbus_message_iter_get_basic(&value, address);
 346                 } else if (g_str_equal(key, "Name") == TRUE) {
 347                         if (name != NULL)
 348                                 dbus_message_iter_get_basic(&value, name);
 349                 } else if (g_str_equal(key, "Alias") == TRUE) {
 350                         if (alias != NULL)
 351                                 dbus_message_iter_get_basic(&value, alias);
 352                 } else if (g_str_equal(key, "Powered") == TRUE) {
 353                         if (powered != NULL)
 354                                 dbus_message_iter_get_basic(&value, powered);
 355                 } else if (g_str_equal(key, "Discovering") == TRUE) {
 356                         if (scanning != NULL)
 357                                 dbus_message_iter_get_basic(&value, scanning);
 358                 } else if (g_str_equal(key, "Devices") == TRUE) {
 359                         if (networks != NULL)
 360                                 memcpy(networks, &value, sizeof(value));
 361                 } else if (g_str_equal(key, "UUIDs") == TRUE) {
 362                         if (uuids != NULL)
 363                                 memcpy(uuids, &value, sizeof(value));
 364                 }
 365
 366                 dbus_message_iter_next(&dict);
 367         }
 368 }
 369
 370 static dbus_bool_t has_pan(DBusMessageIter *array)
 371 {
 372         DBusMessageIter value;
 373
 374         if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
 375                 return FALSE;
 376
 377         dbus_message_iter_recurse(array, &value);
 378
 379         while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) {
 380                 const char *uuid;
 381
 382                 dbus_message_iter_get_basic(&value, &uuid);
 383
 384                 if (g_strcmp0(uuid, UUID_NAP) == 0)
 385                         return TRUE;
 386
 387                 dbus_message_iter_next(&value);
 388         }
 389
 390         return FALSE;
 391 }
 392
 393 static void network_properties_reply(DBusPendingCall *call, void *user_data)
 394 {
 395         char *path = user_data;
 396         struct connman_device *device;
 397         struct connman_network *network;
 398         DBusMessage *reply;
 399         DBusMessageIter uuids;
 400         const char *parent = NULL, *address = NULL, *name = NULL;
 401         struct ether_addr addr;
 402         char ident[13];
 403
 404         reply = dbus_pending_call_steal_reply(call);
 405
 406         extract_properties(reply, &parent, &address, NULL, &name,
 407                                                 NULL, NULL, &uuids, NULL);
 408
 409         if (parent == NULL)
 410                 goto done;
 411
 412         device = g_hash_table_lookup(bluetooth_devices, parent);
 413         if (device == NULL)
 414                 goto done;
 415
 416         if (address == NULL)
 417                 goto done;
 418
 419         ether_aton_r(address, &addr);
 420
 421         snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
 422                                                 addr.ether_addr_octet[0],
 423                                                 addr.ether_addr_octet[1],
 424                                                 addr.ether_addr_octet[2],
 425                                                 addr.ether_addr_octet[3],
 426                                                 addr.ether_addr_octet[4],
 427                                                 addr.ether_addr_octet[5]);
 428
 429         if (has_pan(&uuids) == FALSE)
 430                 goto done;
 431
 432         network = connman_device_get_network(device, ident);
 433         if (network != NULL)
 434                 goto done;
 435
 436         network = connman_network_create(ident,
 437                                         CONNMAN_NETWORK_TYPE_BLUETOOTH_PAN);
 438         if (network == NULL)
 439                 goto done;
 440
 441         connman_network_set_string(network, "Path", path);
 442
 443         connman_network_set_name(network, name);
 444
 445         connman_device_add_network(device, network);
 446
 447         connman_network_set_group(network, ident);
 448
 449         g_hash_table_insert(bluetooth_networks, g_strdup(path), network);
 450
 451 done:
 452         dbus_message_unref(reply);
 453
 454         dbus_pending_call_unref(call);
 455 }
 456
 457 static void add_network(struct connman_device *device, const char *path)
 458 {
 459         DBusMessage *message;
 460         DBusPendingCall *call;
 461
 462         DBG("path %s", path);
 463
 464         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
 465                                 BLUEZ_DEVICE_INTERFACE, GET_PROPERTIES);
 466         if (message == NULL)
 467                 return;
 468
 469         dbus_message_set_auto_start(message, FALSE);
 470
 471         if (dbus_connection_send_with_reply(connection, message,
 472                                                 &call, TIMEOUT) == FALSE) {
 473                 connman_error("Failed to get network properties for %s", path);
 474                 goto done;
 475         }
 476
 477         if (call == NULL) {
 478                 connman_error("D-Bus connection not available");
 479                 goto done;
 480         }
 481
 482         dbus_pending_call_set_notify(call, network_properties_reply,
 483                                                 g_strdup(path), g_free);
 484
 485 done:
 486         dbus_message_unref(message);
 487 }
 488
 489 static void check_networks(struct connman_device *device,
 490                                                 DBusMessageIter *array)
 491 {
 492         DBusMessageIter value;
 493
 494         if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
 495                 return;
 496
 497         dbus_message_iter_recurse(array, &value);
 498
 499         while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_OBJECT_PATH) {
 500                 const char *path;
 501
 502                 dbus_message_iter_get_basic(&value, &path);
 503
 504                 add_network(device, path);
 505
 506                 dbus_message_iter_next(&value);
 507         }
 508 }
 509
 510 static gboolean adapter_changed(DBusConnection *connection,
 511                                 DBusMessage *message, void *user_data)
 512 {
 513         const char *path = dbus_message_get_path(message);
 514         struct connman_device *device;
 515         DBusMessageIter iter, value;
 516         const char *key;
 517
 518         DBG("path %s", path);
 519
 520         device = g_hash_table_lookup(bluetooth_devices, path);
 521         if (device == NULL)
 522                 return TRUE;
 523
 524         if (dbus_message_iter_init(message, &iter) == FALSE)
 525                 return TRUE;
 526
 527         dbus_message_iter_get_basic(&iter, &key);
 528
 529         dbus_message_iter_next(&iter);
 530         dbus_message_iter_recurse(&iter, &value);
 531
 532         if (g_str_equal(key, "Powered") == TRUE) {
 533                 dbus_bool_t val;
 534
 535                 dbus_message_iter_get_basic(&value, &val);
 536                 connman_device_set_powered(device, val);
 537         } else if (g_str_equal(key, "Discovering") == TRUE) {
 538                 dbus_bool_t val;
 539
 540                 dbus_message_iter_get_basic(&value, &val);
 541                 connman_device_set_scanning(device, val);
 542         } else if (g_str_equal(key, "Devices") == TRUE) {
 543                 check_networks(device, &value);
 544         }
 545
 546         return TRUE;
 547 }
 548
 549 static gboolean device_removed(DBusConnection *connection,
 550                                 DBusMessage *message, void *user_data)
 551 {
 552         const char *network_path;
 553         struct connman_network *network;
 554         struct connman_device *device;
 555         DBusMessageIter iter;
 556
 557         DBG("");
 558
 559         if (dbus_message_iter_init(message, &iter) == FALSE)
 560                 return TRUE;
 561
 562         dbus_message_iter_get_basic(&iter, &network_path);
 563
 564         network = g_hash_table_lookup(bluetooth_networks, network_path);
 565         if (network == NULL)
 566                 return TRUE;
 567
 568         device = connman_network_get_device(network);
 569         if (device == NULL)
 570                 return TRUE;
 571
 572         g_hash_table_remove(bluetooth_networks, network_path);
 573
 574         return TRUE;
 575 }
 576
 577 static gboolean device_changed(DBusConnection *connection,
 578                                 DBusMessage *message, void *user_data)
 579 {
 580         const char *path = dbus_message_get_path(message);
 581         DBusMessageIter iter, value;
 582         const char *key;
 583
 584         DBG("path %s", path);
 585
 586         if (dbus_message_iter_init(message, &iter) == FALSE)
 587                 return TRUE;
 588
 589         dbus_message_iter_get_basic(&iter, &key);
 590
 591         dbus_message_iter_next(&iter);
 592         dbus_message_iter_recurse(&iter, &value);
 593
 594         DBG("key %s", key);
 595
 596         if (g_str_equal(key, "UUIDs") == TRUE)
 597                 add_network(NULL, path);
 598
 599         return TRUE;
 600 }
 601
 602 static void adapter_properties_reply(DBusPendingCall *call, void *user_data)
 603 {
 604         char *path = user_data;
 605         struct connman_device *device;
 606         DBusMessage *reply;
 607         DBusMessageIter networks;
 608         const char *address = NULL, *name = NULL;
 609         dbus_bool_t powered = FALSE, scanning = FALSE;
 610         struct ether_addr addr;
 611         char ident[13];
 612
 613         DBG("path %s", path);
 614
 615         reply = dbus_pending_call_steal_reply(call);
 616
 617         if (path == NULL)
 618                 goto done;
 619
 620         extract_properties(reply, NULL, &address, &name, NULL,
 621                                         &powered, &scanning, NULL, &networks);
 622
 623         if (address == NULL)
 624                 goto done;
 625
 626         if (g_strcmp0(address, "00:00:00:00:00:00") == 0)
 627                 goto done;
 628
 629         device = g_hash_table_lookup(bluetooth_devices, path);
 630         if (device != NULL)
 631                 goto update;
 632
 633         ether_aton_r(address, &addr);
 634
 635         snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
 636                                                 addr.ether_addr_octet[0],
 637                                                 addr.ether_addr_octet[1],
 638                                                 addr.ether_addr_octet[2],
 639                                                 addr.ether_addr_octet[3],
 640                                                 addr.ether_addr_octet[4],
 641                                                 addr.ether_addr_octet[5]);
 642
 643         device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_BLUETOOTH);
 644         if (device == NULL)
 645                 goto done;
 646
 647         connman_device_set_ident(device, ident);
 648
 649         connman_device_set_string(device, "Path", path);
 650
 651         if (connman_device_register(device) < 0) {
 652                 connman_device_unref(device);
 653                 goto done;
 654         }
 655
 656         g_hash_table_insert(bluetooth_devices, g_strdup(path), device);
 657
 658 update:
 659         connman_device_set_string(device, "Address", address);
 660         connman_device_set_string(device, "Name", name);
 661         connman_device_set_string(device, "Path", path);
 662
 663         connman_device_set_powered(device, powered);
 664         connman_device_set_scanning(device, scanning);
 665
 666         if (powered == TRUE)
 667                 check_networks(device, &networks);
 668
 669 done:
 670         dbus_message_unref(reply);
 671
 672         dbus_pending_call_unref(call);
 673 }
 674
 675 static void add_adapter(DBusConnection *connection, const char *path)
 676 {
 677         DBusMessage *message;
 678         DBusPendingCall *call;
 679
 680         DBG("path %s", path);
 681
 682         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
 683                                 BLUEZ_ADAPTER_INTERFACE, GET_PROPERTIES);
 684         if (message == NULL)
 685                 return;
 686
 687         dbus_message_set_auto_start(message, FALSE);
 688
 689         if (dbus_connection_send_with_reply(connection, message,
 690                                                 &call, TIMEOUT) == FALSE) {
 691                 connman_error("Failed to get adapter properties for %s", path);
 692                 goto done;
 693         }
 694
 695         if (call == NULL) {
 696                 connman_error("D-Bus connection not available");
 697                 goto done;
 698         }
 699
 700         dbus_pending_call_set_notify(call, adapter_properties_reply,
 701                                                 g_strdup(path), g_free);
 702
 703 done:
 704         dbus_message_unref(message);
 705 }
 706
 707 static gboolean adapter_added(DBusConnection *connection, DBusMessage *message,
 708                                 void *user_data)
 709 {
 710         const char *path;
 711
 712         dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
 713                                 DBUS_TYPE_INVALID);
 714         add_adapter(connection, path);
 715         return TRUE;
 716 }
 717
 718 static void remove_adapter(DBusConnection *connection, const char *path)
 719 {
 720         DBG("path %s", path);
 721
 722         g_hash_table_remove(bluetooth_devices, path);
 723 }
 724
 725 static gboolean adapter_removed(DBusConnection *connection, DBusMessage *message,
 726                                 void *user_data)
 727 {
 728         const char *path;
 729
 730         dbus_message_get_args(message, NULL, DBUS_TYPE_OBJECT_PATH, &path,
 731                                 DBUS_TYPE_INVALID);
 732         remove_adapter(connection, path);
 733         return TRUE;
 734 }
 735
 736 static void list_adapters_reply(DBusPendingCall *call, void *user_data)
 737 {
 738         DBusMessage *reply;
 739         DBusError error;
 740         char **adapters;
 741         int i, num_adapters;
 742
 743         DBG("");
 744
 745         reply = dbus_pending_call_steal_reply(call);
 746
 747         dbus_error_init(&error);
 748
 749         if (dbus_set_error_from_message(&error, reply) == TRUE) {
 750                 connman_error("%s", error.message);
 751                 dbus_error_free(&error);
 752                 goto done;
 753         }
 754
 755         if (dbus_message_get_args(reply, &error,
 756                                 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
 757                                                 &adapters, &num_adapters,
 758                                                 DBUS_TYPE_INVALID) == FALSE) {
 759                 if (dbus_error_is_set(&error) == TRUE) {
 760                         connman_error("%s", error.message);
 761                         dbus_error_free(&error);
 762                 } else
 763                         connman_error("Wrong arguments for adapter list");
 764                 goto done;
 765         }
 766
 767         for (i = 0; i < num_adapters; i++)
 768                 add_adapter(connection, adapters[i]);
 769
 770         g_strfreev(adapters);
 771
 772 done:
 773         dbus_message_unref(reply);
 774
 775         dbus_pending_call_unref(call);
 776 }
 777
 778 static void unregister_device(gpointer data)
 779 {
 780         struct connman_device *device = data;
 781
 782         DBG("");
 783
 784         connman_device_unregister(device);
 785         connman_device_unref(device);
 786 }
 787
 788 static void remove_network(gpointer data)
 789 {
 790         struct connman_network *network = data;
 791         struct connman_device *device;
 792
 793         DBG("network %p", network);
 794
 795         device = connman_network_get_device(network);
 796         if (device != NULL)
 797                 connman_device_remove_network(device, network);
 798
 799         connman_network_unref(network);
 800 }
 801
 802 static void bluetooth_connect(DBusConnection *connection, void *user_data)
 803 {
 804         DBusMessage *message;
 805         DBusPendingCall *call;
 806
 807         DBG("connection %p", connection);
 808
 809         bluetooth_devices = g_hash_table_new_full(g_str_hash, g_str_equal,
 810                                                 g_free, unregister_device);
 811
 812         bluetooth_networks = g_hash_table_new_full(g_str_hash, g_str_equal,
 813                                                 g_free, remove_network);
 814
 815         message = dbus_message_new_method_call(BLUEZ_SERVICE, "/",
 816                                 BLUEZ_MANAGER_INTERFACE, LIST_ADAPTERS);
 817         if (message == NULL)
 818                 return;
 819
 820         dbus_message_set_auto_start(message, FALSE);
 821
 822         if (dbus_connection_send_with_reply(connection, message,
 823                                                 &call, TIMEOUT) == FALSE) {
 824                 connman_error("Failed to get Bluetooth adapters");
 825                 goto done;
 826         }
 827
 828         if (call == NULL) {
 829                 connman_error("D-Bus connection not available");
 830                 goto done;
 831         }
 832
 833         dbus_pending_call_set_notify(call, list_adapters_reply, NULL, NULL);
 834
 835 done:
 836         dbus_message_unref(message);
 837 }
 838
 839 static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
 840 {
 841         DBG("connection %p", connection);
 842
 843         if (bluetooth_devices == NULL)
 844                 return;
 845
 846         g_hash_table_destroy(bluetooth_networks);
 847         g_hash_table_destroy(bluetooth_devices);
 848         bluetooth_devices = NULL;
 849 }
 850
 851 static int bluetooth_probe(struct connman_device *device)
 852 {
 853         DBG("device %p", device);
 854
 855         return 0;
 856 }
 857
 858 static void bluetooth_remove(struct connman_device *device)
 859 {
 860         DBG("device %p", device);
 861 }
 862
 863 static void powered_reply(DBusPendingCall *call, void *user_data)
 864 {
 865         DBusError error;
 866         DBusMessage *reply;
 867
 868         DBG("");
 869
 870         reply = dbus_pending_call_steal_reply(call);
 871
 872         dbus_error_init(&error);
 873
 874         if (dbus_set_error_from_message(&error, reply) == TRUE) {
 875                 connman_error("%s", error.message);
 876                 dbus_error_free(&error);
 877                 dbus_message_unref(reply);
 878                 dbus_pending_call_unref(call);
 879                 return;
 880         }
 881
 882         dbus_message_unref(reply);
 883         dbus_pending_call_unref(call);
 884
 885         add_adapter(connection, user_data);
 886 }
 887
 888 static int change_powered(DBusConnection *connection, const char *path,
 889                                                         dbus_bool_t powered)
 890 {
 891         DBusMessage *message;
 892         DBusMessageIter iter;
 893         DBusPendingCall *call;
 894
 895         DBG("");
 896
 897         if (path == NULL)
 898                 return -EINVAL;
 899
 900         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
 901                                         BLUEZ_ADAPTER_INTERFACE, SET_PROPERTY);
 902         if (message == NULL)
 903                 return -ENOMEM;
 904
 905         dbus_message_set_auto_start(message, FALSE);
 906
 907         dbus_message_iter_init_append(message, &iter);
 908         connman_dbus_property_append_basic(&iter, "Powered",
 909                                                 DBUS_TYPE_BOOLEAN, &powered);
 910
 911         if (dbus_connection_send_with_reply(connection, message,
 912                                                 &call, TIMEOUT) == FALSE) {
 913                 connman_error("Failed to change Powered property");
 914                 dbus_message_unref(message);
 915                 return -EINVAL;
 916         }
 917
 918         if (call == NULL) {
 919                 connman_error("D-Bus connection not available");
 920                 dbus_message_unref(message);
 921                 return -EINVAL;
 922         }
 923
 924         dbus_pending_call_set_notify(call, powered_reply,
 925                                         g_strdup(path), g_free);
 926
 927         dbus_message_unref(message);
 928
 929         return -EINPROGRESS;
 930 }
 931
 932 static int bluetooth_enable(struct connman_device *device)
 933 {
 934         const char *path = connman_device_get_string(device, "Path");
 935
 936         DBG("device %p", device);
 937
 938         return change_powered(connection, path, TRUE);
 939 }
 940
 941 static int bluetooth_disable(struct connman_device *device)
 942 {
 943         const char *path = connman_device_get_string(device, "Path");
 944
 945         DBG("device %p", device);
 946
 947         return change_powered(connection, path, FALSE);
 948 }
 949
 950 static struct connman_device_driver bluetooth_driver = {
 951         .name           = "bluetooth",
 952         .type           = CONNMAN_DEVICE_TYPE_BLUETOOTH,
 953         .probe          = bluetooth_probe,
 954         .remove         = bluetooth_remove,
 955         .enable         = bluetooth_enable,
 956         .disable        = bluetooth_disable,
 957 };
 958
 959 static int tech_probe(struct connman_technology *technology)
 960 {
 961         return 0;
 962 }
 963
 964 static void tech_remove(struct connman_technology *technology)
 965 {
 966 }
 967
 968 static void server_register_reply(DBusPendingCall *call, void *user_data)
 969 {
 970         struct connman_technology *technology = user_data;
 971         DBusError error;
 972         DBusMessage *reply;
 973
 974         DBG("");
 975
 976         reply = dbus_pending_call_steal_reply(call);
 977
 978         dbus_error_init(&error);
 979
 980         if (dbus_set_error_from_message(&error, reply) == TRUE) {
 981                 connman_error("%s", error.message);
 982                 dbus_error_free(&error);
 983                 dbus_message_unref(reply);
 984                 dbus_pending_call_unref(call);
 985                 return;
 986         }
 987
 988         dbus_message_unref(reply);
 989         dbus_pending_call_unref(call);
 990
 991         connman_technology_tethering_notify(technology, TRUE);
 992 }
 993
 994 static void server_unregister_reply(DBusPendingCall *call, void *user_data)
 995 {
 996         struct connman_technology *technology = user_data;
 997         DBusError error;
 998         DBusMessage *reply;
 999
1000         DBG("");
1001
1002         reply = dbus_pending_call_steal_reply(call);
1003
1004         dbus_error_init(&error);
1005
1006         if (dbus_set_error_from_message(&error, reply) == TRUE) {
1007                 connman_error("%s", error.message);
1008                 dbus_error_free(&error);
1009                 dbus_message_unref(reply);
1010                 dbus_pending_call_unref(call);
1011                 return;
1012         }
1013
1014         dbus_message_unref(reply);
1015         dbus_pending_call_unref(call);
1016
1017         connman_technology_tethering_notify(technology, FALSE);
1018 }
1019
1020
1021 static void server_register(const char *path, const char *uuid,
1022                                 struct connman_technology *technology,
1023                                 const char *bridge, connman_bool_t enabled)
1024 {
1025         DBusMessage *message;
1026         DBusPendingCall *call;
1027         char *command;
1028
1029         DBG("path %s enabled %d", path, enabled);
1030
1031         command = enabled ? REGISTER : UNREGISTER;
1032
1033         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
1034                                         BLUEZ_NETWORK_SERVER, command);
1035         if (message == NULL)
1036                 return;
1037
1038         dbus_message_set_auto_start(message, FALSE);
1039
1040         dbus_message_append_args(message, DBUS_TYPE_STRING, &uuid,
1041                                                         DBUS_TYPE_INVALID);
1042
1043         if (enabled == TRUE)
1044                 dbus_message_append_args(message, DBUS_TYPE_STRING, &bridge,
1045                                                         DBUS_TYPE_INVALID);
1046
1047         if (dbus_connection_send_with_reply(connection, message,
1048                                                 &call, TIMEOUT) == FALSE) {
1049                 connman_error("Failed to enable PAN server");
1050                 dbus_message_unref(message);
1051                 return;
1052         }
1053
1054         if (call == NULL) {
1055                 connman_error("D-Bus connection not available");
1056                 dbus_message_unref(message);
1057                 return;
1058         }
1059
1060         if (enabled == TRUE)
1061                 dbus_pending_call_set_notify(call, server_register_reply,
1062                                                 technology, NULL);
1063         else
1064                 dbus_pending_call_set_notify(call, server_unregister_reply,
1065                                                 technology, NULL);
1066
1067         dbus_message_unref(message);
1068 }
1069
1070 struct tethering_info {
1071         struct connman_technology *technology;
1072         const char *bridge;
1073 };
1074
1075 static void enable_nap(gpointer key, gpointer value, gpointer user_data)
1076 {
1077         struct tethering_info *info = user_data;
1078         struct connman_device *device = value;
1079         const char *path;
1080
1081         DBG("");
1082
1083         path = connman_device_get_string(device, "Path");
1084
1085         server_register(path, "nap", info->technology, info->bridge, TRUE);
1086 }
1087
1088 static void disable_nap(gpointer key, gpointer value, gpointer user_data)
1089 {
1090         struct tethering_info *info = user_data;
1091         struct connman_device *device = value;
1092         const char *path;
1093
1094         DBG("");
1095
1096         path = connman_device_get_string(device, "Path");
1097
1098         server_register(path, "nap", info->technology, info->bridge, FALSE);
1099 }
1100
1101 static int tech_set_tethering(struct connman_technology *technology,
1102                                 const char *identifier, const char *passphrase,
1103                                 const char *bridge, connman_bool_t enabled)
1104 {
1105         struct tethering_info info = {
1106                 .technology     = technology,
1107                 .bridge         = bridge,
1108         };
1109
1110         DBG("bridge %s", bridge);
1111
1112         if (enabled)
1113                 g_hash_table_foreach(bluetooth_devices, enable_nap, &info);
1114         else
1115                 g_hash_table_foreach(bluetooth_devices, disable_nap, &info);
1116
1117         return 0;
1118 }
1119
1120 static struct connman_technology_driver tech_driver = {
1121         .name           = "bluetooth",
1122         .type           = CONNMAN_SERVICE_TYPE_BLUETOOTH,
1123         .probe          = tech_probe,
1124         .remove         = tech_remove,
1125         .set_tethering  = tech_set_tethering,
1126 };
1127
1128 static guint watch;
1129 static guint added_watch;
1130 static guint removed_watch;
1131 static guint adapter_watch;
1132 static guint device_watch;
1133 static guint device_removed_watch;
1134 static guint network_watch;
1135
1136 static int bluetooth_init(void)
1137 {
1138         int err;
1139
1140         connection = connman_dbus_get_connection();
1141         if (connection == NULL)
1142                 return -EIO;
1143
1144         watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE,
1145                         bluetooth_connect, bluetooth_disconnect, NULL, NULL);
1146
1147         added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1148                                                 BLUEZ_MANAGER_INTERFACE,
1149                                                 ADAPTER_ADDED, adapter_added,
1150                                                 NULL, NULL);
1151
1152         removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1153                                                 BLUEZ_MANAGER_INTERFACE,
1154                                                 ADAPTER_REMOVED, adapter_removed,
1155                                                 NULL, NULL);
1156
1157         adapter_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1158                                                 BLUEZ_ADAPTER_INTERFACE,
1159                                                 PROPERTY_CHANGED, adapter_changed,
1160                                                 NULL, NULL);
1161
1162         device_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1163                                                 BLUEZ_ADAPTER_INTERFACE,
1164                                                 DEVICE_REMOVED, device_removed,
1165                                                 NULL, NULL);
1166
1167         device_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1168                                                 BLUEZ_DEVICE_INTERFACE,
1169                                                 PROPERTY_CHANGED, device_changed,
1170                                                 NULL, NULL);
1171
1172         network_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1173                                                 BLUEZ_NETWORK_INTERFACE,
1174                                                 PROPERTY_CHANGED, network_changed,
1175                                                 NULL, NULL);
1176
1177         if (watch == 0 || added_watch == 0 || removed_watch == 0
1178                         || adapter_watch == 0 || network_watch == 0
1179                                 || device_watch == 0
1180                                         || device_removed_watch == 0) {
1181                 err = -EIO;
1182                 goto remove;
1183         }
1184
1185         err = connman_network_driver_register(&pan_driver);
1186         if (err < 0)
1187                 goto remove;
1188
1189         err = connman_device_driver_register(&bluetooth_driver);
1190         if (err < 0) {
1191                 connman_network_driver_unregister(&pan_driver);
1192                 goto remove;
1193         }
1194
1195         err = connman_technology_driver_register(&tech_driver);
1196         if (err < 0) {
1197                 connman_device_driver_unregister(&bluetooth_driver);
1198                 connman_network_driver_unregister(&pan_driver);
1199                 return err;
1200         }
1201
1202         return 0;
1203
1204 remove:
1205         g_dbus_remove_watch(connection, watch);
1206         g_dbus_remove_watch(connection, added_watch);
1207         g_dbus_remove_watch(connection, removed_watch);
1208         g_dbus_remove_watch(connection, adapter_watch);
1209         g_dbus_remove_watch(connection, device_removed_watch);
1210         g_dbus_remove_watch(connection, device_watch);
1211         g_dbus_remove_watch(connection, network_watch);
1212
1213         dbus_connection_unref(connection);
1214
1215         return err;
1216 }
1217
1218 static void bluetooth_exit(void)
1219 {
1220         g_dbus_remove_watch(connection, watch);
1221         g_dbus_remove_watch(connection, added_watch);
1222         g_dbus_remove_watch(connection, removed_watch);
1223         g_dbus_remove_watch(connection, adapter_watch);
1224         g_dbus_remove_watch(connection, device_removed_watch);
1225         g_dbus_remove_watch(connection, device_watch);
1226         g_dbus_remove_watch(connection, network_watch);
1227
1228         bluetooth_disconnect(connection, NULL);
1229
1230         connman_technology_driver_unregister(&tech_driver);
1231
1232         connman_device_driver_unregister(&bluetooth_driver);
1233         connman_network_driver_unregister(&pan_driver);
1234
1235         dbus_connection_unref(connection);
1236 }
1237
1238 CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
1239                 CONNMAN_PLUGIN_PRIORITY_DEFAULT, bluetooth_init, bluetooth_exit)