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 ".DataConnectionManager"
46 #define OFONO_SIM_INTERFACE OFONO_SERVICE ".SimManager"
47 #define OFONO_PRI_CONTEXT_INTERFACE OFONO_SERVICE ".PrimaryDataContext"
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 CREATE_CONTEXT "CreateContext"
57 #define CONTEXT_NAME "3G Connection"
58 #define CONTEXT_TYPE "internet"
60 static DBusConnection *connection;
62 static GHashTable *modem_hash = NULL;
66 struct connman_device *device;
70 static int modem_probe(struct connman_device *device)
72 DBG("device %p", device);
77 static void modem_remove(struct connman_device *device)
79 DBG("device %p", device);
82 static void set_property_reply(DBusPendingCall *call, void *user_data)
86 char const *name = user_data;
90 dbus_error_init(&error);
92 reply = dbus_pending_call_steal_reply(call);
94 if (dbus_set_error_from_message(&error, reply)) {
95 connman_error("SetProperty(%s) %s %s", name,
96 error.name, error.message);
97 dbus_error_free(&error);
100 dbus_message_unref(reply);
102 dbus_pending_call_unref(call);
105 static int set_property(const char *path, const char *interface,
106 const char *property, int type, void *value,
107 DBusPendingCallNotifyFunction notify, void *user_data,
108 DBusFreeFunction free_function)
110 DBusMessage *message;
111 DBusMessageIter iter;
112 DBusPendingCall *call;
114 DBG("path %s %s.%s", path, interface, property);
116 g_assert(notify == NULL ? free_function == NULL : 1);
121 message = dbus_message_new_method_call(OFONO_SERVICE, path,
122 interface, SET_PROPERTY);
126 dbus_message_set_auto_start(message, FALSE);
128 dbus_message_iter_init_append(message, &iter);
129 connman_dbus_property_append_basic(&iter, property, type, value);
131 if (dbus_connection_send_with_reply(connection, message,
132 &call, TIMEOUT) == FALSE) {
133 connman_error("Failed to change \"%s\" property on %s",
134 property, interface);
135 dbus_message_unref(message);
140 connman_error("D-Bus connection not available");
141 dbus_message_unref(message);
145 if (notify == NULL) {
146 notify = set_property_reply;
147 user_data = (void *)property;
148 free_function = NULL;
151 dbus_pending_call_set_notify(call, notify, user_data, free_function);
153 dbus_message_unref(message);
158 static int gprs_change_powered(const char *path, dbus_bool_t powered)
160 DBG("path %s powered %d", path, powered);
162 return set_property(path, OFONO_GPRS_INTERFACE, "Powered",
163 DBUS_TYPE_BOOLEAN, &powered,
167 static int modem_enable(struct connman_device *device)
169 const char *path = connman_device_get_string(device, "Path");
171 DBG("device %p, path, %s", device, path);
173 return gprs_change_powered(path, TRUE);
176 static int modem_disable(struct connman_device *device)
178 const char *path = connman_device_get_string(device, "Path");
180 DBG("device %p, path %s", device, path);
182 return gprs_change_powered(path, FALSE);
185 static struct connman_device_driver modem_driver = {
187 .type = CONNMAN_DEVICE_TYPE_CELLULAR,
188 .probe = modem_probe,
189 .remove = modem_remove,
190 .enable = modem_enable,
191 .disable = modem_disable,
194 static char *get_ident(const char *path)
201 pos = strrchr(path, '/');
205 return g_strdup(pos + 1);
208 static void create_service(struct connman_network *network)
215 path = connman_network_get_string(network, "Path");
217 group = get_ident(path);
219 connman_network_set_group(network, group);
224 static void set_network_name_reply(DBusPendingCall *call, void *user_data)
226 struct connman_network *network = user_data;
228 DBusMessageIter array, dict;
230 DBG("network %p", network);
232 reply = dbus_pending_call_steal_reply(call);
234 if (dbus_message_iter_init(reply, &array) == FALSE)
237 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
240 dbus_message_iter_recurse(&array, &dict);
242 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
243 DBusMessageIter entry, value;
246 dbus_message_iter_recurse(&dict, &entry);
247 dbus_message_iter_get_basic(&entry, &key);
249 dbus_message_iter_next(&entry);
250 dbus_message_iter_recurse(&entry, &value);
253 * 'Operator' is deprecated since version 0.20, but
254 * keep it here for backward compatibility reasons.
256 if (g_str_equal(key, "Operator") == TRUE ||
257 g_str_equal(key, "Name") == TRUE) {
260 dbus_message_iter_get_basic(&value, &name);
261 connman_network_set_name(network, name);
262 create_service(network);
263 } else if (g_strcmp0(key, "Status") == 0) {
265 connman_bool_t roaming;
267 dbus_message_iter_get_basic(&value, &status);
268 if (g_strcmp0(status, "roaming") == 0)
270 else if (g_strcmp0(status, "registered") == 0)
273 dbus_message_iter_next(&dict);
277 connman_network_set_roaming(network, roaming);
278 connman_network_update(network);
281 dbus_message_iter_next(&dict);
284 dbus_message_unref(reply);
286 dbus_pending_call_unref(call);
289 static void set_network_name(struct connman_network *network)
291 struct connman_device *device;
292 DBusMessage *message;
293 DBusPendingCall *call;
296 device = connman_network_get_device(network);
298 path = connman_device_get_string(device, "Path");
302 DBG("path %s", path);
304 message = dbus_message_new_method_call(OFONO_SERVICE, path,
305 OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES);
309 dbus_message_set_auto_start(message, FALSE);
311 if (dbus_connection_send_with_reply(connection, message,
312 &call, TIMEOUT) == FALSE) {
313 connman_error("Failed to get operator name");
318 connman_error("D-Bus connection not available");
322 dbus_pending_call_set_notify(call, set_network_name_reply,
323 (void *)network, NULL);
326 dbus_message_unref(message);
329 static void config_network_reply(DBusPendingCall *call, void *user_data)
331 struct connman_network *network = user_data;
333 DBusMessageIter array, dict;
334 gboolean internet_type = FALSE;
336 DBG("network %p", network);
338 reply = dbus_pending_call_steal_reply(call);
340 if (dbus_message_iter_init(reply, &array) == FALSE)
343 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
346 dbus_message_iter_recurse(&array, &dict);
348 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
349 DBusMessageIter entry, value;
352 dbus_message_iter_recurse(&dict, &entry);
353 dbus_message_iter_get_basic(&entry, &key);
355 dbus_message_iter_next(&entry);
356 dbus_message_iter_recurse(&entry, &value);
358 if (g_str_equal(key, "Type") == TRUE) {
361 dbus_message_iter_get_basic(&value, &type);
362 if (g_strcmp0(type, "internet") == 0) {
363 internet_type = TRUE;
365 connman_network_set_protocol(network,
366 CONNMAN_NETWORK_PROTOCOL_IP);
367 set_network_name(network);
369 internet_type = FALSE;
371 connman_network_set_protocol(network,
372 CONNMAN_NETWORK_PROTOCOL_UNKNOWN);
376 dbus_message_iter_next(&dict);
380 dbus_message_unref(reply);
382 dbus_pending_call_unref(call);
385 static void config_network(struct connman_network *network, const char *path)
387 DBusMessage *message;
388 DBusPendingCall *call;
390 DBG("path %s", path);
392 message = dbus_message_new_method_call(OFONO_SERVICE, path,
393 OFONO_PRI_CONTEXT_INTERFACE, GET_PROPERTIES);
397 dbus_message_set_auto_start(message, FALSE);
399 if (dbus_connection_send_with_reply(connection, message,
400 &call, TIMEOUT) == FALSE) {
401 connman_error("Failed to get Primary Context");
406 connman_error("D-Bus connection not available");
410 dbus_pending_call_set_notify(call, config_network_reply,
411 (void *)network, NULL);
414 dbus_message_unref(message);
417 static gboolean registration_changed(DBusConnection *connection,
418 DBusMessage *message, void *user_data)
420 const char *path = dbus_message_get_path(message);
421 struct connman_network *network = user_data;
422 DBusMessageIter iter, value;
425 DBG("path %s", path);
427 if (dbus_message_iter_init(message, &iter) == FALSE)
430 dbus_message_iter_get_basic(&iter, &key);
434 dbus_message_iter_next(&iter);
435 dbus_message_iter_recurse(&iter, &value);
437 if (g_strcmp0(key, "Name") == 0 ||
438 g_strcmp0(key, "Operator") == 0) {
441 dbus_message_iter_get_basic(&value, &name);
442 DBG("name %s", name);
443 connman_network_set_name(network, name);
444 create_service(network);
445 } else if (g_strcmp0(key, "Strength") == 0) {
446 connman_uint8_t strength;
448 dbus_message_iter_get_basic(&value, &strength);
449 connman_network_set_strength(network, strength);
450 connman_network_update(network);
451 } else if (g_strcmp0(key, "Status") == 0) {
453 connman_bool_t roaming;
455 dbus_message_iter_get_basic(&value, &status);
456 if (g_strcmp0(status, "roaming") == 0)
458 else if (g_strcmp0(status, "registered") == 0)
463 connman_network_set_roaming(network, roaming);
464 connman_network_update(network);
470 static int network_probe(struct connman_network *network)
475 reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
476 OFONO_REGISTRATION_INTERFACE,
478 registration_changed,
483 connman_network_set_data(network, GUINT_TO_POINTER(reg_watch));
485 path = connman_network_get_string(network, "Path");
487 DBG("network %p path %s", network, path);
489 config_network(network, path);
494 static struct connman_network *pending_network;
496 static gboolean pending_network_is_available(
497 struct connman_network *pending_network)
499 struct connman_device *device;
500 struct connman_network *network;
501 const char *identifier;
504 /* Modem may be removed during waiting for active reply */
505 device = connman_network_get_device(pending_network);
506 if (device == NULL) {
507 DBG("Modem is removed");
511 identifier = connman_network_get_identifier(pending_network);
513 ident = g_strdup(identifier);
515 connman_network_unref(pending_network);
517 /* network may be removed during waiting for active reply */
518 network = connman_device_get_network(device, ident);
528 static void set_active_reply(DBusPendingCall *call, void *user_data)
532 struct connman_network *network = user_data;
534 DBG("network %p", network);
536 reply = dbus_pending_call_steal_reply(call);
538 if (pending_network_is_available(network) == FALSE)
541 dbus_error_init(&error);
542 if (dbus_set_error_from_message(&error, reply)) {
543 if (connman_network_get_index(network) < 0)
544 connman_network_set_error(network,
545 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
547 pending_network = NULL;
549 connman_error("SetProperty(Active) %s %s",
550 error.name, error.message);
552 dbus_error_free(&error);
554 pending_network = network;
557 dbus_message_unref(reply);
559 dbus_pending_call_unref(call);
562 static int set_network_active(struct connman_network *network,
567 const char *path = connman_network_get_string(network, "Path");
569 DBG("network %p, path %s, active %d", network, path, active);
571 error = set_property(path, OFONO_PRI_CONTEXT_INTERFACE,
572 "Active", DBUS_TYPE_BOOLEAN, &active,
573 set_active_reply, network, NULL);
574 if (active == FALSE && error == -EINPROGRESS)
580 static void set_apn(struct connman_network *network)
582 const char *apn, *path;
584 apn = connman_network_get_string(network, "Cellular.APN");
588 path = connman_network_get_string(network, "Path");
592 DBG("path %s, apn %s", path, apn);
594 set_property(path, OFONO_PRI_CONTEXT_INTERFACE,
595 "AccessPointName", DBUS_TYPE_STRING, &apn,
599 static int network_connect(struct connman_network *network)
601 if (connman_network_get_index(network) >= 0)
604 return set_network_active(network, TRUE);
607 static int network_disconnect(struct connman_network *network)
609 if (connman_network_get_index(network) < 0)
612 return set_network_active(network, FALSE);
615 static void network_remove(struct connman_network *network)
619 DBG("network %p", network);
621 reg_watch = GPOINTER_TO_UINT(connman_network_get_data(network));
622 g_dbus_remove_watch(connection, reg_watch);
625 static int network_setup(struct connman_network *network, const char *key)
629 if (g_strcmp0(key, "Cellular.APN") == 0)
635 static struct connman_network_driver network_driver = {
637 .type = CONNMAN_NETWORK_TYPE_CELLULAR,
638 .probe = network_probe,
639 .remove = network_remove,
640 .connect = network_connect,
641 .disconnect = network_disconnect,
642 .setup = network_setup,
645 static void add_network(struct connman_device *device, const char *path)
647 struct connman_network *network;
652 DBG("device %p path %s", device, path);
654 network = connman_device_get_network(device, path);
658 ident = get_ident(path);
660 network = connman_network_create(ident,
661 CONNMAN_NETWORK_TYPE_CELLULAR);
667 connman_network_set_string(network, "Path", path);
668 connman_network_set_available(network, TRUE);
669 connman_network_set_index(network, -1);
671 mcc = connman_device_get_string(device, "MCC");
673 connman_network_set_string(network, "Cellular.MCC", mcc);
675 mnc = connman_device_get_string(device, "MNC");
677 connman_network_set_string(network, "Cellular.MNC", mnc);
679 connman_device_add_network(device, network);
682 static void add_networks(struct connman_device *device, DBusMessageIter *array)
684 DBusMessageIter entry;
688 dbus_message_iter_recurse(array, &entry);
690 while (dbus_message_iter_get_arg_type(&entry) ==
691 DBUS_TYPE_OBJECT_PATH) {
694 dbus_message_iter_get_basic(&entry, &path);
696 add_network(device, path);
698 dbus_message_iter_next(&entry);
702 static void create_context_reply(DBusPendingCall *call, void *user_data)
709 dbus_error_init(&error);
711 reply = dbus_pending_call_steal_reply(call);
713 if (dbus_set_error_from_message(&error, reply)) {
714 connman_error("CreateContext() %s %s",
715 error.name, error.message);
716 dbus_error_free(&error);
719 dbus_message_unref(reply);
721 dbus_pending_call_unref(call);
724 static void add_default_context(DBusMessageIter *array,
725 const char *path, const char *name, const char *type)
727 DBusMessageIter entry;
728 DBusMessage *message;
729 DBusPendingCall *call;
736 dbus_message_iter_recurse(array, &entry);
738 if (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_OBJECT_PATH)
741 DBG("path %s, name %s, type %s", path, name, type);
743 message = dbus_message_new_method_call(OFONO_SERVICE, path,
744 OFONO_GPRS_INTERFACE, CREATE_CONTEXT);
748 dbus_message_set_auto_start(message, FALSE);
750 dbus_message_append_args(message, DBUS_TYPE_STRING,
751 &name, DBUS_TYPE_STRING,
752 &type, DBUS_TYPE_INVALID);
754 if (dbus_connection_send_with_reply(connection, message,
755 &call, TIMEOUT) == FALSE) {
756 connman_error("Failed to create default context");
757 dbus_message_unref(message);
762 connman_error("D-Bus connection not available");
763 dbus_message_unref(message);
767 dbus_pending_call_set_notify(call, create_context_reply, NULL, NULL);
769 dbus_message_unref(message);
772 static void check_networks_reply(DBusPendingCall *call, void *user_data)
774 struct connman_device *device = user_data;
776 DBusMessageIter array, dict, contexts;
777 dbus_bool_t attached;
779 DBG("device %p", device);
781 reply = dbus_pending_call_steal_reply(call);
783 if (dbus_message_iter_init(reply, &array) == FALSE)
786 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
789 dbus_message_iter_recurse(&array, &dict);
791 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
792 DBusMessageIter entry, value;
795 dbus_message_iter_recurse(&dict, &entry);
796 dbus_message_iter_get_basic(&entry, &key);
798 dbus_message_iter_next(&entry);
799 dbus_message_iter_recurse(&entry, &value);
803 if (g_str_equal(key, "Attached") == TRUE) {
804 dbus_message_iter_get_basic(&value, &attached);
805 DBG("Attached %d", attached);
806 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
809 path = connman_device_get_string(device, "Path");
811 add_default_context(&contexts, path,
812 CONTEXT_NAME, CONTEXT_TYPE);
813 } else if (g_str_equal(key, "Powered") == TRUE) {
816 dbus_message_iter_get_basic(&value, &powered);
818 connman_device_set_powered(device, powered);
821 dbus_message_iter_next(&dict);
824 if (attached == TRUE)
825 add_networks(device, &contexts);
828 dbus_message_unref(reply);
830 dbus_pending_call_unref(call);
833 static void check_networks(struct modem_data *modem)
835 DBusMessage *message;
836 DBusPendingCall *call;
837 struct connman_device *device;
839 DBG("modem %p", modem);
844 device = modem->device;
848 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
849 OFONO_GPRS_INTERFACE, GET_PROPERTIES);
853 dbus_message_set_auto_start(message, FALSE);
855 if (dbus_connection_send_with_reply(connection, message,
856 &call, TIMEOUT) == FALSE) {
857 connman_error("Failed to get ofono GPRS");
862 connman_error("D-Bus connection not available");
866 dbus_pending_call_set_notify(call, check_networks_reply,
867 (void *)device, NULL);
870 dbus_message_unref(message);
873 static void add_device(const char *path, const char *imsi,
874 const char *mcc, const char *mnc)
876 struct modem_data *modem;
877 struct connman_device *device;
879 DBG("path %s imsi %s", path, imsi);
887 modem = g_hash_table_lookup(modem_hash, path);
891 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
895 connman_device_set_ident(device, imsi);
897 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
899 connman_device_set_string(device, "Path", path);
901 connman_device_set_string(device, "MCC", mcc);
903 connman_device_set_string(device, "MNC", mnc);
905 if (connman_device_register(device) < 0) {
906 connman_device_unref(device);
910 modem->device = device;
912 check_networks(modem);
915 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
917 const char *path = user_data;
921 /* If MobileNetworkCodeLength is not provided, mnc_length is 0 */
922 unsigned char mnc_length = 0;
924 DBusMessageIter array, dict;
926 DBG("path %s", path);
928 reply = dbus_pending_call_steal_reply(call);
930 if (dbus_message_iter_init(reply, &array) == FALSE)
933 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
936 dbus_message_iter_recurse(&array, &dict);
938 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
939 DBusMessageIter entry, value;
942 dbus_message_iter_recurse(&dict, &entry);
943 dbus_message_iter_get_basic(&entry, &key);
945 dbus_message_iter_next(&entry);
946 dbus_message_iter_recurse(&entry, &value);
948 if (g_str_equal(key, "SubscriberIdentity") == TRUE)
949 dbus_message_iter_get_basic(&value, &imsi);
951 * 'MobileNetworkCodeLength' is deprecated since version 0.20, but
952 * keep it here for backward compatibility reasons.
954 else if (g_str_equal(key, "MobileNetworkCodeLength") == TRUE)
955 dbus_message_iter_get_basic(&value,
956 (void *) &mnc_length);
957 else if (g_str_equal(key, "MobileCountryCode") == TRUE)
958 dbus_message_iter_get_basic(&value,
960 else if (g_str_equal(key, "MobileNetworkCode") == TRUE)
961 dbus_message_iter_get_basic(&value,
964 dbus_message_iter_next(&dict);
967 if (mnc_length == 2 || mnc_length == 3) {
968 mcc = g_strndup(imsi, 3);
969 mnc = g_strndup(imsi + 3, mnc_length);
972 add_device(path, imsi, mcc, mnc);
974 if (mnc_length == 2 || mnc_length == 3) {
980 dbus_message_unref(reply);
982 dbus_pending_call_unref(call);
985 static void get_imsi(const char *path)
987 DBusMessage *message;
988 DBusPendingCall *call;
990 DBG("path %s", path);
992 message = dbus_message_new_method_call(OFONO_SERVICE, path,
993 OFONO_SIM_INTERFACE, GET_PROPERTIES);
997 dbus_message_set_auto_start(message, FALSE);
999 if (dbus_connection_send_with_reply(connection, message,
1000 &call, TIMEOUT) == FALSE) {
1001 connman_error("Failed to get ofono modem sim");
1006 connman_error("D-Bus connection not available");
1010 dbus_pending_call_set_notify(call, sim_properties_reply,
1011 (void *)path, NULL);
1014 dbus_message_unref(message);
1017 static int modem_change_powered(const char *path, dbus_bool_t powered)
1019 DBG("path %s powered %d", path, powered);
1021 return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
1022 DBUS_TYPE_BOOLEAN, &powered,
1026 static struct modem_data *add_modem(const char *path)
1028 struct modem_data *modem;
1033 modem = g_hash_table_lookup(modem_hash, path);
1034 if (modem != NULL) {
1035 modem->available = TRUE;
1040 modem = g_try_new0(struct modem_data, 1);
1044 modem->path = g_strdup(path);
1045 modem->device = NULL;
1046 modem->available = TRUE;
1048 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1053 static gboolean modem_has_gprs(DBusMessageIter *array)
1055 DBusMessageIter entry;
1057 dbus_message_iter_recurse(array, &entry);
1059 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1060 const char *interface;
1062 dbus_message_iter_get_basic(&entry, &interface);
1064 if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
1067 dbus_message_iter_next(&entry);
1073 static void modem_properties_reply(DBusPendingCall *call, void *user_data)
1077 DBusMessageIter array, dict;
1078 const char *path = user_data;
1080 DBG("path %s", path);
1082 reply = dbus_pending_call_steal_reply(call);
1084 dbus_error_init(&error);
1086 if (dbus_set_error_from_message(&error, reply)) {
1087 connman_error("Modem.GetProperties(%s) %s %s",
1088 path, error.name, error.message);
1089 dbus_error_free(&error);
1093 if (dbus_message_iter_init(reply, &array) == FALSE)
1096 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1099 dbus_message_iter_recurse(&array, &dict);
1101 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1102 DBusMessageIter entry, value;
1104 dbus_bool_t powered;
1106 dbus_message_iter_recurse(&dict, &entry);
1107 dbus_message_iter_get_basic(&entry, &key);
1109 dbus_message_iter_next(&entry);
1110 dbus_message_iter_recurse(&entry, &value);
1112 if (g_str_equal(key, "Powered") == TRUE) {
1113 dbus_message_iter_get_basic(&value, &powered);
1115 if (powered == FALSE) {
1116 modem_change_powered(path, TRUE);
1119 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1120 if (modem_has_gprs(&value) == TRUE)
1124 dbus_message_iter_next(&dict);
1128 dbus_message_unref(reply);
1130 dbus_pending_call_unref(call);
1133 static void get_modem_properties(struct modem_data *modem)
1135 DBusMessage *message;
1136 DBusPendingCall *call;
1138 DBG("path %s", modem->path);
1140 if (modem->path == NULL)
1143 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
1144 OFONO_MODEM_INTERFACE, GET_PROPERTIES);
1145 if (message == NULL)
1148 dbus_message_set_auto_start(message, FALSE);
1150 if (dbus_connection_send_with_reply(connection, message,
1151 &call, TIMEOUT) == FALSE) {
1152 connman_error("Failed to get ofono modem");
1157 connman_error("D-Bus connection not available");
1161 dbus_pending_call_set_notify(call, modem_properties_reply,
1162 (void *)modem->path, NULL);
1165 dbus_message_unref(message);
1168 static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
1170 struct modem_data *modem = value;
1172 modem->available = FALSE;
1175 static void modems_set_unavailable()
1177 g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
1180 static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
1182 struct modem_data *modem = value;
1184 if (modem->available == FALSE)
1185 g_hash_table_remove(modem_hash, key);
1188 static void cleanup_modems()
1190 g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
1193 static void update_modems(DBusMessageIter *array)
1195 DBusMessageIter entry;
1197 dbus_message_iter_recurse(array, &entry);
1199 modems_set_unavailable();
1201 while (dbus_message_iter_get_arg_type(&entry) ==
1202 DBUS_TYPE_OBJECT_PATH) {
1204 struct modem_data *modem;
1206 dbus_message_iter_get_basic(&entry, &path);
1208 modem = add_modem(path);
1210 get_modem_properties(modem);
1212 dbus_message_iter_next(&entry);
1218 static void manager_properties_reply(DBusPendingCall *call, void *user_data)
1222 DBusMessageIter array, dict;
1226 reply = dbus_pending_call_steal_reply(call);
1228 dbus_error_init(&error);
1230 if (dbus_set_error_from_message(&error, reply)) {
1231 connman_error("ModemManager.GetProperties() %s %s",
1232 error.name, error.message);
1233 dbus_error_free(&error);
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);
1245 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1246 DBusMessageIter entry, value;
1249 dbus_message_iter_recurse(&dict, &entry);
1250 dbus_message_iter_get_basic(&entry, &key);
1252 dbus_message_iter_next(&entry);
1253 dbus_message_iter_recurse(&entry, &value);
1255 if (g_str_equal(key, "Modems") == TRUE) {
1256 update_modems(&value);
1260 dbus_message_iter_next(&dict);
1264 dbus_message_unref(reply);
1266 dbus_pending_call_unref(call);
1269 static void modem_remove_device(struct modem_data *modem)
1271 if (modem->device == NULL)
1274 connman_device_unregister(modem->device);
1275 connman_device_unref(modem->device);
1277 modem->device = NULL;
1280 static void remove_modem(gpointer data)
1282 struct modem_data *modem = data;
1284 g_free(modem->path);
1286 modem_remove_device(modem);
1291 static void ofono_connect(DBusConnection *connection, void *user_data)
1293 DBusMessage *message;
1294 DBusPendingCall *call;
1296 DBG("connection %p", connection);
1298 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1299 g_free, remove_modem);
1301 message = dbus_message_new_method_call(OFONO_SERVICE, "/",
1302 OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
1303 if (message == NULL)
1306 dbus_message_set_auto_start(message, FALSE);
1308 if (dbus_connection_send_with_reply(connection, message,
1309 &call, TIMEOUT) == FALSE) {
1310 connman_error("Failed to get ofono modems");
1315 connman_error("D-Bus connection not available");
1319 dbus_pending_call_set_notify(call, manager_properties_reply,
1323 dbus_message_unref(message);
1327 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1329 DBG("connection %p", connection);
1331 if (modem_hash == NULL)
1334 g_hash_table_destroy(modem_hash);
1339 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1342 const char *path = dbus_message_get_path(message);
1343 struct modem_data *modem;
1344 DBusMessageIter iter, value;
1347 DBG("path %s", path);
1349 modem = g_hash_table_lookup(modem_hash, path);
1353 if (dbus_message_iter_init(message, &iter) == FALSE)
1356 dbus_message_iter_get_basic(&iter, &key);
1358 dbus_message_iter_next(&iter);
1359 dbus_message_iter_recurse(&iter, &value);
1361 if (g_str_equal(key, "Powered") == TRUE) {
1362 dbus_bool_t powered;
1364 dbus_message_iter_get_basic(&value, &powered);
1365 if (powered == TRUE)
1368 modem_remove_device(modem);
1369 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1370 if (modem_has_gprs(&value) == TRUE) {
1371 if (modem->device == NULL)
1372 get_imsi(modem->path);
1373 } else if (modem->device != NULL)
1374 modem_remove_device(modem);
1380 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1383 const char *path = dbus_message_get_path(message);
1384 struct modem_data *modem;
1385 DBusMessageIter iter, value;
1388 DBG("path %s", path);
1390 modem = g_hash_table_lookup(modem_hash, path);
1394 if (dbus_message_iter_init(message, &iter) == FALSE)
1397 dbus_message_iter_get_basic(&iter, &key);
1399 dbus_message_iter_next(&iter);
1400 dbus_message_iter_recurse(&iter, &value);
1402 if (g_str_equal(key, "Attached") == TRUE) {
1403 dbus_bool_t attached;
1405 dbus_message_iter_get_basic(&value, &attached);
1407 DBG("Attached %d", attached);
1409 if (attached == TRUE)
1410 check_networks(modem);
1411 else if (modem->device != NULL)
1412 connman_device_remove_all_networks(modem->device);
1414 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
1415 check_networks(modem);
1416 } else if (g_str_equal(key, "Powered") == TRUE) {
1417 dbus_bool_t powered;
1419 if (modem->device == NULL)
1422 dbus_message_iter_get_basic(&value, &powered);
1423 connman_device_set_powered(modem->device, powered);
1429 static gboolean manager_changed(DBusConnection *connection,
1430 DBusMessage *message, void *user_data)
1432 const char *path = dbus_message_get_path(message);
1433 DBusMessageIter iter, value;
1436 DBG("path %s", path);
1438 if (dbus_message_iter_init(message, &iter) == FALSE)
1441 dbus_message_iter_get_basic(&iter, &key);
1443 dbus_message_iter_next(&iter);
1444 dbus_message_iter_recurse(&iter, &value);
1446 if (g_str_equal(key, "Modems") == TRUE)
1447 update_modems(&value);
1452 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1454 DBusMessageIter entry;
1455 gchar *nameserver = NULL, *nameserver_old = NULL;
1459 dbus_message_iter_recurse(array, &entry);
1461 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1464 dbus_message_iter_get_basic(&entry, &dns);
1468 if (nameserver == NULL) {
1470 nameserver = g_strdup(dns);
1473 nameserver_old = nameserver;
1474 nameserver = g_strdup_printf("%s %s",
1475 nameserver_old, dns);
1476 g_free(nameserver_old);
1479 dbus_message_iter_next(&entry);
1482 parent->ipv4.nameserver = nameserver;
1485 static void update_settings(DBusMessageIter *array,
1486 struct connman_element *parent)
1488 DBusMessageIter dict;
1489 const char *interface = NULL;
1493 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1496 dbus_message_iter_recurse(array, &dict);
1498 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1499 DBusMessageIter entry, value;
1502 dbus_message_iter_recurse(&dict, &entry);
1503 dbus_message_iter_get_basic(&entry, &key);
1505 dbus_message_iter_next(&entry);
1506 dbus_message_iter_recurse(&entry, &value);
1508 if (g_str_equal(key, "Interface") == TRUE) {
1511 dbus_message_iter_get_basic(&value, &interface);
1513 DBG("interface %s", interface);
1515 index = connman_inet_ifindex(interface);
1517 connman_network_set_index(
1518 pending_network, index);
1520 connman_error("Can not find interface %s",
1524 } else if (g_str_equal(key, "Method") == TRUE) {
1527 dbus_message_iter_get_basic(&value, &method);
1528 if (g_strcmp0(method, "static") == 0) {
1530 parent->ipv4.method =
1531 CONNMAN_IPCONFIG_METHOD_FIXED;
1532 } else if (g_strcmp0(method, "dhcp") == 0) {
1534 parent->ipv4.method =
1535 CONNMAN_IPCONFIG_METHOD_DHCP;
1538 } else if (g_str_equal(key, "Address") == TRUE) {
1539 const char *address;
1541 dbus_message_iter_get_basic(&value, &address);
1543 DBG("address %s", address);
1545 parent->ipv4.address = g_strdup(address);
1546 } else if (g_str_equal(key, "Netmask") == TRUE) {
1547 const char *netmask;
1549 dbus_message_iter_get_basic(&value, &netmask);
1551 DBG("netmask %s", netmask);
1553 parent->ipv4.netmask = g_strdup(netmask);
1554 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1556 get_dns(&value, parent);
1557 } else if (g_str_equal(key, "Gateway") == TRUE) {
1558 const char *gateway;
1560 dbus_message_iter_get_basic(&value, &gateway);
1562 DBG("gateway %s", gateway);
1564 parent->ipv4.gateway = g_strdup(gateway);
1567 dbus_message_iter_next(&dict);
1570 /* deactive, oFono send NULL inteface before deactive signal */
1571 if (interface == NULL)
1572 connman_network_set_index(pending_network, -1);
1575 static void cleanup_ipconfig(struct connman_element *parent)
1577 g_free(parent->ipv4.address);
1578 parent->ipv4.address = NULL;
1580 g_free(parent->ipv4.netmask);
1581 parent->ipv4.netmask = NULL;
1583 g_free(parent->ipv4.nameserver);
1584 parent->ipv4.nameserver = NULL;
1586 g_free(parent->ipv4.gateway);
1587 parent->ipv4.gateway = NULL;
1589 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1592 static int static_network_set_connected(
1593 struct connman_network *pending_network,
1594 struct connman_element *parent,
1595 connman_bool_t connected)
1597 if (connected == FALSE)
1598 cleanup_ipconfig(parent);
1600 connman_network_set_connected(pending_network, connected);
1605 static gboolean pri_context_changed(DBusConnection *connection,
1606 DBusMessage *message, void *user_data)
1608 const char *path = dbus_message_get_path(message);
1609 struct connman_element *parent;
1610 const char *pending_path;
1611 DBusMessageIter iter, value;
1614 DBG("pending_network %p, path %s", pending_network, path);
1616 if (pending_network == NULL)
1619 pending_path = connman_network_get_string(pending_network, "Path");
1620 if (g_strcmp0(pending_path, path) != 0)
1623 parent = connman_network_get_element(pending_network);
1625 if (dbus_message_iter_init(message, &iter) == FALSE)
1628 dbus_message_iter_get_basic(&iter, &key);
1630 dbus_message_iter_next(&iter);
1631 dbus_message_iter_recurse(&iter, &value);
1633 if (g_str_equal(key, "Settings") == TRUE) {
1635 update_settings(&value, parent);
1636 } else if (g_str_equal(key, "Active") == TRUE) {
1639 dbus_message_iter_get_basic(&value, &active);
1641 switch (parent->ipv4.method) {
1642 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1643 case CONNMAN_IPCONFIG_METHOD_OFF:
1644 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1646 case CONNMAN_IPCONFIG_METHOD_FIXED:
1647 connman_network_set_method(pending_network,
1648 CONNMAN_IPCONFIG_METHOD_FIXED);
1650 if (static_network_set_connected(
1651 pending_network, parent, active) < 0)
1652 set_network_active(pending_network, FALSE);
1654 case CONNMAN_IPCONFIG_METHOD_DHCP:
1655 connman_network_set_method(pending_network,
1656 CONNMAN_IPCONFIG_METHOD_DHCP);
1657 connman_network_set_connected(pending_network, active);
1661 pending_network = NULL;
1668 static guint gprs_watch;
1669 static guint modem_watch;
1670 static guint manager_watch;
1671 static guint context_watch;
1673 static int ofono_init(void)
1677 connection = connman_dbus_get_connection();
1678 if (connection == NULL)
1681 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1682 ofono_connect, ofono_disconnect, NULL, NULL);
1684 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1685 OFONO_GPRS_INTERFACE,
1690 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1691 OFONO_MODEM_INTERFACE,
1696 manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1697 OFONO_MANAGER_INTERFACE,
1702 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1703 OFONO_PRI_CONTEXT_INTERFACE,
1705 pri_context_changed,
1708 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1709 manager_watch == 0 || context_watch == 0) {
1714 err = connman_network_driver_register(&network_driver);
1718 err = connman_device_driver_register(&modem_driver);
1720 connman_network_driver_unregister(&network_driver);
1727 g_dbus_remove_watch(connection, watch);
1728 g_dbus_remove_watch(connection, gprs_watch);
1729 g_dbus_remove_watch(connection, modem_watch);
1730 g_dbus_remove_watch(connection, manager_watch);
1731 g_dbus_remove_watch(connection, context_watch);
1733 dbus_connection_unref(connection);
1738 static void ofono_exit(void)
1740 g_dbus_remove_watch(connection, watch);
1741 g_dbus_remove_watch(connection, gprs_watch);
1742 g_dbus_remove_watch(connection, modem_watch);
1743 g_dbus_remove_watch(connection, manager_watch);
1744 g_dbus_remove_watch(connection, context_watch);
1746 ofono_disconnect(connection, NULL);
1748 connman_device_driver_unregister(&modem_driver);
1749 connman_network_driver_unregister(&network_driver);
1751 dbus_connection_unref(connection);
1754 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1755 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)