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
33 #define CONNMAN_API_SUBJECT_TO_CHANGE
34 #include <connman/plugin.h>
35 #include <connman/device.h>
36 #include <connman/network.h>
37 #include <connman/ipconfig.h>
38 #include <connman/dbus.h>
39 #include <connman/inet.h>
40 #include <connman/technology.h>
41 #include <connman/log.h>
45 #define OFONO_SERVICE "org.ofono"
47 #define OFONO_MANAGER_INTERFACE OFONO_SERVICE ".Manager"
48 #define OFONO_MODEM_INTERFACE OFONO_SERVICE ".Modem"
49 #define OFONO_GPRS_INTERFACE OFONO_SERVICE ".ConnectionManager"
50 #define OFONO_CONTEXT_INTERFACE OFONO_SERVICE ".ConnectionContext"
51 #define OFONO_SIM_INTERFACE OFONO_SERVICE ".SimManager"
52 #define OFONO_REGISTRATION_INTERFACE OFONO_SERVICE ".NetworkRegistration"
54 #define PROPERTY_CHANGED "PropertyChanged"
55 #define GET_PROPERTIES "GetProperties"
56 #define SET_PROPERTY "SetProperty"
57 #define CONTEXT_ADDED "ContextAdded"
58 #define CONTEXT_REMOVED "ContextRemoved"
59 #define ADD_CONTEXT "AddContext"
60 #define GET_MODEMS "GetModems"
61 #define MODEM_ADDED "ModemAdded"
62 #define MODEM_REMOVED "ModemRemoved"
67 static DBusConnection *connection;
69 static GHashTable *modem_hash = NULL;
71 static GHashTable *network_hash;
75 struct connman_device *device;
80 gboolean pending_online;
81 dbus_bool_t requested_online;
84 /* org.ofono.ConnectionManager properties */
87 dbus_bool_t roaming_allowed;
89 connman_bool_t registered;
90 connman_bool_t roaming;
91 uint8_t strength, has_strength;
96 struct connman_network *network;
98 enum connman_ipconfig_method ipv4_method;
99 struct connman_ipaddress ipv4_address;
101 enum connman_ipconfig_method ipv6_method;
102 struct connman_ipaddress ipv6_address;
105 static int modem_probe(struct connman_device *device)
107 DBG("device %p", device);
112 static void modem_remove(struct connman_device *device)
114 DBG("device %p", device);
117 static int call_ofono(const char *path,
118 const char *interface, const char *method,
119 DBusPendingCallNotifyFunction notify, void *user_data,
120 DBusFreeFunction free_function,
123 DBusMessage *message;
124 DBusPendingCall *call;
128 DBG("path %s %s.%s", path, interface, method);
133 message = dbus_message_new_method_call(OFONO_SERVICE, path,
138 dbus_message_set_auto_start(message, FALSE);
141 ok = dbus_message_append_args_valist(message, type, va);
147 if (dbus_connection_send_with_reply(connection, message,
148 &call, TIMEOUT) == FALSE) {
149 connman_error("Failed to call %s.%s", interface, method);
150 dbus_message_unref(message);
155 connman_error("D-Bus connection not available");
156 dbus_message_unref(message);
160 dbus_pending_call_set_notify(call, notify, user_data, free_function);
162 dbus_message_unref(message);
167 static void set_property_reply(DBusPendingCall *call, void *user_data)
171 char const *name = user_data;
175 dbus_error_init(&error);
177 reply = dbus_pending_call_steal_reply(call);
179 if (dbus_set_error_from_message(&error, reply)) {
180 connman_error("SetProperty(%s) %s %s", name,
181 error.name, error.message);
182 dbus_error_free(&error);
185 dbus_message_unref(reply);
187 dbus_pending_call_unref(call);
190 static int set_property(const char *path, const char *interface,
191 const char *property, int type, void *value,
192 DBusPendingCallNotifyFunction notify, void *user_data,
193 DBusFreeFunction free_function)
195 DBusMessage *message;
196 DBusMessageIter iter;
197 DBusPendingCall *call;
199 DBG("path %s %s.%s", path, interface, property);
201 g_assert(notify == NULL ? free_function == NULL : 1);
206 message = dbus_message_new_method_call(OFONO_SERVICE, path,
207 interface, SET_PROPERTY);
211 dbus_message_set_auto_start(message, FALSE);
213 dbus_message_iter_init_append(message, &iter);
214 connman_dbus_property_append_basic(&iter, property, type, value);
216 if (dbus_connection_send_with_reply(connection, message,
217 &call, TIMEOUT) == FALSE) {
218 connman_error("Failed to change \"%s\" property on %s",
219 property, interface);
220 dbus_message_unref(message);
225 connman_error("D-Bus connection not available");
226 dbus_message_unref(message);
230 if (notify == NULL) {
231 notify = set_property_reply;
232 user_data = (void *)property;
233 free_function = NULL;
236 dbus_pending_call_set_notify(call, notify, user_data, free_function);
238 dbus_message_unref(message);
243 static void update_modem_online(struct modem_data *modem,
244 connman_bool_t online)
246 DBG("modem %p path %s online %d", modem, modem->path, online);
248 modem->online = online;
249 modem->requested_online = online;
250 modem->pending_online = FALSE;
253 connman_device_set_powered(modem->device, online);
256 static void set_online_reply(DBusPendingCall *call, void *user_data)
258 struct modem_data *modem;
263 DBG("path %s", (char *)user_data);
265 if (modem_hash == NULL)
268 modem = g_hash_table_lookup(modem_hash, user_data);
272 reply = dbus_pending_call_steal_reply(call);
274 dbus_error_init(&error);
276 if (dbus_set_error_from_message(&error, reply)) {
277 connman_error("SetProperty(Online) %s %s",
278 error.name, error.message);
279 dbus_error_free(&error);
281 result = modem->online;
283 result = modem->requested_online;
285 if (modem->pending_online)
286 update_modem_online(modem, result);
288 dbus_message_unref(reply);
290 dbus_pending_call_unref(call);
293 static int modem_change_online(char const *path, dbus_bool_t online)
295 struct modem_data *modem = g_hash_table_lookup(modem_hash, path);
300 if (modem->online == online)
303 modem->requested_online = online;
305 return set_property(path, OFONO_MODEM_INTERFACE, "Online",
306 DBUS_TYPE_BOOLEAN, &online,
308 (void *)g_strdup(path), g_free);
311 static int modem_enable(struct connman_device *device)
313 const char *path = connman_device_get_string(device, "Path");
315 DBG("device %p, path, %s", device, path);
317 return modem_change_online(path, TRUE);
320 static int modem_disable(struct connman_device *device)
322 const char *path = connman_device_get_string(device, "Path");
324 DBG("device %p path %s", device, path);
326 return modem_change_online(path, FALSE);
329 static struct connman_device_driver modem_driver = {
331 .type = CONNMAN_DEVICE_TYPE_CELLULAR,
332 .probe = modem_probe,
333 .remove = modem_remove,
334 .enable = modem_enable,
335 .disable = modem_disable,
338 static void modem_remove_device(struct modem_data *modem)
340 DBG("modem %p path %s device %p", modem, modem->path, modem->device);
342 if (modem->device == NULL)
345 connman_device_remove_all_networks(modem->device);
346 connman_device_unregister(modem->device);
347 connman_device_unref(modem->device);
349 modem->device = NULL;
352 static void remove_modem(gpointer data)
354 struct modem_data *modem = data;
356 modem_remove_device(modem);
359 g_free(modem->operator);
364 static void remove_network(gpointer data)
366 struct network_info *info = data;
368 connman_network_unregister(info->network);
369 connman_network_unref(info->network);
374 static char *get_ident(const char *path)
381 pos = strrchr(path, '/');
388 static void create_service(struct connman_network *network)
395 path = connman_network_get_string(network, "Path");
397 group = get_ident(path);
399 connman_network_set_group(network, group);
402 static int network_probe(struct connman_network *network)
407 static gboolean pending_network_is_available(struct connman_network *network)
409 /* Modem or network may be removed */
410 if (network == NULL || connman_network_get_device(network) == NULL) {
411 DBG("Modem or network was removed");
418 static void set_connected(struct network_info *info,
419 connman_bool_t connected)
421 DBG("network %p connected %d", info->network, connected);
423 switch (info->ipv4_method) {
424 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
425 case CONNMAN_IPCONFIG_METHOD_OFF:
426 case CONNMAN_IPCONFIG_METHOD_MANUAL:
427 case CONNMAN_IPCONFIG_METHOD_AUTO:
430 case CONNMAN_IPCONFIG_METHOD_FIXED:
431 connman_network_set_ipv4_method(info->network,
433 connman_network_set_ipaddress(info->network,
434 &info->ipv4_address);
438 case CONNMAN_IPCONFIG_METHOD_DHCP:
439 connman_network_set_ipv4_method(info->network,
445 switch (info->ipv6_method) {
446 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
447 case CONNMAN_IPCONFIG_METHOD_OFF:
448 case CONNMAN_IPCONFIG_METHOD_MANUAL:
449 case CONNMAN_IPCONFIG_METHOD_DHCP:
450 case CONNMAN_IPCONFIG_METHOD_AUTO:
453 case CONNMAN_IPCONFIG_METHOD_FIXED:
454 connman_network_set_ipv6_method(info->network,
456 connman_network_set_ipaddress(info->network,
457 &info->ipv6_address);
462 connman_network_set_connected(info->network, connected);
465 static void set_active_reply(DBusPendingCall *call, void *user_data)
467 char const *path = user_data;
470 struct network_info *info;
472 info = g_hash_table_lookup(network_hash, path);
474 reply = dbus_pending_call_steal_reply(call);
479 DBG("path %s network %p", path, info->network);
481 if (!pending_network_is_available(info->network))
484 dbus_error_init(&error);
486 if (dbus_set_error_from_message(&error, reply)) {
487 connman_error("SetProperty(Active) %s %s",
488 error.name, error.message);
490 if (connman_network_get_index(info->network) < 0)
491 connman_network_set_error(info->network,
492 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
494 dbus_error_free(&error);
495 } else if (connman_network_get_index(info->network) >= 0)
496 set_connected(info, TRUE);
499 dbus_message_unref(reply);
501 dbus_pending_call_unref(call);
504 static int set_network_active(struct connman_network *network)
506 dbus_bool_t value = TRUE;
507 const char *path = connman_network_get_string(network, "Path");
509 DBG("network %p, path %s", network, path);
511 return set_property(path, OFONO_CONTEXT_INTERFACE,
512 "Active", DBUS_TYPE_BOOLEAN, &value,
513 set_active_reply, g_strdup(path), g_free);
516 static int set_network_inactive(struct connman_network *network)
519 dbus_bool_t value = FALSE;
520 const char *path = connman_network_get_string(network, "Path");
522 DBG("network %p, path %s", network, path);
524 err = set_property(path, OFONO_CONTEXT_INTERFACE,
525 "Active", DBUS_TYPE_BOOLEAN, &value,
528 if (err == -EINPROGRESS)
534 static int network_connect(struct connman_network *network)
536 struct connman_device *device;
537 struct modem_data *modem;
539 DBG("network %p", network);
541 device = connman_network_get_device(network);
545 modem = connman_device_get_data(device);
549 if (modem->registered == FALSE)
552 if (modem->powered == FALSE)
555 if (modem->roaming_allowed == FALSE && modem->roaming == TRUE)
558 return set_network_active(network);
561 static int network_disconnect(struct connman_network *network)
563 DBG("network %p", network);
565 if (connman_network_get_index(network) < 0)
568 connman_network_set_associating(network, FALSE);
570 return set_network_inactive(network);
573 static void network_remove(struct connman_network *network)
575 char const *path = connman_network_get_string(network, "Path");
577 DBG("network %p path %s", network, path);
579 g_hash_table_remove(network_hash, path);
582 static struct connman_network_driver network_driver = {
584 .type = CONNMAN_NETWORK_TYPE_CELLULAR,
585 .probe = network_probe,
586 .remove = network_remove,
587 .connect = network_connect,
588 .disconnect = network_disconnect,
591 static void get_dns(DBusMessageIter *array, struct network_info *info)
593 DBusMessageIter entry;
594 gchar *nameservers = NULL, *nameservers_old = NULL;
599 dbus_message_iter_recurse(array, &entry);
601 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
604 dbus_message_iter_get_basic(&entry, &dns);
608 if (nameservers == NULL) {
610 nameservers = g_strdup(dns);
613 nameservers_old = nameservers;
614 nameservers = g_strdup_printf("%s %s",
615 nameservers_old, dns);
616 g_free(nameservers_old);
619 dbus_message_iter_next(&entry);
622 connman_network_set_nameservers(info->network, nameservers);
627 static void update_ipv4_settings(DBusMessageIter *array,
628 struct network_info *info)
630 DBusMessageIter dict;
631 char *address = NULL, *netmask = NULL, *gateway = NULL;
632 const char *interface = NULL;
634 DBG("network %p", info->network);
636 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
639 dbus_message_iter_recurse(array, &dict);
641 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
642 DBusMessageIter entry, value;
643 const char *key, *val;
645 dbus_message_iter_recurse(&dict, &entry);
646 dbus_message_iter_get_basic(&entry, &key);
650 dbus_message_iter_next(&entry);
651 dbus_message_iter_recurse(&entry, &value);
653 if (g_str_equal(key, "Interface") == TRUE) {
656 dbus_message_iter_get_basic(&value, &interface);
658 DBG("interface %s", interface);
660 index = connman_inet_ifindex(interface);
662 connman_network_set_index(info->network, index);
664 connman_error("Can not find interface %s",
668 } else if (g_str_equal(key, "Method") == TRUE) {
671 dbus_message_iter_get_basic(&value, &method);
673 if (g_strcmp0(method, "static") == 0) {
676 CONNMAN_IPCONFIG_METHOD_FIXED;
677 } else if (g_strcmp0(method, "dhcp") == 0) {
680 CONNMAN_IPCONFIG_METHOD_DHCP;
683 } else if (g_str_equal(key, "Address") == TRUE) {
684 dbus_message_iter_get_basic(&value, &val);
686 address = g_strdup(val);
688 DBG("address %s", address);
689 } else if (g_str_equal(key, "Netmask") == TRUE) {
690 dbus_message_iter_get_basic(&value, &val);
692 netmask = g_strdup(val);
694 DBG("netmask %s", netmask);
695 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
697 get_dns(&value, info);
698 } else if (g_str_equal(key, "Gateway") == TRUE) {
699 dbus_message_iter_get_basic(&value, &val);
701 gateway = g_strdup(val);
703 DBG("gateway %s", gateway);
706 dbus_message_iter_next(&dict);
710 if (info->ipv4_method == CONNMAN_IPCONFIG_METHOD_FIXED) {
711 connman_ipaddress_set_ipv4(&info->ipv4_address, address,
715 /* deactive, oFono send NULL inteface before deactive signal */
716 if (interface == NULL)
717 connman_network_set_index(info->network, -1);
724 static void update_ipv6_settings(DBusMessageIter *array,
725 struct network_info *info)
727 DBusMessageIter dict;
728 char *address = NULL, *gateway = NULL;
729 unsigned char prefix_length;
730 const char *interface = NULL;
732 DBG("network %p", info->network);
734 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
737 dbus_message_iter_recurse(array, &dict);
739 info->ipv6_method = CONNMAN_IPCONFIG_METHOD_FIXED;
741 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
742 DBusMessageIter entry, value;
743 const char *key, *val;
745 dbus_message_iter_recurse(&dict, &entry);
746 dbus_message_iter_get_basic(&entry, &key);
750 dbus_message_iter_next(&entry);
751 dbus_message_iter_recurse(&entry, &value);
753 if (g_str_equal(key, "Interface") == TRUE) {
756 dbus_message_iter_get_basic(&value, &interface);
758 DBG("interface %s", interface);
760 index = connman_inet_ifindex(interface);
762 connman_network_set_index(info->network, index);
764 connman_error("Can not find interface %s",
768 } else if (g_str_equal(key, "Address") == TRUE) {
769 dbus_message_iter_get_basic(&value, &val);
771 address = g_strdup(val);
773 DBG("address %s", address);
774 } else if (g_str_equal(key, "PrefixLength") == TRUE) {
775 dbus_message_iter_get_basic(&value, &prefix_length);
777 DBG("prefix length %d", prefix_length);
778 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
780 get_dns(&value, info);
781 } else if (g_str_equal(key, "Gateway") == TRUE) {
782 dbus_message_iter_get_basic(&value, &val);
784 gateway = g_strdup(val);
786 DBG("gateway %s", gateway);
789 dbus_message_iter_next(&dict);
792 connman_ipaddress_set_ipv6(&info->ipv6_address, address,
793 prefix_length, gateway);
795 /* deactive, oFono send NULL inteface before deactive signal */
796 if (interface == NULL)
797 connman_network_set_index(info->network, -1);
803 static int add_network(struct connman_device *device,
804 const char *path, DBusMessageIter *dict)
806 struct modem_data *modem = connman_device_get_data(device);
807 struct connman_network *network;
808 struct network_info *info;
810 dbus_bool_t active = FALSE;
812 DBG("modem %p device %p path %s", modem, device, path);
814 ident = get_ident(path);
816 network = connman_device_get_network(device, ident);
820 info = g_hash_table_lookup(network_hash, path);
822 DBG("path %p already exists with device %p", path,
823 connman_network_get_device(info->network));
824 if (connman_network_get_device(info->network))
826 g_hash_table_remove(network_hash, path);
829 network = connman_network_create(ident, CONNMAN_NETWORK_TYPE_CELLULAR);
833 connman_network_register(network);
835 info = g_try_new0(struct network_info, 1);
837 connman_network_unregister(network);
838 connman_network_unref(network);
842 connman_ipaddress_clear(&info->ipv4_address);
843 connman_ipaddress_clear(&info->ipv6_address);
844 info->network = network;
846 connman_network_set_string(network, "Path", path);
848 create_service(network);
850 g_hash_table_insert(network_hash, (char *) path, info);
852 connman_network_set_available(network, TRUE);
853 connman_network_set_index(network, -1);
856 connman_network_set_name(network, modem->operator);
858 if (modem->has_strength)
859 connman_network_set_strength(network, modem->strength);
861 connman_network_set_roaming(network, modem->roaming);
863 while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) {
864 DBusMessageIter entry, value;
867 dbus_message_iter_recurse(dict, &entry);
868 dbus_message_iter_get_basic(&entry, &key);
870 dbus_message_iter_next(&entry);
871 dbus_message_iter_recurse(&entry, &value);
873 if (g_str_equal(key, "Type")) {
876 dbus_message_iter_get_basic(&value, &type);
877 if (g_strcmp0(type, "internet") != 0) {
878 DBG("path %p type %s", path, type);
881 } else if (g_str_equal(key, "Settings"))
882 update_ipv4_settings(&value, info);
883 else if (g_str_equal(key, "IPv6.Settings"))
884 update_ipv6_settings(&value, info);
885 else if (g_str_equal(key, "Active") == TRUE)
886 dbus_message_iter_get_basic(&value, &active);
888 dbus_message_iter_next(dict);
891 if (connman_device_add_network(device, network) != 0)
894 /* Connect only if requested to do so */
895 if (active && connman_network_get_connecting(network) == TRUE)
896 set_connected(info, active);
901 static void check_networks_reply(DBusPendingCall *call, void *user_data)
903 char *path = user_data;
904 struct modem_data *modem;
906 DBusMessageIter array, entry, value, properties;
908 DBG("path %s", path);
910 modem = g_hash_table_lookup(modem_hash, path);
913 if (modem->device == NULL)
916 reply = dbus_pending_call_steal_reply(call);
918 if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
921 dbus_message_iter_init(reply, &array);
923 dbus_message_iter_recurse(&array, &entry);
925 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRUCT) {
926 char const *network_path;
928 dbus_message_iter_recurse(&entry, &value);
929 dbus_message_iter_get_basic(&value, &network_path);
931 dbus_message_iter_next(&value);
932 dbus_message_iter_recurse(&value, &properties);
934 add_network(modem->device, network_path, &properties);
936 dbus_message_iter_next(&entry);
940 dbus_message_unref(reply);
942 dbus_pending_call_unref(call);
945 static void check_networks(struct modem_data *modem)
947 char const *path = modem->path;
949 DBG("modem %p path %s", modem, path);
951 call_ofono(path, OFONO_GPRS_INTERFACE, "GetContexts",
952 check_networks_reply, g_strdup(path), g_free,
956 static void modem_clear_network_errors(struct modem_data *modem)
958 struct connman_device *device = modem->device;
965 g_hash_table_iter_init(&i, network_hash);
967 while (g_hash_table_iter_next(&i, NULL, &value)) {
968 struct network_info *info = value;
970 if (connman_network_get_device(info->network) == device)
971 connman_network_clear_error(info->network);
975 static void modem_operator_name_changed(struct modem_data *modem,
978 struct connman_device *device = modem->device;
985 if (modem->operator != NULL)
986 g_free(modem->operator);
987 modem->operator = g_strdup(name);
989 for (g_hash_table_iter_init(&i, network_hash);
990 g_hash_table_iter_next(&i, NULL, &value);) {
991 struct network_info *info = value;
993 if (connman_network_get_device(info->network) == device) {
994 connman_network_set_name(info->network, name);
995 connman_network_update(info->network);
1000 static void modem_strength_changed(struct modem_data *modem, uint8_t strength)
1002 struct connman_device *device = modem->device;
1006 modem->strength = strength;
1007 modem->has_strength = TRUE;
1012 for (g_hash_table_iter_init(&i, network_hash);
1013 g_hash_table_iter_next(&i, NULL, &value);) {
1014 struct network_info *info = value;
1016 if (connman_network_get_device(info->network) == device) {
1017 connman_network_set_strength(info->network, strength);
1018 connman_network_update(info->network);
1023 static void modem_roaming_changed(struct modem_data *modem,
1026 struct connman_device *device = modem->device;
1027 connman_bool_t roaming = FALSE;
1028 connman_bool_t registered = FALSE;
1029 connman_bool_t was_roaming = modem->roaming;
1033 if (g_str_equal(status, "roaming"))
1035 else if (g_str_equal(status, "registered"))
1038 registered = registered || roaming;
1040 if (modem->roaming == roaming && modem->registered == registered)
1043 modem->registered = registered;
1044 modem->roaming = roaming;
1046 if (roaming == was_roaming)
1052 g_hash_table_iter_init(&i, network_hash);
1054 while (g_hash_table_iter_next(&i, NULL, &value)) {
1055 struct network_info *info = value;
1057 if (connman_network_get_device(info->network) == device) {
1058 connman_network_set_roaming(info->network, roaming);
1059 connman_network_update(info->network);
1064 static void modem_registration_removed(struct modem_data *modem)
1066 modem->registered = FALSE;
1067 modem->roaming = FALSE;
1070 static void modem_registration_changed(struct modem_data *modem,
1071 DBusMessageIter *entry)
1073 DBusMessageIter iter;
1076 connman_uint8_t strength;
1077 char const *name, *status, *mcc_s;
1079 dbus_message_iter_get_basic(entry, &key);
1083 dbus_message_iter_next(entry);
1085 dbus_message_iter_recurse(entry, &iter);
1087 type = dbus_message_iter_get_arg_type(&iter);
1088 if (type != DBUS_TYPE_BYTE && type != DBUS_TYPE_STRING)
1091 if (g_str_equal(key, "Name") && type == DBUS_TYPE_STRING) {
1092 dbus_message_iter_get_basic(&iter, &name);
1093 modem_operator_name_changed(modem, name);
1094 } else if (g_str_equal(key, "Strength") && type == DBUS_TYPE_BYTE) {
1095 dbus_message_iter_get_basic(&iter, &strength);
1096 modem_strength_changed(modem, strength);
1097 } else if (g_str_equal(key, "Status") && type == DBUS_TYPE_STRING) {
1098 dbus_message_iter_get_basic(&iter, &status);
1099 modem_roaming_changed(modem, status);
1100 } else if (g_str_equal(key, "MobileCountryCode") &&
1101 type == DBUS_TYPE_STRING) {
1105 dbus_message_iter_get_basic(&iter, &mcc_s);
1111 alpha2 = mcc_country_codes[mcc - 200];
1112 connman_technology_set_regdom(alpha2);
1117 static gboolean reg_changed(DBusConnection *connection,
1118 DBusMessage *message, void *user_data)
1120 const char *path = dbus_message_get_path(message);
1121 struct modem_data *modem;
1122 DBusMessageIter iter;
1124 DBG("path %s", path);
1126 modem = g_hash_table_lookup(modem_hash, path);
1130 if (dbus_message_iter_init(message, &iter))
1131 modem_registration_changed(modem, &iter);
1136 static void check_registration_reply(DBusPendingCall *call, void *user_data)
1138 char const *path = user_data;
1139 struct modem_data *modem;
1141 DBusMessageIter array, dict, entry;
1143 DBG("path %s", path);
1145 modem = g_hash_table_lookup(modem_hash, path);
1149 reply = dbus_pending_call_steal_reply(call);
1151 if (dbus_message_iter_init(reply, &array) == FALSE)
1154 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1157 dbus_message_iter_recurse(&array, &dict);
1158 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1159 dbus_message_iter_recurse(&dict, &entry);
1160 modem_registration_changed(modem, &entry);
1161 dbus_message_iter_next(&dict);
1165 dbus_message_unref(reply);
1167 dbus_pending_call_unref(call);
1170 static void check_registration(struct modem_data *modem)
1172 char const *path = modem->path;
1174 DBG("modem %p path %s", modem, path);
1176 call_ofono(path, OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES,
1177 check_registration_reply, g_strdup(path), g_free,
1181 static void modem_gprs_changed(struct modem_data *modem,
1182 DBusMessageIter *entry)
1184 DBusMessageIter iter;
1189 dbus_message_iter_get_basic(entry, &key);
1193 dbus_message_iter_next(entry);
1195 dbus_message_iter_recurse(entry, &iter);
1197 type = dbus_message_iter_get_arg_type(&iter);
1199 if (type != DBUS_TYPE_BOOLEAN)
1202 dbus_message_iter_get_basic(&iter, &value);
1204 if (g_str_equal(key, "Attached") == TRUE) {
1205 DBG("Attached %d", value);
1207 modem->attached = value;
1210 modem_clear_network_errors(modem);
1211 } else if (g_str_equal(key, "Powered") == TRUE) {
1212 DBG("Powered %d", value);
1214 modem->powered = value;
1215 } else if (g_str_equal(key, "RoamingAllowed") == TRUE) {
1216 DBG("RoamingAllowed %d", value);
1218 modem->roaming_allowed = value;
1222 static void check_gprs_reply(DBusPendingCall *call, void *user_data)
1224 char const *path = user_data;
1225 struct modem_data *modem;
1227 DBusMessageIter array, dict, entry;
1229 DBG("path %s", path);
1231 modem = g_hash_table_lookup(modem_hash, path);
1235 reply = dbus_pending_call_steal_reply(call);
1237 if (dbus_message_iter_init(reply, &array) == FALSE)
1240 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1243 dbus_message_iter_recurse(&array, &dict);
1244 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1245 dbus_message_iter_recurse(&dict, &entry);
1246 modem_gprs_changed(modem, &entry);
1247 dbus_message_iter_next(&dict);
1251 dbus_message_unref(reply);
1253 dbus_pending_call_unref(call);
1255 check_networks(modem);
1258 static void check_gprs(struct modem_data *modem)
1260 char const *path = modem->path;
1262 DBG("modem %p path %s", modem, path);
1264 call_ofono(path, OFONO_GPRS_INTERFACE, GET_PROPERTIES,
1265 check_gprs_reply, g_strdup(path), g_free,
1269 static void add_device(const char *path, const char *imsi)
1271 struct modem_data *modem;
1272 struct connman_device *device;
1274 DBG("path %s imsi %s", path, imsi);
1282 modem = g_hash_table_lookup(modem_hash, path);
1286 if (modem->device) {
1287 if (!g_strcmp0(imsi, connman_device_get_ident(modem->device)))
1290 modem_remove_device(modem);
1293 if (strlen(imsi) == 0)
1296 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
1300 connman_device_set_ident(device, imsi);
1302 connman_device_set_string(device, "Path", path);
1304 connman_device_set_data(device, modem);
1306 if (connman_device_register(device) < 0) {
1307 connman_device_unref(device);
1311 modem->device = device;
1314 check_registration(modem);
1316 if (modem->has_gprs)
1320 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
1322 const char *path = user_data;
1323 const char *imsi = NULL;
1325 DBusMessageIter array, dict;
1327 DBG("path %s", path);
1329 reply = dbus_pending_call_steal_reply(call);
1331 if (dbus_message_iter_init(reply, &array) == FALSE)
1334 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1337 dbus_message_iter_recurse(&array, &dict);
1339 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1340 DBusMessageIter entry, value;
1343 dbus_message_iter_recurse(&dict, &entry);
1344 dbus_message_iter_get_basic(&entry, &key);
1346 dbus_message_iter_next(&entry);
1347 dbus_message_iter_recurse(&entry, &value);
1349 if (g_str_equal(key, "SubscriberIdentity")) {
1350 dbus_message_iter_get_basic(&value, &imsi);
1351 add_device(path, imsi);
1354 dbus_message_iter_next(&dict);
1358 dbus_message_unref(reply);
1360 dbus_pending_call_unref(call);
1363 static void get_imsi(const char *path)
1365 DBG("path %s", path);
1367 call_ofono(path, OFONO_SIM_INTERFACE, GET_PROPERTIES,
1368 sim_properties_reply, g_strdup(path), g_free,
1372 static int gprs_change_powered(const char *path, dbus_bool_t powered)
1374 DBG("path %s powered %d", path, powered);
1376 return set_property(path, OFONO_GPRS_INTERFACE, "Powered",
1377 DBUS_TYPE_BOOLEAN, &powered,
1381 static int modem_change_powered(const char *path, dbus_bool_t powered)
1383 DBG("path %s powered %d", path, powered);
1385 return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
1386 DBUS_TYPE_BOOLEAN, &powered,
1391 static gboolean modem_has_interface(DBusMessageIter *array,
1392 char const *interface)
1394 DBusMessageIter entry;
1396 dbus_message_iter_recurse(array, &entry);
1398 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1399 const char *element;
1401 dbus_message_iter_get_basic(&entry, &element);
1403 if (g_strcmp0(interface, element) == 0)
1406 dbus_message_iter_next(&entry);
1412 static gboolean modem_has_sim(DBusMessageIter *array)
1414 return modem_has_interface(array, OFONO_SIM_INTERFACE);
1417 static gboolean modem_has_reg(DBusMessageIter *array)
1419 return modem_has_interface(array, OFONO_REGISTRATION_INTERFACE);
1422 static gboolean modem_has_gprs(DBusMessageIter *array)
1424 return modem_has_interface(array, OFONO_GPRS_INTERFACE);
1427 static void add_modem(const char *path, DBusMessageIter *prop)
1429 struct modem_data *modem;
1430 dbus_bool_t powered = FALSE;
1431 dbus_bool_t online = FALSE;
1432 dbus_bool_t locked = FALSE;
1433 gboolean has_sim = FALSE;
1434 gboolean has_reg = FALSE;
1435 gboolean has_gprs = FALSE;
1437 modem = g_hash_table_lookup(modem_hash, path);
1442 modem = g_try_new0(struct modem_data, 1);
1446 modem->path = g_strdup(path);
1447 modem->device = NULL;
1448 modem->available = TRUE;
1450 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1452 while (dbus_message_iter_get_arg_type(prop) == DBUS_TYPE_DICT_ENTRY) {
1453 DBusMessageIter entry, value;
1456 dbus_message_iter_recurse(prop, &entry);
1457 dbus_message_iter_get_basic(&entry, &key);
1459 dbus_message_iter_next(&entry);
1460 dbus_message_iter_recurse(&entry, &value);
1462 if (g_str_equal(key, "Powered") == TRUE)
1463 dbus_message_iter_get_basic(&value, &powered);
1464 else if (g_str_equal(key, "Lockdown") == TRUE)
1465 dbus_message_iter_get_basic(&value, &locked);
1466 else if (g_str_equal(key, "Interfaces") == TRUE) {
1467 has_sim = modem_has_sim(&value);
1468 has_reg = modem_has_reg(&value);
1469 has_gprs = modem_has_gprs(&value);
1472 dbus_message_iter_next(prop);
1479 modem_change_powered(path, TRUE);
1481 modem->has_sim = has_sim;
1482 modem->has_reg = has_reg;
1483 modem->has_gprs = has_gprs;
1485 update_modem_online(modem, online);
1491 static void manager_modems_reply(DBusPendingCall *call, void *user_data)
1495 DBusMessageIter array, dict;
1499 reply = dbus_pending_call_steal_reply(call);
1501 if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
1504 dbus_error_init(&error);
1506 if (dbus_set_error_from_message(&error, reply)) {
1507 connman_error("ModemManager.GetModems() %s %s",
1508 error.name, error.message);
1509 dbus_error_free(&error);
1513 if (dbus_message_iter_init(reply, &array) == FALSE)
1516 dbus_message_iter_recurse(&array, &dict);
1518 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) {
1519 DBusMessageIter value, properties;
1520 const char *modem_path;
1522 dbus_message_iter_recurse(&dict, &value);
1523 dbus_message_iter_get_basic(&value, &modem_path);
1525 dbus_message_iter_next(&value);
1526 dbus_message_iter_recurse(&value, &properties);
1529 add_modem(modem_path, &properties);
1531 dbus_message_iter_next(&dict);
1535 dbus_message_unref(reply);
1537 dbus_pending_call_unref(call);
1540 static void ofono_connect(DBusConnection *connection, void *user_data)
1542 DBG("connection %p", connection);
1544 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1545 g_free, remove_modem);
1547 network_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1548 NULL, remove_network);
1550 call_ofono("/", OFONO_MANAGER_INTERFACE, GET_MODEMS,
1551 manager_modems_reply, NULL, NULL,
1555 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1557 DBG("connection %p", connection);
1559 if (modem_hash == NULL)
1562 g_hash_table_destroy(modem_hash);
1567 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1570 const char *path = dbus_message_get_path(message);
1571 struct modem_data *modem;
1572 DBusMessageIter iter, value;
1575 DBG("path %s", path);
1577 modem = g_hash_table_lookup(modem_hash, path);
1581 if (dbus_message_iter_init(message, &iter) == FALSE)
1584 dbus_message_iter_get_basic(&iter, &key);
1586 dbus_message_iter_next(&iter);
1587 dbus_message_iter_recurse(&iter, &value);
1589 if (g_str_equal(key, "Powered") == TRUE) {
1590 dbus_bool_t powered;
1592 dbus_message_iter_get_basic(&value, &powered);
1593 if (powered == TRUE)
1596 modem->has_sim = FALSE;
1597 modem->has_reg = FALSE;
1598 modem->has_gprs = FALSE;
1600 modem_remove_device(modem);
1601 } else if (g_str_equal(key, "Online") == TRUE) {
1604 dbus_message_iter_get_basic(&value, &online);
1606 update_modem_online(modem, online);
1607 } else if (g_str_equal(key, "Lockdown") == TRUE) {
1610 dbus_message_iter_get_basic(&value, &locked);
1613 modem_change_powered(path, TRUE);
1615 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1616 gboolean has_sim = modem_has_sim(&value);
1617 gboolean has_reg = modem_has_reg(&value);
1618 gboolean had_reg = modem->has_reg;
1619 gboolean has_gprs = modem_has_gprs(&value);
1620 gboolean had_gprs = modem->has_gprs;
1622 modem->has_sim = has_sim;
1623 modem->has_reg = has_reg;
1624 modem->has_gprs = has_gprs;
1626 if (modem->device == NULL) {
1628 get_imsi(modem->path);
1629 } else if (!has_sim) {
1630 modem_remove_device(modem);
1632 if (has_reg && !had_reg)
1633 check_registration(modem);
1634 else if (had_reg && !has_reg)
1635 modem_registration_removed(modem);
1637 if (has_gprs && !had_gprs) {
1638 gprs_change_powered(modem->path, TRUE);
1647 static gboolean sim_changed(DBusConnection *connection, DBusMessage *message,
1650 const char *path = dbus_message_get_path(message);
1651 struct modem_data *modem;
1652 DBusMessageIter iter, value;
1655 DBG("path %s", path);
1657 modem = g_hash_table_lookup(modem_hash, path);
1661 if (dbus_message_iter_init(message, &iter) == FALSE)
1664 dbus_message_iter_get_basic(&iter, &key);
1666 dbus_message_iter_next(&iter);
1667 dbus_message_iter_recurse(&iter, &value);
1669 if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
1672 dbus_message_iter_get_basic(&value, &imsi);
1674 add_device(path, imsi);
1675 } else if (g_str_equal(key, "Present") == TRUE) {
1676 dbus_bool_t present;
1678 dbus_message_iter_get_basic(&value, &present);
1683 if (modem->device != NULL)
1684 modem_remove_device(modem);
1686 modem->has_gprs = FALSE;
1687 modem->has_reg = FALSE;
1693 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1696 const char *path = dbus_message_get_path(message);
1697 struct modem_data *modem;
1698 DBusMessageIter iter;
1700 DBG("path %s", path);
1702 modem = g_hash_table_lookup(modem_hash, path);
1706 if (dbus_message_iter_init(message, &iter))
1707 modem_gprs_changed(modem, &iter);
1712 static gboolean context_added(DBusConnection *connection,
1713 DBusMessage *message, void *user_data)
1715 const char *path = dbus_message_get_path(message);
1716 const char *network_path;
1717 struct modem_data *modem;
1718 DBusMessageIter iter, properties;
1720 DBG("path %s", path);
1722 modem = g_hash_table_lookup(modem_hash, path);
1723 if (modem == NULL || modem->device == NULL)
1726 if (dbus_message_iter_init(message, &iter) == FALSE)
1729 dbus_message_iter_get_basic(&iter, &network_path);
1731 dbus_message_iter_next(&iter);
1732 dbus_message_iter_recurse(&iter, &properties);
1734 add_network(modem->device, network_path, &properties);
1739 static gboolean context_removed(DBusConnection *connection,
1740 DBusMessage *message, void *user_data)
1742 const char *path = dbus_message_get_path(message);
1743 const char *network_path, *identifier;
1744 struct modem_data *modem;
1745 struct network_info *info;
1746 DBusMessageIter iter;
1748 DBG("path %s", path);
1750 modem = g_hash_table_lookup(modem_hash, path);
1751 if (modem == NULL || modem->device == NULL)
1754 if (dbus_message_iter_init(message, &iter) == FALSE)
1757 dbus_message_iter_get_basic(&iter, &network_path);
1759 info = g_hash_table_lookup(network_hash, network_path);
1763 identifier = connman_network_get_identifier(info->network);
1764 connman_device_remove_network(modem->device, identifier);
1769 static gboolean modem_added(DBusConnection *connection,
1770 DBusMessage *message, void *user_data)
1772 DBusMessageIter iter, properties;
1773 const char *modem_path;
1777 if (dbus_message_iter_init(message, &iter) == FALSE)
1780 dbus_message_iter_get_basic(&iter, &modem_path);
1782 dbus_message_iter_next(&iter);
1783 dbus_message_iter_recurse(&iter, &properties);
1785 add_modem(modem_path, &properties);
1790 static gboolean modem_removed(DBusConnection *connection,
1791 DBusMessage *message, void *user_data)
1793 DBusMessageIter iter;
1794 const char *modem_path;
1798 if (dbus_message_iter_init(message, &iter) == FALSE)
1801 dbus_message_iter_get_basic(&iter, &modem_path);
1803 g_hash_table_remove(modem_hash, modem_path);
1808 static gboolean context_changed(DBusConnection *connection,
1809 DBusMessage *message, void *user_data)
1811 const char *path = dbus_message_get_path(message);
1812 struct network_info *info;
1813 DBusMessageIter iter, value;
1816 DBG("path %s", path);
1818 info = g_hash_table_lookup(network_hash, path);
1822 if (!pending_network_is_available(info->network)) {
1823 g_hash_table_remove(network_hash, path);
1827 if (dbus_message_iter_init(message, &iter) == FALSE)
1830 dbus_message_iter_get_basic(&iter, &key);
1832 dbus_message_iter_next(&iter);
1833 dbus_message_iter_recurse(&iter, &value);
1837 if (g_str_equal(key, "Settings") == TRUE)
1838 update_ipv4_settings(&value, info);
1839 else if (g_str_equal(key, "IPv6.Settings"))
1840 update_ipv6_settings(&value, info);
1841 else if (g_str_equal(key, "Active") == TRUE) {
1844 dbus_message_iter_get_basic(&value, &active);
1846 if (active == FALSE)
1847 set_connected(info, active);
1849 /* Connect only if requested to do so */
1850 if (active == TRUE &&
1851 connman_network_get_connecting(info->network) == TRUE)
1852 set_connected(info, active);
1859 static guint reg_watch;
1860 static guint sim_watch;
1861 static guint gprs_watch;
1862 static guint context_added_watch;
1863 static guint context_removed_watch;
1864 static guint modem_watch;
1865 static guint modem_added_watch;
1866 static guint modem_removed_watch;
1867 static guint context_watch;
1869 static int ofono_init(void)
1873 connection = connman_dbus_get_connection();
1874 if (connection == NULL)
1877 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1878 ofono_connect, ofono_disconnect, NULL, NULL);
1880 reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1881 OFONO_REGISTRATION_INTERFACE,
1886 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1887 OFONO_GPRS_INTERFACE,
1892 context_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1893 OFONO_GPRS_INTERFACE,
1898 context_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1899 OFONO_GPRS_INTERFACE,
1904 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1905 OFONO_MODEM_INTERFACE,
1910 sim_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1911 OFONO_SIM_INTERFACE,
1916 modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1917 OFONO_MANAGER_INTERFACE,
1922 modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1923 OFONO_MANAGER_INTERFACE,
1928 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1929 OFONO_CONTEXT_INTERFACE,
1934 if (watch == 0 || gprs_watch == 0 || context_added_watch == 0 ||
1935 context_removed_watch == 0 || modem_watch == 0 ||
1936 reg_watch == 0 || sim_watch == 0 ||
1937 modem_added_watch == 0 || modem_removed_watch == 0 ||
1938 context_watch == 0) {
1943 err = connman_network_driver_register(&network_driver);
1947 err = connman_device_driver_register(&modem_driver);
1949 connman_network_driver_unregister(&network_driver);
1956 g_dbus_remove_watch(connection, watch);
1957 g_dbus_remove_watch(connection, sim_watch);
1958 g_dbus_remove_watch(connection, reg_watch);
1959 g_dbus_remove_watch(connection, gprs_watch);
1960 g_dbus_remove_watch(connection, context_added_watch);
1961 g_dbus_remove_watch(connection, context_removed_watch);
1962 g_dbus_remove_watch(connection, modem_watch);
1963 g_dbus_remove_watch(connection, modem_added_watch);
1964 g_dbus_remove_watch(connection, modem_removed_watch);
1965 g_dbus_remove_watch(connection, context_watch);
1967 dbus_connection_unref(connection);
1972 static void ofono_exit(void)
1974 g_dbus_remove_watch(connection, watch);
1975 g_dbus_remove_watch(connection, sim_watch);
1976 g_dbus_remove_watch(connection, reg_watch);
1977 g_dbus_remove_watch(connection, gprs_watch);
1978 g_dbus_remove_watch(connection, context_added_watch);
1979 g_dbus_remove_watch(connection, context_removed_watch);
1980 g_dbus_remove_watch(connection, modem_watch);
1981 g_dbus_remove_watch(connection, modem_added_watch);
1982 g_dbus_remove_watch(connection, modem_removed_watch);
1983 g_dbus_remove_watch(connection, context_watch);
1985 ofono_disconnect(connection, NULL);
1987 connman_device_driver_unregister(&modem_driver);
1988 connman_network_driver_unregister(&network_driver);
1990 dbus_connection_unref(connection);
1993 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1994 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)