5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
6 * Copyright (C) 2010 Nokia Corporation and/or its subsidiary(-ies).
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.
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.
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
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>
41 #define OFONO_SERVICE "org.ofono"
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"
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"
63 static DBusConnection *connection;
65 static GHashTable *modem_hash = NULL;
67 static GHashTable *network_hash;
71 struct connman_device *device;
76 gboolean pending_online;
77 gboolean requested_online;
80 uint8_t strength, has_strength;
83 static int modem_probe(struct connman_device *device)
85 DBG("device %p", device);
90 static void modem_remove(struct connman_device *device)
92 DBG("device %p", device);
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,
101 DBusMessage *message;
102 DBusPendingCall *call;
106 DBG("path %s %s.%s", path, interface, method);
111 message = dbus_message_new_method_call(OFONO_SERVICE, path,
116 dbus_message_set_auto_start(message, FALSE);
119 ok = dbus_message_append_args_valist(message, type, va);
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);
133 connman_error("D-Bus connection not available");
134 dbus_message_unref(message);
138 dbus_pending_call_set_notify(call, notify, user_data, free_function);
140 dbus_message_unref(message);
145 static void set_property_reply(DBusPendingCall *call, void *user_data)
149 char const *name = user_data;
153 dbus_error_init(&error);
155 reply = dbus_pending_call_steal_reply(call);
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);
163 dbus_message_unref(reply);
165 dbus_pending_call_unref(call);
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)
173 DBusMessage *message;
174 DBusMessageIter iter;
175 DBusPendingCall *call;
177 DBG("path %s %s.%s", path, interface, property);
179 g_assert(notify == NULL ? free_function == NULL : 1);
184 message = dbus_message_new_method_call(OFONO_SERVICE, path,
185 interface, SET_PROPERTY);
189 dbus_message_set_auto_start(message, FALSE);
191 dbus_message_iter_init_append(message, &iter);
192 connman_dbus_property_append_basic(&iter, property, type, value);
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);
203 connman_error("D-Bus connection not available");
204 dbus_message_unref(message);
208 if (notify == NULL) {
209 notify = set_property_reply;
210 user_data = (void *)property;
211 free_function = NULL;
214 dbus_pending_call_set_notify(call, notify, user_data, free_function);
216 dbus_message_unref(message);
221 static void update_modem_online(struct modem_data *modem,
222 connman_bool_t online)
224 DBG("modem %p path %s online %d", modem, modem->path, online);
226 modem->online = online;
227 modem->requested_online = online;
228 modem->pending_online = FALSE;
231 connman_device_set_powered(modem->device, online);
234 static void set_online_reply(DBusPendingCall *call, void *user_data)
236 struct modem_data *modem;
241 DBG("path %s", (char *)user_data);
243 if (modem_hash == NULL)
246 modem = g_hash_table_lookup(modem_hash, user_data);
250 reply = dbus_pending_call_steal_reply(call);
252 dbus_error_init(&error);
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);
259 result = modem->online;
261 result = modem->requested_online;
263 if (modem->pending_online)
264 update_modem_online(modem, result);
266 dbus_message_unref(reply);
268 dbus_pending_call_unref(call);
271 static int modem_change_online(char const *path, dbus_bool_t online)
273 return set_property(path, OFONO_MODEM_INTERFACE, "Online",
274 DBUS_TYPE_BOOLEAN, &online,
276 (void *)g_strdup(path), g_free);
279 static int modem_enable(struct connman_device *device)
281 const char *path = connman_device_get_string(device, "Path");
283 DBG("device %p, path, %s", device, path);
285 return modem_change_online(path, TRUE);
288 static int modem_disable(struct connman_device *device)
290 const char *path = connman_device_get_string(device, "Path");
292 DBG("device %p path %s", device, path);
294 return modem_change_online(path, FALSE);
297 static struct connman_device_driver modem_driver = {
299 .type = CONNMAN_DEVICE_TYPE_CELLULAR,
300 .probe = modem_probe,
301 .remove = modem_remove,
302 .enable = modem_enable,
303 .disable = modem_disable,
306 static void modem_remove_device(struct modem_data *modem)
308 DBG("modem %p path %s device %p", modem, modem->path, modem->device);
310 if (modem->device == NULL)
313 connman_device_remove_all_networks(modem->device);
314 connman_device_unregister(modem->device);
315 connman_device_unref(modem->device);
317 modem->device = NULL;
320 static void remove_modem(gpointer data)
322 struct modem_data *modem = data;
324 modem_remove_device(modem);
331 static void remove_network(gpointer data)
333 connman_network_unref(data);
336 static char *get_ident(const char *path)
343 pos = strrchr(path, '/');
350 static void create_service(struct connman_network *network)
357 path = connman_network_get_string(network, "Path");
359 group = get_ident(path);
361 connman_network_set_group(network, group);
364 static int network_probe(struct connman_network *network)
366 create_service(network);
370 static gboolean pending_network_is_available(struct connman_network *network)
372 /* Modem or network may be removed */
373 if (network == NULL || connman_network_get_device(network) == NULL) {
374 DBG("Modem or network was removed");
381 static void set_active_reply(DBusPendingCall *call, void *user_data)
383 char const *path = user_data;
386 struct connman_network *network;
388 network = g_hash_table_lookup(network_hash, path);
390 DBG("path %s network %p", path, network);
392 reply = dbus_pending_call_steal_reply(call);
394 if (!pending_network_is_available(network))
397 dbus_error_init(&error);
399 if (dbus_set_error_from_message(&error, reply)) {
400 connman_error("SetProperty(Active) %s %s",
401 error.name, error.message);
403 if (connman_network_get_index(network) < 0)
404 connman_network_set_error(network,
405 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
407 dbus_error_free(&error);
411 dbus_message_unref(reply);
413 dbus_pending_call_unref(call);
416 static int set_network_active(struct connman_network *network,
421 const char *path = connman_network_get_string(network, "Path");
423 DBG("network %p, path %s, active %d", network, path, active);
425 error = set_property(path, OFONO_CONTEXT_INTERFACE,
426 "Active", DBUS_TYPE_BOOLEAN, &active,
427 set_active_reply, g_strdup(path), NULL);
429 if (active == FALSE && error == -EINPROGRESS)
435 static void set_apn(struct connman_network *network)
437 const char *apn, *path;
439 apn = connman_network_get_string(network, "Cellular.APN");
443 path = connman_network_get_string(network, "Path");
447 DBG("path %s, apn %s", path, apn);
449 set_property(path, OFONO_CONTEXT_INTERFACE,
450 "AccessPointName", DBUS_TYPE_STRING, &apn,
454 static int network_connect(struct connman_network *network)
456 DBG("network %p", network);
458 if (connman_network_get_index(network) >= 0)
461 return set_network_active(network, TRUE);
464 static int network_disconnect(struct connman_network *network)
466 DBG("network %p", network);
468 if (connman_network_get_index(network) < 0)
471 return set_network_active(network, FALSE);
474 static void network_remove(struct connman_network *network)
476 char const *path = connman_network_get_string(network, "Path");
478 DBG("network %p path %s", network, path);
480 g_hash_table_remove(network_hash, path);
483 static int network_setup(struct connman_network *network, const char *key)
485 if (g_strcmp0(key, "Cellular.APN") == 0)
491 static struct connman_network_driver network_driver = {
493 .type = CONNMAN_NETWORK_TYPE_CELLULAR,
494 .probe = network_probe,
495 .remove = network_remove,
496 .connect = network_connect,
497 .disconnect = network_disconnect,
498 .setup = network_setup,
501 static void update_settings(DBusMessageIter *array,
502 struct connman_network *network);
504 static void set_connected(struct connman_network *network,
505 connman_bool_t connected);
507 static int add_network(struct connman_device *device,
508 const char *path, DBusMessageIter *dict)
510 struct modem_data *modem = connman_device_get_data(device);
511 struct connman_network *network;
513 const char *hash_path;
514 char const *operator;
515 char const *reg_status;
516 dbus_bool_t active = FALSE;
518 DBG("modem %p device %p path %s", modem, device, path);
520 ident = get_ident(path);
522 network = connman_device_get_network(device, ident);
526 network = g_hash_table_lookup(network_hash, path);
527 if (network != NULL) {
528 DBG("path %p already exists with device %p", path,
529 connman_network_get_device(network));
530 if (connman_network_get_device(network))
532 g_hash_table_remove(network_hash, path);
535 network = connman_network_create(ident, CONNMAN_NETWORK_TYPE_CELLULAR);
539 connman_network_set_string(network, "Path", path);
540 hash_path = connman_network_get_string(network, "Path");
541 if (hash_path == NULL)
543 connman_network_ref(network);
544 g_hash_table_insert(network_hash, (char *)hash_path, network);
546 connman_network_set_available(network, TRUE);
547 connman_network_set_index(network, -1);
549 operator = connman_device_get_string(device, "Operator");
551 connman_network_set_name(network, operator);
553 if (modem->has_strength)
554 connman_network_set_strength(network, modem->strength);
556 reg_status = connman_device_get_string(device, "RegistrationStatus");
558 if (!g_strcmp0(reg_status, "roaming"))
559 connman_network_set_roaming(network, TRUE);
560 else if (!g_strcmp0(reg_status, "registered"))
561 connman_network_set_roaming(network, FALSE);
563 while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) {
564 DBusMessageIter entry, value;
567 dbus_message_iter_recurse(dict, &entry);
568 dbus_message_iter_get_basic(&entry, &key);
570 dbus_message_iter_next(&entry);
571 dbus_message_iter_recurse(&entry, &value);
573 if (g_str_equal(key, "Type")) {
576 dbus_message_iter_get_basic(&value, &type);
577 if (g_strcmp0(type, "internet") != 0) {
578 DBG("path %p type %s", path, type);
581 } else if (g_str_equal(key, "AccessPointName")) {
584 dbus_message_iter_get_basic(&value, &ap);
586 connman_network_set_string(network, "Cellular.APN", ap);
587 } else if (g_str_equal(key, "Settings"))
588 update_settings(&value, network);
589 else if (g_str_equal(key, "Active") == TRUE)
590 dbus_message_iter_get_basic(&value, &active);
592 dbus_message_iter_next(dict);
595 if (connman_device_add_network(device, network) != 0)
599 set_connected(network, active);
604 connman_network_unref(network);
605 g_hash_table_remove(network_hash, hash_path);
609 static void check_networks_reply(DBusPendingCall *call, void *user_data)
611 char *path = user_data;
612 struct modem_data *modem;
614 DBusMessageIter array, entry, value, properties;
616 DBG("path %s", path);
618 modem = g_hash_table_lookup(modem_hash, path);
621 if (modem->device == NULL)
624 reply = dbus_pending_call_steal_reply(call);
626 if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
629 dbus_message_iter_init(reply, &array);
631 dbus_message_iter_recurse(&array, &entry);
633 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRUCT) {
634 char const *network_path;
636 dbus_message_iter_recurse(&entry, &value);
637 dbus_message_iter_get_basic(&value, &network_path);
639 dbus_message_iter_next(&value);
640 dbus_message_iter_recurse(&value, &properties);
642 add_network(modem->device, network_path, &properties);
644 dbus_message_iter_next(&entry);
648 dbus_message_unref(reply);
650 dbus_pending_call_unref(call);
653 static void check_networks(struct modem_data *modem)
655 char const *path = modem->path;
657 DBG("modem %p path %s", modem, path);
659 call_ofono(path, OFONO_GPRS_INTERFACE, "GetContexts",
660 check_networks_reply, g_strdup(path), g_free,
664 static void modem_operator_name_changed(struct modem_data *modem,
667 struct connman_device *device = modem->device;
674 connman_device_set_string(device, "Operator", name);
676 for (g_hash_table_iter_init(&i, network_hash);
677 g_hash_table_iter_next(&i, NULL, &value);) {
678 struct connman_network *network = value;
680 if (connman_network_get_device(network) == device) {
681 connman_network_set_name(network, name);
682 connman_network_update(network);
687 static void modem_strength_changed(struct modem_data *modem, uint8_t strength)
689 struct connman_device *device = modem->device;
693 modem->strength = strength;
694 modem->has_strength = TRUE;
699 for (g_hash_table_iter_init(&i, network_hash);
700 g_hash_table_iter_next(&i, NULL, &value);) {
701 struct connman_network *network = value;
703 if (connman_network_get_device(network) == device) {
704 connman_network_set_strength(network, strength);
705 connman_network_update(network);
710 static void modem_roaming_changed(struct modem_data *modem,
713 struct connman_device *device = modem->device;
714 connman_bool_t roaming;
721 connman_device_set_string(device, "RegistrationStatus", status);
723 if (g_str_equal(status, "roaming"))
725 else if (g_str_equal(status, "registered"))
730 for (g_hash_table_iter_init(&i, network_hash);
731 g_hash_table_iter_next(&i, NULL, &value);) {
732 struct connman_network *network = value;
734 if (connman_network_get_device(network) == device) {
735 connman_network_set_roaming(network, roaming);
736 connman_network_update(network);
741 static void modem_registration_changed(struct modem_data *modem,
742 DBusMessageIter *entry)
744 DBusMessageIter iter;
749 connman_uint8_t byte;
752 dbus_message_iter_get_basic(entry, &key);
756 dbus_message_iter_next(entry);
758 dbus_message_iter_recurse(entry, &iter);
760 type = dbus_message_iter_get_arg_type(&iter);
761 if (type != DBUS_TYPE_BYTE && type != DBUS_TYPE_STRING)
764 dbus_message_iter_get_basic(&iter, &value);
766 if (g_str_equal(key, "Name") && type == DBUS_TYPE_STRING)
767 modem_operator_name_changed(modem, value.str);
768 else if (g_str_equal(key, "Strength") && type == DBUS_TYPE_BYTE)
769 modem_strength_changed(modem, value.byte);
770 else if (g_str_equal(key, "Status") && type == DBUS_TYPE_STRING)
771 modem_roaming_changed(modem, value.str);
775 static gboolean reg_changed(DBusConnection *connection,
776 DBusMessage *message, void *user_data)
778 const char *path = dbus_message_get_path(message);
779 struct modem_data *modem;
780 DBusMessageIter iter;
782 DBG("path %s", path);
784 modem = g_hash_table_lookup(modem_hash, path);
788 if (dbus_message_iter_init(message, &iter))
789 modem_registration_changed(modem, &iter);
794 static void check_registration_reply(DBusPendingCall *call, void *user_data)
796 char const *path = user_data;
797 struct modem_data *modem;
799 DBusMessageIter array, dict, entry;
801 DBG("path %s", path);
803 modem = g_hash_table_lookup(modem_hash, path);
807 reply = dbus_pending_call_steal_reply(call);
809 if (dbus_message_iter_init(reply, &array) == FALSE)
812 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
815 dbus_message_iter_recurse(&array, &dict);
816 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
817 dbus_message_iter_recurse(&dict, &entry);
818 modem_registration_changed(modem, &entry);
819 dbus_message_iter_next(&dict);
823 dbus_message_unref(reply);
825 dbus_pending_call_unref(call);
828 static void check_registration(struct modem_data *modem)
830 char const *path = modem->path;
832 DBG("modem %p path %s", modem, path);
834 call_ofono(path, OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES,
835 check_registration_reply, g_strdup(path), g_free,
839 static void add_device(const char *path, const char *imsi)
841 struct modem_data *modem;
842 struct connman_device *device;
844 DBG("path %s imsi %s", path, imsi);
852 modem = g_hash_table_lookup(modem_hash, path);
857 if (!g_strcmp0(imsi, connman_device_get_ident(modem->device)))
860 modem_remove_device(modem);
863 if (strlen(imsi) == 0)
866 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
870 connman_device_set_ident(device, imsi);
872 connman_device_set_string(device, "Path", path);
874 connman_device_set_data(device, modem);
876 if (connman_device_register(device) < 0) {
877 connman_device_unref(device);
881 modem->device = device;
884 check_registration(modem);
886 check_networks(modem);
889 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
891 const char *path = user_data;
892 const char *imsi = NULL;
894 DBusMessageIter array, dict;
896 DBG("path %s", path);
898 reply = dbus_pending_call_steal_reply(call);
900 if (dbus_message_iter_init(reply, &array) == FALSE)
903 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
906 dbus_message_iter_recurse(&array, &dict);
908 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
909 DBusMessageIter entry, value;
912 dbus_message_iter_recurse(&dict, &entry);
913 dbus_message_iter_get_basic(&entry, &key);
915 dbus_message_iter_next(&entry);
916 dbus_message_iter_recurse(&entry, &value);
918 if (g_str_equal(key, "SubscriberIdentity")) {
919 dbus_message_iter_get_basic(&value, &imsi);
920 add_device(path, imsi);
923 dbus_message_iter_next(&dict);
927 dbus_message_unref(reply);
929 dbus_pending_call_unref(call);
932 static void get_imsi(const char *path)
934 DBG("path %s", path);
936 call_ofono(path, OFONO_SIM_INTERFACE, GET_PROPERTIES,
937 sim_properties_reply, g_strdup(path), g_free,
941 static int gprs_change_powered(const char *path, dbus_bool_t powered)
943 DBG("path %s powered %d", path, powered);
945 return set_property(path, OFONO_GPRS_INTERFACE, "Powered",
946 DBUS_TYPE_BOOLEAN, &powered,
950 static int modem_change_powered(const char *path, dbus_bool_t powered)
952 DBG("path %s powered %d", path, powered);
954 return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
955 DBUS_TYPE_BOOLEAN, &powered,
960 static gboolean modem_has_interface(DBusMessageIter *array,
961 char const *interface)
963 DBusMessageIter entry;
965 dbus_message_iter_recurse(array, &entry);
967 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
970 dbus_message_iter_get_basic(&entry, &element);
972 if (g_strcmp0(interface, element) == 0)
975 dbus_message_iter_next(&entry);
981 static gboolean modem_has_sim(DBusMessageIter *array)
983 return modem_has_interface(array, OFONO_SIM_INTERFACE);
986 static gboolean modem_has_reg(DBusMessageIter *array)
988 return modem_has_interface(array, OFONO_REGISTRATION_INTERFACE);
991 static gboolean modem_has_gprs(DBusMessageIter *array)
993 return modem_has_interface(array, OFONO_GPRS_INTERFACE);
996 static void add_modem(const char *path, DBusMessageIter *properties)
998 struct modem_data *modem;
999 DBusMessageIter dict;
1000 dbus_bool_t powered = FALSE;
1001 dbus_bool_t online = FALSE;
1002 dbus_bool_t has_online = FALSE;
1003 gboolean has_sim = FALSE;
1004 gboolean has_reg = FALSE;
1005 gboolean has_gprs = FALSE;
1007 modem = g_hash_table_lookup(modem_hash, path);
1012 modem = g_try_new0(struct modem_data, 1);
1016 modem->path = g_strdup(path);
1017 modem->device = NULL;
1018 modem->available = TRUE;
1020 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1022 dbus_message_iter_recurse(properties, &dict);
1024 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1025 DBusMessageIter entry, value;
1028 dbus_message_iter_recurse(&dict, &entry);
1029 dbus_message_iter_get_basic(&entry, &key);
1031 dbus_message_iter_next(&entry);
1032 dbus_message_iter_recurse(&entry, &value);
1034 if (g_str_equal(key, "Powered") == TRUE)
1035 dbus_message_iter_get_basic(&value, &powered);
1036 else if (g_str_equal(key, "Online") == TRUE) {
1038 dbus_message_iter_get_basic(&value, &online);
1039 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1040 has_sim = modem_has_sim(&value);
1041 has_reg = modem_has_reg(&value);
1042 has_gprs = modem_has_gprs(&value);
1045 dbus_message_iter_next(&dict);
1049 modem_change_powered(path, TRUE);
1051 modem->has_sim = has_sim;
1052 modem->has_reg = has_reg;
1053 modem->has_gprs = has_gprs;
1055 update_modem_online(modem, online);
1061 static void manager_modems_reply(DBusPendingCall *call, void *user_data)
1065 DBusMessageIter array, dict;
1069 reply = dbus_pending_call_steal_reply(call);
1071 if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
1074 dbus_error_init(&error);
1076 if (dbus_set_error_from_message(&error, reply)) {
1077 connman_error("ModemManager.GetModems() %s %s",
1078 error.name, error.message);
1079 dbus_error_free(&error);
1083 if (dbus_message_iter_init(reply, &array) == FALSE)
1086 dbus_message_iter_recurse(&array, &dict);
1088 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) {
1089 DBusMessageIter value, properties;
1090 const char *modem_path;
1092 dbus_message_iter_recurse(&dict, &value);
1093 dbus_message_iter_get_basic(&value, &modem_path);
1095 dbus_message_iter_next(&value);
1096 dbus_message_iter_recurse(&value, &properties);
1099 add_modem(modem_path, &properties);
1101 dbus_message_iter_next(&dict);
1105 dbus_message_unref(reply);
1107 dbus_pending_call_unref(call);
1110 static void ofono_connect(DBusConnection *connection, void *user_data)
1112 DBG("connection %p", connection);
1114 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1115 g_free, remove_modem);
1117 network_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1118 NULL, remove_network);
1120 call_ofono("/", OFONO_MANAGER_INTERFACE, GET_MODEMS,
1121 manager_modems_reply, NULL, NULL,
1125 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1127 DBG("connection %p", connection);
1129 if (modem_hash == NULL)
1132 g_hash_table_destroy(modem_hash);
1137 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1140 const char *path = dbus_message_get_path(message);
1141 struct modem_data *modem;
1142 DBusMessageIter iter, value;
1145 DBG("path %s", path);
1147 modem = g_hash_table_lookup(modem_hash, path);
1151 if (dbus_message_iter_init(message, &iter) == FALSE)
1154 dbus_message_iter_get_basic(&iter, &key);
1156 dbus_message_iter_next(&iter);
1157 dbus_message_iter_recurse(&iter, &value);
1159 if (g_str_equal(key, "Powered") == TRUE) {
1160 dbus_bool_t powered;
1162 dbus_message_iter_get_basic(&value, &powered);
1163 if (powered == TRUE)
1166 modem->has_sim = FALSE;
1167 modem->has_reg = FALSE;
1168 modem->has_gprs = FALSE;
1170 modem_remove_device(modem);
1171 } else if (g_str_equal(key, "Online") == TRUE) {
1174 dbus_message_iter_get_basic(&value, &online);
1176 update_modem_online(modem, online);
1177 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1178 gboolean has_sim = modem_has_sim(&value);
1179 gboolean has_reg = modem_has_reg(&value);
1180 gboolean added_reg = has_reg && !modem->has_reg;
1181 gboolean has_gprs = modem_has_gprs(&value);
1182 gboolean added_gprs = has_gprs && !modem->has_gprs;
1184 modem->has_sim = has_sim;
1185 modem->has_reg = has_reg;
1186 modem->has_gprs = has_gprs;
1188 if (modem->device == NULL) {
1190 get_imsi(modem->path);
1191 } else if (!has_sim) {
1192 modem_remove_device(modem);
1195 check_registration(modem);
1197 gprs_change_powered(modem->path, TRUE);
1204 static gboolean sim_changed(DBusConnection *connection, DBusMessage *message,
1207 const char *path = dbus_message_get_path(message);
1208 struct modem_data *modem;
1209 DBusMessageIter iter, value;
1212 DBG("path %s", path);
1214 modem = g_hash_table_lookup(modem_hash, path);
1218 if (dbus_message_iter_init(message, &iter) == FALSE)
1221 dbus_message_iter_get_basic(&iter, &key);
1223 dbus_message_iter_next(&iter);
1224 dbus_message_iter_recurse(&iter, &value);
1226 if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
1229 dbus_message_iter_get_basic(&value, &imsi);
1231 add_device(path, imsi);
1232 } else if (g_str_equal(key, "Present") == TRUE) {
1233 dbus_bool_t present;
1235 dbus_message_iter_get_basic(&value, &present);
1240 if (modem->device != NULL)
1241 modem_remove_device(modem);
1243 modem->has_gprs = FALSE;
1244 modem->has_reg = FALSE;
1250 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1253 const char *path = dbus_message_get_path(message);
1254 struct modem_data *modem;
1255 DBusMessageIter iter, value;
1258 DBG("path %s", path);
1260 modem = g_hash_table_lookup(modem_hash, path);
1264 if (dbus_message_iter_init(message, &iter) == FALSE)
1267 dbus_message_iter_get_basic(&iter, &key);
1269 dbus_message_iter_next(&iter);
1270 dbus_message_iter_recurse(&iter, &value);
1272 if (g_str_equal(key, "Attached") == TRUE) {
1273 dbus_bool_t attached;
1275 dbus_message_iter_get_basic(&value, &attached);
1277 DBG("Attached %d", attached);
1279 if (attached == TRUE)
1280 check_networks(modem);
1281 else if (modem->device != NULL)
1282 connman_device_remove_all_networks(modem->device);
1289 static gboolean modem_added(DBusConnection *connection,
1290 DBusMessage *message, void *user_data)
1292 DBusMessageIter iter, properties;
1293 const char *modem_path;
1297 if (dbus_message_iter_init(message, &iter) == FALSE)
1300 dbus_message_iter_get_basic(&iter, &modem_path);
1302 dbus_message_iter_next(&iter);
1303 dbus_message_iter_recurse(&iter, &properties);
1305 add_modem(modem_path, &properties);
1310 static gboolean modem_removed(DBusConnection *connection,
1311 DBusMessage *message, void *user_data)
1313 DBusMessageIter iter;
1314 const char *modem_path;
1318 if (dbus_message_iter_init(message, &iter) == FALSE)
1321 dbus_message_iter_get_basic(&iter, &modem_path);
1323 g_hash_table_remove(modem_hash, modem_path);
1329 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1331 DBusMessageIter entry;
1332 gchar *nameserver = NULL, *nameserver_old = NULL;
1336 dbus_message_iter_recurse(array, &entry);
1338 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1341 dbus_message_iter_get_basic(&entry, &dns);
1345 if (nameserver == NULL) {
1347 nameserver = g_strdup(dns);
1350 nameserver_old = nameserver;
1351 nameserver = g_strdup_printf("%s %s",
1352 nameserver_old, dns);
1353 g_free(nameserver_old);
1356 dbus_message_iter_next(&entry);
1359 parent->ipv4.nameserver = nameserver;
1362 static void update_settings(DBusMessageIter *array,
1363 struct connman_network *network)
1365 struct connman_element *parent = connman_network_get_element(network);
1366 DBusMessageIter dict;
1367 const char *interface = NULL;
1369 DBG("network %p", network);
1371 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1374 dbus_message_iter_recurse(array, &dict);
1376 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1377 DBusMessageIter entry, value;
1380 dbus_message_iter_recurse(&dict, &entry);
1381 dbus_message_iter_get_basic(&entry, &key);
1385 dbus_message_iter_next(&entry);
1386 dbus_message_iter_recurse(&entry, &value);
1388 if (g_str_equal(key, "Interface") == TRUE) {
1391 dbus_message_iter_get_basic(&value, &interface);
1393 DBG("interface %s", interface);
1395 index = connman_inet_ifindex(interface);
1397 connman_network_set_index(network, index);
1399 connman_error("Can not find interface %s",
1403 } else if (g_str_equal(key, "Method") == TRUE) {
1406 dbus_message_iter_get_basic(&value, &method);
1407 if (g_strcmp0(method, "static") == 0) {
1409 parent->ipv4.method =
1410 CONNMAN_IPCONFIG_METHOD_FIXED;
1411 } else if (g_strcmp0(method, "dhcp") == 0) {
1413 parent->ipv4.method =
1414 CONNMAN_IPCONFIG_METHOD_DHCP;
1417 } else if (g_str_equal(key, "Address") == TRUE) {
1418 const char *address;
1420 dbus_message_iter_get_basic(&value, &address);
1422 DBG("address %s", address);
1424 parent->ipv4.address = g_strdup(address);
1425 } else if (g_str_equal(key, "Netmask") == TRUE) {
1426 const char *netmask;
1428 dbus_message_iter_get_basic(&value, &netmask);
1430 DBG("netmask %s", netmask);
1432 parent->ipv4.netmask = g_strdup(netmask);
1433 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1435 get_dns(&value, parent);
1436 } else if (g_str_equal(key, "Gateway") == TRUE) {
1437 const char *gateway;
1439 dbus_message_iter_get_basic(&value, &gateway);
1441 DBG("gateway %s", gateway);
1443 parent->ipv4.gateway = g_strdup(gateway);
1446 dbus_message_iter_next(&dict);
1449 /* deactive, oFono send NULL inteface before deactive signal */
1450 if (interface == NULL)
1451 connman_network_set_index(network, -1);
1454 static void cleanup_ipconfig(struct connman_network *network)
1456 struct connman_element *parent = connman_network_get_element(network);
1458 g_free(parent->ipv4.address);
1459 parent->ipv4.address = NULL;
1461 g_free(parent->ipv4.netmask);
1462 parent->ipv4.netmask = NULL;
1464 g_free(parent->ipv4.nameserver);
1465 parent->ipv4.nameserver = NULL;
1467 g_free(parent->ipv4.gateway);
1468 parent->ipv4.gateway = NULL;
1470 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1474 static void set_connected(struct connman_network *network,
1475 connman_bool_t connected)
1477 struct connman_element *parent = connman_network_get_element(network);
1478 enum connman_ipconfig_method method = parent->ipv4.method;
1481 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1482 case CONNMAN_IPCONFIG_METHOD_OFF:
1483 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1486 case CONNMAN_IPCONFIG_METHOD_FIXED:
1487 connman_network_set_method(network, method);
1489 if (connected == FALSE)
1490 cleanup_ipconfig(network);
1492 connman_network_set_connected(network, connected);
1495 case CONNMAN_IPCONFIG_METHOD_DHCP:
1496 connman_network_set_method(network, method);
1498 connman_network_set_connected(network, connected);
1503 static gboolean context_changed(DBusConnection *connection,
1504 DBusMessage *message, void *user_data)
1506 const char *path = dbus_message_get_path(message);
1507 struct connman_network *network;
1508 DBusMessageIter iter, value;
1511 DBG("path %s", path);
1513 network = g_hash_table_lookup(network_hash, path);
1514 if (network == NULL)
1517 if (!pending_network_is_available(network)) {
1518 remove_network(network);
1522 if (dbus_message_iter_init(message, &iter) == FALSE)
1525 dbus_message_iter_get_basic(&iter, &key);
1527 dbus_message_iter_next(&iter);
1528 dbus_message_iter_recurse(&iter, &value);
1530 if (g_str_equal(key, "Settings") == TRUE)
1531 update_settings(&value, network);
1532 else if (g_str_equal(key, "Active") == TRUE) {
1535 dbus_message_iter_get_basic(&value, &active);
1537 set_connected(network, active);
1544 static guint reg_watch;
1545 static guint sim_watch;
1546 static guint gprs_watch;
1547 static guint modem_watch;
1548 static guint modem_added_watch;
1549 static guint modem_removed_watch;
1550 static guint context_watch;
1552 static int ofono_init(void)
1556 connection = connman_dbus_get_connection();
1557 if (connection == NULL)
1560 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1561 ofono_connect, ofono_disconnect, NULL, NULL);
1563 reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1564 OFONO_REGISTRATION_INTERFACE,
1569 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1570 OFONO_GPRS_INTERFACE,
1575 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1576 OFONO_MODEM_INTERFACE,
1581 sim_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1582 OFONO_SIM_INTERFACE,
1587 modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1588 OFONO_MANAGER_INTERFACE,
1593 modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1594 OFONO_MANAGER_INTERFACE,
1599 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1600 OFONO_CONTEXT_INTERFACE,
1605 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1606 reg_watch == 0 || sim_watch == 0 ||
1607 modem_added_watch == 0 || modem_removed_watch == 0 ||
1608 context_watch == 0) {
1613 err = connman_network_driver_register(&network_driver);
1617 err = connman_device_driver_register(&modem_driver);
1619 connman_network_driver_unregister(&network_driver);
1626 g_dbus_remove_watch(connection, watch);
1627 g_dbus_remove_watch(connection, sim_watch);
1628 g_dbus_remove_watch(connection, reg_watch);
1629 g_dbus_remove_watch(connection, gprs_watch);
1630 g_dbus_remove_watch(connection, modem_watch);
1631 g_dbus_remove_watch(connection, modem_added_watch);
1632 g_dbus_remove_watch(connection, modem_removed_watch);
1633 g_dbus_remove_watch(connection, context_watch);
1635 dbus_connection_unref(connection);
1640 static void ofono_exit(void)
1642 g_dbus_remove_watch(connection, watch);
1643 g_dbus_remove_watch(connection, sim_watch);
1644 g_dbus_remove_watch(connection, reg_watch);
1645 g_dbus_remove_watch(connection, gprs_watch);
1646 g_dbus_remove_watch(connection, modem_watch);
1647 g_dbus_remove_watch(connection, modem_added_watch);
1648 g_dbus_remove_watch(connection, modem_removed_watch);
1649 g_dbus_remove_watch(connection, context_watch);
1651 ofono_disconnect(connection, NULL);
1653 connman_device_driver_unregister(&modem_driver);
1654 connman_network_driver_unregister(&network_driver);
1656 dbus_connection_unref(connection);
1659 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1660 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)