plugins/ofono.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2010  Intel Corporation. All rights reserved.
   6  *  Copyright (C) 2010 Nokia Corporation and/or its subsidiary(-ies).
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License version 2 as
  10  *  published by the Free Software Foundation.
  11  *
  12  *  This program is distributed in the hope that it will be useful,
  13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *  GNU General Public License for more details.
  16  *
  17  *  You should have received a copy of the GNU General Public License
  18  *  along with this program; if not, write to the Free Software
  19  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  20  *
  21  */
  22
  23 #ifdef HAVE_CONFIG_H
  24 #include <config.h>
  25 #endif
  26
  27 #include <errno.h>
  28
  29 #include <gdbus.h>
  30 #include <string.h>
  31
  32 #define CONNMAN_API_SUBJECT_TO_CHANGE
  33 #include <connman/plugin.h>
  34 #include <connman/element.h>
  35 #include <connman/device.h>
  36 #include <connman/network.h>
  37 #include <connman/dbus.h>
  38 #include <connman/inet.h>
  39 #include <connman/log.h>
  40
  41 #define OFONO_SERVICE                   "org.ofono"
  42
  43 #define OFONO_MANAGER_INTERFACE         OFONO_SERVICE ".Manager"
  44 #define OFONO_MODEM_INTERFACE           OFONO_SERVICE ".Modem"
  45 #define OFONO_GPRS_INTERFACE            OFONO_SERVICE ".ConnectionManager"
  46 #define OFONO_CONTEXT_INTERFACE         OFONO_SERVICE ".ConnectionContext"
  47 #define OFONO_SIM_INTERFACE             OFONO_SERVICE ".SimManager"
  48 #define OFONO_REGISTRATION_INTERFACE    OFONO_SERVICE ".NetworkRegistration"
  49
  50 #define PROPERTY_CHANGED                "PropertyChanged"
  51 #define GET_PROPERTIES                  "GetProperties"
  52 #define SET_PROPERTY                    "SetProperty"
  53 #define CONTEXT_ADDED                   "ContextAdded"
  54 #define CONTEXT_REMOVED                 "ContextRemoved"
  55 #define ADD_CONTEXT                     "AddContext"
  56 #define GET_MODEMS                      "GetModems"
  57 #define MODEM_ADDED                     "ModemAdded"
  58 #define MODEM_REMOVED                   "ModemRemoved"
  59
  60
  61 #define TIMEOUT 40000
  62
  63 static DBusConnection *connection;
  64
  65 static GHashTable *modem_hash = NULL;
  66
  67 static GHashTable *network_hash;
  68
  69 struct modem_data {
  70         char *path;
  71         struct connman_device *device;
  72         gboolean has_sim;
  73         gboolean has_reg;
  74         gboolean has_gprs;
  75         gboolean available;
  76         gboolean pending_online;
  77         gboolean requested_online;
  78         gboolean online;
  79
  80         uint8_t strength, has_strength;
  81 };
  82
  83 static int modem_probe(struct connman_device *device)
  84 {
  85         DBG("device %p", device);
  86
  87         return 0;
  88 }
  89
  90 static void modem_remove(struct connman_device *device)
  91 {
  92         DBG("device %p", device);
  93 }
  94
  95 static int call_ofono(const char *path,
  96                         const char *interface, const char *method,
  97                         DBusPendingCallNotifyFunction notify, void *user_data,
  98                         DBusFreeFunction free_function,
  99                         int type, ...)
 100 {
 101         DBusMessage *message;
 102         DBusPendingCall *call;
 103         dbus_bool_t ok;
 104         va_list va;
 105
 106         DBG("path %s %s.%s", path, interface, method);
 107
 108         if (path == NULL)
 109                 return -EINVAL;
 110
 111         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 112                                         interface, method);
 113         if (message == NULL)
 114                 return -ENOMEM;
 115
 116         dbus_message_set_auto_start(message, FALSE);
 117
 118         va_start(va, type);
 119         ok = dbus_message_append_args_valist(message, type, va);
 120         va_end(va);
 121
 122         if (!ok)
 123                 return -ENOMEM;
 124
 125         if (dbus_connection_send_with_reply(connection, message,
 126                                                 &call, TIMEOUT) == FALSE) {
 127                 connman_error("Failed to call %s.%s", interface, method);
 128                 dbus_message_unref(message);
 129                 return -EINVAL;
 130         }
 131
 132         if (call == NULL) {
 133                 connman_error("D-Bus connection not available");
 134                 dbus_message_unref(message);
 135                 return -EINVAL;
 136         }
 137
 138         dbus_pending_call_set_notify(call, notify, user_data, free_function);
 139
 140         dbus_message_unref(message);
 141
 142         return -EINPROGRESS;
 143 }
 144
 145 static void set_property_reply(DBusPendingCall *call, void *user_data)
 146 {
 147         DBusMessage *reply;
 148         DBusError error;
 149         char const *name = user_data;
 150
 151         DBG("");
 152
 153         dbus_error_init(&error);
 154
 155         reply = dbus_pending_call_steal_reply(call);
 156
 157         if (dbus_set_error_from_message(&error, reply)) {
 158                 connman_error("SetProperty(%s) %s %s", name,
 159                                 error.name, error.message);
 160                 dbus_error_free(&error);
 161         }
 162
 163         dbus_message_unref(reply);
 164
 165         dbus_pending_call_unref(call);
 166 }
 167
 168 static int set_property(const char *path, const char *interface,
 169                         const char *property, int type, void *value,
 170                         DBusPendingCallNotifyFunction notify, void *user_data,
 171                         DBusFreeFunction free_function)
 172 {
 173         DBusMessage *message;
 174         DBusMessageIter iter;
 175         DBusPendingCall *call;
 176
 177         DBG("path %s %s.%s", path, interface, property);
 178
 179         g_assert(notify == NULL ? free_function == NULL : 1);
 180
 181         if (path == NULL)
 182                 return -EINVAL;
 183
 184         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 185                                         interface, SET_PROPERTY);
 186         if (message == NULL)
 187                 return -ENOMEM;
 188
 189         dbus_message_set_auto_start(message, FALSE);
 190
 191         dbus_message_iter_init_append(message, &iter);
 192         connman_dbus_property_append_basic(&iter, property, type, value);
 193
 194         if (dbus_connection_send_with_reply(connection, message,
 195                                                 &call, TIMEOUT) == FALSE) {
 196                 connman_error("Failed to change \"%s\" property on %s",
 197                                 property, interface);
 198                 dbus_message_unref(message);
 199                 return -EINVAL;
 200         }
 201
 202         if (call == NULL) {
 203                 connman_error("D-Bus connection not available");
 204                 dbus_message_unref(message);
 205                 return -EINVAL;
 206         }
 207
 208         if (notify == NULL) {
 209                 notify = set_property_reply;
 210                 user_data = (void *)property;
 211                 free_function = NULL;
 212         }
 213
 214         dbus_pending_call_set_notify(call, notify, user_data, free_function);
 215
 216         dbus_message_unref(message);
 217
 218         return -EINPROGRESS;
 219 }
 220
 221 static void update_modem_online(struct modem_data *modem,
 222                                 connman_bool_t online)
 223 {
 224         DBG("modem %p path %s online %d", modem, modem->path, online);
 225
 226         modem->online = online;
 227         modem->requested_online = online;
 228         modem->pending_online = FALSE;
 229
 230         if (modem->device)
 231                 connman_device_set_powered(modem->device, online);
 232 }
 233
 234 static void set_online_reply(DBusPendingCall *call, void *user_data)
 235 {
 236         struct modem_data *modem;
 237         DBusMessage *reply;
 238         DBusError error;
 239         gboolean result;
 240
 241         DBG("path %s", (char *)user_data);
 242
 243         if (modem_hash == NULL)
 244                 return;
 245
 246         modem = g_hash_table_lookup(modem_hash, user_data);
 247         if (modem == NULL)
 248                 return;
 249
 250         reply = dbus_pending_call_steal_reply(call);
 251
 252         dbus_error_init(&error);
 253
 254         if (dbus_set_error_from_message(&error, reply)) {
 255                 connman_error("SetProperty(Online) %s %s",
 256                                 error.name, error.message);
 257                 dbus_error_free(&error);
 258
 259                 result = modem->online;
 260         } else
 261                 result = modem->requested_online;
 262
 263         if (modem->pending_online)
 264                 update_modem_online(modem, result);
 265
 266         dbus_message_unref(reply);
 267
 268         dbus_pending_call_unref(call);
 269 }
 270
 271 static int modem_change_online(char const *path, dbus_bool_t online)
 272 {
 273         return set_property(path, OFONO_MODEM_INTERFACE, "Online",
 274                                 DBUS_TYPE_BOOLEAN, &online,
 275                                 set_online_reply,
 276                                 (void *)g_strdup(path), g_free);
 277 }
 278
 279 static int modem_enable(struct connman_device *device)
 280 {
 281         const char *path = connman_device_get_string(device, "Path");
 282
 283         DBG("device %p, path, %s", device, path);
 284
 285         return modem_change_online(path, TRUE);
 286 }
 287
 288 static int modem_disable(struct connman_device *device)
 289 {
 290         const char *path = connman_device_get_string(device, "Path");
 291
 292         DBG("device %p path %s", device, path);
 293
 294         return modem_change_online(path, FALSE);
 295 }
 296
 297 static struct connman_device_driver modem_driver = {
 298         .name           = "modem",
 299         .type           = CONNMAN_DEVICE_TYPE_CELLULAR,
 300         .probe          = modem_probe,
 301         .remove         = modem_remove,
 302         .enable         = modem_enable,
 303         .disable        = modem_disable,
 304 };
 305
 306 static void modem_remove_device(struct modem_data *modem)
 307 {
 308         DBG("modem %p path %s device %p", modem, modem->path, modem->device);
 309
 310         if (modem->device == NULL)
 311                 return;
 312
 313         connman_device_remove_all_networks(modem->device);
 314         connman_device_unregister(modem->device);
 315         connman_device_unref(modem->device);
 316
 317         modem->device = NULL;
 318 }
 319
 320 static void remove_modem(gpointer data)
 321 {
 322         struct modem_data *modem = data;
 323
 324         modem_remove_device(modem);
 325
 326         g_free(modem->path);
 327
 328         g_free(modem);
 329 }
 330
 331 static void remove_network(gpointer data)
 332 {
 333         connman_network_unref(data);
 334 }
 335
 336 static char *get_ident(const char *path)
 337 {
 338         char *pos;
 339
 340         if (*path != '/')
 341                 return NULL;
 342
 343         pos = strrchr(path, '/');
 344         if (pos == NULL)
 345                 return NULL;
 346
 347         return pos + 1;
 348 }
 349
 350 static void create_service(struct connman_network *network)
 351 {
 352         const char *path;
 353         char *group;
 354
 355         DBG("");
 356
 357         path = connman_network_get_string(network, "Path");
 358
 359         group = get_ident(path);
 360
 361         connman_network_set_group(network, group);
 362 }
 363
 364 static int network_probe(struct connman_network *network)
 365 {
 366         return 0;
 367 }
 368
 369 static gboolean pending_network_is_available(struct connman_network *network)
 370 {
 371         /* Modem or network may be removed */
 372         if (network == NULL || connman_network_get_device(network) == NULL) {
 373                 DBG("Modem or network was removed");
 374                 return FALSE;
 375         }
 376
 377         return TRUE;
 378 }
 379
 380 static void set_active_reply(DBusPendingCall *call, void *user_data)
 381 {
 382         char const *path = user_data;
 383         DBusMessage *reply;
 384         DBusError error;
 385         struct connman_network *network;
 386
 387         network = g_hash_table_lookup(network_hash, path);
 388
 389         DBG("path %s network %p", path, network);
 390
 391         reply = dbus_pending_call_steal_reply(call);
 392
 393         if (!pending_network_is_available(network))
 394                 goto done;
 395
 396         dbus_error_init(&error);
 397
 398         if (dbus_set_error_from_message(&error, reply)) {
 399                 connman_error("SetProperty(Active) %s %s",
 400                                 error.name, error.message);
 401
 402                 if (connman_network_get_index(network) < 0)
 403                         connman_network_set_error(network,
 404                                 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
 405
 406                 dbus_error_free(&error);
 407         }
 408
 409 done:
 410         dbus_message_unref(reply);
 411
 412         dbus_pending_call_unref(call);
 413 }
 414
 415 static int set_network_active(struct connman_network *network,
 416                                                 dbus_bool_t active)
 417 {
 418         int error;
 419
 420         const char *path = connman_network_get_string(network, "Path");
 421
 422         DBG("network %p, path %s, active %d", network, path, active);
 423
 424         error = set_property(path, OFONO_CONTEXT_INTERFACE,
 425                                 "Active", DBUS_TYPE_BOOLEAN, &active,
 426                                 set_active_reply, g_strdup(path), NULL);
 427
 428         if (active == FALSE && error == -EINPROGRESS)
 429                 error = 0;
 430
 431         return error;
 432 }
 433
 434 static void set_apn(struct connman_network *network)
 435 {
 436         const char *apn, *path;
 437
 438         apn = connman_network_get_string(network, "Cellular.APN");
 439         if (apn == NULL)
 440                 return;
 441
 442         path = connman_network_get_string(network, "Path");
 443         if (path == NULL)
 444                 return;
 445
 446         DBG("path %s, apn %s", path, apn);
 447
 448         set_property(path, OFONO_CONTEXT_INTERFACE,
 449                         "AccessPointName", DBUS_TYPE_STRING, &apn,
 450                         NULL, NULL, NULL);
 451 }
 452
 453 static int network_connect(struct connman_network *network)
 454 {
 455         DBG("network %p", network);
 456
 457         if (connman_network_get_index(network) >= 0)
 458                 return -EISCONN;
 459
 460         return set_network_active(network, TRUE);
 461 }
 462
 463 static int network_disconnect(struct connman_network *network)
 464 {
 465         DBG("network %p", network);
 466
 467         if (connman_network_get_index(network) < 0)
 468                 return -ENOTCONN;
 469
 470         return set_network_active(network, FALSE);
 471 }
 472
 473 static void network_remove(struct connman_network *network)
 474 {
 475         char const *path = connman_network_get_string(network, "Path");
 476
 477         DBG("network %p path %s", network, path);
 478
 479         g_hash_table_remove(network_hash, path);
 480 }
 481
 482 static int network_setup(struct connman_network *network, const char *key)
 483 {
 484         if (g_strcmp0(key, "Cellular.APN") == 0)
 485                 set_apn(network);
 486
 487         return 0;
 488 }
 489
 490 static struct connman_network_driver network_driver = {
 491         .name           = "network",
 492         .type           = CONNMAN_NETWORK_TYPE_CELLULAR,
 493         .probe          = network_probe,
 494         .remove         = network_remove,
 495         .connect        = network_connect,
 496         .disconnect     = network_disconnect,
 497         .setup          = network_setup,
 498 };
 499
 500 static void update_settings(DBusMessageIter *array,
 501                                 struct connman_network *network);
 502
 503 static void set_connected(struct connman_network *network,
 504                                 connman_bool_t connected);
 505
 506 static int add_network(struct connman_device *device,
 507                         const char *path, DBusMessageIter *dict)
 508 {
 509         struct modem_data *modem = connman_device_get_data(device);
 510         struct connman_network *network;
 511         char *ident;
 512         const char *hash_path;
 513         char const *operator;
 514         char const *reg_status;
 515         dbus_bool_t active = FALSE;
 516
 517         DBG("modem %p device %p path %s", modem, device, path);
 518
 519         ident = get_ident(path);
 520
 521         network = connman_device_get_network(device, ident);
 522         if (network != NULL)
 523                 return -EALREADY;
 524
 525         network = g_hash_table_lookup(network_hash, path);
 526         if (network != NULL) {
 527                 DBG("path %p already exists with device %p", path,
 528                         connman_network_get_device(network));
 529                 if (connman_network_get_device(network))
 530                         return -EALREADY;
 531                 g_hash_table_remove(network_hash, path);
 532         }
 533
 534         network = connman_network_create(ident, CONNMAN_NETWORK_TYPE_CELLULAR);
 535         if (network == NULL)
 536                 return -ENOMEM;
 537
 538         connman_network_set_string(network, "Path", path);
 539         hash_path = connman_network_get_string(network, "Path");
 540         if (hash_path == NULL)
 541                 goto error;
 542
 543         create_service(network);
 544
 545         connman_network_ref(network);
 546         g_hash_table_insert(network_hash, (char *)hash_path, network);
 547
 548         connman_network_set_available(network, TRUE);
 549         connman_network_set_index(network, -1);
 550
 551         operator = connman_device_get_string(device, "Operator");
 552         if (operator)
 553                 connman_network_set_name(network, operator);
 554
 555         if (modem->has_strength)
 556                 connman_network_set_strength(network, modem->strength);
 557
 558         reg_status = connman_device_get_string(device, "RegistrationStatus");
 559
 560         if (!g_strcmp0(reg_status, "roaming"))
 561                 connman_network_set_roaming(network, TRUE);
 562         else if (!g_strcmp0(reg_status, "registered"))
 563                 connman_network_set_roaming(network, FALSE);
 564
 565         while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) {
 566                 DBusMessageIter entry, value;
 567                 const char *key;
 568
 569                 dbus_message_iter_recurse(dict, &entry);
 570                 dbus_message_iter_get_basic(&entry, &key);
 571
 572                 dbus_message_iter_next(&entry);
 573                 dbus_message_iter_recurse(&entry, &value);
 574
 575                 if (g_str_equal(key, "Type")) {
 576                         const char *type;
 577
 578                         dbus_message_iter_get_basic(&value, &type);
 579                         if (g_strcmp0(type, "internet") != 0) {
 580                                 DBG("path %p type %s", path, type);
 581                                 goto error;
 582                         }
 583                 } else if (g_str_equal(key, "AccessPointName")) {
 584                         const char *ap;
 585
 586                         dbus_message_iter_get_basic(&value, &ap);
 587
 588                         connman_network_set_string(network, "Cellular.APN", ap);
 589                 } else if (g_str_equal(key, "Settings"))
 590                         update_settings(&value, network);
 591                 else if (g_str_equal(key, "Active") == TRUE)
 592                         dbus_message_iter_get_basic(&value, &active);
 593
 594                 dbus_message_iter_next(dict);
 595         }
 596
 597         if (connman_device_add_network(device, network) != 0)
 598                 goto error;
 599
 600         if (active)
 601                 set_connected(network, active);
 602
 603         return 0;
 604
 605 error:
 606         connman_network_unref(network);
 607         g_hash_table_remove(network_hash, hash_path);
 608         return -EIO;
 609 }
 610
 611 static void check_networks_reply(DBusPendingCall *call, void *user_data)
 612 {
 613         char *path = user_data;
 614         struct modem_data *modem;
 615         DBusMessage *reply;
 616         DBusMessageIter array, entry, value, properties;
 617
 618         DBG("path %s", path);
 619
 620         modem = g_hash_table_lookup(modem_hash, path);
 621         if (modem == NULL)
 622                 return;
 623         if (modem->device == NULL)
 624                 return;
 625
 626         reply = dbus_pending_call_steal_reply(call);
 627
 628         if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
 629                 goto done;
 630
 631         dbus_message_iter_init(reply, &array);
 632
 633         dbus_message_iter_recurse(&array, &entry);
 634
 635         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRUCT) {
 636                 char const *network_path;
 637
 638                 dbus_message_iter_recurse(&entry, &value);
 639                 dbus_message_iter_get_basic(&value, &network_path);
 640
 641                 dbus_message_iter_next(&value);
 642                 dbus_message_iter_recurse(&value, &properties);
 643
 644                 add_network(modem->device, network_path, &properties);
 645
 646                 dbus_message_iter_next(&entry);
 647         }
 648
 649 done:
 650         dbus_message_unref(reply);
 651
 652         dbus_pending_call_unref(call);
 653 }
 654
 655 static void check_networks(struct modem_data *modem)
 656 {
 657         char const *path = modem->path;
 658
 659         DBG("modem %p path %s", modem, path);
 660
 661         call_ofono(path, OFONO_GPRS_INTERFACE, "GetContexts",
 662                         check_networks_reply, g_strdup(path), g_free,
 663                         DBUS_TYPE_INVALID);
 664 }
 665
 666 static void modem_operator_name_changed(struct modem_data *modem,
 667                                         char const *name)
 668 {
 669         struct connman_device *device = modem->device;
 670         GHashTableIter i;
 671         gpointer value;
 672
 673         if (device == NULL)
 674                 return;
 675
 676         connman_device_set_string(device, "Operator", name);
 677
 678         for (g_hash_table_iter_init(&i, network_hash);
 679              g_hash_table_iter_next(&i, NULL, &value);) {
 680                 struct connman_network *network = value;
 681
 682                 if (connman_network_get_device(network) == device) {
 683                         connman_network_set_name(network, name);
 684                         connman_network_update(network);
 685                 }
 686         }
 687 }
 688
 689 static void modem_strength_changed(struct modem_data *modem, uint8_t strength)
 690 {
 691         struct connman_device *device = modem->device;
 692         GHashTableIter i;
 693         gpointer value;
 694
 695         modem->strength = strength;
 696         modem->has_strength = TRUE;
 697
 698         if (device == NULL)
 699                 return;
 700
 701         for (g_hash_table_iter_init(&i, network_hash);
 702              g_hash_table_iter_next(&i, NULL, &value);) {
 703                 struct connman_network *network = value;
 704
 705                 if (connman_network_get_device(network) == device) {
 706                         connman_network_set_strength(network, strength);
 707                         connman_network_update(network);
 708                 }
 709         }
 710 }
 711
 712 static void modem_roaming_changed(struct modem_data *modem,
 713                                         char const *status)
 714 {
 715         struct connman_device *device = modem->device;
 716         connman_bool_t roaming;
 717         GHashTableIter i;
 718         gpointer value;
 719
 720         if (device == NULL)
 721                 return;
 722
 723         connman_device_set_string(device, "RegistrationStatus", status);
 724
 725         if (g_str_equal(status, "roaming"))
 726                 roaming = TRUE;
 727         else if (g_str_equal(status, "registered"))
 728                 roaming = FALSE;
 729         else
 730                 return;
 731
 732         for (g_hash_table_iter_init(&i, network_hash);
 733              g_hash_table_iter_next(&i, NULL, &value);) {
 734                 struct connman_network *network = value;
 735
 736                 if (connman_network_get_device(network) == device) {
 737                         connman_network_set_roaming(network, roaming);
 738                         connman_network_update(network);
 739                 }
 740         }
 741 }
 742
 743 static void modem_registration_changed(struct modem_data *modem,
 744                                         DBusMessageIter *entry)
 745 {
 746         DBusMessageIter iter;
 747         const char *key;
 748         int type;
 749         struct {
 750                 char const *str;
 751                 connman_uint8_t byte;
 752         } value;
 753
 754         dbus_message_iter_get_basic(entry, &key);
 755
 756         DBG("key %s", key);
 757
 758         dbus_message_iter_next(entry);
 759
 760         dbus_message_iter_recurse(entry, &iter);
 761
 762         type = dbus_message_iter_get_arg_type(&iter);
 763         if (type != DBUS_TYPE_BYTE && type != DBUS_TYPE_STRING)
 764                 return;
 765
 766         dbus_message_iter_get_basic(&iter, &value);
 767
 768         if (g_str_equal(key, "Name") && type == DBUS_TYPE_STRING)
 769                 modem_operator_name_changed(modem, value.str);
 770         else if (g_str_equal(key, "Strength") && type == DBUS_TYPE_BYTE)
 771                 modem_strength_changed(modem, value.byte);
 772         else if (g_str_equal(key, "Status") && type == DBUS_TYPE_STRING)
 773                 modem_roaming_changed(modem, value.str);
 774
 775 }
 776
 777 static gboolean reg_changed(DBusConnection *connection,
 778                                 DBusMessage *message, void *user_data)
 779 {
 780         const char *path = dbus_message_get_path(message);
 781         struct modem_data *modem;
 782         DBusMessageIter iter;
 783
 784         DBG("path %s", path);
 785
 786         modem = g_hash_table_lookup(modem_hash, path);
 787         if (modem == NULL)
 788                 return TRUE;
 789
 790         if (dbus_message_iter_init(message, &iter))
 791                 modem_registration_changed(modem, &iter);
 792
 793         return TRUE;
 794 }
 795
 796 static void check_registration_reply(DBusPendingCall *call, void *user_data)
 797 {
 798         char const *path = user_data;
 799         struct modem_data *modem;
 800         DBusMessage *reply;
 801         DBusMessageIter array, dict, entry;
 802
 803         DBG("path %s", path);
 804
 805         modem = g_hash_table_lookup(modem_hash, path);
 806         if (modem == NULL)
 807                 return;
 808
 809         reply = dbus_pending_call_steal_reply(call);
 810
 811         if (dbus_message_iter_init(reply, &array) == FALSE)
 812                 goto done;
 813
 814         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 815                 goto done;
 816
 817         dbus_message_iter_recurse(&array, &dict);
 818         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 819                 dbus_message_iter_recurse(&dict, &entry);
 820                 modem_registration_changed(modem, &entry);
 821                 dbus_message_iter_next(&dict);
 822         }
 823
 824 done:
 825         dbus_message_unref(reply);
 826
 827         dbus_pending_call_unref(call);
 828 }
 829
 830 static void check_registration(struct modem_data *modem)
 831 {
 832         char const *path = modem->path;
 833
 834         DBG("modem %p path %s", modem, path);
 835
 836         call_ofono(path, OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES,
 837                         check_registration_reply, g_strdup(path), g_free,
 838                         DBUS_TYPE_INVALID);
 839 }
 840
 841 static void add_device(const char *path, const char *imsi)
 842 {
 843         struct modem_data *modem;
 844         struct connman_device *device;
 845
 846         DBG("path %s imsi %s", path, imsi);
 847
 848         if (path == NULL)
 849                 return;
 850
 851         if (imsi == NULL)
 852                 return;
 853
 854         modem = g_hash_table_lookup(modem_hash, path);
 855         if (modem == NULL)
 856                 return;
 857
 858         if (modem->device) {
 859                 if (!g_strcmp0(imsi, connman_device_get_ident(modem->device)))
 860                         return;
 861
 862                 modem_remove_device(modem);
 863         }
 864
 865         if (strlen(imsi) == 0)
 866                 return;
 867
 868         device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
 869         if (device == NULL)
 870                 return;
 871
 872         connman_device_set_ident(device, imsi);
 873
 874         connman_device_set_string(device, "Path", path);
 875
 876         connman_device_set_data(device, modem);
 877
 878         if (connman_device_register(device) < 0) {
 879                 connman_device_unref(device);
 880                 return;
 881         }
 882
 883         modem->device = device;
 884
 885         if (modem->has_reg)
 886                 check_registration(modem);
 887         if (modem->has_gprs)
 888                 check_networks(modem);
 889 }
 890
 891 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
 892 {
 893         const char *path = user_data;
 894         const char *imsi = NULL;
 895         DBusMessage *reply;
 896         DBusMessageIter array, dict;
 897
 898         DBG("path %s", path);
 899
 900         reply = dbus_pending_call_steal_reply(call);
 901
 902         if (dbus_message_iter_init(reply, &array) == FALSE)
 903                 goto done;
 904
 905         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 906                 goto done;
 907
 908         dbus_message_iter_recurse(&array, &dict);
 909
 910         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 911                 DBusMessageIter entry, value;
 912                 const char *key;
 913
 914                 dbus_message_iter_recurse(&dict, &entry);
 915                 dbus_message_iter_get_basic(&entry, &key);
 916
 917                 dbus_message_iter_next(&entry);
 918                 dbus_message_iter_recurse(&entry, &value);
 919
 920                 if (g_str_equal(key, "SubscriberIdentity")) {
 921                         dbus_message_iter_get_basic(&value, &imsi);
 922                         add_device(path, imsi);
 923                 }
 924
 925                 dbus_message_iter_next(&dict);
 926         }
 927
 928 done:
 929         dbus_message_unref(reply);
 930
 931         dbus_pending_call_unref(call);
 932 }
 933
 934 static void get_imsi(const char *path)
 935 {
 936         DBG("path %s", path);
 937
 938         call_ofono(path, OFONO_SIM_INTERFACE, GET_PROPERTIES,
 939                         sim_properties_reply, g_strdup(path), g_free,
 940                         DBUS_TYPE_INVALID);
 941 }
 942
 943 static int gprs_change_powered(const char *path, dbus_bool_t powered)
 944 {
 945         DBG("path %s powered %d", path, powered);
 946
 947         return set_property(path, OFONO_GPRS_INTERFACE, "Powered",
 948                                 DBUS_TYPE_BOOLEAN, &powered,
 949                                 NULL, NULL, NULL);
 950 }
 951
 952 static int modem_change_powered(const char *path, dbus_bool_t powered)
 953 {
 954         DBG("path %s powered %d", path, powered);
 955
 956         return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
 957                                 DBUS_TYPE_BOOLEAN, &powered,
 958                                 NULL, NULL, NULL);
 959 }
 960
 961
 962 static gboolean modem_has_interface(DBusMessageIter *array,
 963                                         char const *interface)
 964 {
 965         DBusMessageIter entry;
 966
 967         dbus_message_iter_recurse(array, &entry);
 968
 969         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
 970                 const char *element;
 971
 972                 dbus_message_iter_get_basic(&entry, &element);
 973
 974                 if (g_strcmp0(interface, element) == 0)
 975                         return TRUE;
 976
 977                 dbus_message_iter_next(&entry);
 978         }
 979
 980         return FALSE;
 981 }
 982
 983 static gboolean modem_has_sim(DBusMessageIter *array)
 984 {
 985         return modem_has_interface(array, OFONO_SIM_INTERFACE);
 986 }
 987
 988 static gboolean modem_has_reg(DBusMessageIter *array)
 989 {
 990         return modem_has_interface(array, OFONO_REGISTRATION_INTERFACE);
 991 }
 992
 993 static gboolean modem_has_gprs(DBusMessageIter *array)
 994 {
 995         return modem_has_interface(array, OFONO_GPRS_INTERFACE);
 996 }
 997
 998 static void add_modem(const char *path, DBusMessageIter *prop)
 999 {
1000         struct modem_data *modem;
1001         dbus_bool_t powered = FALSE;
1002         dbus_bool_t online = FALSE;
1003         dbus_bool_t has_online = FALSE;
1004         gboolean has_sim = FALSE;
1005         gboolean has_reg = FALSE;
1006         gboolean has_gprs = FALSE;
1007
1008         modem = g_hash_table_lookup(modem_hash, path);
1009
1010         if (modem != NULL)
1011                 return;
1012
1013         modem = g_try_new0(struct modem_data, 1);
1014         if (modem == NULL)
1015                 return;
1016
1017         modem->path = g_strdup(path);
1018         modem->device = NULL;
1019         modem->available = TRUE;
1020
1021         g_hash_table_insert(modem_hash, g_strdup(path), modem);
1022
1023         while (dbus_message_iter_get_arg_type(prop) == DBUS_TYPE_DICT_ENTRY) {
1024                 DBusMessageIter entry, value;
1025                 const char *key;
1026
1027                 dbus_message_iter_recurse(prop, &entry);
1028                 dbus_message_iter_get_basic(&entry, &key);
1029
1030                 dbus_message_iter_next(&entry);
1031                 dbus_message_iter_recurse(&entry, &value);
1032
1033                 if (g_str_equal(key, "Powered") == TRUE)
1034                         dbus_message_iter_get_basic(&value, &powered);
1035                 else if (g_str_equal(key, "Online") == TRUE) {
1036                         has_online = TRUE;
1037                         dbus_message_iter_get_basic(&value, &online);
1038                 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1039                         has_sim = modem_has_sim(&value);
1040                         has_reg = modem_has_reg(&value);
1041                         has_gprs = modem_has_gprs(&value);
1042                 }
1043
1044                 dbus_message_iter_next(prop);
1045         }
1046
1047         if (!powered)
1048                 modem_change_powered(path, TRUE);
1049
1050         modem->has_sim = has_sim;
1051         modem->has_reg = has_reg;
1052         modem->has_gprs = has_gprs;
1053
1054         update_modem_online(modem, online);
1055
1056         if (has_sim)
1057                 get_imsi(path);
1058 }
1059
1060 static void manager_modems_reply(DBusPendingCall *call, void *user_data)
1061 {
1062         DBusMessage *reply;
1063         DBusError error;
1064         DBusMessageIter array, dict;
1065
1066         DBG("");
1067
1068         reply = dbus_pending_call_steal_reply(call);
1069
1070         if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
1071                 goto done;
1072
1073         dbus_error_init(&error);
1074
1075         if (dbus_set_error_from_message(&error, reply)) {
1076                 connman_error("ModemManager.GetModems() %s %s",
1077                                 error.name, error.message);
1078                 dbus_error_free(&error);
1079                 goto done;
1080         }
1081
1082         if (dbus_message_iter_init(reply, &array) == FALSE)
1083                 goto done;
1084
1085         dbus_message_iter_recurse(&array, &dict);
1086
1087         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) {
1088                 DBusMessageIter value, properties;
1089                 const char *modem_path;
1090
1091                 dbus_message_iter_recurse(&dict, &value);
1092                 dbus_message_iter_get_basic(&value, &modem_path);
1093
1094                 dbus_message_iter_next(&value);
1095                 dbus_message_iter_recurse(&value, &properties);
1096
1097                 /* Add modem */
1098                 add_modem(modem_path, &properties);
1099
1100                 dbus_message_iter_next(&dict);
1101         }
1102
1103 done:
1104         dbus_message_unref(reply);
1105
1106         dbus_pending_call_unref(call);
1107 }
1108
1109 static void ofono_connect(DBusConnection *connection, void *user_data)
1110 {
1111         DBG("connection %p", connection);
1112
1113         modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1114                                                 g_free, remove_modem);
1115
1116         network_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1117                                                 NULL, remove_network);
1118
1119         call_ofono("/", OFONO_MANAGER_INTERFACE, GET_MODEMS,
1120                         manager_modems_reply, NULL, NULL,
1121                         DBUS_TYPE_INVALID);
1122 }
1123
1124 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1125 {
1126         DBG("connection %p", connection);
1127
1128         if (modem_hash == NULL)
1129                 return;
1130
1131         g_hash_table_destroy(modem_hash);
1132
1133         modem_hash = NULL;
1134 }
1135
1136 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1137                                 void *user_data)
1138 {
1139         const char *path = dbus_message_get_path(message);
1140         struct modem_data *modem;
1141         DBusMessageIter iter, value;
1142         const char *key;
1143
1144         DBG("path %s", path);
1145
1146         modem = g_hash_table_lookup(modem_hash, path);
1147         if (modem == NULL)
1148                 return TRUE;
1149
1150         if (dbus_message_iter_init(message, &iter) == FALSE)
1151                 return TRUE;
1152
1153         dbus_message_iter_get_basic(&iter, &key);
1154
1155         dbus_message_iter_next(&iter);
1156         dbus_message_iter_recurse(&iter, &value);
1157
1158         if (g_str_equal(key, "Powered") == TRUE) {
1159                 dbus_bool_t powered;
1160
1161                 dbus_message_iter_get_basic(&value, &powered);
1162                 if (powered == TRUE)
1163                         return TRUE;
1164
1165                 modem->has_sim = FALSE;
1166                 modem->has_reg = FALSE;
1167                 modem->has_gprs = FALSE;
1168
1169                 modem_remove_device(modem);
1170         } else if (g_str_equal(key, "Online") == TRUE) {
1171                 dbus_bool_t online;
1172
1173                 dbus_message_iter_get_basic(&value, &online);
1174
1175                 update_modem_online(modem, online);
1176         } else if (g_str_equal(key, "Interfaces") == TRUE) {
1177                 gboolean has_sim = modem_has_sim(&value);
1178                 gboolean has_reg = modem_has_reg(&value);
1179                 gboolean added_reg = has_reg && !modem->has_reg;
1180                 gboolean has_gprs = modem_has_gprs(&value);
1181                 gboolean added_gprs = has_gprs && !modem->has_gprs;
1182
1183                 modem->has_sim = has_sim;
1184                 modem->has_reg = has_reg;
1185                 modem->has_gprs = has_gprs;
1186
1187                 if (modem->device == NULL) {
1188                         if (has_sim)
1189                                 get_imsi(modem->path);
1190                 } else if (!has_sim) {
1191                         modem_remove_device(modem);
1192                 } else {
1193                         if (added_reg)
1194                                 check_registration(modem);
1195                         if (added_gprs)
1196                                 gprs_change_powered(modem->path, TRUE);
1197                 }
1198         }
1199
1200         return TRUE;
1201 }
1202
1203 static gboolean sim_changed(DBusConnection *connection, DBusMessage *message,
1204                                 void *user_data)
1205 {
1206         const char *path = dbus_message_get_path(message);
1207         struct modem_data *modem;
1208         DBusMessageIter iter, value;
1209         const char *key;
1210
1211         DBG("path %s", path);
1212
1213         modem = g_hash_table_lookup(modem_hash, path);
1214         if (modem == NULL)
1215                 return TRUE;
1216
1217         if (dbus_message_iter_init(message, &iter) == FALSE)
1218                 return TRUE;
1219
1220         dbus_message_iter_get_basic(&iter, &key);
1221
1222         dbus_message_iter_next(&iter);
1223         dbus_message_iter_recurse(&iter, &value);
1224
1225         if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
1226                 char *imsi;
1227
1228                 dbus_message_iter_get_basic(&value, &imsi);
1229
1230                 add_device(path, imsi);
1231         } else if (g_str_equal(key, "Present") == TRUE) {
1232                 dbus_bool_t present;
1233
1234                 dbus_message_iter_get_basic(&value, &present);
1235
1236                 if (present)
1237                         return TRUE;
1238
1239                 if (modem->device != NULL)
1240                         modem_remove_device(modem);
1241
1242                 modem->has_gprs = FALSE;
1243                 modem->has_reg = FALSE;
1244         }
1245
1246         return TRUE;
1247 }
1248
1249 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1250                                 void *user_data)
1251 {
1252         const char *path = dbus_message_get_path(message);
1253         struct modem_data *modem;
1254         DBusMessageIter iter, value;
1255         const char *key;
1256
1257         DBG("path %s", path);
1258
1259         modem = g_hash_table_lookup(modem_hash, path);
1260         if (modem == NULL)
1261                 return TRUE;
1262
1263         if (dbus_message_iter_init(message, &iter) == FALSE)
1264                 return TRUE;
1265
1266         dbus_message_iter_get_basic(&iter, &key);
1267
1268         dbus_message_iter_next(&iter);
1269         dbus_message_iter_recurse(&iter, &value);
1270
1271         if (g_str_equal(key, "Attached") == TRUE) {
1272                 dbus_bool_t attached;
1273
1274                 dbus_message_iter_get_basic(&value, &attached);
1275
1276                 DBG("Attached %d", attached);
1277
1278                 if (attached == TRUE)
1279                         check_networks(modem);
1280                 else if (modem->device != NULL)
1281                         connman_device_remove_all_networks(modem->device);
1282
1283         }
1284
1285         return TRUE;
1286 }
1287
1288 static gboolean modem_added(DBusConnection *connection,
1289                                 DBusMessage *message, void *user_data)
1290 {
1291         DBusMessageIter iter, properties;
1292         const char *modem_path;
1293
1294         DBG("");
1295
1296         if (dbus_message_iter_init(message, &iter) == FALSE)
1297                 return TRUE;
1298
1299         dbus_message_iter_get_basic(&iter, &modem_path);
1300
1301         dbus_message_iter_next(&iter);
1302         dbus_message_iter_recurse(&iter, &properties);
1303
1304         add_modem(modem_path, &properties);
1305
1306         return TRUE;
1307 }
1308
1309 static gboolean modem_removed(DBusConnection *connection,
1310                                 DBusMessage *message, void *user_data)
1311 {
1312         DBusMessageIter iter;
1313         const char *modem_path;
1314
1315         DBG("");
1316
1317         if (dbus_message_iter_init(message, &iter) == FALSE)
1318                 return TRUE;
1319
1320         dbus_message_iter_get_basic(&iter, &modem_path);
1321
1322         g_hash_table_remove(modem_hash, modem_path);
1323
1324         return TRUE;
1325 }
1326
1327
1328 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1329 {
1330         DBusMessageIter entry;
1331         gchar *nameserver = NULL, *nameserver_old = NULL;
1332
1333         DBG("");
1334
1335         dbus_message_iter_recurse(array, &entry);
1336
1337         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1338                 const char *dns;
1339
1340                 dbus_message_iter_get_basic(&entry, &dns);
1341
1342                 DBG("dns %s", dns);
1343
1344                 if (nameserver == NULL) {
1345
1346                         nameserver = g_strdup(dns);
1347                 } else {
1348
1349                         nameserver_old = nameserver;
1350                         nameserver = g_strdup_printf("%s %s",
1351                                                 nameserver_old, dns);
1352                         g_free(nameserver_old);
1353                 }
1354
1355                 dbus_message_iter_next(&entry);
1356         }
1357
1358         parent->ipv4.nameserver = nameserver;
1359 }
1360
1361 static void update_settings(DBusMessageIter *array,
1362                                 struct connman_network *network)
1363 {
1364         struct connman_element *parent = connman_network_get_element(network);
1365         DBusMessageIter dict;
1366         const char *interface = NULL;
1367
1368         DBG("network %p", network);
1369
1370         if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1371                 return;
1372
1373         dbus_message_iter_recurse(array, &dict);
1374
1375         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1376                 DBusMessageIter entry, value;
1377                 const char *key;
1378
1379                 dbus_message_iter_recurse(&dict, &entry);
1380                 dbus_message_iter_get_basic(&entry, &key);
1381
1382                 DBG("key %s", key);
1383
1384                 dbus_message_iter_next(&entry);
1385                 dbus_message_iter_recurse(&entry, &value);
1386
1387                 if (g_str_equal(key, "Interface") == TRUE) {
1388                         int index;
1389
1390                         dbus_message_iter_get_basic(&value, &interface);
1391
1392                         DBG("interface %s", interface);
1393
1394                         index = connman_inet_ifindex(interface);
1395                         if (index >= 0) {
1396                                 connman_network_set_index(network, index);
1397                         } else {
1398                                 connman_error("Can not find interface %s",
1399                                                                 interface);
1400                                 break;
1401                         }
1402                 } else if (g_str_equal(key, "Method") == TRUE) {
1403                         const char *method;
1404
1405                         dbus_message_iter_get_basic(&value, &method);
1406                         if (g_strcmp0(method, "static") == 0) {
1407
1408                                 parent->ipv4.method =
1409                                         CONNMAN_IPCONFIG_METHOD_FIXED;
1410                         } else if (g_strcmp0(method, "dhcp") == 0) {
1411
1412                                 parent->ipv4.method =
1413                                         CONNMAN_IPCONFIG_METHOD_DHCP;
1414                                 break;
1415                         }
1416                 } else if (g_str_equal(key, "Address") == TRUE) {
1417                         const char *address;
1418
1419                         dbus_message_iter_get_basic(&value, &address);
1420
1421                         DBG("address %s", address);
1422
1423                         parent->ipv4.address = g_strdup(address);
1424                 } else if (g_str_equal(key, "Netmask") == TRUE) {
1425                         const char *netmask;
1426
1427                         dbus_message_iter_get_basic(&value, &netmask);
1428
1429                         DBG("netmask %s", netmask);
1430
1431                         parent->ipv4.netmask = g_strdup(netmask);
1432                 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1433
1434                         get_dns(&value, parent);
1435                 } else if (g_str_equal(key, "Gateway") == TRUE) {
1436                         const char *gateway;
1437
1438                         dbus_message_iter_get_basic(&value, &gateway);
1439
1440                         DBG("gateway %s", gateway);
1441
1442                         parent->ipv4.gateway = g_strdup(gateway);
1443                 }
1444
1445                 dbus_message_iter_next(&dict);
1446         }
1447
1448         /* deactive, oFono send NULL inteface before deactive signal */
1449         if (interface == NULL)
1450                 connman_network_set_index(network, -1);
1451 }
1452
1453 static void cleanup_ipconfig(struct connman_network *network)
1454 {
1455         struct connman_element *parent = connman_network_get_element(network);
1456
1457         g_free(parent->ipv4.address);
1458         parent->ipv4.address = NULL;
1459
1460         g_free(parent->ipv4.netmask);
1461         parent->ipv4.netmask = NULL;
1462
1463         g_free(parent->ipv4.nameserver);
1464         parent->ipv4.nameserver = NULL;
1465
1466         g_free(parent->ipv4.gateway);
1467         parent->ipv4.gateway = NULL;
1468
1469         parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1470 }
1471
1472
1473 static void set_connected(struct connman_network *network,
1474                                 connman_bool_t connected)
1475 {
1476         struct connman_element *parent = connman_network_get_element(network);
1477         enum connman_ipconfig_method method = parent->ipv4.method;
1478
1479         switch (method) {
1480         case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1481         case CONNMAN_IPCONFIG_METHOD_OFF:
1482         case CONNMAN_IPCONFIG_METHOD_MANUAL:
1483                 return;
1484
1485         case CONNMAN_IPCONFIG_METHOD_FIXED:
1486                 connman_network_set_method(network, method);
1487
1488                 if (connected == FALSE)
1489                         cleanup_ipconfig(network);
1490
1491                 connman_network_set_connected(network, connected);
1492                 break;
1493
1494         case CONNMAN_IPCONFIG_METHOD_DHCP:
1495                 connman_network_set_method(network, method);
1496
1497                 connman_network_set_connected(network, connected);
1498                 break;
1499         }
1500 }
1501
1502 static gboolean context_changed(DBusConnection *connection,
1503                                         DBusMessage *message, void *user_data)
1504 {
1505         const char *path = dbus_message_get_path(message);
1506         struct connman_network *network;
1507         DBusMessageIter iter, value;
1508         const char *key;
1509
1510         DBG("path %s", path);
1511
1512         network = g_hash_table_lookup(network_hash, path);
1513         if (network == NULL)
1514                 return TRUE;
1515
1516         if (!pending_network_is_available(network)) {
1517                 remove_network(network);
1518                 return TRUE;
1519         }
1520
1521         if (dbus_message_iter_init(message, &iter) == FALSE)
1522                 return TRUE;
1523
1524         dbus_message_iter_get_basic(&iter, &key);
1525
1526         dbus_message_iter_next(&iter);
1527         dbus_message_iter_recurse(&iter, &value);
1528
1529         if (g_str_equal(key, "Settings") == TRUE)
1530                 update_settings(&value, network);
1531         else if (g_str_equal(key, "Active") == TRUE) {
1532                 dbus_bool_t active;
1533
1534                 dbus_message_iter_get_basic(&value, &active);
1535
1536                 set_connected(network, active);
1537         }
1538
1539         return TRUE;
1540 }
1541
1542 static guint watch;
1543 static guint reg_watch;
1544 static guint sim_watch;
1545 static guint gprs_watch;
1546 static guint modem_watch;
1547 static guint modem_added_watch;
1548 static guint modem_removed_watch;
1549 static guint context_watch;
1550
1551 static int ofono_init(void)
1552 {
1553         int err;
1554
1555         connection = connman_dbus_get_connection();
1556         if (connection == NULL)
1557                 return -EIO;
1558
1559         watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1560                         ofono_connect, ofono_disconnect, NULL, NULL);
1561
1562         reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1563                                                 OFONO_REGISTRATION_INTERFACE,
1564                                                 PROPERTY_CHANGED,
1565                                                 reg_changed,
1566                                                 NULL, NULL);
1567
1568         gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1569                                                 OFONO_GPRS_INTERFACE,
1570                                                 PROPERTY_CHANGED,
1571                                                 gprs_changed,
1572                                                 NULL, NULL);
1573
1574         modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1575                                                 OFONO_MODEM_INTERFACE,
1576                                                 PROPERTY_CHANGED,
1577                                                 modem_changed,
1578                                                 NULL, NULL);
1579
1580         sim_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1581                                                 OFONO_SIM_INTERFACE,
1582                                                 PROPERTY_CHANGED,
1583                                                 sim_changed,
1584                                                 NULL, NULL);
1585
1586         modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1587                                                 OFONO_MANAGER_INTERFACE,
1588                                                 MODEM_ADDED,
1589                                                 modem_added,
1590                                                 NULL, NULL);
1591
1592         modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1593                                                 OFONO_MANAGER_INTERFACE,
1594                                                 MODEM_REMOVED,
1595                                                 modem_removed,
1596                                                 NULL, NULL);
1597
1598         context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1599                                                 OFONO_CONTEXT_INTERFACE,
1600                                                 PROPERTY_CHANGED,
1601                                                 context_changed,
1602                                                 NULL, NULL);
1603
1604         if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1605                         reg_watch == 0 || sim_watch == 0 ||
1606                         modem_added_watch == 0 || modem_removed_watch == 0 ||
1607                                 context_watch == 0) {
1608                 err = -EIO;
1609                 goto remove;
1610         }
1611
1612         err = connman_network_driver_register(&network_driver);
1613         if (err < 0)
1614                 goto remove;
1615
1616         err = connman_device_driver_register(&modem_driver);
1617         if (err < 0) {
1618                 connman_network_driver_unregister(&network_driver);
1619                 goto remove;
1620         }
1621
1622         return 0;
1623
1624 remove:
1625         g_dbus_remove_watch(connection, watch);
1626         g_dbus_remove_watch(connection, sim_watch);
1627         g_dbus_remove_watch(connection, reg_watch);
1628         g_dbus_remove_watch(connection, gprs_watch);
1629         g_dbus_remove_watch(connection, modem_watch);
1630         g_dbus_remove_watch(connection, modem_added_watch);
1631         g_dbus_remove_watch(connection, modem_removed_watch);
1632         g_dbus_remove_watch(connection, context_watch);
1633
1634         dbus_connection_unref(connection);
1635
1636         return err;
1637 }
1638
1639 static void ofono_exit(void)
1640 {
1641         g_dbus_remove_watch(connection, watch);
1642         g_dbus_remove_watch(connection, sim_watch);
1643         g_dbus_remove_watch(connection, reg_watch);
1644         g_dbus_remove_watch(connection, gprs_watch);
1645         g_dbus_remove_watch(connection, modem_watch);
1646         g_dbus_remove_watch(connection, modem_added_watch);
1647         g_dbus_remove_watch(connection, modem_removed_watch);
1648         g_dbus_remove_watch(connection, context_watch);
1649
1650         ofono_disconnect(connection, NULL);
1651
1652         connman_device_driver_unregister(&modem_driver);
1653         connman_network_driver_unregister(&network_driver);
1654
1655         dbus_connection_unref(connection);
1656 }
1657
1658 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1659                 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)