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, "Powered") == TRUE) {
783 dbus_message_iter_get_basic(&value, &powered);
785 connman_device_set_powered(device, powered);
788 dbus_message_iter_next(&dict);
791 if (attached == TRUE)
792 add_networks(device, &contexts);
795 dbus_message_unref(reply);
797 dbus_pending_call_unref(call);
800 static void check_networks(struct modem_data *modem)
802 DBusMessage *message;
803 DBusPendingCall *call;
804 struct connman_device *device;
806 DBG("modem %p", modem);
811 device = modem->device;
815 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
816 OFONO_GPRS_INTERFACE, GET_PROPERTIES);
820 dbus_message_set_auto_start(message, FALSE);
822 if (dbus_connection_send_with_reply(connection, message,
823 &call, TIMEOUT) == FALSE) {
824 connman_error("Failed to get ofono GPRS");
829 connman_error("D-Bus connection not available");
833 dbus_pending_call_set_notify(call, check_networks_reply,
834 (void *)device, NULL);
837 dbus_message_unref(message);
840 static void add_device(const char *path, const char *imsi,
841 unsigned char mnc_length)
843 struct modem_data *modem;
844 struct connman_device *device;
847 DBG("path %s imsi %s mnc_length %d", path, imsi, mnc_length);
855 modem = g_hash_table_lookup(modem_hash, path);
859 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
863 connman_device_set_ident(device, imsi);
865 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
867 connman_device_set_string(device, "Path", path);
869 if (mnc_length == 2 || mnc_length == 3) {
870 mcc_mnc = g_strndup(imsi, mnc_length + 3);
871 connman_device_set_string(device, "MCC_MNC", mcc_mnc);
875 if (connman_device_register(device) < 0) {
876 connman_device_unref(device);
880 modem->device = device;
882 check_networks(modem);
885 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
887 const char *path = user_data;
889 /* If MobileNetworkCodeLength is not provided, mnc_length is 0 */
890 unsigned char mnc_length = 0;
892 DBusMessageIter array, dict;
894 DBG("path %s", path);
896 reply = dbus_pending_call_steal_reply(call);
898 if (dbus_message_iter_init(reply, &array) == FALSE)
901 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
904 dbus_message_iter_recurse(&array, &dict);
906 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
907 DBusMessageIter entry, value;
910 dbus_message_iter_recurse(&dict, &entry);
911 dbus_message_iter_get_basic(&entry, &key);
913 dbus_message_iter_next(&entry);
914 dbus_message_iter_recurse(&entry, &value);
916 if (g_str_equal(key, "SubscriberIdentity") == TRUE)
917 dbus_message_iter_get_basic(&value, &imsi);
918 else if (g_str_equal(key, "MobileNetworkCodeLength") == TRUE)
919 dbus_message_iter_get_basic(&value,
920 (void *) &mnc_length);
922 dbus_message_iter_next(&dict);
925 add_device(path, imsi, mnc_length);
928 dbus_message_unref(reply);
930 dbus_pending_call_unref(call);
933 static void get_imsi(const char *path)
935 DBusMessage *message;
936 DBusPendingCall *call;
938 DBG("path %s", path);
940 message = dbus_message_new_method_call(OFONO_SERVICE, path,
941 OFONO_SIM_INTERFACE, GET_PROPERTIES);
945 dbus_message_set_auto_start(message, FALSE);
947 if (dbus_connection_send_with_reply(connection, message,
948 &call, TIMEOUT) == FALSE) {
949 connman_error("Failed to get ofono modem sim");
954 connman_error("D-Bus connection not available");
958 dbus_pending_call_set_notify(call, sim_properties_reply,
962 dbus_message_unref(message);
965 static int modem_change_powered(const char *path, dbus_bool_t powered)
967 DBusMessage *message;
968 DBusMessageIter iter;
969 DBusPendingCall *call;
971 DBG("path %s powered %d", path, powered);
976 message = dbus_message_new_method_call(OFONO_SERVICE, path,
977 OFONO_MODEM_INTERFACE, SET_PROPERTY);
981 dbus_message_set_auto_start(message, FALSE);
983 dbus_message_iter_init_append(message, &iter);
984 connman_dbus_property_append_basic(&iter, "Powered",
985 DBUS_TYPE_BOOLEAN, &powered);
987 if (dbus_connection_send_with_reply(connection, message,
988 &call, TIMEOUT) == FALSE) {
989 connman_error("Failed to change powered property");
990 dbus_message_unref(message);
995 connman_error("D-Bus connection not available");
996 dbus_message_unref(message);
1000 dbus_pending_call_set_notify(call, powered_reply, NULL, NULL);
1002 dbus_message_unref(message);
1004 return -EINPROGRESS;
1007 static struct modem_data *add_modem(const char *path)
1009 struct modem_data *modem;
1014 modem = g_hash_table_lookup(modem_hash, path);
1015 if (modem != NULL) {
1016 modem->available = TRUE;
1021 modem = g_try_new0(struct modem_data, 1);
1025 modem->path = g_strdup(path);
1026 modem->device = NULL;
1027 modem->available = TRUE;
1029 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1034 static gboolean modem_has_gprs(DBusMessageIter *array)
1036 DBusMessageIter entry;
1038 dbus_message_iter_recurse(array, &entry);
1040 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1041 const char *interface;
1043 dbus_message_iter_get_basic(&entry, &interface);
1045 if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
1048 dbus_message_iter_next(&entry);
1054 static void modem_properties_reply(DBusPendingCall *call, void *user_data)
1057 DBusMessageIter array, dict;
1058 const char *path = user_data;
1060 DBG("path %s", path);
1062 reply = dbus_pending_call_steal_reply(call);
1064 if (dbus_message_iter_init(reply, &array) == FALSE)
1067 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1070 dbus_message_iter_recurse(&array, &dict);
1072 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1073 DBusMessageIter entry, value;
1075 dbus_bool_t powered;
1077 dbus_message_iter_recurse(&dict, &entry);
1078 dbus_message_iter_get_basic(&entry, &key);
1080 dbus_message_iter_next(&entry);
1081 dbus_message_iter_recurse(&entry, &value);
1083 if (g_str_equal(key, "Powered") == TRUE) {
1084 dbus_message_iter_get_basic(&value, &powered);
1086 if (powered == FALSE) {
1087 modem_change_powered(path, TRUE);
1090 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1091 if (modem_has_gprs(&value) == TRUE)
1095 dbus_message_iter_next(&dict);
1099 dbus_message_unref(reply);
1101 dbus_pending_call_unref(call);
1104 static void get_modem_properties(struct modem_data *modem)
1106 DBusMessage *message;
1107 DBusPendingCall *call;
1109 DBG("path %s", modem->path);
1111 if (modem->path == NULL)
1114 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
1115 OFONO_MODEM_INTERFACE, GET_PROPERTIES);
1116 if (message == NULL)
1119 dbus_message_set_auto_start(message, FALSE);
1121 if (dbus_connection_send_with_reply(connection, message,
1122 &call, TIMEOUT) == FALSE) {
1123 connman_error("Failed to get ofono modem");
1128 connman_error("D-Bus connection not available");
1132 dbus_pending_call_set_notify(call, modem_properties_reply,
1133 (void *)modem->path, NULL);
1136 dbus_message_unref(message);
1139 static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
1141 struct modem_data *modem = value;
1143 modem->available = FALSE;
1146 static void modems_set_unavailable()
1148 g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
1151 static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
1153 struct modem_data *modem = value;
1155 if (modem->available == FALSE)
1156 g_hash_table_remove(modem_hash, key);
1159 static void cleanup_modems()
1161 g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
1164 static void update_modems(DBusMessageIter *array)
1166 DBusMessageIter entry;
1168 dbus_message_iter_recurse(array, &entry);
1170 modems_set_unavailable();
1172 while (dbus_message_iter_get_arg_type(&entry) ==
1173 DBUS_TYPE_OBJECT_PATH) {
1175 struct modem_data *modem;
1177 dbus_message_iter_get_basic(&entry, &path);
1179 modem = add_modem(path);
1181 get_modem_properties(modem);
1183 dbus_message_iter_next(&entry);
1189 static void manager_properties_reply(DBusPendingCall *call, void *user_data)
1192 DBusMessageIter array, dict;
1196 reply = dbus_pending_call_steal_reply(call);
1198 if (dbus_message_iter_init(reply, &array) == FALSE)
1201 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1204 dbus_message_iter_recurse(&array, &dict);
1206 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1207 DBusMessageIter entry, value;
1210 dbus_message_iter_recurse(&dict, &entry);
1211 dbus_message_iter_get_basic(&entry, &key);
1213 dbus_message_iter_next(&entry);
1214 dbus_message_iter_recurse(&entry, &value);
1216 if (g_str_equal(key, "Modems") == TRUE) {
1217 update_modems(&value);
1221 dbus_message_iter_next(&dict);
1225 dbus_message_unref(reply);
1227 dbus_pending_call_unref(call);
1230 static void modem_remove_device(struct modem_data *modem)
1232 if (modem->device == NULL)
1235 connman_device_unregister(modem->device);
1236 connman_device_unref(modem->device);
1238 modem->device = NULL;
1241 static void remove_modem(gpointer data)
1243 struct modem_data *modem = data;
1245 g_free(modem->path);
1247 modem_remove_device(modem);
1252 static void ofono_connect(DBusConnection *connection, void *user_data)
1254 DBusMessage *message;
1255 DBusPendingCall *call;
1257 DBG("connection %p", connection);
1259 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1260 g_free, remove_modem);
1262 message = dbus_message_new_method_call(OFONO_SERVICE, "/",
1263 OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
1264 if (message == NULL)
1267 dbus_message_set_auto_start(message, FALSE);
1269 if (dbus_connection_send_with_reply(connection, message,
1270 &call, TIMEOUT) == FALSE) {
1271 connman_error("Failed to get ofono modems");
1276 connman_error("D-Bus connection not available");
1280 dbus_pending_call_set_notify(call, manager_properties_reply,
1284 dbus_message_unref(message);
1288 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1290 DBG("connection %p", connection);
1292 if (modem_hash == NULL)
1295 g_hash_table_destroy(modem_hash);
1300 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1303 const char *path = dbus_message_get_path(message);
1304 struct modem_data *modem;
1305 DBusMessageIter iter, value;
1308 DBG("path %s", path);
1310 modem = g_hash_table_lookup(modem_hash, path);
1314 if (dbus_message_iter_init(message, &iter) == FALSE)
1317 dbus_message_iter_get_basic(&iter, &key);
1319 dbus_message_iter_next(&iter);
1320 dbus_message_iter_recurse(&iter, &value);
1322 if (g_str_equal(key, "Powered") == TRUE) {
1323 dbus_bool_t powered;
1325 dbus_message_iter_get_basic(&value, &powered);
1326 if (powered == TRUE)
1329 modem_remove_device(modem);
1330 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1331 if (modem_has_gprs(&value) == TRUE) {
1332 if (modem->device == NULL)
1333 get_imsi(modem->path);
1334 } else if (modem->device != NULL)
1335 modem_remove_device(modem);
1341 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1344 const char *path = dbus_message_get_path(message);
1345 struct modem_data *modem;
1346 DBusMessageIter iter, value;
1349 DBG("path %s", path);
1351 modem = g_hash_table_lookup(modem_hash, path);
1355 if (dbus_message_iter_init(message, &iter) == FALSE)
1358 dbus_message_iter_get_basic(&iter, &key);
1360 dbus_message_iter_next(&iter);
1361 dbus_message_iter_recurse(&iter, &value);
1363 if (g_str_equal(key, "Attached") == TRUE) {
1364 dbus_bool_t attached;
1366 dbus_message_iter_get_basic(&value, &attached);
1368 DBG("Attached %d", attached);
1370 if (attached == TRUE)
1371 check_networks(modem);
1372 else if (modem->device != NULL)
1373 connman_device_remove_all_networks(modem->device);
1375 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
1376 check_networks(modem);
1377 } else if (g_str_equal(key, "Powered") == TRUE) {
1378 dbus_bool_t powered;
1380 if (modem->device == NULL)
1383 dbus_message_iter_get_basic(&value, &powered);
1384 connman_device_set_powered(modem->device, powered);
1390 static gboolean manager_changed(DBusConnection *connection,
1391 DBusMessage *message, void *user_data)
1393 const char *path = dbus_message_get_path(message);
1394 DBusMessageIter iter, value;
1397 DBG("path %s", path);
1399 if (dbus_message_iter_init(message, &iter) == FALSE)
1402 dbus_message_iter_get_basic(&iter, &key);
1404 dbus_message_iter_next(&iter);
1405 dbus_message_iter_recurse(&iter, &value);
1407 if (g_str_equal(key, "Modems") == TRUE)
1408 update_modems(&value);
1413 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1415 DBusMessageIter entry;
1416 gchar *nameserver = NULL, *nameserver_old = NULL;
1420 dbus_message_iter_recurse(array, &entry);
1422 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1425 dbus_message_iter_get_basic(&entry, &dns);
1429 if (nameserver == NULL) {
1431 nameserver = g_strdup(dns);
1434 nameserver_old = nameserver;
1435 nameserver = g_strdup_printf("%s %s",
1436 nameserver_old, dns);
1437 g_free(nameserver_old);
1440 dbus_message_iter_next(&entry);
1443 parent->ipv4.nameserver = nameserver;
1446 static void update_settings(DBusMessageIter *array,
1447 struct connman_element *parent)
1449 DBusMessageIter dict;
1450 const char *interface = NULL;
1454 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1457 dbus_message_iter_recurse(array, &dict);
1459 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1460 DBusMessageIter entry, value;
1463 dbus_message_iter_recurse(&dict, &entry);
1464 dbus_message_iter_get_basic(&entry, &key);
1466 dbus_message_iter_next(&entry);
1467 dbus_message_iter_recurse(&entry, &value);
1469 if (g_str_equal(key, "Interface") == TRUE) {
1472 dbus_message_iter_get_basic(&value, &interface);
1474 DBG("interface %s", interface);
1476 index = connman_inet_ifindex(interface);
1478 connman_network_set_index(
1479 pending_network, index);
1481 connman_error("Can not find interface %s",
1485 } else if (g_str_equal(key, "Method") == TRUE) {
1488 dbus_message_iter_get_basic(&value, &method);
1489 if (g_strcmp0(method, "static") == 0) {
1491 parent->ipv4.method =
1492 CONNMAN_IPCONFIG_METHOD_FIXED;
1493 } else if (g_strcmp0(method, "dhcp") == 0) {
1495 parent->ipv4.method =
1496 CONNMAN_IPCONFIG_METHOD_DHCP;
1499 } else if (g_str_equal(key, "Address") == TRUE) {
1500 const char *address;
1502 dbus_message_iter_get_basic(&value, &address);
1504 DBG("address %s", address);
1506 parent->ipv4.address = g_strdup(address);
1507 } else if (g_str_equal(key, "Netmask") == TRUE) {
1508 const char *netmask;
1510 dbus_message_iter_get_basic(&value, &netmask);
1512 DBG("netmask %s", netmask);
1514 parent->ipv4.netmask = g_strdup(netmask);
1515 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1517 get_dns(&value, parent);
1518 } else if (g_str_equal(key, "Gateway") == TRUE) {
1519 const char *gateway;
1521 dbus_message_iter_get_basic(&value, &gateway);
1523 DBG("gateway %s", gateway);
1525 parent->ipv4.gateway = g_strdup(gateway);
1528 dbus_message_iter_next(&dict);
1531 /* deactive, oFono send NULL inteface before deactive signal */
1532 if (interface == NULL)
1533 connman_network_set_index(pending_network, -1);
1536 static void cleanup_ipconfig(struct connman_element *parent)
1538 g_free(parent->ipv4.address);
1539 parent->ipv4.address = NULL;
1541 g_free(parent->ipv4.netmask);
1542 parent->ipv4.netmask = NULL;
1544 g_free(parent->ipv4.nameserver);
1545 parent->ipv4.nameserver = NULL;
1547 g_free(parent->ipv4.gateway);
1548 parent->ipv4.gateway = NULL;
1550 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1553 static int static_network_set_connected(
1554 struct connman_network *pending_network,
1555 struct connman_element *parent,
1556 connman_bool_t connected)
1558 if (connected == TRUE) {
1559 struct connman_element *element;
1561 if (parent->ipv4.address == NULL)
1564 if (parent->ipv4.netmask == NULL)
1567 element = connman_element_create(NULL);
1568 if (element == NULL) {
1569 connman_error("Can not create connman_element");
1573 element->type = CONNMAN_ELEMENT_TYPE_IPV4;
1574 element->index = parent->index;
1576 if (connman_element_register(element, parent) < 0) {
1577 connman_element_unref(element);
1581 cleanup_ipconfig(parent);
1583 connman_network_set_connected(pending_network, connected);
1588 connman_network_set_error(pending_network,
1589 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
1591 cleanup_ipconfig(parent);
1596 static gboolean pri_context_changed(DBusConnection *connection,
1597 DBusMessage *message, void *user_data)
1599 const char *path = dbus_message_get_path(message);
1600 struct connman_element *parent;
1601 const char *pending_path;
1602 DBusMessageIter iter, value;
1605 DBG("pending_network %p, path %s", pending_network, path);
1607 if (pending_network == NULL)
1610 pending_path = connman_network_get_string(pending_network, "Path");
1611 if (g_strcmp0(pending_path, path) != 0)
1614 parent = connman_network_get_element(pending_network);
1616 if (dbus_message_iter_init(message, &iter) == FALSE)
1619 dbus_message_iter_get_basic(&iter, &key);
1621 dbus_message_iter_next(&iter);
1622 dbus_message_iter_recurse(&iter, &value);
1624 if (g_str_equal(key, "Settings") == TRUE) {
1626 update_settings(&value, parent);
1627 } else if (g_str_equal(key, "Active") == TRUE) {
1630 dbus_message_iter_get_basic(&value, &active);
1632 switch (parent->ipv4.method) {
1633 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1634 case CONNMAN_IPCONFIG_METHOD_OFF:
1635 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1637 case CONNMAN_IPCONFIG_METHOD_FIXED:
1638 connman_network_set_method(pending_network,
1639 CONNMAN_IPCONFIG_METHOD_FIXED);
1641 if (static_network_set_connected(
1642 pending_network, parent, active) < 0)
1643 set_network_active(pending_network, FALSE);
1645 case CONNMAN_IPCONFIG_METHOD_DHCP:
1646 connman_network_set_method(pending_network,
1647 CONNMAN_IPCONFIG_METHOD_DHCP);
1648 connman_network_set_connected(pending_network, active);
1652 pending_network = NULL;
1659 static guint gprs_watch;
1660 static guint modem_watch;
1661 static guint manager_watch;
1662 static guint context_watch;
1664 static int ofono_init(void)
1668 connection = connman_dbus_get_connection();
1669 if (connection == NULL)
1672 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1673 ofono_connect, ofono_disconnect, NULL, NULL);
1675 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1676 OFONO_GPRS_INTERFACE,
1681 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1682 OFONO_MODEM_INTERFACE,
1687 manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1688 OFONO_MANAGER_INTERFACE,
1693 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1694 OFONO_PRI_CONTEXT_INTERFACE,
1696 pri_context_changed,
1699 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1700 manager_watch == 0 || context_watch == 0) {
1705 err = connman_network_driver_register(&network_driver);
1709 err = connman_device_driver_register(&modem_driver);
1711 connman_network_driver_unregister(&network_driver);
1718 g_dbus_remove_watch(connection, watch);
1719 g_dbus_remove_watch(connection, gprs_watch);
1720 g_dbus_remove_watch(connection, modem_watch);
1721 g_dbus_remove_watch(connection, manager_watch);
1722 g_dbus_remove_watch(connection, context_watch);
1724 dbus_connection_unref(connection);
1729 static void ofono_exit(void)
1731 g_dbus_remove_watch(connection, watch);
1732 g_dbus_remove_watch(connection, gprs_watch);
1733 g_dbus_remove_watch(connection, modem_watch);
1734 g_dbus_remove_watch(connection, manager_watch);
1735 g_dbus_remove_watch(connection, context_watch);
1737 ofono_disconnect(connection, NULL);
1739 connman_device_driver_unregister(&modem_driver);
1740 connman_network_driver_unregister(&network_driver);
1742 dbus_connection_unref(connection);
1745 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1746 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)