5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
31 #define CONNMAN_API_SUBJECT_TO_CHANGE
32 #include <connman/plugin.h>
33 #include <connman/element.h>
34 #include <connman/device.h>
35 #include <connman/network.h>
36 #include <connman/dbus.h>
37 #include <connman/inet.h>
38 #include <connman/log.h>
40 #define OFONO_SERVICE "org.ofono"
42 #define OFONO_MANAGER_INTERFACE OFONO_SERVICE ".Manager"
43 #define OFONO_MODEM_INTERFACE OFONO_SERVICE ".Modem"
44 #define OFONO_GPRS_INTERFACE OFONO_SERVICE ".DataConnectionManager"
45 #define OFONO_SIM_INTERFACE OFONO_SERVICE ".SimManager"
46 #define OFONO_PRI_CONTEXT_INTERFACE OFONO_SERVICE ".PrimaryDataContext"
47 #define OFONO_REGISTRATION_INTERFACE OFONO_SERVICE ".NetworkRegistration"
49 #define PROPERTY_CHANGED "PropertyChanged"
50 #define GET_PROPERTIES "GetProperties"
51 #define SET_PROPERTY "SetProperty"
52 #define CREATE_CONTEXT "CreateContext"
56 #define CONTEXT_NAME "3G Connection"
57 #define CONTEXT_TYPE "internet"
59 static DBusConnection *connection;
61 static GHashTable *modem_hash = NULL;
65 struct connman_device *device;
69 static int modem_probe(struct connman_device *device)
71 DBG("device %p", device);
76 static void modem_remove(struct connman_device *device)
78 DBG("device %p", device);
81 static void powered_reply(DBusPendingCall *call, void *user_data)
88 dbus_error_init(&error);
90 reply = dbus_pending_call_steal_reply(call);
92 if (dbus_set_error_from_message(&error, reply)) {
93 connman_error("%s", error.message);
94 dbus_error_free(&error);
97 dbus_message_unref(reply);
99 dbus_pending_call_unref(call);
102 static int gprs_change_powered(const char *path, dbus_bool_t powered)
104 DBusMessage *message;
105 DBusMessageIter iter;
106 DBusPendingCall *call;
108 DBG("path %s powered %d", path, powered);
113 message = dbus_message_new_method_call(OFONO_SERVICE, path,
114 OFONO_GPRS_INTERFACE, SET_PROPERTY);
118 dbus_message_set_auto_start(message, FALSE);
120 dbus_message_iter_init_append(message, &iter);
121 connman_dbus_property_append_basic(&iter, "Powered",
122 DBUS_TYPE_BOOLEAN, &powered);
124 if (dbus_connection_send_with_reply(connection, message,
125 &call, TIMEOUT) == FALSE) {
126 connman_error("Failed to change powered property");
127 dbus_message_unref(message);
132 connman_error("D-Bus connection not available");
133 dbus_message_unref(message);
137 dbus_pending_call_set_notify(call, powered_reply, (void *)path, NULL);
139 dbus_message_unref(message);
144 static int modem_enable(struct connman_device *device)
146 const char *path = connman_device_get_string(device, "Path");
148 DBG("device %p, path, %s", device, path);
150 return gprs_change_powered(path, TRUE);
153 static int modem_disable(struct connman_device *device)
155 const char *path = connman_device_get_string(device, "Path");
157 DBG("device %p, path %s", device, path);
159 return gprs_change_powered(path, FALSE);
162 static struct connman_device_driver modem_driver = {
164 .type = CONNMAN_DEVICE_TYPE_CELLULAR,
165 .probe = modem_probe,
166 .remove = modem_remove,
167 .enable = modem_enable,
168 .disable = modem_disable,
171 static char *get_ident(const char *path)
178 ident = g_strdup(path + 1);
182 while ((pos = strchr(pos, '/')) != NULL)
188 static void create_service(struct connman_network *network)
195 path = connman_network_get_string(network, "Path");
197 group = get_ident(path);
199 connman_network_set_group(network, group);
204 static void set_network_name_reply(DBusPendingCall *call, void *user_data)
206 struct connman_network *network = user_data;
208 DBusMessageIter array, dict;
210 DBG("network %p", network);
212 reply = dbus_pending_call_steal_reply(call);
214 if (dbus_message_iter_init(reply, &array) == FALSE)
217 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
220 dbus_message_iter_recurse(&array, &dict);
222 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
223 DBusMessageIter entry, value;
226 dbus_message_iter_recurse(&dict, &entry);
227 dbus_message_iter_get_basic(&entry, &key);
229 dbus_message_iter_next(&entry);
230 dbus_message_iter_recurse(&entry, &value);
232 if (g_str_equal(key, "Operator") == TRUE) {
235 dbus_message_iter_get_basic(&value, &name);
236 connman_network_set_name(network, name);
237 create_service(network);
240 dbus_message_iter_next(&dict);
243 dbus_message_unref(reply);
245 dbus_pending_call_unref(call);
248 static void set_network_name(struct connman_network *network)
250 struct connman_device *device;
251 DBusMessage *message;
252 DBusPendingCall *call;
255 device = connman_network_get_device(network);
257 path = connman_device_get_string(device, "Path");
261 DBG("path %s", path);
263 message = dbus_message_new_method_call(OFONO_SERVICE, path,
264 OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES);
268 dbus_message_set_auto_start(message, FALSE);
270 if (dbus_connection_send_with_reply(connection, message,
271 &call, TIMEOUT) == FALSE) {
272 connman_error("Failed to get operator");
277 connman_error("D-Bus connection not available");
281 dbus_pending_call_set_notify(call, set_network_name_reply,
282 (void *)network, NULL);
285 dbus_message_unref(message);
288 static void config_network_reply(DBusPendingCall *call, void *user_data)
290 struct connman_network *network = user_data;
292 DBusMessageIter array, dict;
293 gboolean internet_type = FALSE;
295 DBG("network %p", network);
297 reply = dbus_pending_call_steal_reply(call);
299 if (dbus_message_iter_init(reply, &array) == FALSE)
302 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
305 dbus_message_iter_recurse(&array, &dict);
307 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
308 DBusMessageIter entry, value;
311 dbus_message_iter_recurse(&dict, &entry);
312 dbus_message_iter_get_basic(&entry, &key);
314 dbus_message_iter_next(&entry);
315 dbus_message_iter_recurse(&entry, &value);
317 if (g_str_equal(key, "Type") == TRUE) {
320 dbus_message_iter_get_basic(&value, &type);
321 if (g_strcmp0(type, "internet") == 0) {
322 internet_type = TRUE;
324 connman_network_set_protocol(network,
325 CONNMAN_NETWORK_PROTOCOL_IP);
326 set_network_name(network);
328 internet_type = FALSE;
330 connman_network_set_protocol(network,
331 CONNMAN_NETWORK_PROTOCOL_UNKNOWN);
335 dbus_message_iter_next(&dict);
339 dbus_message_unref(reply);
341 dbus_pending_call_unref(call);
344 static void config_network(struct connman_network *network, const char *path)
346 DBusMessage *message;
347 DBusPendingCall *call;
349 DBG("path %s", path);
351 message = dbus_message_new_method_call(OFONO_SERVICE, path,
352 OFONO_PRI_CONTEXT_INTERFACE, GET_PROPERTIES);
356 dbus_message_set_auto_start(message, FALSE);
358 if (dbus_connection_send_with_reply(connection, message,
359 &call, TIMEOUT) == FALSE) {
360 connman_error("Failed to get Primary Context");
365 connman_error("D-Bus connection not available");
369 dbus_pending_call_set_notify(call, config_network_reply,
370 (void *)network, NULL);
373 dbus_message_unref(message);
376 static int network_probe(struct connman_network *network)
380 path = connman_network_get_string(network, "Path");
382 DBG("network %p path %s", network, path);
384 config_network(network, path);
389 static struct connman_network *pending_network;
391 static gboolean pending_network_is_available(
392 struct connman_network *pending_network)
394 struct connman_device *device;
395 struct connman_network *network;
396 const char *identifier;
399 /* Modem may be removed during waiting for active reply */
400 device = connman_network_get_device(pending_network);
401 if (device == NULL) {
402 DBG("Modem is removed");
406 identifier = connman_network_get_identifier(pending_network);
408 ident = g_strdup(identifier);
410 connman_network_unref(pending_network);
412 /* network may be removed during waiting for active reply */
413 network = connman_device_get_network(device, ident);
423 static void set_active_reply(DBusPendingCall *call, void *user_data)
427 struct connman_network *network = user_data;
429 DBG("network %p", network);
431 reply = dbus_pending_call_steal_reply(call);
433 if (pending_network_is_available(network) == FALSE)
436 dbus_error_init(&error);
437 if (dbus_set_error_from_message(&error, reply)) {
438 if (connman_network_get_index(network) < 0)
439 connman_network_set_error(network,
440 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
442 pending_network = NULL;
444 connman_error("%s", error.message);
446 dbus_error_free(&error);
448 pending_network = network;
451 dbus_message_unref(reply);
453 dbus_pending_call_unref(call);
456 static int set_network_active(struct connman_network *network,
459 DBusMessage *message;
460 DBusPendingCall *call;
461 DBusMessageIter iter;
463 const char *path = connman_network_get_string(network, "Path");
465 DBG("network %p, path %s, active %d", network, path, active);
470 message = dbus_message_new_method_call(OFONO_SERVICE, path,
471 OFONO_PRI_CONTEXT_INTERFACE, SET_PROPERTY);
475 dbus_message_set_auto_start(message, FALSE);
477 dbus_message_iter_init_append(message, &iter);
478 connman_dbus_property_append_basic(&iter, "Active",
479 DBUS_TYPE_BOOLEAN, &active);
481 if (dbus_connection_send_with_reply(connection, message,
482 &call, TIMEOUT * 10) == FALSE) {
483 connman_error("Failed to connect service");
484 dbus_message_unref(message);
489 connman_error("D-Bus connection not available");
490 dbus_message_unref(message);
494 connman_network_ref(network);
496 dbus_pending_call_set_notify(call, set_active_reply, network, NULL);
498 dbus_message_unref(message);
506 static void set_apn_reply(DBusPendingCall *call, void *user_data)
511 reply = dbus_pending_call_steal_reply(call);
513 dbus_error_init(&error);
514 if (dbus_set_error_from_message(&error, reply)) {
515 connman_error("%s", error.message);
517 dbus_error_free(&error);
520 dbus_message_unref(reply);
522 dbus_pending_call_unref(call);
525 static void set_apn(struct connman_network *network)
527 DBusMessage *message;
528 DBusPendingCall *call;
529 DBusMessageIter iter;
530 const char *apn, *path;
532 apn = connman_network_get_string(network, "Cellular.APN");
536 path = connman_network_get_string(network, "Path");
540 DBG("path %s, apn %s", path, apn);
542 message = dbus_message_new_method_call(OFONO_SERVICE, path,
543 OFONO_PRI_CONTEXT_INTERFACE, SET_PROPERTY);
547 dbus_message_set_auto_start(message, FALSE);
549 dbus_message_iter_init_append(message, &iter);
550 connman_dbus_property_append_basic(&iter, "AccessPointName",
551 DBUS_TYPE_STRING, &apn);
553 if (dbus_connection_send_with_reply(connection, message,
554 &call, TIMEOUT) == FALSE) {
555 dbus_message_unref(message);
560 connman_error("D-Bus connection not available");
561 dbus_message_unref(message);
565 dbus_pending_call_set_notify(call, set_apn_reply, NULL, NULL);
567 dbus_message_unref(message);
570 static int network_connect(struct connman_network *network)
572 if (connman_network_get_index(network) >= 0)
575 return set_network_active(network, TRUE);
578 static int network_disconnect(struct connman_network *network)
580 if (connman_network_get_index(network) < 0)
583 return set_network_active(network, FALSE);
586 static void network_remove(struct connman_network *network)
588 DBG("network %p", network);
591 static int network_setup(struct connman_network *network, const char *key)
595 if (g_strcmp0(key, "Cellular.APN") == 0)
601 static struct connman_network_driver network_driver = {
603 .type = CONNMAN_NETWORK_TYPE_CELLULAR,
604 .probe = network_probe,
605 .remove = network_remove,
606 .connect = network_connect,
607 .disconnect = network_disconnect,
608 .setup = network_setup,
611 static void add_network(struct connman_device *device, const char *path)
613 struct connman_network *network;
614 char *ident, *mcc, *mnc;
617 DBG("device %p path %s", device, path);
619 network = connman_device_get_network(device, path);
623 ident = get_ident(path);
625 network = connman_network_create(ident,
626 CONNMAN_NETWORK_TYPE_CELLULAR);
632 connman_network_set_string(network, "Path", path);
633 connman_network_set_available(network, TRUE);
634 connman_network_set_index(network, -1);
636 mcc_mnc = connman_device_get_string(device, "MCC_MNC");
637 if (mcc_mnc != NULL) {
638 mcc = g_strndup(mcc_mnc, 3);
639 connman_network_set_string(network, "Cellular.MCC", mcc);
642 mnc = g_strdup(mcc_mnc + 3);
643 connman_network_set_string(network, "Cellular.MNC", mnc);
647 connman_device_add_network(device, network);
650 static void add_networks(struct connman_device *device, DBusMessageIter *array)
652 DBusMessageIter entry;
656 dbus_message_iter_recurse(array, &entry);
658 while (dbus_message_iter_get_arg_type(&entry) ==
659 DBUS_TYPE_OBJECT_PATH) {
662 dbus_message_iter_get_basic(&entry, &path);
664 add_network(device, path);
666 dbus_message_iter_next(&entry);
670 static void create_context_reply(DBusPendingCall *call, void *user_data)
677 dbus_error_init(&error);
679 reply = dbus_pending_call_steal_reply(call);
681 if (dbus_set_error_from_message(&error, reply)) {
682 connman_error("%s", error.message);
683 dbus_error_free(&error);
686 dbus_message_unref(reply);
688 dbus_pending_call_unref(call);
691 static void add_default_context(DBusMessageIter *array,
692 const char *path, const char *name, const char *type)
694 DBusMessageIter entry;
695 DBusMessage *message;
696 DBusPendingCall *call;
703 dbus_message_iter_recurse(array, &entry);
705 if (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_OBJECT_PATH)
708 DBG("path %s, name %s, type %s", path, name, type);
710 message = dbus_message_new_method_call(OFONO_SERVICE, path,
711 OFONO_GPRS_INTERFACE, CREATE_CONTEXT);
715 dbus_message_set_auto_start(message, FALSE);
717 dbus_message_append_args(message, DBUS_TYPE_STRING,
718 &name, DBUS_TYPE_STRING,
719 &type, DBUS_TYPE_INVALID);
721 if (dbus_connection_send_with_reply(connection, message,
722 &call, TIMEOUT) == FALSE) {
723 connman_error("Failed to create default context");
724 dbus_message_unref(message);
729 connman_error("D-Bus connection not available");
730 dbus_message_unref(message);
734 dbus_pending_call_set_notify(call, create_context_reply, NULL, NULL);
736 dbus_message_unref(message);
739 static void check_networks_reply(DBusPendingCall *call, void *user_data)
741 struct connman_device *device = user_data;
743 DBusMessageIter array, dict, contexts;
744 dbus_bool_t attached;
746 DBG("device %p", device);
748 reply = dbus_pending_call_steal_reply(call);
750 if (dbus_message_iter_init(reply, &array) == FALSE)
753 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
756 dbus_message_iter_recurse(&array, &dict);
758 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
759 DBusMessageIter entry, value;
762 dbus_message_iter_recurse(&dict, &entry);
763 dbus_message_iter_get_basic(&entry, &key);
765 dbus_message_iter_next(&entry);
766 dbus_message_iter_recurse(&entry, &value);
770 if (g_str_equal(key, "Attached") == TRUE) {
771 dbus_message_iter_get_basic(&value, &attached);
772 DBG("Attached %d", attached);
773 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
776 path = connman_device_get_string(device, "Path");
778 add_default_context(&contexts, path,
779 CONTEXT_NAME, CONTEXT_TYPE);
780 } else if (g_str_equal(key, "Status") == TRUE) {
783 dbus_message_iter_get_basic(&value, &status);
784 /* FIXME: add roaming support */
785 } else if (g_str_equal(key, "Powered") == TRUE) {
788 dbus_message_iter_get_basic(&value, &powered);
790 connman_device_set_powered(device, powered);
793 dbus_message_iter_next(&dict);
796 if (attached == TRUE)
797 add_networks(device, &contexts);
800 dbus_message_unref(reply);
802 dbus_pending_call_unref(call);
805 static void check_networks(struct modem_data *modem)
807 DBusMessage *message;
808 DBusPendingCall *call;
809 struct connman_device *device;
811 DBG("modem %p", modem);
816 device = modem->device;
820 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
821 OFONO_GPRS_INTERFACE, GET_PROPERTIES);
825 dbus_message_set_auto_start(message, FALSE);
827 if (dbus_connection_send_with_reply(connection, message,
828 &call, TIMEOUT) == FALSE) {
829 connman_error("Failed to get ofono GPRS");
834 connman_error("D-Bus connection not available");
838 dbus_pending_call_set_notify(call, check_networks_reply,
839 (void *)device, NULL);
842 dbus_message_unref(message);
845 static void add_device(const char *path, const char *imsi,
846 unsigned char mnc_length)
848 struct modem_data *modem;
849 struct connman_device *device;
852 DBG("path %s imsi %s mnc_length %d", path, imsi, mnc_length);
860 modem = g_hash_table_lookup(modem_hash, path);
864 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
868 connman_device_set_ident(device, imsi);
870 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
872 connman_device_set_string(device, "Path", path);
874 if (mnc_length == 2 || mnc_length == 3) {
875 mcc_mnc = g_strndup(imsi, mnc_length + 3);
876 connman_device_set_string(device, "MCC_MNC", mcc_mnc);
880 if (connman_device_register(device) < 0) {
881 connman_device_unref(device);
885 modem->device = device;
887 check_networks(modem);
890 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
892 const char *path = user_data;
894 /* If MobileNetworkCodeLength is not provided, mnc_length is 0 */
895 unsigned char mnc_length = 0;
897 DBusMessageIter array, dict;
899 DBG("path %s", path);
901 reply = dbus_pending_call_steal_reply(call);
903 if (dbus_message_iter_init(reply, &array) == FALSE)
906 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
909 dbus_message_iter_recurse(&array, &dict);
911 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
912 DBusMessageIter entry, value;
915 dbus_message_iter_recurse(&dict, &entry);
916 dbus_message_iter_get_basic(&entry, &key);
918 dbus_message_iter_next(&entry);
919 dbus_message_iter_recurse(&entry, &value);
921 if (g_str_equal(key, "SubscriberIdentity") == TRUE)
922 dbus_message_iter_get_basic(&value, &imsi);
923 else if (g_str_equal(key, "MobileNetworkCodeLength") == TRUE)
924 dbus_message_iter_get_basic(&value,
925 (void *) &mnc_length);
927 dbus_message_iter_next(&dict);
930 add_device(path, imsi, mnc_length);
933 dbus_message_unref(reply);
935 dbus_pending_call_unref(call);
938 static void get_imsi(const char *path)
940 DBusMessage *message;
941 DBusPendingCall *call;
943 DBG("path %s", path);
945 message = dbus_message_new_method_call(OFONO_SERVICE, path,
946 OFONO_SIM_INTERFACE, GET_PROPERTIES);
950 dbus_message_set_auto_start(message, FALSE);
952 if (dbus_connection_send_with_reply(connection, message,
953 &call, TIMEOUT) == FALSE) {
954 connman_error("Failed to get ofono modem sim");
959 connman_error("D-Bus connection not available");
963 dbus_pending_call_set_notify(call, sim_properties_reply,
967 dbus_message_unref(message);
970 static int modem_change_powered(const char *path, dbus_bool_t powered)
972 DBusMessage *message;
973 DBusMessageIter iter;
974 DBusPendingCall *call;
976 DBG("path %s powered %d", path, powered);
981 message = dbus_message_new_method_call(OFONO_SERVICE, path,
982 OFONO_MODEM_INTERFACE, SET_PROPERTY);
986 dbus_message_set_auto_start(message, FALSE);
988 dbus_message_iter_init_append(message, &iter);
989 connman_dbus_property_append_basic(&iter, "Powered",
990 DBUS_TYPE_BOOLEAN, &powered);
992 if (dbus_connection_send_with_reply(connection, message,
993 &call, TIMEOUT) == FALSE) {
994 connman_error("Failed to change powered property");
995 dbus_message_unref(message);
1000 connman_error("D-Bus connection not available");
1001 dbus_message_unref(message);
1005 dbus_pending_call_set_notify(call, powered_reply, NULL, NULL);
1007 dbus_message_unref(message);
1009 return -EINPROGRESS;
1012 static struct modem_data *add_modem(const char *path)
1014 struct modem_data *modem;
1019 modem = g_hash_table_lookup(modem_hash, path);
1020 if (modem != NULL) {
1021 modem->available = TRUE;
1026 modem = g_try_new0(struct modem_data, 1);
1030 modem->path = g_strdup(path);
1031 modem->device = NULL;
1032 modem->available = TRUE;
1034 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1039 static gboolean modem_has_gprs(DBusMessageIter *array)
1041 DBusMessageIter entry;
1043 dbus_message_iter_recurse(array, &entry);
1045 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1046 const char *interface;
1048 dbus_message_iter_get_basic(&entry, &interface);
1050 if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
1053 dbus_message_iter_next(&entry);
1059 static void modem_properties_reply(DBusPendingCall *call, void *user_data)
1062 DBusMessageIter array, dict;
1063 const char *path = user_data;
1065 DBG("path %s", path);
1067 reply = dbus_pending_call_steal_reply(call);
1069 if (dbus_message_iter_init(reply, &array) == FALSE)
1072 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1075 dbus_message_iter_recurse(&array, &dict);
1077 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1078 DBusMessageIter entry, value;
1080 dbus_bool_t powered;
1082 dbus_message_iter_recurse(&dict, &entry);
1083 dbus_message_iter_get_basic(&entry, &key);
1085 dbus_message_iter_next(&entry);
1086 dbus_message_iter_recurse(&entry, &value);
1088 if (g_str_equal(key, "Powered") == TRUE) {
1089 dbus_message_iter_get_basic(&value, &powered);
1091 if (powered == FALSE) {
1092 modem_change_powered(path, TRUE);
1095 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1096 if (modem_has_gprs(&value) == TRUE)
1100 dbus_message_iter_next(&dict);
1104 dbus_message_unref(reply);
1106 dbus_pending_call_unref(call);
1109 static void get_modem_properties(struct modem_data *modem)
1111 DBusMessage *message;
1112 DBusPendingCall *call;
1114 DBG("path %s", modem->path);
1116 if (modem->path == NULL)
1119 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
1120 OFONO_MODEM_INTERFACE, GET_PROPERTIES);
1121 if (message == NULL)
1124 dbus_message_set_auto_start(message, FALSE);
1126 if (dbus_connection_send_with_reply(connection, message,
1127 &call, TIMEOUT) == FALSE) {
1128 connman_error("Failed to get ofono modem");
1133 connman_error("D-Bus connection not available");
1137 dbus_pending_call_set_notify(call, modem_properties_reply,
1138 (void *)modem->path, NULL);
1141 dbus_message_unref(message);
1144 static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
1146 struct modem_data *modem = value;
1148 modem->available = FALSE;
1151 static void modems_set_unavailable()
1153 g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
1156 static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
1158 struct modem_data *modem = value;
1160 if (modem->available == FALSE)
1161 g_hash_table_remove(modem_hash, key);
1164 static void cleanup_modems()
1166 g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
1169 static void update_modems(DBusMessageIter *array)
1171 DBusMessageIter entry;
1173 dbus_message_iter_recurse(array, &entry);
1175 modems_set_unavailable();
1177 while (dbus_message_iter_get_arg_type(&entry) ==
1178 DBUS_TYPE_OBJECT_PATH) {
1180 struct modem_data *modem;
1182 dbus_message_iter_get_basic(&entry, &path);
1184 modem = add_modem(path);
1186 get_modem_properties(modem);
1188 dbus_message_iter_next(&entry);
1194 static void manager_properties_reply(DBusPendingCall *call, void *user_data)
1197 DBusMessageIter array, dict;
1201 reply = dbus_pending_call_steal_reply(call);
1203 if (dbus_message_iter_init(reply, &array) == FALSE)
1206 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1209 dbus_message_iter_recurse(&array, &dict);
1211 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1212 DBusMessageIter entry, value;
1215 dbus_message_iter_recurse(&dict, &entry);
1216 dbus_message_iter_get_basic(&entry, &key);
1218 dbus_message_iter_next(&entry);
1219 dbus_message_iter_recurse(&entry, &value);
1221 if (g_str_equal(key, "Modems") == TRUE) {
1222 update_modems(&value);
1226 dbus_message_iter_next(&dict);
1230 dbus_message_unref(reply);
1232 dbus_pending_call_unref(call);
1235 static void modem_remove_device(struct modem_data *modem)
1237 if (modem->device == NULL)
1240 connman_device_unregister(modem->device);
1241 connman_device_unref(modem->device);
1243 modem->device = NULL;
1246 static void remove_modem(gpointer data)
1248 struct modem_data *modem = data;
1250 g_free(modem->path);
1252 modem_remove_device(modem);
1257 static void ofono_connect(DBusConnection *connection, void *user_data)
1259 DBusMessage *message;
1260 DBusPendingCall *call;
1262 DBG("connection %p", connection);
1264 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1265 g_free, remove_modem);
1267 message = dbus_message_new_method_call(OFONO_SERVICE, "/",
1268 OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
1269 if (message == NULL)
1272 dbus_message_set_auto_start(message, FALSE);
1274 if (dbus_connection_send_with_reply(connection, message,
1275 &call, TIMEOUT) == FALSE) {
1276 connman_error("Failed to get ofono modems");
1281 connman_error("D-Bus connection not available");
1285 dbus_pending_call_set_notify(call, manager_properties_reply,
1289 dbus_message_unref(message);
1293 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1295 DBG("connection %p", connection);
1297 if (modem_hash == NULL)
1300 g_hash_table_destroy(modem_hash);
1305 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1308 const char *path = dbus_message_get_path(message);
1309 struct modem_data *modem;
1310 DBusMessageIter iter, value;
1313 DBG("path %s", path);
1315 modem = g_hash_table_lookup(modem_hash, path);
1319 if (dbus_message_iter_init(message, &iter) == FALSE)
1322 dbus_message_iter_get_basic(&iter, &key);
1324 dbus_message_iter_next(&iter);
1325 dbus_message_iter_recurse(&iter, &value);
1327 if (g_str_equal(key, "Powered") == TRUE) {
1328 dbus_bool_t powered;
1330 dbus_message_iter_get_basic(&value, &powered);
1331 if (powered == TRUE)
1334 modem_remove_device(modem);
1335 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1336 if (modem_has_gprs(&value) == TRUE) {
1337 if (modem->device == NULL)
1338 get_imsi(modem->path);
1339 } else if (modem->device != NULL)
1340 modem_remove_device(modem);
1346 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1349 const char *path = dbus_message_get_path(message);
1350 struct modem_data *modem;
1351 DBusMessageIter iter, value;
1354 DBG("path %s", path);
1356 modem = g_hash_table_lookup(modem_hash, path);
1360 if (dbus_message_iter_init(message, &iter) == FALSE)
1363 dbus_message_iter_get_basic(&iter, &key);
1365 dbus_message_iter_next(&iter);
1366 dbus_message_iter_recurse(&iter, &value);
1368 if (g_str_equal(key, "Attached") == TRUE) {
1369 dbus_bool_t attached;
1371 dbus_message_iter_get_basic(&value, &attached);
1373 DBG("Attached %d", attached);
1375 if (attached == TRUE)
1376 check_networks(modem);
1377 else if (modem->device != NULL)
1378 connman_device_remove_all_networks(modem->device);
1380 } else if (g_str_equal(key, "Status") == TRUE) {
1382 dbus_message_iter_get_basic(&value, &status);
1384 DBG("status %s", status);
1386 /* FIXME: add roaming support */
1387 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
1388 check_networks(modem);
1389 } else if (g_str_equal(key, "Powered") == TRUE) {
1390 dbus_bool_t powered;
1392 if (modem->device == NULL)
1395 dbus_message_iter_get_basic(&value, &powered);
1396 connman_device_set_powered(modem->device, powered);
1402 static gboolean manager_changed(DBusConnection *connection,
1403 DBusMessage *message, void *user_data)
1405 const char *path = dbus_message_get_path(message);
1406 DBusMessageIter iter, value;
1409 DBG("path %s", path);
1411 if (dbus_message_iter_init(message, &iter) == FALSE)
1414 dbus_message_iter_get_basic(&iter, &key);
1416 dbus_message_iter_next(&iter);
1417 dbus_message_iter_recurse(&iter, &value);
1419 if (g_str_equal(key, "Modems") == TRUE)
1420 update_modems(&value);
1425 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1427 DBusMessageIter entry;
1428 gchar *nameserver = NULL, *nameserver_old = NULL;
1432 dbus_message_iter_recurse(array, &entry);
1434 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1437 dbus_message_iter_get_basic(&entry, &dns);
1441 if (nameserver == NULL) {
1443 nameserver = g_strdup(dns);
1446 nameserver_old = nameserver;
1447 nameserver = g_strdup_printf("%s %s",
1448 nameserver_old, dns);
1449 g_free(nameserver_old);
1452 dbus_message_iter_next(&entry);
1455 parent->ipv4.nameserver = nameserver;
1458 static void update_settings(DBusMessageIter *array,
1459 struct connman_element *parent)
1461 DBusMessageIter dict;
1462 const char *interface = NULL;
1466 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1469 dbus_message_iter_recurse(array, &dict);
1471 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1472 DBusMessageIter entry, value;
1475 dbus_message_iter_recurse(&dict, &entry);
1476 dbus_message_iter_get_basic(&entry, &key);
1478 dbus_message_iter_next(&entry);
1479 dbus_message_iter_recurse(&entry, &value);
1481 if (g_str_equal(key, "Interface") == TRUE) {
1484 dbus_message_iter_get_basic(&value, &interface);
1486 DBG("interface %s", interface);
1488 index = connman_inet_ifindex(interface);
1490 connman_network_set_index(
1491 pending_network, index);
1493 connman_error("Can not find interface %s",
1497 } else if (g_str_equal(key, "Method") == TRUE) {
1500 dbus_message_iter_get_basic(&value, &method);
1501 if (g_strcmp0(method, "static") == 0) {
1503 parent->ipv4.method =
1504 CONNMAN_IPCONFIG_METHOD_FIXED;
1505 } else if (g_strcmp0(method, "dhcp") == 0) {
1507 parent->ipv4.method =
1508 CONNMAN_IPCONFIG_METHOD_DHCP;
1511 } else if (g_str_equal(key, "Address") == TRUE) {
1512 const char *address;
1514 dbus_message_iter_get_basic(&value, &address);
1516 DBG("address %s", address);
1518 parent->ipv4.address = g_strdup(address);
1519 } else if (g_str_equal(key, "Netmask") == TRUE) {
1520 const char *netmask;
1522 dbus_message_iter_get_basic(&value, &netmask);
1524 DBG("netmask %s", netmask);
1526 parent->ipv4.netmask = g_strdup(netmask);
1527 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1529 get_dns(&value, parent);
1530 } else if (g_str_equal(key, "Gateway") == TRUE) {
1531 const char *gateway;
1533 dbus_message_iter_get_basic(&value, &gateway);
1535 DBG("gateway %s", gateway);
1537 parent->ipv4.gateway = g_strdup(gateway);
1540 dbus_message_iter_next(&dict);
1543 /* deactive, oFono send NULL inteface before deactive signal */
1544 if (interface == NULL)
1545 connman_network_set_index(pending_network, -1);
1548 static void cleanup_ipconfig(struct connman_element *parent)
1550 g_free(parent->ipv4.address);
1551 parent->ipv4.address = NULL;
1553 g_free(parent->ipv4.netmask);
1554 parent->ipv4.netmask = NULL;
1556 g_free(parent->ipv4.nameserver);
1557 parent->ipv4.nameserver = NULL;
1559 g_free(parent->ipv4.gateway);
1560 parent->ipv4.gateway = NULL;
1562 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1565 static int static_network_set_connected(
1566 struct connman_network *pending_network,
1567 struct connman_element *parent,
1568 connman_bool_t connected)
1570 if (connected == TRUE) {
1571 struct connman_element *element;
1573 if (parent->ipv4.address == NULL)
1576 if (parent->ipv4.netmask == NULL)
1579 element = connman_element_create(NULL);
1580 if (element == NULL) {
1581 connman_error("Can not create connman_element");
1585 element->type = CONNMAN_ELEMENT_TYPE_IPV4;
1586 element->index = parent->index;
1588 if (connman_element_register(element, parent) < 0) {
1589 connman_element_unref(element);
1593 cleanup_ipconfig(parent);
1595 connman_network_set_connected(pending_network, connected);
1600 connman_network_set_error(pending_network,
1601 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
1603 cleanup_ipconfig(parent);
1608 static gboolean pri_context_changed(DBusConnection *connection,
1609 DBusMessage *message, void *user_data)
1611 const char *path = dbus_message_get_path(message);
1612 struct connman_element *parent;
1613 const char *pending_path;
1614 DBusMessageIter iter, value;
1617 DBG("pending_network %p, path %s", pending_network, path);
1619 if (pending_network == NULL)
1622 pending_path = connman_network_get_string(pending_network, "Path");
1623 if (g_strcmp0(pending_path, path) != 0)
1626 parent = connman_network_get_element(pending_network);
1628 if (dbus_message_iter_init(message, &iter) == FALSE)
1631 dbus_message_iter_get_basic(&iter, &key);
1633 dbus_message_iter_next(&iter);
1634 dbus_message_iter_recurse(&iter, &value);
1636 if (g_str_equal(key, "Settings") == TRUE) {
1638 update_settings(&value, parent);
1639 } else if (g_str_equal(key, "Active") == TRUE) {
1642 dbus_message_iter_get_basic(&value, &active);
1644 switch (parent->ipv4.method) {
1645 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1646 case CONNMAN_IPCONFIG_METHOD_OFF:
1647 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1649 case CONNMAN_IPCONFIG_METHOD_FIXED:
1650 connman_network_set_method(pending_network,
1651 CONNMAN_IPCONFIG_METHOD_FIXED);
1653 if (static_network_set_connected(
1654 pending_network, parent, active) < 0)
1655 set_network_active(pending_network, FALSE);
1657 case CONNMAN_IPCONFIG_METHOD_DHCP:
1658 connman_network_set_method(pending_network,
1659 CONNMAN_IPCONFIG_METHOD_DHCP);
1660 connman_network_set_connected(pending_network, active);
1664 pending_network = NULL;
1671 static guint gprs_watch;
1672 static guint modem_watch;
1673 static guint manager_watch;
1674 static guint context_watch;
1676 static int ofono_init(void)
1680 connection = connman_dbus_get_connection();
1681 if (connection == NULL)
1684 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1685 ofono_connect, ofono_disconnect, NULL, NULL);
1687 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1688 OFONO_GPRS_INTERFACE,
1693 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1694 OFONO_MODEM_INTERFACE,
1699 manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1700 OFONO_MANAGER_INTERFACE,
1705 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1706 OFONO_PRI_CONTEXT_INTERFACE,
1708 pri_context_changed,
1711 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1712 manager_watch == 0 || context_watch == 0) {
1717 err = connman_network_driver_register(&network_driver);
1721 err = connman_device_driver_register(&modem_driver);
1723 connman_network_driver_unregister(&network_driver);
1730 g_dbus_remove_watch(connection, watch);
1731 g_dbus_remove_watch(connection, gprs_watch);
1732 g_dbus_remove_watch(connection, modem_watch);
1733 g_dbus_remove_watch(connection, manager_watch);
1734 g_dbus_remove_watch(connection, context_watch);
1736 dbus_connection_unref(connection);
1741 static void ofono_exit(void)
1743 g_dbus_remove_watch(connection, watch);
1744 g_dbus_remove_watch(connection, gprs_watch);
1745 g_dbus_remove_watch(connection, modem_watch);
1746 g_dbus_remove_watch(connection, manager_watch);
1747 g_dbus_remove_watch(connection, context_watch);
1749 ofono_disconnect(connection, NULL);
1751 connman_device_driver_unregister(&modem_driver);
1752 connman_network_driver_unregister(&network_driver);
1754 dbus_connection_unref(connection);
1757 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1758 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)