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 pos = strrchr(path, '/');
182 return g_strdup(pos + 1);
185 static void create_service(struct connman_network *network)
192 path = connman_network_get_string(network, "Path");
194 group = get_ident(path);
196 connman_network_set_group(network, group);
201 static void set_network_name_reply(DBusPendingCall *call, void *user_data)
203 struct connman_network *network = user_data;
205 DBusMessageIter array, dict;
207 DBG("network %p", network);
209 reply = dbus_pending_call_steal_reply(call);
211 if (dbus_message_iter_init(reply, &array) == FALSE)
214 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
217 dbus_message_iter_recurse(&array, &dict);
219 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
220 DBusMessageIter entry, value;
223 dbus_message_iter_recurse(&dict, &entry);
224 dbus_message_iter_get_basic(&entry, &key);
226 dbus_message_iter_next(&entry);
227 dbus_message_iter_recurse(&entry, &value);
230 * 'Operator' is deprecated since version 0.20, but
231 * keep it here for backward compatibility reasons.
233 if (g_str_equal(key, "Operator") == TRUE ||
234 g_str_equal(key, "Name") == TRUE) {
237 dbus_message_iter_get_basic(&value, &name);
238 connman_network_set_name(network, name);
239 create_service(network);
240 } else if (g_strcmp0(key, "Status") == 0) {
242 connman_bool_t roaming;
244 dbus_message_iter_get_basic(&value, &status);
245 if (g_strcmp0(status, "roaming") == 0)
247 else if (g_strcmp0(status, "registered") == 0)
250 dbus_message_iter_next(&dict);
254 connman_network_set_roaming(network, roaming);
255 connman_network_update(network);
258 dbus_message_iter_next(&dict);
261 dbus_message_unref(reply);
263 dbus_pending_call_unref(call);
266 static void set_network_name(struct connman_network *network)
268 struct connman_device *device;
269 DBusMessage *message;
270 DBusPendingCall *call;
273 device = connman_network_get_device(network);
275 path = connman_device_get_string(device, "Path");
279 DBG("path %s", path);
281 message = dbus_message_new_method_call(OFONO_SERVICE, path,
282 OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES);
286 dbus_message_set_auto_start(message, FALSE);
288 if (dbus_connection_send_with_reply(connection, message,
289 &call, TIMEOUT) == FALSE) {
290 connman_error("Failed to get operator");
295 connman_error("D-Bus connection not available");
299 dbus_pending_call_set_notify(call, set_network_name_reply,
300 (void *)network, NULL);
303 dbus_message_unref(message);
306 static void config_network_reply(DBusPendingCall *call, void *user_data)
308 struct connman_network *network = user_data;
310 DBusMessageIter array, dict;
311 gboolean internet_type = FALSE;
313 DBG("network %p", network);
315 reply = dbus_pending_call_steal_reply(call);
317 if (dbus_message_iter_init(reply, &array) == FALSE)
320 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
323 dbus_message_iter_recurse(&array, &dict);
325 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
326 DBusMessageIter entry, value;
329 dbus_message_iter_recurse(&dict, &entry);
330 dbus_message_iter_get_basic(&entry, &key);
332 dbus_message_iter_next(&entry);
333 dbus_message_iter_recurse(&entry, &value);
335 if (g_str_equal(key, "Type") == TRUE) {
338 dbus_message_iter_get_basic(&value, &type);
339 if (g_strcmp0(type, "internet") == 0) {
340 internet_type = TRUE;
342 connman_network_set_protocol(network,
343 CONNMAN_NETWORK_PROTOCOL_IP);
344 set_network_name(network);
346 internet_type = FALSE;
348 connman_network_set_protocol(network,
349 CONNMAN_NETWORK_PROTOCOL_UNKNOWN);
353 dbus_message_iter_next(&dict);
357 dbus_message_unref(reply);
359 dbus_pending_call_unref(call);
362 static void config_network(struct connman_network *network, const char *path)
364 DBusMessage *message;
365 DBusPendingCall *call;
367 DBG("path %s", path);
369 message = dbus_message_new_method_call(OFONO_SERVICE, path,
370 OFONO_PRI_CONTEXT_INTERFACE, GET_PROPERTIES);
374 dbus_message_set_auto_start(message, FALSE);
376 if (dbus_connection_send_with_reply(connection, message,
377 &call, TIMEOUT) == FALSE) {
378 connman_error("Failed to get Primary Context");
383 connman_error("D-Bus connection not available");
387 dbus_pending_call_set_notify(call, config_network_reply,
388 (void *)network, NULL);
391 dbus_message_unref(message);
394 static gboolean registration_changed(DBusConnection *connection,
395 DBusMessage *message, void *user_data)
397 const char *path = dbus_message_get_path(message);
398 struct connman_network *network = user_data;
399 DBusMessageIter iter, value;
402 DBG("path %s", path);
404 if (dbus_message_iter_init(message, &iter) == FALSE)
407 dbus_message_iter_get_basic(&iter, &key);
411 dbus_message_iter_next(&iter);
412 dbus_message_iter_recurse(&iter, &value);
414 if (g_strcmp0(key, "Name") == 0 ||
415 g_strcmp0(key, "Operator") == 0) {
418 dbus_message_iter_get_basic(&value, &name);
419 DBG("name %s", name);
420 connman_network_set_name(network, name);
421 create_service(network);
422 } else if (g_strcmp0(key, "Strength") == 0) {
423 connman_uint8_t strength;
425 dbus_message_iter_get_basic(&value, &strength);
426 connman_network_set_strength(network, strength);
427 connman_network_update(network);
428 } else if (g_strcmp0(key, "Status") == 0) {
430 connman_bool_t roaming;
432 dbus_message_iter_get_basic(&value, &status);
433 if (g_strcmp0(status, "roaming") == 0)
435 else if (g_strcmp0(status, "registered") == 0)
440 connman_network_set_roaming(network, roaming);
441 connman_network_update(network);
447 static int network_probe(struct connman_network *network)
452 reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
453 OFONO_REGISTRATION_INTERFACE,
455 registration_changed,
460 connman_network_set_data(network, GUINT_TO_POINTER(reg_watch));
462 path = connman_network_get_string(network, "Path");
464 DBG("network %p path %s", network, path);
466 config_network(network, path);
471 static struct connman_network *pending_network;
473 static gboolean pending_network_is_available(
474 struct connman_network *pending_network)
476 struct connman_device *device;
477 struct connman_network *network;
478 const char *identifier;
481 /* Modem may be removed during waiting for active reply */
482 device = connman_network_get_device(pending_network);
483 if (device == NULL) {
484 DBG("Modem is removed");
488 identifier = connman_network_get_identifier(pending_network);
490 ident = g_strdup(identifier);
492 connman_network_unref(pending_network);
494 /* network may be removed during waiting for active reply */
495 network = connman_device_get_network(device, ident);
505 static void set_active_reply(DBusPendingCall *call, void *user_data)
509 struct connman_network *network = user_data;
511 DBG("network %p", network);
513 reply = dbus_pending_call_steal_reply(call);
515 if (pending_network_is_available(network) == FALSE)
518 dbus_error_init(&error);
519 if (dbus_set_error_from_message(&error, reply)) {
520 if (connman_network_get_index(network) < 0)
521 connman_network_set_error(network,
522 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
524 pending_network = NULL;
526 connman_error("%s", error.message);
528 dbus_error_free(&error);
530 pending_network = network;
533 dbus_message_unref(reply);
535 dbus_pending_call_unref(call);
538 static int set_network_active(struct connman_network *network,
541 DBusMessage *message;
542 DBusPendingCall *call;
543 DBusMessageIter iter;
545 const char *path = connman_network_get_string(network, "Path");
547 DBG("network %p, path %s, active %d", network, path, active);
552 message = dbus_message_new_method_call(OFONO_SERVICE, path,
553 OFONO_PRI_CONTEXT_INTERFACE, SET_PROPERTY);
557 dbus_message_set_auto_start(message, FALSE);
559 dbus_message_iter_init_append(message, &iter);
560 connman_dbus_property_append_basic(&iter, "Active",
561 DBUS_TYPE_BOOLEAN, &active);
563 if (dbus_connection_send_with_reply(connection, message,
564 &call, TIMEOUT * 10) == FALSE) {
565 connman_error("Failed to connect service");
566 dbus_message_unref(message);
571 connman_error("D-Bus connection not available");
572 dbus_message_unref(message);
576 connman_network_ref(network);
578 dbus_pending_call_set_notify(call, set_active_reply, network, NULL);
580 dbus_message_unref(message);
588 static void set_apn_reply(DBusPendingCall *call, void *user_data)
593 reply = dbus_pending_call_steal_reply(call);
595 dbus_error_init(&error);
596 if (dbus_set_error_from_message(&error, reply)) {
597 connman_error("%s", error.message);
599 dbus_error_free(&error);
602 dbus_message_unref(reply);
604 dbus_pending_call_unref(call);
607 static void set_apn(struct connman_network *network)
609 DBusMessage *message;
610 DBusPendingCall *call;
611 DBusMessageIter iter;
612 const char *apn, *path;
614 apn = connman_network_get_string(network, "Cellular.APN");
618 path = connman_network_get_string(network, "Path");
622 DBG("path %s, apn %s", path, apn);
624 message = dbus_message_new_method_call(OFONO_SERVICE, path,
625 OFONO_PRI_CONTEXT_INTERFACE, SET_PROPERTY);
629 dbus_message_set_auto_start(message, FALSE);
631 dbus_message_iter_init_append(message, &iter);
632 connman_dbus_property_append_basic(&iter, "AccessPointName",
633 DBUS_TYPE_STRING, &apn);
635 if (dbus_connection_send_with_reply(connection, message,
636 &call, TIMEOUT) == FALSE) {
637 dbus_message_unref(message);
642 connman_error("D-Bus connection not available");
643 dbus_message_unref(message);
647 dbus_pending_call_set_notify(call, set_apn_reply, NULL, NULL);
649 dbus_message_unref(message);
652 static int network_connect(struct connman_network *network)
654 if (connman_network_get_index(network) >= 0)
657 return set_network_active(network, TRUE);
660 static int network_disconnect(struct connman_network *network)
662 if (connman_network_get_index(network) < 0)
665 return set_network_active(network, FALSE);
668 static void network_remove(struct connman_network *network)
672 DBG("network %p", network);
674 reg_watch = GPOINTER_TO_UINT(connman_network_get_data(network));
675 g_dbus_remove_watch(connection, reg_watch);
678 static int network_setup(struct connman_network *network, const char *key)
682 if (g_strcmp0(key, "Cellular.APN") == 0)
688 static struct connman_network_driver network_driver = {
690 .type = CONNMAN_NETWORK_TYPE_CELLULAR,
691 .probe = network_probe,
692 .remove = network_remove,
693 .connect = network_connect,
694 .disconnect = network_disconnect,
695 .setup = network_setup,
698 static void add_network(struct connman_device *device, const char *path)
700 struct connman_network *network;
705 DBG("device %p path %s", device, path);
707 network = connman_device_get_network(device, path);
711 ident = get_ident(path);
713 network = connman_network_create(ident,
714 CONNMAN_NETWORK_TYPE_CELLULAR);
720 connman_network_set_string(network, "Path", path);
721 connman_network_set_available(network, TRUE);
722 connman_network_set_index(network, -1);
724 mcc = connman_device_get_string(device, "MCC");
726 connman_network_set_string(network, "Cellular.MCC", mcc);
728 mnc = connman_device_get_string(device, "MNC");
730 connman_network_set_string(network, "Cellular.MNC", mnc);
732 connman_device_add_network(device, network);
735 static void add_networks(struct connman_device *device, DBusMessageIter *array)
737 DBusMessageIter entry;
741 dbus_message_iter_recurse(array, &entry);
743 while (dbus_message_iter_get_arg_type(&entry) ==
744 DBUS_TYPE_OBJECT_PATH) {
747 dbus_message_iter_get_basic(&entry, &path);
749 add_network(device, path);
751 dbus_message_iter_next(&entry);
755 static void create_context_reply(DBusPendingCall *call, void *user_data)
762 dbus_error_init(&error);
764 reply = dbus_pending_call_steal_reply(call);
766 if (dbus_set_error_from_message(&error, reply)) {
767 connman_error("%s", error.message);
768 dbus_error_free(&error);
771 dbus_message_unref(reply);
773 dbus_pending_call_unref(call);
776 static void add_default_context(DBusMessageIter *array,
777 const char *path, const char *name, const char *type)
779 DBusMessageIter entry;
780 DBusMessage *message;
781 DBusPendingCall *call;
788 dbus_message_iter_recurse(array, &entry);
790 if (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_OBJECT_PATH)
793 DBG("path %s, name %s, type %s", path, name, type);
795 message = dbus_message_new_method_call(OFONO_SERVICE, path,
796 OFONO_GPRS_INTERFACE, CREATE_CONTEXT);
800 dbus_message_set_auto_start(message, FALSE);
802 dbus_message_append_args(message, DBUS_TYPE_STRING,
803 &name, DBUS_TYPE_STRING,
804 &type, DBUS_TYPE_INVALID);
806 if (dbus_connection_send_with_reply(connection, message,
807 &call, TIMEOUT) == FALSE) {
808 connman_error("Failed to create default context");
809 dbus_message_unref(message);
814 connman_error("D-Bus connection not available");
815 dbus_message_unref(message);
819 dbus_pending_call_set_notify(call, create_context_reply, NULL, NULL);
821 dbus_message_unref(message);
824 static void check_networks_reply(DBusPendingCall *call, void *user_data)
826 struct connman_device *device = user_data;
828 DBusMessageIter array, dict, contexts;
829 dbus_bool_t attached;
831 DBG("device %p", device);
833 reply = dbus_pending_call_steal_reply(call);
835 if (dbus_message_iter_init(reply, &array) == FALSE)
838 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
841 dbus_message_iter_recurse(&array, &dict);
843 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
844 DBusMessageIter entry, value;
847 dbus_message_iter_recurse(&dict, &entry);
848 dbus_message_iter_get_basic(&entry, &key);
850 dbus_message_iter_next(&entry);
851 dbus_message_iter_recurse(&entry, &value);
855 if (g_str_equal(key, "Attached") == TRUE) {
856 dbus_message_iter_get_basic(&value, &attached);
857 DBG("Attached %d", attached);
858 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
861 path = connman_device_get_string(device, "Path");
863 add_default_context(&contexts, path,
864 CONTEXT_NAME, CONTEXT_TYPE);
865 } else if (g_str_equal(key, "Powered") == TRUE) {
868 dbus_message_iter_get_basic(&value, &powered);
870 connman_device_set_powered(device, powered);
873 dbus_message_iter_next(&dict);
876 if (attached == TRUE)
877 add_networks(device, &contexts);
880 dbus_message_unref(reply);
882 dbus_pending_call_unref(call);
885 static void check_networks(struct modem_data *modem)
887 DBusMessage *message;
888 DBusPendingCall *call;
889 struct connman_device *device;
891 DBG("modem %p", modem);
896 device = modem->device;
900 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
901 OFONO_GPRS_INTERFACE, GET_PROPERTIES);
905 dbus_message_set_auto_start(message, FALSE);
907 if (dbus_connection_send_with_reply(connection, message,
908 &call, TIMEOUT) == FALSE) {
909 connman_error("Failed to get ofono GPRS");
914 connman_error("D-Bus connection not available");
918 dbus_pending_call_set_notify(call, check_networks_reply,
919 (void *)device, NULL);
922 dbus_message_unref(message);
925 static void add_device(const char *path, const char *imsi,
926 const char *mcc, const char *mnc)
928 struct modem_data *modem;
929 struct connman_device *device;
931 DBG("path %s imsi %s", path, imsi);
939 modem = g_hash_table_lookup(modem_hash, path);
943 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
947 connman_device_set_ident(device, imsi);
949 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
951 connman_device_set_string(device, "Path", path);
953 connman_device_set_string(device, "MCC", mcc);
955 connman_device_set_string(device, "MNC", mnc);
957 if (connman_device_register(device) < 0) {
958 connman_device_unref(device);
962 modem->device = device;
964 check_networks(modem);
967 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
969 const char *path = user_data;
973 /* If MobileNetworkCodeLength is not provided, mnc_length is 0 */
974 unsigned char mnc_length = 0;
976 DBusMessageIter array, dict;
978 DBG("path %s", path);
980 reply = dbus_pending_call_steal_reply(call);
982 if (dbus_message_iter_init(reply, &array) == FALSE)
985 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
988 dbus_message_iter_recurse(&array, &dict);
990 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
991 DBusMessageIter entry, value;
994 dbus_message_iter_recurse(&dict, &entry);
995 dbus_message_iter_get_basic(&entry, &key);
997 dbus_message_iter_next(&entry);
998 dbus_message_iter_recurse(&entry, &value);
1000 if (g_str_equal(key, "SubscriberIdentity") == TRUE)
1001 dbus_message_iter_get_basic(&value, &imsi);
1003 * 'MobileNetworkCodeLength' is deprecated since version 0.20, but
1004 * keep it here for backward compatibility reasons.
1006 else if (g_str_equal(key, "MobileNetworkCodeLength") == TRUE)
1007 dbus_message_iter_get_basic(&value,
1008 (void *) &mnc_length);
1009 else if (g_str_equal(key, "MobileCountryCode") == TRUE)
1010 dbus_message_iter_get_basic(&value,
1012 else if (g_str_equal(key, "MobileNetworkCode") == TRUE)
1013 dbus_message_iter_get_basic(&value,
1016 dbus_message_iter_next(&dict);
1019 if (mnc_length == 2 || mnc_length == 3) {
1020 mcc = g_strndup(imsi, 3);
1021 mnc = g_strndup(imsi + 3, mnc_length);
1024 add_device(path, imsi, mcc, mnc);
1026 if (mnc_length == 2 || mnc_length == 3) {
1032 dbus_message_unref(reply);
1034 dbus_pending_call_unref(call);
1037 static void get_imsi(const char *path)
1039 DBusMessage *message;
1040 DBusPendingCall *call;
1042 DBG("path %s", path);
1044 message = dbus_message_new_method_call(OFONO_SERVICE, path,
1045 OFONO_SIM_INTERFACE, GET_PROPERTIES);
1046 if (message == NULL)
1049 dbus_message_set_auto_start(message, FALSE);
1051 if (dbus_connection_send_with_reply(connection, message,
1052 &call, TIMEOUT) == FALSE) {
1053 connman_error("Failed to get ofono modem sim");
1058 connman_error("D-Bus connection not available");
1062 dbus_pending_call_set_notify(call, sim_properties_reply,
1063 (void *)path, NULL);
1066 dbus_message_unref(message);
1069 static int modem_change_powered(const char *path, dbus_bool_t powered)
1071 DBusMessage *message;
1072 DBusMessageIter iter;
1073 DBusPendingCall *call;
1075 DBG("path %s powered %d", path, powered);
1080 message = dbus_message_new_method_call(OFONO_SERVICE, path,
1081 OFONO_MODEM_INTERFACE, SET_PROPERTY);
1082 if (message == NULL)
1085 dbus_message_set_auto_start(message, FALSE);
1087 dbus_message_iter_init_append(message, &iter);
1088 connman_dbus_property_append_basic(&iter, "Powered",
1089 DBUS_TYPE_BOOLEAN, &powered);
1091 if (dbus_connection_send_with_reply(connection, message,
1092 &call, TIMEOUT) == FALSE) {
1093 connman_error("Failed to change powered property");
1094 dbus_message_unref(message);
1099 connman_error("D-Bus connection not available");
1100 dbus_message_unref(message);
1104 dbus_pending_call_set_notify(call, powered_reply, NULL, NULL);
1106 dbus_message_unref(message);
1108 return -EINPROGRESS;
1111 static struct modem_data *add_modem(const char *path)
1113 struct modem_data *modem;
1118 modem = g_hash_table_lookup(modem_hash, path);
1119 if (modem != NULL) {
1120 modem->available = TRUE;
1125 modem = g_try_new0(struct modem_data, 1);
1129 modem->path = g_strdup(path);
1130 modem->device = NULL;
1131 modem->available = TRUE;
1133 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1138 static gboolean modem_has_gprs(DBusMessageIter *array)
1140 DBusMessageIter entry;
1142 dbus_message_iter_recurse(array, &entry);
1144 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1145 const char *interface;
1147 dbus_message_iter_get_basic(&entry, &interface);
1149 if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
1152 dbus_message_iter_next(&entry);
1158 static void modem_properties_reply(DBusPendingCall *call, void *user_data)
1161 DBusMessageIter array, dict;
1162 const char *path = user_data;
1164 DBG("path %s", path);
1166 reply = dbus_pending_call_steal_reply(call);
1168 if (dbus_message_iter_init(reply, &array) == FALSE)
1171 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1174 dbus_message_iter_recurse(&array, &dict);
1176 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1177 DBusMessageIter entry, value;
1179 dbus_bool_t powered;
1181 dbus_message_iter_recurse(&dict, &entry);
1182 dbus_message_iter_get_basic(&entry, &key);
1184 dbus_message_iter_next(&entry);
1185 dbus_message_iter_recurse(&entry, &value);
1187 if (g_str_equal(key, "Powered") == TRUE) {
1188 dbus_message_iter_get_basic(&value, &powered);
1190 if (powered == FALSE) {
1191 modem_change_powered(path, TRUE);
1194 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1195 if (modem_has_gprs(&value) == TRUE)
1199 dbus_message_iter_next(&dict);
1203 dbus_message_unref(reply);
1205 dbus_pending_call_unref(call);
1208 static void get_modem_properties(struct modem_data *modem)
1210 DBusMessage *message;
1211 DBusPendingCall *call;
1213 DBG("path %s", modem->path);
1215 if (modem->path == NULL)
1218 message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
1219 OFONO_MODEM_INTERFACE, GET_PROPERTIES);
1220 if (message == NULL)
1223 dbus_message_set_auto_start(message, FALSE);
1225 if (dbus_connection_send_with_reply(connection, message,
1226 &call, TIMEOUT) == FALSE) {
1227 connman_error("Failed to get ofono modem");
1232 connman_error("D-Bus connection not available");
1236 dbus_pending_call_set_notify(call, modem_properties_reply,
1237 (void *)modem->path, NULL);
1240 dbus_message_unref(message);
1243 static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
1245 struct modem_data *modem = value;
1247 modem->available = FALSE;
1250 static void modems_set_unavailable()
1252 g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
1255 static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
1257 struct modem_data *modem = value;
1259 if (modem->available == FALSE)
1260 g_hash_table_remove(modem_hash, key);
1263 static void cleanup_modems()
1265 g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
1268 static void update_modems(DBusMessageIter *array)
1270 DBusMessageIter entry;
1272 dbus_message_iter_recurse(array, &entry);
1274 modems_set_unavailable();
1276 while (dbus_message_iter_get_arg_type(&entry) ==
1277 DBUS_TYPE_OBJECT_PATH) {
1279 struct modem_data *modem;
1281 dbus_message_iter_get_basic(&entry, &path);
1283 modem = add_modem(path);
1285 get_modem_properties(modem);
1287 dbus_message_iter_next(&entry);
1293 static void manager_properties_reply(DBusPendingCall *call, void *user_data)
1296 DBusMessageIter array, dict;
1300 reply = dbus_pending_call_steal_reply(call);
1302 if (dbus_message_iter_init(reply, &array) == FALSE)
1305 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
1308 dbus_message_iter_recurse(&array, &dict);
1310 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1311 DBusMessageIter entry, value;
1314 dbus_message_iter_recurse(&dict, &entry);
1315 dbus_message_iter_get_basic(&entry, &key);
1317 dbus_message_iter_next(&entry);
1318 dbus_message_iter_recurse(&entry, &value);
1320 if (g_str_equal(key, "Modems") == TRUE) {
1321 update_modems(&value);
1325 dbus_message_iter_next(&dict);
1329 dbus_message_unref(reply);
1331 dbus_pending_call_unref(call);
1334 static void modem_remove_device(struct modem_data *modem)
1336 if (modem->device == NULL)
1339 connman_device_unregister(modem->device);
1340 connman_device_unref(modem->device);
1342 modem->device = NULL;
1345 static void remove_modem(gpointer data)
1347 struct modem_data *modem = data;
1349 g_free(modem->path);
1351 modem_remove_device(modem);
1356 static void ofono_connect(DBusConnection *connection, void *user_data)
1358 DBusMessage *message;
1359 DBusPendingCall *call;
1361 DBG("connection %p", connection);
1363 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1364 g_free, remove_modem);
1366 message = dbus_message_new_method_call(OFONO_SERVICE, "/",
1367 OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
1368 if (message == NULL)
1371 dbus_message_set_auto_start(message, FALSE);
1373 if (dbus_connection_send_with_reply(connection, message,
1374 &call, TIMEOUT) == FALSE) {
1375 connman_error("Failed to get ofono modems");
1380 connman_error("D-Bus connection not available");
1384 dbus_pending_call_set_notify(call, manager_properties_reply,
1388 dbus_message_unref(message);
1392 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1394 DBG("connection %p", connection);
1396 if (modem_hash == NULL)
1399 g_hash_table_destroy(modem_hash);
1404 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1407 const char *path = dbus_message_get_path(message);
1408 struct modem_data *modem;
1409 DBusMessageIter iter, value;
1412 DBG("path %s", path);
1414 modem = g_hash_table_lookup(modem_hash, path);
1418 if (dbus_message_iter_init(message, &iter) == FALSE)
1421 dbus_message_iter_get_basic(&iter, &key);
1423 dbus_message_iter_next(&iter);
1424 dbus_message_iter_recurse(&iter, &value);
1426 if (g_str_equal(key, "Powered") == TRUE) {
1427 dbus_bool_t powered;
1429 dbus_message_iter_get_basic(&value, &powered);
1430 if (powered == TRUE)
1433 modem_remove_device(modem);
1434 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1435 if (modem_has_gprs(&value) == TRUE) {
1436 if (modem->device == NULL)
1437 get_imsi(modem->path);
1438 } else if (modem->device != NULL)
1439 modem_remove_device(modem);
1445 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1448 const char *path = dbus_message_get_path(message);
1449 struct modem_data *modem;
1450 DBusMessageIter iter, value;
1453 DBG("path %s", path);
1455 modem = g_hash_table_lookup(modem_hash, 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, "Attached") == TRUE) {
1468 dbus_bool_t attached;
1470 dbus_message_iter_get_basic(&value, &attached);
1472 DBG("Attached %d", attached);
1474 if (attached == TRUE)
1475 check_networks(modem);
1476 else if (modem->device != NULL)
1477 connman_device_remove_all_networks(modem->device);
1479 } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
1480 check_networks(modem);
1481 } else if (g_str_equal(key, "Powered") == TRUE) {
1482 dbus_bool_t powered;
1484 if (modem->device == NULL)
1487 dbus_message_iter_get_basic(&value, &powered);
1488 connman_device_set_powered(modem->device, powered);
1494 static gboolean manager_changed(DBusConnection *connection,
1495 DBusMessage *message, void *user_data)
1497 const char *path = dbus_message_get_path(message);
1498 DBusMessageIter iter, value;
1501 DBG("path %s", path);
1503 if (dbus_message_iter_init(message, &iter) == FALSE)
1506 dbus_message_iter_get_basic(&iter, &key);
1508 dbus_message_iter_next(&iter);
1509 dbus_message_iter_recurse(&iter, &value);
1511 if (g_str_equal(key, "Modems") == TRUE)
1512 update_modems(&value);
1517 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1519 DBusMessageIter entry;
1520 gchar *nameserver = NULL, *nameserver_old = NULL;
1524 dbus_message_iter_recurse(array, &entry);
1526 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1529 dbus_message_iter_get_basic(&entry, &dns);
1533 if (nameserver == NULL) {
1535 nameserver = g_strdup(dns);
1538 nameserver_old = nameserver;
1539 nameserver = g_strdup_printf("%s %s",
1540 nameserver_old, dns);
1541 g_free(nameserver_old);
1544 dbus_message_iter_next(&entry);
1547 parent->ipv4.nameserver = nameserver;
1550 static void update_settings(DBusMessageIter *array,
1551 struct connman_element *parent)
1553 DBusMessageIter dict;
1554 const char *interface = NULL;
1558 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1561 dbus_message_iter_recurse(array, &dict);
1563 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1564 DBusMessageIter entry, value;
1567 dbus_message_iter_recurse(&dict, &entry);
1568 dbus_message_iter_get_basic(&entry, &key);
1570 dbus_message_iter_next(&entry);
1571 dbus_message_iter_recurse(&entry, &value);
1573 if (g_str_equal(key, "Interface") == TRUE) {
1576 dbus_message_iter_get_basic(&value, &interface);
1578 DBG("interface %s", interface);
1580 index = connman_inet_ifindex(interface);
1582 connman_network_set_index(
1583 pending_network, index);
1585 connman_error("Can not find interface %s",
1589 } else if (g_str_equal(key, "Method") == TRUE) {
1592 dbus_message_iter_get_basic(&value, &method);
1593 if (g_strcmp0(method, "static") == 0) {
1595 parent->ipv4.method =
1596 CONNMAN_IPCONFIG_METHOD_FIXED;
1597 } else if (g_strcmp0(method, "dhcp") == 0) {
1599 parent->ipv4.method =
1600 CONNMAN_IPCONFIG_METHOD_DHCP;
1603 } else if (g_str_equal(key, "Address") == TRUE) {
1604 const char *address;
1606 dbus_message_iter_get_basic(&value, &address);
1608 DBG("address %s", address);
1610 parent->ipv4.address = g_strdup(address);
1611 } else if (g_str_equal(key, "Netmask") == TRUE) {
1612 const char *netmask;
1614 dbus_message_iter_get_basic(&value, &netmask);
1616 DBG("netmask %s", netmask);
1618 parent->ipv4.netmask = g_strdup(netmask);
1619 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1621 get_dns(&value, parent);
1622 } else if (g_str_equal(key, "Gateway") == TRUE) {
1623 const char *gateway;
1625 dbus_message_iter_get_basic(&value, &gateway);
1627 DBG("gateway %s", gateway);
1629 parent->ipv4.gateway = g_strdup(gateway);
1632 dbus_message_iter_next(&dict);
1635 /* deactive, oFono send NULL inteface before deactive signal */
1636 if (interface == NULL)
1637 connman_network_set_index(pending_network, -1);
1640 static void cleanup_ipconfig(struct connman_element *parent)
1642 g_free(parent->ipv4.address);
1643 parent->ipv4.address = NULL;
1645 g_free(parent->ipv4.netmask);
1646 parent->ipv4.netmask = NULL;
1648 g_free(parent->ipv4.nameserver);
1649 parent->ipv4.nameserver = NULL;
1651 g_free(parent->ipv4.gateway);
1652 parent->ipv4.gateway = NULL;
1654 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1657 static int static_network_set_connected(
1658 struct connman_network *pending_network,
1659 struct connman_element *parent,
1660 connman_bool_t connected)
1662 if (connected == FALSE)
1663 cleanup_ipconfig(parent);
1665 connman_network_set_connected(pending_network, connected);
1670 static gboolean pri_context_changed(DBusConnection *connection,
1671 DBusMessage *message, void *user_data)
1673 const char *path = dbus_message_get_path(message);
1674 struct connman_element *parent;
1675 const char *pending_path;
1676 DBusMessageIter iter, value;
1679 DBG("pending_network %p, path %s", pending_network, path);
1681 if (pending_network == NULL)
1684 pending_path = connman_network_get_string(pending_network, "Path");
1685 if (g_strcmp0(pending_path, path) != 0)
1688 parent = connman_network_get_element(pending_network);
1690 if (dbus_message_iter_init(message, &iter) == FALSE)
1693 dbus_message_iter_get_basic(&iter, &key);
1695 dbus_message_iter_next(&iter);
1696 dbus_message_iter_recurse(&iter, &value);
1698 if (g_str_equal(key, "Settings") == TRUE) {
1700 update_settings(&value, parent);
1701 } else if (g_str_equal(key, "Active") == TRUE) {
1704 dbus_message_iter_get_basic(&value, &active);
1706 switch (parent->ipv4.method) {
1707 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1708 case CONNMAN_IPCONFIG_METHOD_OFF:
1709 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1711 case CONNMAN_IPCONFIG_METHOD_FIXED:
1712 connman_network_set_method(pending_network,
1713 CONNMAN_IPCONFIG_METHOD_FIXED);
1715 if (static_network_set_connected(
1716 pending_network, parent, active) < 0)
1717 set_network_active(pending_network, FALSE);
1719 case CONNMAN_IPCONFIG_METHOD_DHCP:
1720 connman_network_set_method(pending_network,
1721 CONNMAN_IPCONFIG_METHOD_DHCP);
1722 connman_network_set_connected(pending_network, active);
1726 pending_network = NULL;
1733 static guint gprs_watch;
1734 static guint modem_watch;
1735 static guint manager_watch;
1736 static guint context_watch;
1738 static int ofono_init(void)
1742 connection = connman_dbus_get_connection();
1743 if (connection == NULL)
1746 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1747 ofono_connect, ofono_disconnect, NULL, NULL);
1749 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1750 OFONO_GPRS_INTERFACE,
1755 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1756 OFONO_MODEM_INTERFACE,
1761 manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1762 OFONO_MANAGER_INTERFACE,
1767 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1768 OFONO_PRI_CONTEXT_INTERFACE,
1770 pri_context_changed,
1773 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1774 manager_watch == 0 || context_watch == 0) {
1779 err = connman_network_driver_register(&network_driver);
1783 err = connman_device_driver_register(&modem_driver);
1785 connman_network_driver_unregister(&network_driver);
1792 g_dbus_remove_watch(connection, watch);
1793 g_dbus_remove_watch(connection, gprs_watch);
1794 g_dbus_remove_watch(connection, modem_watch);
1795 g_dbus_remove_watch(connection, manager_watch);
1796 g_dbus_remove_watch(connection, context_watch);
1798 dbus_connection_unref(connection);
1803 static void ofono_exit(void)
1805 g_dbus_remove_watch(connection, watch);
1806 g_dbus_remove_watch(connection, gprs_watch);
1807 g_dbus_remove_watch(connection, modem_watch);
1808 g_dbus_remove_watch(connection, manager_watch);
1809 g_dbus_remove_watch(connection, context_watch);
1811 ofono_disconnect(connection, NULL);
1813 connman_device_driver_unregister(&modem_driver);
1814 connman_network_driver_unregister(&network_driver);
1816 dbus_connection_unref(connection);
1819 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1820 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)