plugins/ofono.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 <errno.h>
  27
  28 #include <gdbus.h>
  29 #include <string.h>
  30
  31 #define CONNMAN_API_SUBJECT_TO_CHANGE
  32 #include <connman/plugin.h>
  33 #include <connman/element.h>
  34 #include <connman/device.h>
  35 #include <connman/network.h>
  36 #include <connman/dbus.h>
  37 #include <connman/inet.h>
  38 #include <connman/log.h>
  39
  40 #define OFONO_SERVICE                   "org.ofono"
  41
  42 #define OFONO_MANAGER_INTERFACE         OFONO_SERVICE ".Manager"
  43 #define OFONO_MODEM_INTERFACE           OFONO_SERVICE ".Modem"
  44 #define OFONO_GPRS_INTERFACE            OFONO_SERVICE ".DataConnectionManager"
  45 #define OFONO_SIM_INTERFACE             OFONO_SERVICE ".SimManager"
  46 #define OFONO_PRI_CONTEXT_INTERFACE     OFONO_SERVICE ".PrimaryDataContext"
  47
  48 #define PROPERTY_CHANGED                "PropertyChanged"
  49 #define GET_PROPERTIES                  "GetProperties"
  50 #define SET_PROPERTY                    "SetProperty"
  51
  52 #define TIMEOUT 5000
  53
  54 static DBusConnection *connection;
  55
  56 static GHashTable *modem_hash = NULL;
  57
  58 struct modem_data {
  59         char *path;
  60         struct connman_device *device;
  61         gboolean available;
  62 };
  63
  64 static int modem_probe(struct connman_device *device)
  65 {
  66         DBG("device %p", device);
  67
  68         return 0;
  69 }
  70
  71 static void modem_remove(struct connman_device *device)
  72 {
  73         DBG("device %p", device);
  74 }
  75
  76 static void powered_reply(DBusPendingCall *call, void *user_data)
  77 {
  78         DBusMessage *reply;
  79         DBusError error;
  80
  81         DBG("");
  82
  83         dbus_error_init(&error);
  84
  85         reply = dbus_pending_call_steal_reply(call);
  86
  87         if (dbus_set_error_from_message(&error, reply)) {
  88                 connman_error("%s", error.message);
  89                 dbus_error_free(&error);
  90         }
  91
  92         dbus_message_unref(reply);
  93
  94         dbus_pending_call_unref(call);
  95 }
  96
  97 static int gprs_change_powered(const char *path, dbus_bool_t powered)
  98 {
  99         DBusMessage *message;
 100         DBusMessageIter iter;
 101         DBusPendingCall *call;
 102
 103         DBG("path %s powered %d", path, powered);
 104
 105         if (path == NULL)
 106                 return -EINVAL;
 107
 108         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 109                                         OFONO_GPRS_INTERFACE, SET_PROPERTY);
 110         if (message == NULL)
 111                 return -ENOMEM;
 112
 113         dbus_message_set_auto_start(message, FALSE);
 114
 115         dbus_message_iter_init_append(message, &iter);
 116         connman_dbus_property_append_basic(&iter, "Powered",
 117                                                 DBUS_TYPE_BOOLEAN, &powered);
 118
 119         if (dbus_connection_send_with_reply(connection, message,
 120                                                 &call, TIMEOUT) == FALSE) {
 121                 connman_error("Failed to change powered property");
 122                 dbus_message_unref(message);
 123                 return -EINVAL;
 124         }
 125
 126         if (call == NULL) {
 127                 connman_error("D-Bus connection not available");
 128                 dbus_message_unref(message);
 129                 return -EINVAL;
 130         }
 131
 132         dbus_pending_call_set_notify(call, powered_reply, (void *)path, NULL);
 133
 134         dbus_message_unref(message);
 135
 136         return -EINPROGRESS;
 137 }
 138
 139 static int modem_enable(struct connman_device *device)
 140 {
 141         const char *path = connman_device_get_string(device, "Path");
 142
 143         DBG("device %p, path, %s", device, path);
 144
 145         return gprs_change_powered(path, TRUE);
 146 }
 147
 148 static int modem_disable(struct connman_device *device)
 149 {
 150         const char *path = connman_device_get_string(device, "Path");
 151
 152         DBG("device %p, path %s", device, path);
 153
 154         return gprs_change_powered(path, FALSE);
 155 }
 156
 157 static struct connman_device_driver modem_driver = {
 158         .name           = "modem",
 159         .type           = CONNMAN_DEVICE_TYPE_CELLULAR,
 160         .probe          = modem_probe,
 161         .remove         = modem_remove,
 162         .enable         = modem_enable,
 163         .disable        = modem_disable,
 164 };
 165
 166 static char *get_ident(const char *path)
 167 {
 168         char *ident, *pos;
 169
 170         if (*path != '/')
 171                 return NULL;
 172
 173         ident = g_strdup(path + 1);
 174
 175         pos = ident;
 176
 177         while ((pos = strchr(pos, '/')) != NULL)
 178                 *pos = '_';
 179
 180         return ident;
 181 }
 182
 183 static void config_network_reply(DBusPendingCall *call, void *user_data)
 184 {
 185         struct connman_network *network = user_data;
 186         DBusMessage *reply;
 187         DBusMessageIter array, dict;
 188         gboolean internet_type = FALSE;
 189
 190         DBG("network %p", network);
 191
 192         reply = dbus_pending_call_steal_reply(call);
 193
 194         if (dbus_message_iter_init(reply, &array) == FALSE)
 195                 goto done;
 196
 197         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 198                 goto done;
 199
 200         dbus_message_iter_recurse(&array, &dict);
 201
 202         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 203                 DBusMessageIter entry, value;
 204                 const char *key;
 205
 206                 dbus_message_iter_recurse(&dict, &entry);
 207                 dbus_message_iter_get_basic(&entry, &key);
 208
 209                 dbus_message_iter_next(&entry);
 210                 dbus_message_iter_recurse(&entry, &value);
 211
 212                 if (g_str_equal(key, "Name") == TRUE) {
 213                         const char *name;
 214
 215                         dbus_message_iter_get_basic(&value, &name);
 216                         connman_network_set_name(network, name);
 217                 } else if (g_str_equal(key, "Type") == TRUE) {
 218                         const char *type;
 219
 220                         dbus_message_iter_get_basic(&value, &type);
 221                         if (g_strcmp0(type, "internet") == 0) {
 222                                 internet_type = TRUE;
 223
 224                                 connman_network_set_protocol(network,
 225                                                 CONNMAN_NETWORK_PROTOCOL_IP);
 226                         } else {
 227                                 internet_type = FALSE;
 228
 229                                 connman_network_set_protocol(network,
 230                                         CONNMAN_NETWORK_PROTOCOL_UNKNOWN);
 231                         }
 232                 }
 233
 234                 dbus_message_iter_next(&dict);
 235         }
 236
 237         if (internet_type == TRUE) {
 238                 const char *path;
 239                 char *group;
 240
 241                 path = connman_network_get_string(network, "Path");
 242
 243                 group = get_ident(path);
 244
 245                 connman_network_set_group(network, group);
 246
 247                 g_free(group);
 248         }
 249
 250 done:
 251         dbus_message_unref(reply);
 252
 253         dbus_pending_call_unref(call);
 254 }
 255
 256 static void config_network(struct connman_network *network, const char *path)
 257 {
 258         DBusMessage *message;
 259         DBusPendingCall *call;
 260
 261         DBG("path %s", path);
 262
 263         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 264                                 OFONO_PRI_CONTEXT_INTERFACE, GET_PROPERTIES);
 265         if (message == NULL)
 266                 return;
 267
 268         dbus_message_set_auto_start(message, FALSE);
 269
 270         if (dbus_connection_send_with_reply(connection, message,
 271                                                 &call, TIMEOUT) == FALSE) {
 272                 connman_error("Failed to get Primary Context");
 273                 goto done;
 274         }
 275
 276         if (call == NULL) {
 277                 connman_error("D-Bus connection not available");
 278                 goto done;
 279         }
 280
 281         dbus_pending_call_set_notify(call, config_network_reply,
 282                                                 (void *)network, NULL);
 283
 284 done:
 285         dbus_message_unref(message);
 286 }
 287
 288 static int network_probe(struct connman_network *network)
 289 {
 290         const char *path;
 291
 292         path = connman_network_get_string(network, "Path");
 293
 294         DBG("network %p path %s", network, path);
 295
 296         config_network(network, path);
 297
 298         return 0;
 299 }
 300
 301 static struct connman_network *pending_network;
 302
 303 static gboolean pending_network_is_available(
 304                 struct connman_network *pending_network)
 305 {
 306         struct connman_device *device;
 307         struct connman_network *network;
 308         const char *identifier;
 309         char *ident;
 310
 311         /* Modem may be removed during waiting for active reply */
 312         device  = connman_network_get_device(pending_network);
 313         if (device == NULL)
 314                 return FALSE;
 315
 316         identifier = connman_network_get_identifier(pending_network);
 317
 318         ident = g_strdup(identifier);
 319
 320         connman_network_unref(pending_network);
 321
 322         /* network may be removed during waiting for active reply */
 323         network = connman_device_get_network(device, ident);
 324
 325         g_free(ident);
 326
 327         if (network == NULL)
 328                 return FALSE;
 329
 330         return TRUE;
 331 }
 332
 333 static void set_active_reply(DBusPendingCall *call, void *user_data)
 334 {
 335         DBusMessage *reply;
 336         DBusError error;
 337         struct connman_network *network = user_data;
 338
 339         DBG("network %p", network);
 340
 341         reply = dbus_pending_call_steal_reply(call);
 342
 343         if (pending_network_is_available(network) == FALSE)
 344                 goto done;
 345
 346         dbus_error_init(&error);
 347         if (dbus_set_error_from_message(&error, reply)) {
 348                 if (connman_network_get_index(network) < 0)
 349                         connman_network_set_error(network,
 350                                 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
 351
 352                 pending_network = NULL;
 353
 354                 connman_error("%s", error.message);
 355
 356                 dbus_error_free(&error);
 357         } else
 358                 pending_network = network;
 359
 360 done:
 361         dbus_message_unref(reply);
 362
 363         dbus_pending_call_unref(call);
 364 }
 365
 366 static int set_network_active(struct connman_network *network,
 367                                                 dbus_bool_t active)
 368 {
 369         DBusMessage *message;
 370         DBusPendingCall *call;
 371         DBusMessageIter iter;
 372
 373         const char *path = connman_network_get_string(network, "Path");
 374
 375         DBG("network %p, path %s, active %d", network, path, active);
 376
 377         if (path == NULL)
 378                 return -EINVAL;
 379
 380         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 381                                 OFONO_PRI_CONTEXT_INTERFACE, SET_PROPERTY);
 382         if (message == NULL)
 383                 return -ENOMEM;
 384
 385         dbus_message_set_auto_start(message, FALSE);
 386
 387         dbus_message_iter_init_append(message, &iter);
 388         connman_dbus_property_append_basic(&iter, "Active",
 389                                                 DBUS_TYPE_BOOLEAN, &active);
 390
 391         if (dbus_connection_send_with_reply(connection, message,
 392                                         &call, TIMEOUT * 10) == FALSE) {
 393                 connman_error("Failed to connect service");
 394                 dbus_message_unref(message);
 395                 return -EINVAL;
 396         }
 397
 398         if (call == NULL) {
 399                 connman_error("D-Bus connection not available");
 400                 dbus_message_unref(message);
 401                 return -EINVAL;
 402         }
 403
 404         connman_network_ref(network);
 405
 406         dbus_pending_call_set_notify(call, set_active_reply, network, NULL);
 407
 408         dbus_message_unref(message);
 409
 410         if (active == TRUE)
 411                 return -EINPROGRESS;
 412
 413         return 0;
 414 }
 415
 416 static int network_connect(struct connman_network *network)
 417 {
 418         if (connman_network_get_index(network) >= 0)
 419                 return -EISCONN;
 420
 421         return set_network_active(network, TRUE);
 422 }
 423
 424 static int network_disconnect(struct connman_network *network)
 425 {
 426         if (connman_network_get_index(network) < 0)
 427                 return -ENOTCONN;
 428
 429         return set_network_active(network, FALSE);
 430 }
 431
 432 static void network_remove(struct connman_network *network)
 433 {
 434         DBG("network %p", network);
 435 }
 436
 437 static struct connman_network_driver network_driver = {
 438         .name           = "network",
 439         .type           = CONNMAN_NETWORK_TYPE_CELLULAR,
 440         .probe          = network_probe,
 441         .remove         = network_remove,
 442         .connect        = network_connect,
 443         .disconnect     = network_disconnect,
 444 };
 445
 446 static void add_network(struct connman_device *device, const char *path)
 447 {
 448         struct connman_network *network;
 449         char *ident;
 450
 451         DBG("device %p path %s", device, path);
 452
 453         network = connman_device_get_network(device, path);
 454         if (network != NULL)
 455                 return;
 456
 457         ident = get_ident(path);
 458
 459         network = connman_network_create(ident,
 460                                         CONNMAN_NETWORK_TYPE_CELLULAR);
 461         if (network == NULL)
 462                 return;
 463
 464         g_free(ident);
 465
 466         connman_network_set_string(network, "Path", path);
 467         connman_network_set_available(network, TRUE);
 468         connman_network_set_index(network, -1);
 469         connman_device_add_network(device, network);
 470 }
 471
 472 static void add_networks(struct connman_device *device, DBusMessageIter *array)
 473 {
 474         DBusMessageIter entry;
 475
 476         DBG("");
 477
 478         dbus_message_iter_recurse(array, &entry);
 479
 480         while (dbus_message_iter_get_arg_type(&entry) ==
 481                                         DBUS_TYPE_OBJECT_PATH) {
 482                 const char *path;
 483
 484                 dbus_message_iter_get_basic(&entry, &path);
 485
 486                 add_network(device, path);
 487
 488                 dbus_message_iter_next(&entry);
 489         }
 490 }
 491
 492 static void check_networks_reply(DBusPendingCall *call, void *user_data)
 493 {
 494         struct connman_device *device = user_data;
 495         DBusMessage *reply;
 496         DBusMessageIter array, dict, contexts;
 497         dbus_bool_t attached;
 498
 499         DBG("device %p", device);
 500
 501         reply = dbus_pending_call_steal_reply(call);
 502
 503         if (dbus_message_iter_init(reply, &array) == FALSE)
 504                 goto done;
 505
 506         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 507                 goto done;
 508
 509         dbus_message_iter_recurse(&array, &dict);
 510
 511         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 512                 DBusMessageIter entry, value;
 513                 const char *key;
 514
 515                 dbus_message_iter_recurse(&dict, &entry);
 516                 dbus_message_iter_get_basic(&entry, &key);
 517
 518                 dbus_message_iter_next(&entry);
 519                 dbus_message_iter_recurse(&entry, &value);
 520
 521                 DBG("key %s", key);
 522
 523                 if (g_str_equal(key, "Attached") == TRUE) {
 524                         dbus_message_iter_get_basic(&value, &attached);
 525                         DBG("Attached %d", attached);
 526                 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
 527                         contexts = value;
 528                 } else if (g_str_equal(key, "Status") == TRUE) {
 529                         const char *status;
 530
 531                         dbus_message_iter_get_basic(&value, &status);
 532                         /* FIXME: add roaming support */
 533                 } else if (g_str_equal(key, "Powered") == TRUE) {
 534                         dbus_bool_t powered;
 535
 536                         dbus_message_iter_get_basic(&value, &powered);
 537
 538                         connman_device_set_powered(device, powered);
 539                 }
 540
 541                 dbus_message_iter_next(&dict);
 542         }
 543
 544         if (attached == TRUE)
 545                 add_networks(device, &contexts);
 546
 547 done:
 548         dbus_message_unref(reply);
 549
 550         dbus_pending_call_unref(call);
 551 }
 552
 553 static void check_networks(struct modem_data *modem)
 554 {
 555         DBusMessage *message;
 556         DBusPendingCall *call;
 557         struct connman_device *device;
 558
 559         DBG("modem %p", modem);
 560
 561         if (modem == NULL)
 562                 return;
 563
 564         device = modem->device;
 565         if (device == NULL)
 566                 return;
 567
 568         message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
 569                                         OFONO_GPRS_INTERFACE, GET_PROPERTIES);
 570         if (message == NULL)
 571                 return;
 572
 573         dbus_message_set_auto_start(message, FALSE);
 574
 575         if (dbus_connection_send_with_reply(connection, message,
 576                                                 &call, TIMEOUT) == FALSE) {
 577                 connman_error("Failed to get ofono GPRS");
 578                 goto done;
 579         }
 580
 581         if (call == NULL) {
 582                 connman_error("D-Bus connection not available");
 583                 goto done;
 584         }
 585
 586         dbus_pending_call_set_notify(call, check_networks_reply,
 587                                                 (void *)device, NULL);
 588
 589 done:
 590         dbus_message_unref(message);
 591 }
 592
 593 static void add_device(const char *path, const char *imsi)
 594 {
 595         struct modem_data *modem;
 596         struct connman_device *device;
 597
 598         DBG("path %s imsi %s", path, imsi);
 599
 600         if (path == NULL)
 601                 return;
 602
 603         if (imsi == NULL)
 604                 return;
 605
 606         modem = g_hash_table_lookup(modem_hash, path);
 607         if (modem == NULL)
 608                 return;
 609
 610         device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
 611         if (device == NULL)
 612                 return;
 613
 614         connman_device_set_ident(device, imsi);
 615
 616         connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
 617
 618         connman_device_set_string(device, "Path", path);
 619
 620         if (connman_device_register(device) < 0) {
 621                 connman_device_unref(device);
 622                 return;
 623         }
 624
 625         modem->device = device;
 626
 627         check_networks(modem);
 628 }
 629
 630 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
 631 {
 632         const char *path = user_data;
 633         DBusMessage *reply;
 634         DBusMessageIter array, dict;
 635
 636         DBG("path %s", path);
 637
 638         reply = dbus_pending_call_steal_reply(call);
 639
 640         if (dbus_message_iter_init(reply, &array) == FALSE)
 641                 goto done;
 642
 643         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 644                 goto done;
 645
 646         dbus_message_iter_recurse(&array, &dict);
 647
 648         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 649                 DBusMessageIter entry, value;
 650                 const char *key, *imsi;
 651
 652                 dbus_message_iter_recurse(&dict, &entry);
 653                 dbus_message_iter_get_basic(&entry, &key);
 654
 655                 dbus_message_iter_next(&entry);
 656                 dbus_message_iter_recurse(&entry, &value);
 657
 658                 if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
 659                         dbus_message_iter_get_basic(&value, &imsi);
 660
 661                         add_device(path, imsi);
 662                 }
 663
 664                 dbus_message_iter_next(&dict);
 665         }
 666
 667 done:
 668         dbus_message_unref(reply);
 669
 670         dbus_pending_call_unref(call);
 671 }
 672
 673 static void get_imsi(const char *path)
 674 {
 675         DBusMessage *message;
 676         DBusPendingCall *call;
 677
 678         DBG("path %s", path);
 679
 680         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 681                                 OFONO_SIM_INTERFACE, GET_PROPERTIES);
 682         if (message == NULL)
 683                 return;
 684
 685         dbus_message_set_auto_start(message, FALSE);
 686
 687         if (dbus_connection_send_with_reply(connection, message,
 688                                                 &call, TIMEOUT) == FALSE) {
 689                 connman_error("Failed to get ofono modem sim");
 690                 goto done;
 691         }
 692
 693         if (call == NULL) {
 694                 connman_error("D-Bus connection not available");
 695                 goto done;
 696         }
 697
 698         dbus_pending_call_set_notify(call, sim_properties_reply,
 699                                                 (void *)path, NULL);
 700
 701 done:
 702         dbus_message_unref(message);
 703 }
 704
 705 static int modem_change_powered(const char *path, dbus_bool_t powered)
 706 {
 707         DBusMessage *message;
 708         DBusMessageIter iter;
 709         DBusPendingCall *call;
 710
 711         DBG("path %s powered %d", path, powered);
 712
 713         if (path == NULL)
 714                 return -EINVAL;
 715
 716         message = dbus_message_new_method_call(OFONO_SERVICE, path,
 717                                         OFONO_MODEM_INTERFACE, SET_PROPERTY);
 718         if (message == NULL)
 719                 return -ENOMEM;
 720
 721         dbus_message_set_auto_start(message, FALSE);
 722
 723         dbus_message_iter_init_append(message, &iter);
 724         connman_dbus_property_append_basic(&iter, "Powered",
 725                                                 DBUS_TYPE_BOOLEAN, &powered);
 726
 727         if (dbus_connection_send_with_reply(connection, message,
 728                                                 &call, TIMEOUT) == FALSE) {
 729                 connman_error("Failed to change powered property");
 730                 dbus_message_unref(message);
 731                 return -EINVAL;
 732         }
 733
 734         if (call == NULL) {
 735                 connman_error("D-Bus connection not available");
 736                 dbus_message_unref(message);
 737                 return -EINVAL;
 738         }
 739
 740         dbus_pending_call_set_notify(call, powered_reply, NULL, NULL);
 741
 742         dbus_message_unref(message);
 743
 744         return -EINPROGRESS;
 745 }
 746
 747 static struct modem_data *add_modem(const char *path)
 748 {
 749         struct modem_data *modem;
 750
 751         if (path == NULL)
 752                 return NULL;
 753
 754         modem = g_hash_table_lookup(modem_hash, path);
 755         if (modem != NULL) {
 756                 modem->available = TRUE;
 757
 758                 return modem;
 759         }
 760
 761         modem = g_try_new0(struct modem_data, 1);
 762         if (modem == NULL)
 763                 return NULL;
 764
 765         modem->path = g_strdup(path);
 766         modem->device = NULL;
 767         modem->available = TRUE;
 768
 769         g_hash_table_insert(modem_hash, g_strdup(path), modem);
 770
 771         return modem;
 772 }
 773
 774 static gboolean modem_has_gprs(DBusMessageIter *array)
 775 {
 776         DBusMessageIter entry;
 777
 778         dbus_message_iter_recurse(array, &entry);
 779
 780         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
 781                 const char *interface;
 782
 783                 dbus_message_iter_get_basic(&entry, &interface);
 784
 785                 if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
 786                         return TRUE;
 787
 788                 dbus_message_iter_next(&entry);
 789         }
 790
 791         return FALSE;
 792 }
 793
 794 static void modem_properties_reply(DBusPendingCall *call, void *user_data)
 795 {
 796         DBusMessage *reply;
 797         DBusMessageIter array, dict;
 798         const char *path = user_data;
 799
 800         DBG("path %s", path);
 801
 802         reply = dbus_pending_call_steal_reply(call);
 803
 804         if (dbus_message_iter_init(reply, &array) == FALSE)
 805                 goto done;
 806
 807         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 808                 goto done;
 809
 810         dbus_message_iter_recurse(&array, &dict);
 811
 812         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 813                 DBusMessageIter entry, value;
 814                 const char *key;
 815                 dbus_bool_t powered;
 816
 817                 dbus_message_iter_recurse(&dict, &entry);
 818                 dbus_message_iter_get_basic(&entry, &key);
 819
 820                 dbus_message_iter_next(&entry);
 821                 dbus_message_iter_recurse(&entry, &value);
 822
 823                 if (g_str_equal(key, "Powered") == TRUE) {
 824                         dbus_message_iter_get_basic(&value, &powered);
 825
 826                         if (powered == FALSE) {
 827                                 modem_change_powered(path, TRUE);
 828                                 break;
 829                         }
 830                 } else if (g_str_equal(key, "Interface") == TRUE) {
 831                         if (modem_has_gprs(&value) == TRUE)
 832                                 get_imsi(path);
 833                 }
 834
 835                 dbus_message_iter_next(&dict);
 836         }
 837
 838 done:
 839         dbus_message_unref(reply);
 840
 841         dbus_pending_call_unref(call);
 842 }
 843
 844 static void get_modem_properties(struct modem_data *modem)
 845 {
 846         DBusMessage *message;
 847         DBusPendingCall *call;
 848
 849         DBG("path %s", modem->path);
 850
 851         if (modem->path == NULL)
 852                 return;
 853
 854         message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
 855                                 OFONO_MODEM_INTERFACE, GET_PROPERTIES);
 856         if (message == NULL)
 857                 return;
 858
 859         dbus_message_set_auto_start(message, FALSE);
 860
 861         if (dbus_connection_send_with_reply(connection, message,
 862                                                 &call, TIMEOUT) == FALSE) {
 863                 connman_error("Failed to get ofono modem");
 864                 goto done;
 865         }
 866
 867         if (call == NULL) {
 868                 connman_error("D-Bus connection not available");
 869                 goto done;
 870         }
 871
 872         dbus_pending_call_set_notify(call, modem_properties_reply,
 873                                                 (void *)modem->path, NULL);
 874
 875 done:
 876         dbus_message_unref(message);
 877 }
 878
 879 static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
 880 {
 881         struct modem_data *modem = value;
 882
 883         modem->available = FALSE;
 884 }
 885
 886 static void modems_set_unavailable()
 887 {
 888         g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
 889 }
 890
 891 static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
 892 {
 893         struct modem_data *modem = value;
 894
 895         if (modem->available == FALSE)
 896                 g_hash_table_remove(modem_hash, key);
 897 }
 898
 899 static void cleanup_modems()
 900 {
 901         g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
 902 }
 903
 904 static void update_modems(DBusMessageIter *array)
 905 {
 906         DBusMessageIter entry;
 907
 908         dbus_message_iter_recurse(array, &entry);
 909
 910         modems_set_unavailable();
 911
 912         while (dbus_message_iter_get_arg_type(&entry) ==
 913                                         DBUS_TYPE_OBJECT_PATH) {
 914                 const char *path;
 915                 struct modem_data *modem;
 916
 917                 dbus_message_iter_get_basic(&entry, &path);
 918
 919                 modem = add_modem(path);
 920                 if (modem != NULL)
 921                         get_modem_properties(modem);
 922
 923                 dbus_message_iter_next(&entry);
 924         }
 925
 926         cleanup_modems();
 927 }
 928
 929 static void manager_properties_reply(DBusPendingCall *call, void *user_data)
 930 {
 931         DBusMessage *reply;
 932         DBusMessageIter array, dict;
 933
 934         DBG("");
 935
 936         reply = dbus_pending_call_steal_reply(call);
 937
 938         if (dbus_message_iter_init(reply, &array) == FALSE)
 939                 goto done;
 940
 941         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
 942                 goto done;
 943
 944         dbus_message_iter_recurse(&array, &dict);
 945
 946         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
 947                 DBusMessageIter entry, value;
 948                 const char *key;
 949
 950                 dbus_message_iter_recurse(&dict, &entry);
 951                 dbus_message_iter_get_basic(&entry, &key);
 952
 953                 dbus_message_iter_next(&entry);
 954                 dbus_message_iter_recurse(&entry, &value);
 955
 956                 if (g_str_equal(key, "Modems") == TRUE) {
 957                         update_modems(&value);
 958                         break;
 959                 }
 960
 961                 dbus_message_iter_next(&dict);
 962         }
 963
 964 done:
 965         dbus_message_unref(reply);
 966
 967         dbus_pending_call_unref(call);
 968 }
 969
 970 static void modem_remove_device(struct modem_data *modem)
 971 {
 972         if (modem->device == NULL)
 973                 return;
 974
 975         connman_device_unregister(modem->device);
 976         connman_device_unref(modem->device);
 977
 978         modem->device = NULL;
 979 }
 980
 981 static void remove_modem(gpointer data)
 982 {
 983         struct modem_data *modem = data;
 984
 985         g_free(modem->path);
 986
 987         modem_remove_device(modem);
 988
 989         g_free(modem);
 990 }
 991
 992 static void ofono_connect(DBusConnection *connection, void *user_data)
 993 {
 994         DBusMessage *message;
 995         DBusPendingCall *call;
 996
 997         DBG("connection %p", connection);
 998
 999         modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1000                                                 g_free, remove_modem);
