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 char *path = user_data;
775 struct modem_data *modem;
776 struct connman_device *device;
778 DBusMessageIter array, dict, contexts;
779 dbus_bool_t attached;
781 DBG("path %s", path);
783 modem = g_hash_table_lookup(modem_hash, path);
784 if (modem == NULL || modem->device == NULL)
787 device = modem->device;
789 reply = dbus_pending_call_steal_reply(call);
791 if (dbus_message_iter_init(reply, &array) == FALSE)
794 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
797 dbus_message_iter_recurse(&array, &dict);
799 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
800 DBusMessageIter entry, value;
803 dbus_message_iter_recurse(&dict, &entry);
804 dbus_message_iter_get_basic(&entry, &key);
806 dbus_message_iter_next(&entry);
807 dbus_message_iter_recurse(&entry, &value);
811 if (g_str_equal(key, "Attached") == TRUE) {
812 dbus_message_iter_get_basic(&value, &attached);
813 DBG("Attached %d", attached);
814 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
817 path = connman_device_get_string(device, "Path");
819 add_default_context(&contexts, path,
820 CONTEXT_NAME, CONTEXT_TYPE);
821 } else if (g_str_equal(key, "Powered") == TRUE) {
824 dbus_message_iter_get_basic(&value, &powered);
826 connman_device_set_powered(device, powered);
829 dbus_message_iter_next(&dict);
832 if (attached == TRUE)
833 add_networks(device, &contexts);
836 dbus_message_unref(reply);
838 dbus_pending_call_unref(call);
841 static void check_networks(struct modem_data *modem)
843 DBusMessage *message;
844 DBusPendingCall *call;
846 DBG("modem %p", modem);
851 if (modem->device == NULL)
854 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
855 OFONO_GPRS_INTERFACE, GET_PROPERTIES);
859 dbus_message_set_auto_start(message, FALSE);
861 if (dbus_connection_send_with_reply(connection, message,
862 &call, TIMEOUT) == FALSE) {
863 connman_error("Failed to get ofono GPRS");
868 connman_error("D-Bus connection not available");
872 dbus_pending_call_set_notify(call, check_networks_reply,
873 g_strdup(modem->path), g_free);
876 dbus_message_unref(message);
879 static void add_device(const char *path, const char *imsi,
880 const char *mcc, const char *mnc)
882 struct modem_data *modem;
883 struct connman_device *device;
885 DBG("path %s imsi %s", path, imsi);
893 modem = g_hash_table_lookup(modem_hash, path);
897 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
901 connman_device_set_ident(device, imsi);
903 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
905 connman_device_set_string(device, "Path", path);
907 connman_device_set_string(device, "MCC", mcc);
909 connman_device_set_string(device, "MNC", mnc);
911 if (connman_device_register(device) < 0) {
912 connman_device_unref(device);
916 modem->device = device;
918 check_networks(modem);
921 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
923 const char *path = user_data;
927 /* If MobileNetworkCodeLength is not provided, mnc_length is 0 */
928 unsigned char mnc_length = 0;
930 DBusMessageIter array, dict;
932 DBG("path %s", path);
934 reply = dbus_pending_call_steal_reply(call);
936 if (dbus_message_iter_init(reply, &array) == FALSE)
939 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
942 dbus_message_iter_recurse(&array, &dict);
944 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
945 DBusMessageIter entry, value;
948 dbus_message_iter_recurse(&dict, &entry);
949 dbus_message_iter_get_basic(&entry, &key);
951 dbus_message_iter_next(&entry);
952 dbus_message_iter_recurse(&entry, &value);
954 if (g_str_equal(key, "SubscriberIdentity") == TRUE)
955 dbus_message_iter_get_basic(&value, &imsi);
957 * 'MobileNetworkCodeLength' is deprecated since version 0.20, but
958 * keep it here for backward compatibility reasons.
960 else if (g_str_equal(key, "MobileNetworkCodeLength") == TRUE)
961 dbus_message_iter_get_basic(&value,
962 (void *) &mnc_length);
963 else if (g_str_equal(key, "MobileCountryCode") == TRUE)
964 dbus_message_iter_get_basic(&value,
966 else if (g_str_equal(key, "MobileNetworkCode") == TRUE)
967 dbus_message_iter_get_basic(&value,
970 dbus_message_iter_next(&dict);
973 if (mnc_length == 2 || mnc_length == 3) {
974 mcc = g_strndup(imsi, 3);
975 mnc = g_strndup(imsi + 3, mnc_length);
978 add_device(path, imsi, mcc, mnc);
980 if (mnc_length == 2 || mnc_length == 3) {
986 dbus_message_unref(reply);
988 dbus_pending_call_unref(call);
991 static void get_imsi(const char *path)
993 DBusMessage *message;
994 DBusPendingCall *call;
996 DBG("path %s", path);
998 message = dbus_message_new_method_call(OFONO_SERVICE, path,
999 OFONO_SIM_INTERFACE, GET_PROPERTIES);
1000 if (message == NULL)
1003 dbus_message_set_auto_start(message, FALSE);
1005 if (dbus_connection_send_with_reply(connection, message,
1006 &call, TIMEOUT) == FALSE) {
1007 connman_error("Failed to get ofono modem sim");
1012 connman_error("D-Bus connection not available");
1016 dbus_pending_call_set_notify(call, sim_properties_reply,
1017 g_strdup(path), g_free);
1020 dbus_message_unref(message);
1023 static int modem_change_powered(const char *path, dbus_bool_t powered)
1025 DBG("path %s powered %d", path, powered);
1027 return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
1028 DBUS_TYPE_BOOLEAN, &powered,
1032 static struct modem_data *add_modem(const char *path)
1034 struct modem_data *modem;
1036 DBG("path %s", path);
1041 modem = g_hash_table_lookup(modem_hash, path);
1042 if (modem != NULL) {
1043 modem->available = TRUE;
1048 modem = g_try_new0(struct modem_data, 1);
1052 modem->path = g_strdup(path);
1053 modem->device = NULL;
1054 modem->available = TRUE;
1056 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1061 static gboolean modem_has_gprs(DBusMessageIter *array)
1063 DBusMessageIter entry;
1065 dbus_message_iter_recurse(array, &entry);
1067 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1068 const char *interface;
1070 dbus_message_iter_get_basic(&entry, &interface);
1072 if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
1075 dbus_message_iter_next(&entry);
1081 static void modem_properties_reply(DBusPendingCall *call, void *user_data)
1085 DBusMessageIter array, dict;
1086 const char *path = user_data;
1087 dbus_bool_t powered = FALSE;
1088 gboolean has_gprs = FALSE;
1089 struct modem_data *new_modem;
1091 DBG("path %s", path);
1093 reply = dbus_pending_call_steal_reply(call);
1095 if (g_hash_table_lookup(modem_hash, path))
1098 dbus_error_init(&error);
1100 if (dbus_set_error_from_message(&error, reply)) {
1101 connman_error("Modem.GetProperties(%s) %s %s",
1102 path, error.name, error.message);
1103 dbus_error_free(&error);
1107 if (dbus_message_iter_init(reply, &array) == FALSE)
1110 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1113 dbus_message_iter_recurse(&array, &dict);
1115 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1116 DBusMessageIter entry, value;
1119 dbus_message_iter_recurse(&dict, &entry);
1120 dbus_message_iter_get_basic(&entry, &key);
1122 dbus_message_iter_next(&entry);
1123 dbus_message_iter_recurse(&entry, &value);
1125 if (g_str_equal(key, "Powered") == TRUE)
1126 dbus_message_iter_get_basic(&value, &powered);
1127 else if (g_str_equal(key, "Interfaces") == TRUE)
1128 has_gprs = modem_has_gprs(&value);
1130 dbus_message_iter_next(&dict);
1133 new_modem = add_modem(path);
1134 if (new_modem == NULL)
1138 modem_change_powered(path, TRUE);
1144 dbus_message_unref(reply);
1146 dbus_pending_call_unref(call);
1149 static void get_modem_properties(const char *path)
1151 DBusMessage *message;
1152 DBusPendingCall *call;
1154 DBG("path %s", path);
1159 message = dbus_message_new_method_call(OFONO_SERVICE, path,
1160 OFONO_MODEM_INTERFACE, GET_PROPERTIES);
1161 if (message == NULL)
1164 dbus_message_set_auto_start(message, FALSE);
1166 if (dbus_connection_send_with_reply(connection, message,
1167 &call, TIMEOUT) == FALSE) {
1168 connman_error("Failed to get ofono modem");
1173 connman_error("D-Bus connection not available");
1177 dbus_pending_call_set_notify(call, modem_properties_reply,
1178 g_strdup(path), g_free);
1181 dbus_message_unref(message);
1184 static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
1186 struct modem_data *modem = value;
1188 modem->available = FALSE;
1191 static void modems_set_unavailable()
1193 g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
1196 static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
1198 struct modem_data *modem = value;
1200 if (modem->available == FALSE)
1201 g_hash_table_remove(modem_hash, key);
1204 static void cleanup_modems()
1206 g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
1209 static void update_modems(DBusMessageIter *array)
1211 DBusMessageIter entry;
1215 dbus_message_iter_recurse(array, &entry);
1217 modems_set_unavailable();
1219 while (dbus_message_iter_get_arg_type(&entry) ==
1220 DBUS_TYPE_OBJECT_PATH) {
1222 struct modem_data *modem;
1224 dbus_message_iter_get_basic(&entry, &path);
1226 modem = g_hash_table_lookup(modem_hash, path);
1229 modem->available = TRUE;
1231 get_modem_properties(path);
1233 dbus_message_iter_next(&entry);
1239 static void manager_properties_reply(DBusPendingCall *call, void *user_data)
1243 DBusMessageIter array, dict;
1247 reply = dbus_pending_call_steal_reply(call);
1249 dbus_error_init(&error);
1251 if (dbus_set_error_from_message(&error, reply)) {
1252 connman_error("ModemManager.GetProperties() %s %s",
1253 error.name, error.message);
1254 dbus_error_free(&error);
1258 if (dbus_message_iter_init(reply, &array) == FALSE)
1261 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1264 dbus_message_iter_recurse(&array, &dict);
1266 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1267 DBusMessageIter entry, value;
1270 dbus_message_iter_recurse(&dict, &entry);
1271 dbus_message_iter_get_basic(&entry, &key);
1273 dbus_message_iter_next(&entry);
1274 dbus_message_iter_recurse(&entry, &value);
1276 if (g_str_equal(key, "Modems") == TRUE) {
1277 update_modems(&value);
1281 dbus_message_iter_next(&dict);
1285 dbus_message_unref(reply);
1287 dbus_pending_call_unref(call);
1290 static void modem_remove_device(struct modem_data *modem)
1292 if (modem->device == NULL)
1295 connman_device_unregister(modem->device);
1296 connman_device_unref(modem->device);
1298 modem->device = NULL;
1301 static void remove_modem(gpointer data)
1303 struct modem_data *modem = data;
1305 g_free(modem->path);
1307 modem_remove_device(modem);
1312 static void ofono_connect(DBusConnection *connection, void *user_data)
1314 DBusMessage *message;
1315 DBusPendingCall *call;
1317 DBG("connection %p", connection);
1319 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1320 g_free, remove_modem);
1322 message = dbus_message_new_method_call(OFONO_SERVICE, "/",
1323 OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
1324 if (message == NULL)
1327 dbus_message_set_auto_start(message, FALSE);
1329 if (dbus_connection_send_with_reply(connection, message,
1330 &call, TIMEOUT) == FALSE) {
1331 connman_error("Failed to get ofono modems");
1336 connman_error("D-Bus connection not available");
1340 dbus_pending_call_set_notify(call, manager_properties_reply,
1344 dbus_message_unref(message);
1348 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1350 DBG("connection %p", connection);
1352 if (modem_hash == NULL)
1355 g_hash_table_destroy(modem_hash);
1360 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1363 const char *path = dbus_message_get_path(message);
1364 struct modem_data *modem;
1365 DBusMessageIter iter, value;
1368 DBG("path %s", path);
1370 modem = g_hash_table_lookup(modem_hash, path);
1374 if (dbus_message_iter_init(message, &iter) == FALSE)
1377 dbus_message_iter_get_basic(&iter, &key);
1379 dbus_message_iter_next(&iter);
1380 dbus_message_iter_recurse(&iter, &value);
1382 if (g_str_equal(key, "Powered") == TRUE) {
1383 dbus_bool_t powered;
1385 dbus_message_iter_get_basic(&value, &powered);
1386 if (powered == TRUE)
1389 modem_remove_device(modem);
1390 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1391 if (modem_has_gprs(&value) == TRUE) {
1392 if (modem->device == NULL)
1393 get_imsi(modem->path);
1394 } else if (modem->device != NULL)
1395 modem_remove_device(modem);
1401 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1404 const char *path = dbus_message_get_path(message);
1405 struct modem_data *modem;
1406 DBusMessageIter iter, value;
1409 DBG("path %s", path);
1411 modem = g_hash_table_lookup(modem_hash, path);
1415 if (dbus_message_iter_init(message, &iter) == FALSE)
1418 dbus_message_iter_get_basic(&iter, &key);
1420 dbus_message_iter_next(&iter);
1421 dbus_message_iter_recurse(&iter, &value);
1423 if (g_str_equal(key, "Attached") == TRUE) {
1424 dbus_bool_t attached;
1426 dbus_message_iter_get_basic(&value, &attached);
1428 DBG("Attached %d", attached);
1430 if (attached == TRUE)
1431 check_networks(modem);
1432 else if (modem->device != NULL)
1433 connman_device_remove_all_networks(modem->device);
1435 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
1436 check_networks(modem);
1437 } else if (g_str_equal(key, "Powered") == TRUE) {
1438 dbus_bool_t powered;
1440 if (modem->device == NULL)
1443 dbus_message_iter_get_basic(&value, &powered);
1444 connman_device_set_powered(modem->device, powered);
1450 static gboolean manager_changed(DBusConnection *connection,
1451 DBusMessage *message, void *user_data)
1453 const char *path = dbus_message_get_path(message);
1454 DBusMessageIter iter, value;
1457 DBG("path %s", path);
1459 if (dbus_message_iter_init(message, &iter) == FALSE)
1462 dbus_message_iter_get_basic(&iter, &key);
1464 dbus_message_iter_next(&iter);
1465 dbus_message_iter_recurse(&iter, &value);
1467 if (g_str_equal(key, "Modems") == TRUE)
1468 update_modems(&value);
1473 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1475 DBusMessageIter entry;
1476 gchar *nameserver = NULL, *nameserver_old = NULL;
1480 dbus_message_iter_recurse(array, &entry);
1482 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1485 dbus_message_iter_get_basic(&entry, &dns);
1489 if (nameserver == NULL) {
1491 nameserver = g_strdup(dns);
1494 nameserver_old = nameserver;
1495 nameserver = g_strdup_printf("%s %s",
1496 nameserver_old, dns);
1497 g_free(nameserver_old);
1500 dbus_message_iter_next(&entry);
1503 parent->ipv4.nameserver = nameserver;
1506 static void update_settings(DBusMessageIter *array,
1507 struct connman_element *parent)
1509 DBusMessageIter dict;
1510 const char *interface = NULL;
1514 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1517 dbus_message_iter_recurse(array, &dict);
1519 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1520 DBusMessageIter entry, value;
1523 dbus_message_iter_recurse(&dict, &entry);
1524 dbus_message_iter_get_basic(&entry, &key);
1526 dbus_message_iter_next(&entry);
1527 dbus_message_iter_recurse(&entry, &value);
1529 if (g_str_equal(key, "Interface") == TRUE) {
1532 dbus_message_iter_get_basic(&value, &interface);
1534 DBG("interface %s", interface);
1536 index = connman_inet_ifindex(interface);
1538 connman_network_set_index(
1539 pending_network, index);
1541 connman_error("Can not find interface %s",
1545 } else if (g_str_equal(key, "Method") == TRUE) {
1548 dbus_message_iter_get_basic(&value, &method);
1549 if (g_strcmp0(method, "static") == 0) {
1551 parent->ipv4.method =
1552 CONNMAN_IPCONFIG_METHOD_FIXED;
1553 } else if (g_strcmp0(method, "dhcp") == 0) {
1555 parent->ipv4.method =
1556 CONNMAN_IPCONFIG_METHOD_DHCP;
1559 } else if (g_str_equal(key, "Address") == TRUE) {
1560 const char *address;
1562 dbus_message_iter_get_basic(&value, &address);
1564 DBG("address %s", address);
1566 parent->ipv4.address = g_strdup(address);
1567 } else if (g_str_equal(key, "Netmask") == TRUE) {
1568 const char *netmask;
1570 dbus_message_iter_get_basic(&value, &netmask);
1572 DBG("netmask %s", netmask);
1574 parent->ipv4.netmask = g_strdup(netmask);
1575 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1577 get_dns(&value, parent);
1578 } else if (g_str_equal(key, "Gateway") == TRUE) {
1579 const char *gateway;
1581 dbus_message_iter_get_basic(&value, &gateway);
1583 DBG("gateway %s", gateway);
1585 parent->ipv4.gateway = g_strdup(gateway);
1588 dbus_message_iter_next(&dict);
1591 /* deactive, oFono send NULL inteface before deactive signal */
1592 if (interface == NULL)
1593 connman_network_set_index(pending_network, -1);
1596 static void cleanup_ipconfig(struct connman_element *parent)
1598 g_free(parent->ipv4.address);
1599 parent->ipv4.address = NULL;
1601 g_free(parent->ipv4.netmask);
1602 parent->ipv4.netmask = NULL;
1604 g_free(parent->ipv4.nameserver);
1605 parent->ipv4.nameserver = NULL;
1607 g_free(parent->ipv4.gateway);
1608 parent->ipv4.gateway = NULL;
1610 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1613 static int static_network_set_connected(
1614 struct connman_network *pending_network,
1615 struct connman_element *parent,
1616 connman_bool_t connected)
1618 if (connected == FALSE)
1619 cleanup_ipconfig(parent);
1621 connman_network_set_connected(pending_network, connected);
1626 static gboolean pri_context_changed(DBusConnection *connection,
1627 DBusMessage *message, void *user_data)
1629 const char *path = dbus_message_get_path(message);
1630 struct connman_element *parent;
1631 const char *pending_path;
1632 DBusMessageIter iter, value;
1635 DBG("pending_network %p, path %s", pending_network, path);
1637 if (pending_network == NULL)
1640 pending_path = connman_network_get_string(pending_network, "Path");
1641 if (g_strcmp0(pending_path, path) != 0)
1644 parent = connman_network_get_element(pending_network);
1646 if (dbus_message_iter_init(message, &iter) == FALSE)
1649 dbus_message_iter_get_basic(&iter, &key);
1651 dbus_message_iter_next(&iter);
1652 dbus_message_iter_recurse(&iter, &value);
1654 if (g_str_equal(key, "Settings") == TRUE) {
1656 update_settings(&value, parent);
1657 } else if (g_str_equal(key, "Active") == TRUE) {
1660 dbus_message_iter_get_basic(&value, &active);
1662 switch (parent->ipv4.method) {
1663 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1664 case CONNMAN_IPCONFIG_METHOD_OFF:
1665 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1667 case CONNMAN_IPCONFIG_METHOD_FIXED:
1668 connman_network_set_method(pending_network,
1669 CONNMAN_IPCONFIG_METHOD_FIXED);
1671 if (static_network_set_connected(
1672 pending_network, parent, active) < 0)
1673 set_network_active(pending_network, FALSE);
1675 case CONNMAN_IPCONFIG_METHOD_DHCP:
1676 connman_network_set_method(pending_network,
1677 CONNMAN_IPCONFIG_METHOD_DHCP);
1678 connman_network_set_connected(pending_network, active);
1682 pending_network = NULL;
1689 static guint gprs_watch;
1690 static guint modem_watch;
1691 static guint manager_watch;
1692 static guint context_watch;
1694 static int ofono_init(void)
1698 connection = connman_dbus_get_connection();
1699 if (connection == NULL)
1702 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1703 ofono_connect, ofono_disconnect, NULL, NULL);
1705 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1706 OFONO_GPRS_INTERFACE,
1711 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1712 OFONO_MODEM_INTERFACE,
1717 manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1718 OFONO_MANAGER_INTERFACE,
1723 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1724 OFONO_PRI_CONTEXT_INTERFACE,
1726 pri_context_changed,
1729 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1730 manager_watch == 0 || context_watch == 0) {
1735 err = connman_network_driver_register(&network_driver);
1739 err = connman_device_driver_register(&modem_driver);
1741 connman_network_driver_unregister(&network_driver);
1748 g_dbus_remove_watch(connection, watch);
1749 g_dbus_remove_watch(connection, gprs_watch);
1750 g_dbus_remove_watch(connection, modem_watch);
1751 g_dbus_remove_watch(connection, manager_watch);
1752 g_dbus_remove_watch(connection, context_watch);
1754 dbus_connection_unref(connection);
1759 static void ofono_exit(void)
1761 g_dbus_remove_watch(connection, watch);
1762 g_dbus_remove_watch(connection, gprs_watch);
1763 g_dbus_remove_watch(connection, modem_watch);
1764 g_dbus_remove_watch(connection, manager_watch);
1765 g_dbus_remove_watch(connection, context_watch);
1767 ofono_disconnect(connection, NULL);
1769 connman_device_driver_unregister(&modem_driver);
1770 connman_network_driver_unregister(&network_driver);
1772 dbus_connection_unref(connection);
1775 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1776 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)