ofono: Set network group when adding the network
[platform/upstream/connman.git] / 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 *properties)
999 {
1000         struct modem_data *modem;
1001         DBusMessageIter dict;
1002         dbus_bool_t powered = FALSE;
1003         dbus_bool_t online = FALSE;
1004         dbus_bool_t has_online = FALSE;
1005         gboolean has_sim = FALSE;
1006         gboolean has_reg = FALSE;
1007         gboolean has_gprs = FALSE;
1008
1009         modem = g_hash_table_lookup(modem_hash, path);
1010
1011         if (modem != NULL)
1012                 return;
1013
1014         modem = g_try_new0(struct modem_data, 1);
1015         if (modem == NULL)
1016                 return;
1017
1018         modem->path = g_strdup(path);
1019         modem->device = NULL;
1020         modem->available = TRUE;
1021
1022         g_hash_table_insert(modem_hash, g_strdup(path), modem);
1023
1024         dbus_message_iter_recurse(properties, &dict);
1025
1026         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1027                 DBusMessageIter entry, value;
1028                 const char *key;
1029
1030                 dbus_message_iter_recurse(&dict, &entry);
1031                 dbus_message_iter_get_basic(&entry, &key);
1032
1033                 dbus_message_iter_next(&entry);
1034                 dbus_message_iter_recurse(&entry, &value);
1035
1036                 if (g_str_equal(key, "Powered") == TRUE)
1037                         dbus_message_iter_get_basic(&value, &powered);
1038                 else if (g_str_equal(key, "Online") == TRUE) {
1039                         has_online = TRUE;
1040                         dbus_message_iter_get_basic(&value, &online);
1041                 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1042                         has_sim = modem_has_sim(&value);
1043                         has_reg = modem_has_reg(&value);
1044                         has_gprs = modem_has_gprs(&value);
1045                 }
1046
1047                 dbus_message_iter_next(&dict);
1048         }
1049
1050         if (!powered)
1051                 modem_change_powered(path, TRUE);
1052
1053         modem->has_sim = has_sim;
1054         modem->has_reg = has_reg;
1055         modem->has_gprs = has_gprs;
1056
1057         update_modem_online(modem, online);
1058
1059         if (has_sim)
1060                 get_imsi(path);
1061 }
1062
1063 static void manager_modems_reply(DBusPendingCall *call, void *user_data)
1064 {
1065         DBusMessage *reply;
1066         DBusError error;
1067         DBusMessageIter array, dict;
1068
1069         DBG("");
1070
1071         reply = dbus_pending_call_steal_reply(call);
1072
1073         if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
1074                 goto done;
1075
1076         dbus_error_init(&error);
1077
1078         if (dbus_set_error_from_message(&error, reply)) {
1079                 connman_error("ModemManager.GetModems() %s %s",
1080                                 error.name, error.message);
1081                 dbus_error_free(&error);
1082                 goto done;
1083         }
1084
1085         if (dbus_message_iter_init(reply, &array) == FALSE)
1086                 goto done;
1087
1088         dbus_message_iter_recurse(&array, &dict);
1089
1090         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) {
1091                 DBusMessageIter value, properties;
1092                 const char *modem_path;
1093
1094                 dbus_message_iter_recurse(&dict, &value);
1095                 dbus_message_iter_get_basic(&value, &modem_path);
1096
1097                 dbus_message_iter_next(&value);
1098                 dbus_message_iter_recurse(&value, &properties);
1099
1100                 /* Add modem */
1101                 add_modem(modem_path, &properties);
1102
1103                 dbus_message_iter_next(&dict);
1104         }
1105
1106 done:
1107         dbus_message_unref(reply);
1108
1109         dbus_pending_call_unref(call);
1110 }
1111
1112 static void ofono_connect(DBusConnection *connection, void *user_data)
1113 {
1114         DBG("connection %p", connection);
1115
1116         modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1117                                                 g_free, remove_modem);
1118
1119         network_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1120                                                 NULL, remove_network);
1121
1122         call_ofono("/", OFONO_MANAGER_INTERFACE, GET_MODEMS,
1123                         manager_modems_reply, NULL, NULL,
1124                         DBUS_TYPE_INVALID);
1125 }
1126
1127 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1128 {
1129         DBG("connection %p", connection);
1130
1131         if (modem_hash == NULL)
1132                 return;
1133
1134         g_hash_table_destroy(modem_hash);
1135
1136         modem_hash = NULL;
1137 }
1138
1139 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1140                                 void *user_data)
1141 {
1142         const char *path = dbus_message_get_path(message);
1143         struct modem_data *modem;
1144         DBusMessageIter iter, value;
1145         const char *key;
1146
1147         DBG("path %s", path);
1148
1149         modem = g_hash_table_lookup(modem_hash, path);
1150         if (modem == NULL)
1151                 return TRUE;
1152
1153         if (dbus_message_iter_init(message, &iter) == FALSE)
1154                 return TRUE;
1155
1156         dbus_message_iter_get_basic(&iter, &key);
1157
1158         dbus_message_iter_next(&iter);
1159         dbus_message_iter_recurse(&iter, &value);
1160
1161         if (g_str_equal(key, "Powered") == TRUE) {
1162                 dbus_bool_t powered;
1163
1164                 dbus_message_iter_get_basic(&value, &powered);
1165                 if (powered == TRUE)
1166                         return TRUE;
1167
1168                 modem->has_sim = FALSE;
1169                 modem->has_reg = FALSE;
1170                 modem->has_gprs = FALSE;
1171
1172                 modem_remove_device(modem);
1173         } else if (g_str_equal(key, "Online") == TRUE) {
1174                 dbus_bool_t online;
1175
1176                 dbus_message_iter_get_basic(&value, &online);
1177
1178                 update_modem_online(modem, online);
1179         } else if (g_str_equal(key, "Interfaces") == TRUE) {
1180                 gboolean has_sim = modem_has_sim(&value);
1181                 gboolean has_reg = modem_has_reg(&value);
1182                 gboolean added_reg = has_reg && !modem->has_reg;
1183                 gboolean has_gprs = modem_has_gprs(&value);
1184                 gboolean added_gprs = has_gprs && !modem->has_gprs;
1185
1186                 modem->has_sim = has_sim;
1187                 modem->has_reg = has_reg;
1188                 modem->has_gprs = has_gprs;
1189
1190                 if (modem->device == NULL) {
1191                         if (has_sim)
1192                                 get_imsi(modem->path);
1193                 } else if (!has_sim) {
1194                         modem_remove_device(modem);
1195                 } else {
1196                         if (added_reg)
1197                                 check_registration(modem);
1198                         if (added_gprs)
1199                                 gprs_change_powered(modem->path, TRUE);
1200                 }
1201         }
1202
1203         return TRUE;
1204 }
1205
1206 static gboolean sim_changed(DBusConnection *connection, DBusMessage *message,
1207                                 void *user_data)
1208 {
1209         const char *path = dbus_message_get_path(message);
1210         struct modem_data *modem;
1211         DBusMessageIter iter, value;
1212         const char *key;
1213
1214         DBG("path %s", path);
1215
1216         modem = g_hash_table_lookup(modem_hash, path);
1217         if (modem == NULL)
1218                 return TRUE;
1219
1220         if (dbus_message_iter_init(message, &iter) == FALSE)
1221                 return TRUE;
1222
1223         dbus_message_iter_get_basic(&iter, &key);
1224
1225         dbus_message_iter_next(&iter);
1226         dbus_message_iter_recurse(&iter, &value);
1227
1228         if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
1229                 char *imsi;
1230
1231                 dbus_message_iter_get_basic(&value, &imsi);
1232
1233                 add_device(path, imsi);
1234         } else if (g_str_equal(key, "Present") == TRUE) {
1235                 dbus_bool_t present;
1236
1237                 dbus_message_iter_get_basic(&value, &present);
1238
1239                 if (present)
1240                         return TRUE;
1241
1242                 if (modem->device != NULL)
1243                         modem_remove_device(modem);
1244
1245                 modem->has_gprs = FALSE;
1246                 modem->has_reg = FALSE;
1247         }
1248
1249         return TRUE;
1250 }
1251
1252 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1253                                 void *user_data)
1254 {
1255         const char *path = dbus_message_get_path(message);
1256         struct modem_data *modem;
1257         DBusMessageIter iter, value;
1258         const char *key;
1259
1260         DBG("path %s", path);
1261
1262         modem = g_hash_table_lookup(modem_hash, path);
1263         if (modem == NULL)
1264                 return TRUE;
1265
1266         if (dbus_message_iter_init(message, &iter) == FALSE)
1267                 return TRUE;
1268
1269         dbus_message_iter_get_basic(&iter, &key);
1270
1271         dbus_message_iter_next(&iter);
1272         dbus_message_iter_recurse(&iter, &value);
1273
1274         if (g_str_equal(key, "Attached") == TRUE) {
1275                 dbus_bool_t attached;
1276
1277                 dbus_message_iter_get_basic(&value, &attached);
1278
1279                 DBG("Attached %d", attached);
1280
1281                 if (attached == TRUE)
1282                         check_networks(modem);
1283                 else if (modem->device != NULL)
1284                         connman_device_remove_all_networks(modem->device);
1285
1286         }
1287
1288         return TRUE;
1289 }
1290
1291 static gboolean modem_added(DBusConnection *connection,
1292                                 DBusMessage *message, void *user_data)
1293 {
1294         DBusMessageIter iter, properties;
1295         const char *modem_path;
1296
1297         DBG("");
1298
1299         if (dbus_message_iter_init(message, &iter) == FALSE)
1300                 return TRUE;
1301
1302         dbus_message_iter_get_basic(&iter, &modem_path);
1303
1304         dbus_message_iter_next(&iter);
1305         dbus_message_iter_recurse(&iter, &properties);
1306
1307         add_modem(modem_path, &properties);
1308
1309         return TRUE;
1310 }
1311
1312 static gboolean modem_removed(DBusConnection *connection,
1313                                 DBusMessage *message, void *user_data)
1314 {
1315         DBusMessageIter iter;
1316         const char *modem_path;
1317
1318         DBG("");
1319
1320         if (dbus_message_iter_init(message, &iter) == FALSE)
1321                 return TRUE;
1322
1323         dbus_message_iter_get_basic(&iter, &modem_path);
1324
1325         g_hash_table_remove(modem_hash, modem_path);
1326
1327         return TRUE;
1328 }
1329
1330
1331 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1332 {
1333         DBusMessageIter entry;
1334         gchar *nameserver = NULL, *nameserver_old = NULL;
1335
1336         DBG("");
1337
1338         dbus_message_iter_recurse(array, &entry);
1339
1340         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1341                 const char *dns;
1342
1343                 dbus_message_iter_get_basic(&entry, &dns);
1344
1345                 DBG("dns %s", dns);
1346
1347                 if (nameserver == NULL) {
1348
1349                         nameserver = g_strdup(dns);
1350                 } else {
1351
1352                         nameserver_old = nameserver;
1353                         nameserver = g_strdup_printf("%s %s",
1354                                                 nameserver_old, dns);
1355                         g_free(nameserver_old);
1356                 }
1357
1358                 dbus_message_iter_next(&entry);
1359         }
1360
1361         parent->ipv4.nameserver = nameserver;
1362 }
1363
1364 static void update_settings(DBusMessageIter *array,
1365                                 struct connman_network *network)
1366 {
1367         struct connman_element *parent = connman_network_get_element(network);
1368         DBusMessageIter dict;
1369         const char *interface = NULL;
1370
1371         DBG("network %p", network);
1372
1373         if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1374                 return;
1375
1376         dbus_message_iter_recurse(array, &dict);
1377
1378         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1379                 DBusMessageIter entry, value;
1380                 const char *key;
1381
1382                 dbus_message_iter_recurse(&dict, &entry);
1383                 dbus_message_iter_get_basic(&entry, &key);
1384
1385                 DBG("key %s", key);
1386
1387                 dbus_message_iter_next(&entry);
1388                 dbus_message_iter_recurse(&entry, &value);
1389
1390                 if (g_str_equal(key, "Interface") == TRUE) {
1391                         int index;
1392
1393                         dbus_message_iter_get_basic(&value, &interface);
1394
1395                         DBG("interface %s", interface);
1396
1397                         index = connman_inet_ifindex(interface);
1398                         if (index >= 0) {
1399                                 connman_network_set_index(network, index);
1400                         } else {
1401                                 connman_error("Can not find interface %s",
1402                                                                 interface);
1403                                 break;
1404                         }
1405                 } else if (g_str_equal(key, "Method") == TRUE) {
1406                         const char *method;
1407
1408                         dbus_message_iter_get_basic(&value, &method);
1409                         if (g_strcmp0(method, "static") == 0) {
1410
1411                                 parent->ipv4.method =
1412                                         CONNMAN_IPCONFIG_METHOD_FIXED;
1413                         } else if (g_strcmp0(method, "dhcp") == 0) {
1414
1415                                 parent->ipv4.method =
1416                                         CONNMAN_IPCONFIG_METHOD_DHCP;
1417                                 break;
1418                         }
1419                 } else if (g_str_equal(key, "Address") == TRUE) {
1420                         const char *address;
1421
1422                         dbus_message_iter_get_basic(&value, &address);
1423
1424                         DBG("address %s", address);
1425
1426                         parent->ipv4.address = g_strdup(address);
1427                 } else if (g_str_equal(key, "Netmask") == TRUE) {
1428                         const char *netmask;
1429
1430                         dbus_message_iter_get_basic(&value, &netmask);
1431
1432                         DBG("netmask %s", netmask);
1433
1434                         parent->ipv4.netmask = g_strdup(netmask);
1435                 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1436
1437                         get_dns(&value, parent);
1438                 } else if (g_str_equal(key, "Gateway") == TRUE) {
1439                         const char *gateway;
1440
1441                         dbus_message_iter_get_basic(&value, &gateway);
1442
1443                         DBG("gateway %s", gateway);
1444
1445                         parent->ipv4.gateway = g_strdup(gateway);
1446                 }
1447
1448                 dbus_message_iter_next(&dict);
1449         }
1450
1451         /* deactive, oFono send NULL inteface before deactive signal */
1452         if (interface == NULL)
1453                 connman_network_set_index(network, -1);
1454 }
1455
1456 static void cleanup_ipconfig(struct connman_network *network)
1457 {
1458         struct connman_element *parent = connman_network_get_element(network);
1459
1460         g_free(parent->ipv4.address);
1461         parent->ipv4.address = NULL;
1462
1463         g_free(parent->ipv4.netmask);
1464         parent->ipv4.netmask = NULL;
1465
1466         g_free(parent->ipv4.nameserver);
1467         parent->ipv4.nameserver = NULL;
1468
1469         g_free(parent->ipv4.gateway);
1470         parent->ipv4.gateway = NULL;
1471
1472         parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1473 }
1474
1475
1476 static void set_connected(struct connman_network *network,
1477                                 connman_bool_t connected)
1478 {
1479         struct connman_element *parent = connman_network_get_element(network);
1480         enum connman_ipconfig_method method = parent->ipv4.method;
1481
1482         switch (method) {
1483         case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1484         case CONNMAN_IPCONFIG_METHOD_OFF:
1485         case CONNMAN_IPCONFIG_METHOD_MANUAL:
1486                 return;
1487
1488         case CONNMAN_IPCONFIG_METHOD_FIXED:
1489                 connman_network_set_method(network, method);
1490
1491                 if (connected == FALSE)
1492                         cleanup_ipconfig(network);
1493
1494                 connman_network_set_connected(network, connected);
1495                 break;
1496
1497         case CONNMAN_IPCONFIG_METHOD_DHCP:
1498                 connman_network_set_method(network, method);
1499
1500                 connman_network_set_connected(network, connected);
1501                 break;
1502         }
1503 }
1504
1505 static gboolean context_changed(DBusConnection *connection,
1506                                         DBusMessage *message, void *user_data)
1507 {
1508         const char *path = dbus_message_get_path(message);
1509         struct connman_network *network;
1510         DBusMessageIter iter, value;
1511         const char *key;
1512
1513         DBG("path %s", path);
1514
1515         network = g_hash_table_lookup(network_hash, path);
1516         if (network == NULL)
1517                 return TRUE;
1518
1519         if (!pending_network_is_available(network)) {
1520                 remove_network(network);
1521                 return TRUE;
1522         }
1523
1524         if (dbus_message_iter_init(message, &iter) == FALSE)
1525                 return TRUE;
1526
1527         dbus_message_iter_get_basic(&iter, &key);
1528
1529         dbus_message_iter_next(&iter);
1530         dbus_message_iter_recurse(&iter, &value);
1531
1532         if (g_str_equal(key, "Settings") == TRUE)
1533                 update_settings(&value, network);
1534         else if (g_str_equal(key, "Active") == TRUE) {
1535                 dbus_bool_t active;
1536
1537                 dbus_message_iter_get_basic(&value, &active);
1538
1539                 set_connected(network, active);
1540         }
1541
1542         return TRUE;
1543 }
1544
1545 static guint watch;
1546 static guint reg_watch;
1547 static guint sim_watch;
1548 static guint gprs_watch;
1549 static guint modem_watch;
1550 static guint modem_added_watch;
1551 static guint modem_removed_watch;
1552 static guint context_watch;
1553
1554 static int ofono_init(void)
1555 {
1556         int err;
1557
1558         connection = connman_dbus_get_connection();
1559         if (connection == NULL)
1560                 return -EIO;
1561
1562         watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1563                         ofono_connect, ofono_disconnect, NULL, NULL);
1564
1565         reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1566                                                 OFONO_REGISTRATION_INTERFACE,
1567                                                 PROPERTY_CHANGED,
1568                                                 reg_changed,
1569                                                 NULL, NULL);
1570
1571         gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1572                                                 OFONO_GPRS_INTERFACE,
1573                                                 PROPERTY_CHANGED,
1574                                                 gprs_changed,
1575                                                 NULL, NULL);
1576
1577         modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1578                                                 OFONO_MODEM_INTERFACE,
1579                                                 PROPERTY_CHANGED,
1580                                                 modem_changed,
1581                                                 NULL, NULL);
1582
1583         sim_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1584                                                 OFONO_SIM_INTERFACE,
1585                                                 PROPERTY_CHANGED,
1586                                                 sim_changed,
1587                                                 NULL, NULL);
1588
1589         modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1590                                                 OFONO_MANAGER_INTERFACE,
1591                                                 MODEM_ADDED,
1592                                                 modem_added,
1593                                                 NULL, NULL);
1594
1595         modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1596                                                 OFONO_MANAGER_INTERFACE,
1597                                                 MODEM_REMOVED,
1598                                                 modem_removed,
1599                                                 NULL, NULL);
1600
1601         context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1602                                                 OFONO_CONTEXT_INTERFACE,
1603                                                 PROPERTY_CHANGED,
1604                                                 context_changed,
1605                                                 NULL, NULL);
1606
1607         if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1608                         reg_watch == 0 || sim_watch == 0 ||
1609                         modem_added_watch == 0 || modem_removed_watch == 0 ||
1610                                 context_watch == 0) {
1611                 err = -EIO;
1612                 goto remove;
1613         }
1614
1615         err = connman_network_driver_register(&network_driver);
1616         if (err < 0)
1617                 goto remove;
1618
1619         err = connman_device_driver_register(&modem_driver);
1620         if (err < 0) {
1621                 connman_network_driver_unregister(&network_driver);
1622                 goto remove;
1623         }
1624
1625         return 0;
1626
1627 remove:
1628         g_dbus_remove_watch(connection, watch);
1629         g_dbus_remove_watch(connection, sim_watch);
1630         g_dbus_remove_watch(connection, reg_watch);
1631         g_dbus_remove_watch(connection, gprs_watch);
1632         g_dbus_remove_watch(connection, modem_watch);
1633         g_dbus_remove_watch(connection, modem_added_watch);
1634         g_dbus_remove_watch(connection, modem_removed_watch);
1635         g_dbus_remove_watch(connection, context_watch);
1636
1637         dbus_connection_unref(connection);
1638
1639         return err;
1640 }
1641
1642 static void ofono_exit(void)
1643 {
1644         g_dbus_remove_watch(connection, watch);
1645         g_dbus_remove_watch(connection, sim_watch);
1646         g_dbus_remove_watch(connection, reg_watch);
1647         g_dbus_remove_watch(connection, gprs_watch);
1648         g_dbus_remove_watch(connection, modem_watch);
1649         g_dbus_remove_watch(connection, modem_added_watch);
1650         g_dbus_remove_watch(connection, modem_removed_watch);
1651         g_dbus_remove_watch(connection, context_watch);
1652
1653         ofono_disconnect(connection, NULL);
1654
1655         connman_device_driver_unregister(&modem_driver);
1656         connman_network_driver_unregister(&network_driver);
1657
1658         dbus_connection_unref(connection);
1659 }
1660
1661 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1662                 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)