1001
1002         message = dbus_message_new_method_call(OFONO_SERVICE, "/",
1003                                 OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
1004         if (message == NULL)
1005                 return;
1006
1007         dbus_message_set_auto_start(message, FALSE);
1008
1009         if (dbus_connection_send_with_reply(connection, message,
1010                                                 &call, TIMEOUT) == FALSE) {
1011                 connman_error("Failed to get ofono modems");
1012                 goto done;
1013         }
1014
1015         if (call == NULL) {
1016                 connman_error("D-Bus connection not available");
1017                 goto done;
1018         }
1019
1020         dbus_pending_call_set_notify(call, manager_properties_reply,
1021                                                                 NULL, NULL);
1022
1023 done:
1024         dbus_message_unref(message);
1025
1026 }
1027
1028 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1029 {
1030         DBG("connection %p", connection);
1031
1032         if (modem_hash == NULL)
1033                 return;
1034
1035         g_hash_table_destroy(modem_hash);
1036
1037         modem_hash = NULL;
1038 }
1039
1040 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1041                                 void *user_data)
1042 {
1043         const char *path = dbus_message_get_path(message);
1044         struct modem_data *modem;
1045         DBusMessageIter iter, value;
1046         const char *key;
1047
1048         DBG("path %s", path);
1049
1050         modem = g_hash_table_lookup(modem_hash, path);
1051         if (modem == NULL)
1052                 return TRUE;
1053
1054         if (dbus_message_iter_init(message, &iter) == FALSE)
1055                 return TRUE;
1056
1057         dbus_message_iter_get_basic(&iter, &key);
1058
1059         dbus_message_iter_next(&iter);
1060         dbus_message_iter_recurse(&iter, &value);
1061
1062         if (g_str_equal(key, "Powered") == TRUE) {
1063                 dbus_bool_t powered;
1064
1065                 dbus_message_iter_get_basic(&value, &powered);
1066                 if (powered == TRUE)
1067                         return TRUE;
1068
1069                 modem_remove_device(modem);
1070         } else if (g_str_equal(key, "Interfaces") == TRUE) {
1071                 if (modem_has_gprs(&value) == TRUE) {
1072                         if (modem->device == NULL)
1073                                 get_imsi(modem->path);
1074                 } else if (modem->device != NULL)
1075                         modem_remove_device(modem);
1076         }
1077
1078         return TRUE;
1079 }
1080
1081 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1082                                 void *user_data)
1083 {
1084         const char *path = dbus_message_get_path(message);
1085         struct modem_data *modem;
1086         DBusMessageIter iter, value;
1087         const char *key;
1088
1089         DBG("path %s", path);
1090
1091         modem = g_hash_table_lookup(modem_hash, path);
1092         if (modem == NULL)
1093                 return TRUE;
1094
1095         if (dbus_message_iter_init(message, &iter) == FALSE)
1096                 return TRUE;
1097
1098         dbus_message_iter_get_basic(&iter, &key);
1099
1100         dbus_message_iter_next(&iter);
1101         dbus_message_iter_recurse(&iter, &value);
1102
1103         if (g_str_equal(key, "Attached") == TRUE) {
1104                 dbus_bool_t attached;
1105
1106                 dbus_message_iter_get_basic(&value, &attached);
1107
1108                 DBG("Attached %d", attached);
1109
1110                 if (attached == TRUE)
1111                         check_networks(modem);
1112                 else if (modem->device != NULL)
1113                         connman_device_remove_all_networks(modem->device);
1114
1115         } else if (g_str_equal(key, "Status") == TRUE) {
1116                 const char *status;
1117                 dbus_message_iter_get_basic(&value, &status);
1118
1119                 DBG("status %s", status);
1120
1121                 /* FIXME: add roaming support */
1122         } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
1123                 check_networks(modem);
1124         } else if (g_str_equal(key, "Powered") == TRUE) {
1125                 dbus_bool_t powered;
1126
1127                 if (modem->device == NULL)
1128                         return TRUE;
1129
1130                 dbus_message_iter_get_basic(&value, &powered);
1131                 connman_device_set_powered(modem->device, powered);
1132         }
1133
1134         return TRUE;
1135 }
1136
1137 static gboolean manager_changed(DBusConnection *connection,
1138                                 DBusMessage *message, void *user_data)
1139 {
1140         const char *path = dbus_message_get_path(message);
1141         DBusMessageIter iter, value;
1142         const char *key;
1143
1144         DBG("path %s", path);
1145
1146         if (dbus_message_iter_init(message, &iter) == FALSE)
1147                 return TRUE;
1148
1149         dbus_message_iter_get_basic(&iter, &key);
1150
1151         dbus_message_iter_next(&iter);
1152         dbus_message_iter_recurse(&iter, &value);
1153
1154         if (g_str_equal(key, "Modems") == TRUE)
1155                 update_modems(&value);
1156
1157         return TRUE;
1158 }
1159
1160 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1161 {
1162         DBusMessageIter entry;
1163         gchar *nameserver = NULL, *nameserver_old = NULL;
1164
1165         DBG("");
1166
1167         dbus_message_iter_recurse(array, &entry);
1168
1169         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1170                 const char *dns;
1171
1172                 dbus_message_iter_get_basic(&entry, &dns);
1173
1174                 DBG("dns %s", dns);
1175
1176                 if (nameserver == NULL) {
1177
1178                         nameserver = g_strdup(dns);
1179                 } else {
1180
1181                         nameserver_old = nameserver;
1182                         nameserver = g_strdup_printf("%s %s",
1183                                                 nameserver_old, dns);
1184                         g_free(nameserver_old);
1185                 }
1186
1187                 dbus_message_iter_next(&entry);
1188         }
1189
1190         parent->ipv4.nameserver = nameserver;
1191 }
1192
1193 static void update_settings(DBusMessageIter *array,
1194                         struct connman_element *parent)
1195 {
1196         DBusMessageIter dict;
1197         const char *interface = NULL;
1198
1199         DBG("");
1200
1201         if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1202                 return;
1203
1204         dbus_message_iter_recurse(array, &dict);
1205
1206         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1207                 DBusMessageIter entry, value;
1208                 const char *key;
1209
1210                 dbus_message_iter_recurse(&dict, &entry);
1211                 dbus_message_iter_get_basic(&entry, &key);
1212
1213                 dbus_message_iter_next(&entry);
1214                 dbus_message_iter_recurse(&entry, &value);
1215
1216                 if (g_str_equal(key, "Interface") == TRUE) {
1217                         int index;
1218
1219                         dbus_message_iter_get_basic(&value, &interface);
1220
1221                         DBG("interface %s", interface);
1222
1223                         index = connman_inet_ifindex(interface);
1224                         if (index >= 0) {
1225                                 connman_network_set_index(
1226                                         pending_network, index);
1227                         } else {
1228                                 connman_error("Can not find interface %s",
1229                                                                 interface);
1230                                 break;
1231                         }
1232                 } else if (g_str_equal(key, "Method") == TRUE) {
1233                         const char *method;
1234
1235                         dbus_message_iter_get_basic(&value, &method);
1236                         if (g_strcmp0(method, "static") == 0) {
1237
1238                                 parent->ipv4.method =
1239                                         CONNMAN_IPCONFIG_METHOD_FIXED;
1240                         } else if (g_strcmp0(method, "dhcp") == 0) {
1241
1242                                 parent->ipv4.method =
1243                                         CONNMAN_IPCONFIG_METHOD_DHCP;
1244                                 break;
1245                         }
1246                 } else if (g_str_equal(key, "Address") == TRUE) {
1247                         const char *address;
1248
1249                         dbus_message_iter_get_basic(&value, &address);
1250
1251                         DBG("address %s", address);
1252
1253                         parent->ipv4.address = g_strdup(address);
1254                 } else if (g_str_equal(key, "Netmask") == TRUE) {
1255                         const char *netmask;
1256
1257                         dbus_message_iter_get_basic(&value, &netmask);
1258
1259                         DBG("netmask %s", netmask);
1260
1261                         parent->ipv4.netmask = g_strdup(netmask);
1262                 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1263
1264                         get_dns(&value, parent);
1265                 } else if (g_str_equal(key, "Gateway") == TRUE) {
1266                         const char *gateway;
1267
1268                         dbus_message_iter_get_basic(&value, &gateway);
1269
1270                         DBG("gateway %s", gateway);
1271
1272                         parent->ipv4.gateway = g_strdup(gateway);
1273                 }
1274
1275                 dbus_message_iter_next(&dict);
1276         }
1277
1278         /* deactive, oFono send NULL inteface before deactive signal */
1279         if (interface == NULL)
1280                 connman_network_set_index(pending_network, -1);
1281 }
1282
1283 static void cleanup_ipconfig(struct connman_element *parent)
1284 {
1285         g_free(parent->ipv4.address);
1286         parent->ipv4.address = NULL;
1287
1288         g_free(parent->ipv4.netmask);
1289         parent->ipv4.netmask = NULL;
1290
1291         g_free(parent->ipv4.nameserver);
1292         parent->ipv4.nameserver = NULL;
1293
1294         g_free(parent->ipv4.gateway);
1295         parent->ipv4.gateway = NULL;
1296
1297         parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1298 }
1299
1300 static int static_network_set_connected(
1301                 struct connman_network *pending_network,
1302                                 struct connman_element *parent,
1303                                         connman_bool_t connected)
1304 {
1305         if (connected == TRUE) {
1306                 struct connman_element *element;
1307
1308                 if (parent->ipv4.address == NULL)
1309                         goto failed;
1310
1311                 if (parent->ipv4.netmask == NULL)
1312                         goto failed;
1313
1314                 element = connman_element_create(NULL);
1315                 if (element == NULL) {
1316                         connman_error("Can not create connman_element");
1317                         return -ENOMEM;
1318                 }
1319
1320                 element->type = CONNMAN_ELEMENT_TYPE_IPV4;
1321                 element->index = parent->index;
1322
1323                 if (connman_element_register(element, parent) < 0) {
1324                         connman_element_unref(element);
1325                         goto failed;
1326                 }
1327         } else
1328                 cleanup_ipconfig(parent);
1329
1330         connman_network_set_connected(pending_network, connected);
1331
1332         return 0;
1333
1334 failed:
1335         connman_network_set_error(pending_network,
1336                 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
1337
1338         cleanup_ipconfig(parent);
1339
1340         return -EINVAL;
1341 }
1342
1343 static gboolean pri_context_changed(DBusConnection *connection,
1344                                         DBusMessage *message, void *user_data)
1345 {
1346         const char *path = dbus_message_get_path(message);
1347         struct connman_element *parent;
1348         const char *pending_path;
1349         DBusMessageIter iter, value;
1350         const char *key;
1351
1352         DBG("pending_network %p, path %s", pending_network, path);
1353
1354         if (pending_network == NULL)
1355                 return TRUE;
1356
1357         pending_path = connman_network_get_string(pending_network, "Path");
1358         if (g_strcmp0(pending_path, path) != 0)
1359                 return TRUE;
1360
1361         parent = connman_network_get_element(pending_network);
1362
1363         if (dbus_message_iter_init(message, &iter) == FALSE)
1364                 return TRUE;
1365
1366         dbus_message_iter_get_basic(&iter, &key);
1367
1368         dbus_message_iter_next(&iter);
1369         dbus_message_iter_recurse(&iter, &value);
1370
1371         if (g_str_equal(key, "Settings") == TRUE) {
1372
1373                 update_settings(&value, parent);
1374         } else if (g_str_equal(key, "Active") == TRUE) {
1375                 dbus_bool_t active;
1376
1377                 dbus_message_iter_get_basic(&value, &active);
1378
1379                 switch (parent->ipv4.method) {
1380                 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1381                 case CONNMAN_IPCONFIG_METHOD_OFF:
1382                 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1383                         break;
1384                 case CONNMAN_IPCONFIG_METHOD_FIXED:
1385                         if (static_network_set_connected(
1386                                         pending_network, parent, active) < 0)
1387                                 set_network_active(pending_network, FALSE);
1388                         break;
1389                 case CONNMAN_IPCONFIG_METHOD_DHCP:
1390                         connman_network_set_method(pending_network,
1391                                                 CONNMAN_IPCONFIG_METHOD_DHCP);
1392                         connman_network_set_connected(pending_network, active);
1393                         break;
1394                 }
1395
1396                 pending_network = NULL;
1397         }
1398
1399         return TRUE;
1400 }
1401
1402 static guint watch;
1403 static guint gprs_watch;
1404 static guint modem_watch;
1405 static guint manager_watch;
1406 static guint context_watch;
1407
1408 static int ofono_init(void)
1409 {
1410         int err;
1411
1412         connection = connman_dbus_get_connection();
1413         if (connection == NULL)
1414                 return -EIO;
1415
1416         watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1417                         ofono_connect, ofono_disconnect, NULL, NULL);
1418
1419         gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1420                                                 OFONO_GPRS_INTERFACE,
1421                                                 PROPERTY_CHANGED,
1422                                                 gprs_changed,
1423                                                 NULL, NULL);
1424
1425         modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1426                                                 OFONO_MODEM_INTERFACE,
1427                                                 PROPERTY_CHANGED,
1428                                                 modem_changed,
1429                                                 NULL, NULL);
1430
1431         manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1432                                                 OFONO_MANAGER_INTERFACE,
1433                                                 PROPERTY_CHANGED,
1434                                                 manager_changed,
1435                                                 NULL, NULL);
1436
1437         context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1438                                                 OFONO_PRI_CONTEXT_INTERFACE,
1439                                                 PROPERTY_CHANGED,
1440                                                 pri_context_changed,
1441                                                 NULL, NULL);
1442
1443         if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1444                         manager_watch == 0 || context_watch == 0) {
1445                 err = -EIO;
1446                 goto remove;
1447         }
1448
1449         err = connman_network_driver_register(&network_driver);
1450         if (err < 0)
1451                 goto remove;
1452
1453         err = connman_device_driver_register(&modem_driver);
1454         if (err < 0) {
1455                 connman_network_driver_unregister(&network_driver);
1456                 goto remove;
1457         }
1458
1459         return 0;
1460
1461 remove:
1462         g_dbus_remove_watch(connection, watch);
1463         g_dbus_remove_watch(connection, gprs_watch);
1464         g_dbus_remove_watch(connection, modem_watch);
1465         g_dbus_remove_watch(connection, manager_watch);
1466         g_dbus_remove_watch(connection, context_watch);
1467
1468         dbus_connection_unref(connection);
1469
1470         return err;
1471 }
1472
1473 static void ofono_exit(void)
1474 {
1475         g_dbus_remove_watch(connection, watch);
1476         g_dbus_remove_watch(connection, gprs_watch);
1477         g_dbus_remove_watch(connection, modem_watch);
1478         g_dbus_remove_watch(connection, manager_watch);
1479         g_dbus_remove_watch(connection, context_watch);
1480
1481         ofono_disconnect(connection, NULL);
1482
1483         connman_device_driver_unregister(&modem_driver);
1484         connman_network_driver_unregister(&network_driver);
1485
1486         dbus_connection_unref(connection);
1487 }
1488
1489 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1490                 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)