5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
6 * Copyright (C) 2010 Nokia Corporation and/or its subsidiary(-ies).
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
32 #define CONNMAN_API_SUBJECT_TO_CHANGE
33 #include <connman/plugin.h>
34 #include <connman/element.h>
35 #include <connman/device.h>
36 #include <connman/network.h>
37 #include <connman/dbus.h>
38 #include <connman/inet.h>
39 #include <connman/log.h>
41 #define OFONO_SERVICE "org.ofono"
43 #define OFONO_MANAGER_INTERFACE OFONO_SERVICE ".Manager"
44 #define OFONO_MODEM_INTERFACE OFONO_SERVICE ".Modem"
45 #define OFONO_GPRS_INTERFACE OFONO_SERVICE ".ConnectionManager"
46 #define OFONO_CONTEXT_INTERFACE OFONO_SERVICE ".ConnectionContext"
47 #define OFONO_SIM_INTERFACE OFONO_SERVICE ".SimManager"
48 #define OFONO_REGISTRATION_INTERFACE OFONO_SERVICE ".NetworkRegistration"
50 #define PROPERTY_CHANGED "PropertyChanged"
51 #define GET_PROPERTIES "GetProperties"
52 #define SET_PROPERTY "SetProperty"
53 #define CONTEXT_ADDED "ContextAdded"
54 #define CONTEXT_REMOVED "ContextRemoved"
55 #define ADD_CONTEXT "AddContext"
56 #define GET_MODEMS "GetModems"
57 #define MODEM_ADDED "ModemAdded"
58 #define MODEM_REMOVED "ModemRemoved"
63 #define CONTEXT_NAME "3G Connection"
64 #define CONTEXT_TYPE "internet"
66 static DBusConnection *connection;
68 static GHashTable *modem_hash = NULL;
70 static GHashTable *network_hash;
74 struct connman_device *device;
79 gboolean pending_online;
80 gboolean requested_online;
83 uint8_t strength, has_strength;
86 static int modem_probe(struct connman_device *device)
88 DBG("device %p", device);
93 static void modem_remove(struct connman_device *device)
95 DBG("device %p", device);
98 static int call_ofono(const char *path,
99 const char *interface, const char *method,
100 DBusPendingCallNotifyFunction notify, void *user_data,
101 DBusFreeFunction free_function,
104 DBusMessage *message;
105 DBusPendingCall *call;
109 DBG("path %s %s.%s", path, interface, method);
114 message = dbus_message_new_method_call(OFONO_SERVICE, path,
119 dbus_message_set_auto_start(message, FALSE);
122 ok = dbus_message_append_args_valist(message, type, va);
128 if (dbus_connection_send_with_reply(connection, message,
129 &call, TIMEOUT) == FALSE) {
130 connman_error("Failed to call %s.%s", interface, method);
131 dbus_message_unref(message);
136 connman_error("D-Bus connection not available");
137 dbus_message_unref(message);
141 dbus_pending_call_set_notify(call, notify, user_data, free_function);
143 dbus_message_unref(message);
148 static void set_property_reply(DBusPendingCall *call, void *user_data)
152 char const *name = user_data;
156 dbus_error_init(&error);
158 reply = dbus_pending_call_steal_reply(call);
160 if (dbus_set_error_from_message(&error, reply)) {
161 connman_error("SetProperty(%s) %s %s", name,
162 error.name, error.message);
163 dbus_error_free(&error);
166 dbus_message_unref(reply);
168 dbus_pending_call_unref(call);
171 static int set_property(const char *path, const char *interface,
172 const char *property, int type, void *value,
173 DBusPendingCallNotifyFunction notify, void *user_data,
174 DBusFreeFunction free_function)
176 DBusMessage *message;
177 DBusMessageIter iter;
178 DBusPendingCall *call;
180 DBG("path %s %s.%s", path, interface, property);
182 g_assert(notify == NULL ? free_function == NULL : 1);
187 message = dbus_message_new_method_call(OFONO_SERVICE, path,
188 interface, SET_PROPERTY);
192 dbus_message_set_auto_start(message, FALSE);
194 dbus_message_iter_init_append(message, &iter);
195 connman_dbus_property_append_basic(&iter, property, type, value);
197 if (dbus_connection_send_with_reply(connection, message,
198 &call, TIMEOUT) == FALSE) {
199 connman_error("Failed to change \"%s\" property on %s",
200 property, interface);
201 dbus_message_unref(message);
206 connman_error("D-Bus connection not available");
207 dbus_message_unref(message);
211 if (notify == NULL) {
212 notify = set_property_reply;
213 user_data = (void *)property;
214 free_function = NULL;
217 dbus_pending_call_set_notify(call, notify, user_data, free_function);
219 dbus_message_unref(message);
224 static void update_modem_online(struct modem_data *modem,
225 connman_bool_t online)
227 DBG("modem %p path %s online %d", modem, modem->path, online);
229 modem->online = online;
230 modem->requested_online = online;
231 modem->pending_online = FALSE;
234 connman_device_set_powered(modem->device, online);
237 static void set_online_reply(DBusPendingCall *call, void *user_data)
239 struct modem_data *modem;
244 DBG("path %s", (char *)user_data);
246 if (modem_hash == NULL)
249 modem = g_hash_table_lookup(modem_hash, user_data);
253 reply = dbus_pending_call_steal_reply(call);
255 dbus_error_init(&error);
257 if (dbus_set_error_from_message(&error, reply)) {
258 connman_error("SetProperty(Online) %s %s",
259 error.name, error.message);
260 dbus_error_free(&error);
262 result = modem->online;
264 result = modem->requested_online;
266 if (modem->pending_online)
267 update_modem_online(modem, result);
269 dbus_message_unref(reply);
271 dbus_pending_call_unref(call);
274 static int modem_change_online(char const *path, dbus_bool_t online)
276 return set_property(path, OFONO_MODEM_INTERFACE, "Online",
277 DBUS_TYPE_BOOLEAN, &online,
279 (void *)g_strdup(path), g_free);
282 static int modem_enable(struct connman_device *device)
284 const char *path = connman_device_get_string(device, "Path");
286 DBG("device %p, path, %s", device, path);
288 return modem_change_online(path, TRUE);
291 static int modem_disable(struct connman_device *device)
293 const char *path = connman_device_get_string(device, "Path");
295 DBG("device %p path %s", device, path);
297 return modem_change_online(path, FALSE);
300 static struct connman_device_driver modem_driver = {
302 .type = CONNMAN_DEVICE_TYPE_CELLULAR,
303 .probe = modem_probe,
304 .remove = modem_remove,
305 .enable = modem_enable,
306 .disable = modem_disable,
309 static void modem_remove_device(struct modem_data *modem)
311 DBG("modem %p path %s device %p", modem, modem->path, modem->device);
313 if (modem->device == NULL)
316 connman_device_remove_all_networks(modem->device);
317 connman_device_unregister(modem->device);
318 connman_device_unref(modem->device);
320 modem->device = NULL;
323 static void remove_modem(gpointer data)
325 struct modem_data *modem = data;
327 modem_remove_device(modem);
334 static void remove_network(gpointer data)
336 connman_network_unref(data);
339 static char *get_ident(const char *path)
346 pos = strrchr(path, '/');
353 static void create_service(struct connman_network *network)
360 path = connman_network_get_string(network, "Path");
362 group = get_ident(path);
364 connman_network_set_group(network, group);
367 static int network_probe(struct connman_network *network)
369 create_service(network);
373 static gboolean pending_network_is_available(struct connman_network *network)
375 /* Modem or network may be removed */
376 if (network == NULL || connman_network_get_device(network) == NULL) {
377 DBG("Modem or network was removed");
384 static void set_active_reply(DBusPendingCall *call, void *user_data)
386 char const *path = user_data;
389 struct connman_network *network;
391 network = g_hash_table_lookup(network_hash, path);
393 DBG("path %s network %p", path, network);
395 reply = dbus_pending_call_steal_reply(call);
397 if (!pending_network_is_available(network))
400 dbus_error_init(&error);
402 if (dbus_set_error_from_message(&error, reply)) {
403 connman_error("SetProperty(Active) %s %s",
404 error.name, error.message);
406 if (connman_network_get_index(network) < 0)
407 connman_network_set_error(network,
408 CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
410 dbus_error_free(&error);
414 dbus_message_unref(reply);
416 dbus_pending_call_unref(call);
419 static int set_network_active(struct connman_network *network,
424 const char *path = connman_network_get_string(network, "Path");
426 DBG("network %p, path %s, active %d", network, path, active);
428 error = set_property(path, OFONO_CONTEXT_INTERFACE,
429 "Active", DBUS_TYPE_BOOLEAN, &active,
430 set_active_reply, g_strdup(path), NULL);
432 if (active == FALSE && error == -EINPROGRESS)
438 static void set_apn(struct connman_network *network)
440 const char *apn, *path;
442 apn = connman_network_get_string(network, "Cellular.APN");
446 path = connman_network_get_string(network, "Path");
450 DBG("path %s, apn %s", path, apn);
452 set_property(path, OFONO_CONTEXT_INTERFACE,
453 "AccessPointName", DBUS_TYPE_STRING, &apn,
457 static int network_connect(struct connman_network *network)
459 DBG("network %p", network);
461 if (connman_network_get_index(network) >= 0)
464 return set_network_active(network, TRUE);
467 static int network_disconnect(struct connman_network *network)
469 DBG("network %p", network);
471 if (connman_network_get_index(network) < 0)
474 return set_network_active(network, FALSE);
477 static void network_remove(struct connman_network *network)
479 char const *path = connman_network_get_string(network, "Path");
481 DBG("network %p path %s", network, path);
483 g_hash_table_remove(network_hash, path);
486 static int network_setup(struct connman_network *network, const char *key)
488 if (g_strcmp0(key, "Cellular.APN") == 0)
494 static struct connman_network_driver network_driver = {
496 .type = CONNMAN_NETWORK_TYPE_CELLULAR,
497 .probe = network_probe,
498 .remove = network_remove,
499 .connect = network_connect,
500 .disconnect = network_disconnect,
501 .setup = network_setup,
504 static void update_settings(DBusMessageIter *array,
505 struct connman_network *network);
507 static void set_connected(struct connman_network *network,
508 connman_bool_t connected);
510 static int add_network(struct connman_device *device,
511 const char *path, DBusMessageIter *dict)
513 struct modem_data *modem = connman_device_get_data(device);
514 struct connman_network *network;
516 const char *hash_path;
517 char const *operator;
518 char const *reg_status;
519 dbus_bool_t active = FALSE;
521 DBG("modem %p device %p path %s", modem, device, path);
523 ident = get_ident(path);
525 network = connman_device_get_network(device, ident);
529 network = g_hash_table_lookup(network_hash, path);
530 if (network != NULL) {
531 DBG("path %p already exists with device %p", path,
532 connman_network_get_device(network));
533 if (connman_network_get_device(network))
535 g_hash_table_remove(network_hash, path);
538 network = connman_network_create(ident, CONNMAN_NETWORK_TYPE_CELLULAR);
542 connman_network_set_string(network, "Path", path);
543 hash_path = connman_network_get_string(network, "Path");
544 if (hash_path == NULL)
546 connman_network_ref(network);
547 g_hash_table_insert(network_hash, (char *)hash_path, network);
549 connman_network_set_available(network, TRUE);
550 connman_network_set_index(network, -1);
552 operator = connman_device_get_string(device, "Operator");
554 connman_network_set_name(network, operator);
556 if (modem->has_strength)
557 connman_network_set_strength(network, modem->strength);
559 reg_status = connman_device_get_string(device, "RegistrationStatus");
561 if (!g_strcmp0(reg_status, "roaming"))
562 connman_network_set_roaming(network, TRUE);
563 else if (!g_strcmp0(reg_status, "registered"))
564 connman_network_set_roaming(network, FALSE);
566 while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) {
567 DBusMessageIter entry, value;
570 dbus_message_iter_recurse(dict, &entry);
571 dbus_message_iter_get_basic(&entry, &key);
573 dbus_message_iter_next(&entry);
574 dbus_message_iter_recurse(&entry, &value);
576 if (g_str_equal(key, "Type")) {
579 dbus_message_iter_get_basic(&value, &type);
580 if (g_strcmp0(type, "internet") == 0) {
581 connman_network_set_protocol(network,
582 CONNMAN_NETWORK_PROTOCOL_IP);
584 DBG("path %p type %s", path, type);
587 } else if (g_str_equal(key, "AccessPointName")) {
590 dbus_message_iter_get_basic(&value, &ap);
592 connman_network_set_string(network, "Cellular.APN", ap);
593 } else if (g_str_equal(key, "Settings"))
594 update_settings(&value, network);
595 else if (g_str_equal(key, "Active") == TRUE)
596 dbus_message_iter_get_basic(&value, &active);
598 dbus_message_iter_next(dict);
601 if (connman_device_add_network(device, network) != 0)
605 set_connected(network, active);
610 connman_network_unref(network);
611 g_hash_table_remove(network_hash, hash_path);
615 static void check_networks_reply(DBusPendingCall *call, void *user_data)
617 char *path = user_data;
618 struct modem_data *modem;
620 DBusMessageIter array, entry, value, properties;
622 DBG("path %s", path);
624 modem = g_hash_table_lookup(modem_hash, path);
627 if (modem->device == NULL)
630 reply = dbus_pending_call_steal_reply(call);
632 if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
635 dbus_message_iter_init(reply, &array);
637 dbus_message_iter_recurse(&array, &entry);
639 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRUCT) {
640 char const *network_path;
642 dbus_message_iter_recurse(&entry, &value);
643 dbus_message_iter_get_basic(&value, &network_path);
645 dbus_message_iter_next(&value);
646 dbus_message_iter_recurse(&value, &properties);
648 add_network(modem->device, network_path, &properties);
650 dbus_message_iter_next(&entry);
654 dbus_message_unref(reply);
656 dbus_pending_call_unref(call);
659 static void check_networks(struct modem_data *modem)
661 char const *path = modem->path;
663 DBG("modem %p path %s", modem, path);
665 call_ofono(path, OFONO_GPRS_INTERFACE, "GetContexts",
666 check_networks_reply, g_strdup(path), g_free,
670 static void modem_operator_name_changed(struct modem_data *modem,
673 struct connman_device *device = modem->device;
680 connman_device_set_string(device, "Operator", name);
682 for (g_hash_table_iter_init(&i, network_hash);
683 g_hash_table_iter_next(&i, NULL, &value);) {
684 struct connman_network *network = value;
686 if (connman_network_get_device(network) == device) {
687 connman_network_set_name(network, name);
688 connman_network_update(network);
693 static void modem_strength_changed(struct modem_data *modem, uint8_t strength)
695 struct connman_device *device = modem->device;
699 modem->strength = strength;
700 modem->has_strength = TRUE;
705 for (g_hash_table_iter_init(&i, network_hash);
706 g_hash_table_iter_next(&i, NULL, &value);) {
707 struct connman_network *network = value;
709 if (connman_network_get_device(network) == device) {
710 connman_network_set_strength(network, strength);
711 connman_network_update(network);
716 static void modem_roaming_changed(struct modem_data *modem,
719 struct connman_device *device = modem->device;
720 connman_bool_t roaming;
724 connman_device_set_string(device, "RegistrationStatus", status);
726 if (g_str_equal(status, "roaming"))
728 else if (g_str_equal(status, "registered"))
736 for (g_hash_table_iter_init(&i, network_hash);
737 g_hash_table_iter_next(&i, NULL, &value);) {
738 struct connman_network *network = value;
740 if (connman_network_get_device(network) == device) {
741 connman_network_set_roaming(network, roaming);
742 connman_network_update(network);
747 static void modem_registration_changed(struct modem_data *modem,
748 DBusMessageIter *entry)
750 DBusMessageIter iter;
755 connman_uint8_t byte;
758 dbus_message_iter_get_basic(entry, &key);
762 dbus_message_iter_next(entry);
764 dbus_message_iter_recurse(entry, &iter);
766 type = dbus_message_iter_get_arg_type(&iter);
767 if (type != DBUS_TYPE_BYTE && type != DBUS_TYPE_STRING)
770 dbus_message_iter_get_basic(&iter, &value);
772 if (g_str_equal(key, "Name") && type == DBUS_TYPE_STRING)
773 modem_operator_name_changed(modem, value.str);
774 else if (g_str_equal(key, "Strength") && type == DBUS_TYPE_BYTE)
775 modem_strength_changed(modem, value.byte);
776 else if (g_str_equal(key, "Status") && type == DBUS_TYPE_STRING)
777 modem_roaming_changed(modem, value.str);
781 static gboolean reg_changed(DBusConnection *connection,
782 DBusMessage *message, void *user_data)
784 const char *path = dbus_message_get_path(message);
785 struct modem_data *modem;
786 DBusMessageIter iter;
788 DBG("path %s", path);
790 modem = g_hash_table_lookup(modem_hash, path);
794 if (dbus_message_iter_init(message, &iter))
795 modem_registration_changed(modem, &iter);
800 static void check_registration_reply(DBusPendingCall *call, void *user_data)
802 char const *path = user_data;
803 struct modem_data *modem;
805 DBusMessageIter array, dict, entry;
807 DBG("path %s", path);
809 modem = g_hash_table_lookup(modem_hash, path);
813 reply = dbus_pending_call_steal_reply(call);
815 if (dbus_message_iter_init(reply, &array) == FALSE)
818 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
821 dbus_message_iter_recurse(&array, &dict);
822 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
823 dbus_message_iter_recurse(&dict, &entry);
824 modem_registration_changed(modem, &entry);
825 dbus_message_iter_next(&dict);
829 dbus_message_unref(reply);
831 dbus_pending_call_unref(call);
834 static void check_registration(struct modem_data *modem)
836 char const *path = modem->path;
838 DBG("modem %p path %s", modem, path);
840 call_ofono(path, OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES,
841 check_registration_reply, g_strdup(path), g_free,
845 static void add_device(const char *path, const char *imsi)
847 struct modem_data *modem;
848 struct connman_device *device;
850 DBG("path %s imsi %s", path, imsi);
858 modem = g_hash_table_lookup(modem_hash, path);
863 if (!g_strcmp0(imsi, connman_device_get_ident(modem->device)))
866 modem_remove_device(modem);
869 if (strlen(imsi) == 0)
872 device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
876 connman_device_set_ident(device, imsi);
878 connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
880 connman_device_set_string(device, "Path", path);
882 connman_device_set_data(device, modem);
884 if (connman_device_register(device) < 0) {
885 connman_device_unref(device);
889 modem->device = device;
892 check_registration(modem);
894 check_networks(modem);
897 static void sim_properties_reply(DBusPendingCall *call, void *user_data)
899 const char *path = user_data;
900 const char *imsi = NULL;
902 DBusMessageIter array, dict;
904 DBG("path %s", path);
906 reply = dbus_pending_call_steal_reply(call);
908 if (dbus_message_iter_init(reply, &array) == FALSE)
911 if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
914 dbus_message_iter_recurse(&array, &dict);
916 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
917 DBusMessageIter entry, value;
920 dbus_message_iter_recurse(&dict, &entry);
921 dbus_message_iter_get_basic(&entry, &key);
923 dbus_message_iter_next(&entry);
924 dbus_message_iter_recurse(&entry, &value);
926 if (g_str_equal(key, "SubscriberIdentity")) {
927 dbus_message_iter_get_basic(&value, &imsi);
928 add_device(path, imsi);
931 dbus_message_iter_next(&dict);
935 dbus_message_unref(reply);
937 dbus_pending_call_unref(call);
940 static void get_imsi(const char *path)
942 DBG("path %s", path);
944 call_ofono(path, OFONO_SIM_INTERFACE, GET_PROPERTIES,
945 sim_properties_reply, g_strdup(path), g_free,
949 static int gprs_change_powered(const char *path, dbus_bool_t powered)
951 DBG("path %s powered %d", path, powered);
953 return set_property(path, OFONO_GPRS_INTERFACE, "Powered",
954 DBUS_TYPE_BOOLEAN, &powered,
958 static int modem_change_powered(const char *path, dbus_bool_t powered)
960 DBG("path %s powered %d", path, powered);
962 return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
963 DBUS_TYPE_BOOLEAN, &powered,
968 static gboolean modem_has_interface(DBusMessageIter *array,
969 char const *interface)
971 DBusMessageIter entry;
973 dbus_message_iter_recurse(array, &entry);
975 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
978 dbus_message_iter_get_basic(&entry, &element);
980 if (g_strcmp0(interface, element) == 0)
983 dbus_message_iter_next(&entry);
989 static gboolean modem_has_sim(DBusMessageIter *array)
991 return modem_has_interface(array, OFONO_SIM_INTERFACE);
994 static gboolean modem_has_reg(DBusMessageIter *array)
996 return modem_has_interface(array, OFONO_REGISTRATION_INTERFACE);
999 static gboolean modem_has_gprs(DBusMessageIter *array)
1001 return modem_has_interface(array, OFONO_GPRS_INTERFACE);
1004 static void add_modem(const char *path, DBusMessageIter *properties)
1006 struct modem_data *modem;
1007 DBusMessageIter dict;
1008 dbus_bool_t powered = FALSE;
1009 dbus_bool_t online = FALSE;
1010 dbus_bool_t has_online = FALSE;
1011 gboolean has_sim = FALSE;
1012 gboolean has_reg = FALSE;
1013 gboolean has_gprs = FALSE;
1015 modem = g_hash_table_lookup(modem_hash, path);
1020 modem = g_try_new0(struct modem_data, 1);
1024 modem->path = g_strdup(path);
1025 modem->device = NULL;
1026 modem->available = TRUE;
1028 g_hash_table_insert(modem_hash, g_strdup(path), modem);
1030 dbus_message_iter_recurse(properties, &dict);
1032 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1033 DBusMessageIter entry, value;
1036 dbus_message_iter_recurse(&dict, &entry);
1037 dbus_message_iter_get_basic(&entry, &key);
1039 dbus_message_iter_next(&entry);
1040 dbus_message_iter_recurse(&entry, &value);
1042 if (g_str_equal(key, "Powered") == TRUE)
1043 dbus_message_iter_get_basic(&value, &powered);
1044 else if (g_str_equal(key, "Online") == TRUE) {
1046 dbus_message_iter_get_basic(&value, &online);
1047 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1048 has_sim = modem_has_sim(&value);
1049 has_reg = modem_has_reg(&value);
1050 has_gprs = modem_has_gprs(&value);
1053 dbus_message_iter_next(&dict);
1057 modem_change_powered(path, TRUE);
1059 modem->has_sim = has_sim;
1060 modem->has_reg = has_reg;
1061 modem->has_gprs = has_gprs;
1063 update_modem_online(modem, online);
1069 static void manager_modems_reply(DBusPendingCall *call, void *user_data)
1073 DBusMessageIter array, dict;
1077 reply = dbus_pending_call_steal_reply(call);
1079 if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
1082 dbus_error_init(&error);
1084 if (dbus_set_error_from_message(&error, reply)) {
1085 connman_error("ModemManager.GetModems() %s %s",
1086 error.name, error.message);
1087 dbus_error_free(&error);
1091 if (dbus_message_iter_init(reply, &array) == FALSE)
1094 dbus_message_iter_recurse(&array, &dict);
1096 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) {
1097 DBusMessageIter value, properties;
1098 const char *modem_path;
1100 dbus_message_iter_recurse(&dict, &value);
1101 dbus_message_iter_get_basic(&value, &modem_path);
1103 dbus_message_iter_next(&value);
1104 dbus_message_iter_recurse(&value, &properties);
1107 add_modem(modem_path, &properties);
1109 dbus_message_iter_next(&dict);
1113 dbus_message_unref(reply);
1115 dbus_pending_call_unref(call);
1118 static void ofono_connect(DBusConnection *connection, void *user_data)
1120 DBG("connection %p", connection);
1122 modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1123 g_free, remove_modem);
1125 network_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
1126 NULL, remove_network);
1128 call_ofono("/", OFONO_MANAGER_INTERFACE, GET_MODEMS,
1129 manager_modems_reply, NULL, NULL,
1133 static void ofono_disconnect(DBusConnection *connection, void *user_data)
1135 DBG("connection %p", connection);
1137 if (modem_hash == NULL)
1140 g_hash_table_destroy(modem_hash);
1145 static gboolean modem_changed(DBusConnection *connection, DBusMessage *message,
1148 const char *path = dbus_message_get_path(message);
1149 struct modem_data *modem;
1150 DBusMessageIter iter, value;
1153 DBG("path %s", path);
1155 modem = g_hash_table_lookup(modem_hash, path);
1159 if (dbus_message_iter_init(message, &iter) == FALSE)
1162 dbus_message_iter_get_basic(&iter, &key);
1164 dbus_message_iter_next(&iter);
1165 dbus_message_iter_recurse(&iter, &value);
1167 if (g_str_equal(key, "Powered") == TRUE) {
1168 dbus_bool_t powered;
1170 dbus_message_iter_get_basic(&value, &powered);
1171 if (powered == TRUE)
1174 modem->has_sim = FALSE;
1175 modem->has_reg = FALSE;
1176 modem->has_gprs = FALSE;
1178 modem_remove_device(modem);
1179 } else if (g_str_equal(key, "Online") == TRUE) {
1182 dbus_message_iter_get_basic(&value, &online);
1184 update_modem_online(modem, online);
1185 } else if (g_str_equal(key, "Interfaces") == TRUE) {
1186 gboolean has_sim = modem_has_sim(&value);
1187 gboolean has_reg = modem_has_reg(&value);
1188 gboolean added_reg = has_reg && !modem->has_reg;
1189 gboolean has_gprs = modem_has_gprs(&value);
1190 gboolean added_gprs = has_gprs && !modem->has_gprs;
1192 modem->has_sim = has_sim;
1193 modem->has_reg = has_reg;
1194 modem->has_gprs = has_gprs;
1196 if (modem->device == NULL) {
1198 get_imsi(modem->path);
1199 } else if (!has_sim) {
1200 modem_remove_device(modem);
1203 check_registration(modem);
1205 gprs_change_powered(modem->path, TRUE);
1212 static gboolean sim_changed(DBusConnection *connection, DBusMessage *message,
1215 const char *path = dbus_message_get_path(message);
1216 struct modem_data *modem;
1217 DBusMessageIter iter, value;
1220 DBG("path %s", path);
1222 modem = g_hash_table_lookup(modem_hash, path);
1226 if (dbus_message_iter_init(message, &iter) == FALSE)
1229 dbus_message_iter_get_basic(&iter, &key);
1231 dbus_message_iter_next(&iter);
1232 dbus_message_iter_recurse(&iter, &value);
1234 if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
1237 dbus_message_iter_get_basic(&value, &imsi);
1239 add_device(path, imsi);
1240 } else if (g_str_equal(key, "Present") == TRUE) {
1241 dbus_bool_t present;
1243 dbus_message_iter_get_basic(&value, &present);
1248 if (modem->device != NULL)
1249 modem_remove_device(modem);
1251 modem->has_gprs = FALSE;
1252 modem->has_reg = FALSE;
1258 static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
1261 const char *path = dbus_message_get_path(message);
1262 struct modem_data *modem;
1263 DBusMessageIter iter, value;
1266 DBG("path %s", path);
1268 modem = g_hash_table_lookup(modem_hash, path);
1272 if (dbus_message_iter_init(message, &iter) == FALSE)
1275 dbus_message_iter_get_basic(&iter, &key);
1277 dbus_message_iter_next(&iter);
1278 dbus_message_iter_recurse(&iter, &value);
1280 if (g_str_equal(key, "Attached") == TRUE) {
1281 dbus_bool_t attached;
1283 dbus_message_iter_get_basic(&value, &attached);
1285 DBG("Attached %d", attached);
1287 if (attached == TRUE)
1288 check_networks(modem);
1289 else if (modem->device != NULL)
1290 connman_device_remove_all_networks(modem->device);
1297 static gboolean modem_added(DBusConnection *connection,
1298 DBusMessage *message, void *user_data)
1303 static gboolean modem_removed(DBusConnection *connection,
1304 DBusMessage *message, void *user_data)
1310 static void get_dns(DBusMessageIter *array, struct connman_element *parent)
1312 DBusMessageIter entry;
1313 gchar *nameserver = NULL, *nameserver_old = NULL;
1317 dbus_message_iter_recurse(array, &entry);
1319 while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
1322 dbus_message_iter_get_basic(&entry, &dns);
1326 if (nameserver == NULL) {
1328 nameserver = g_strdup(dns);
1331 nameserver_old = nameserver;
1332 nameserver = g_strdup_printf("%s %s",
1333 nameserver_old, dns);
1334 g_free(nameserver_old);
1337 dbus_message_iter_next(&entry);
1340 parent->ipv4.nameserver = nameserver;
1343 static void update_settings(DBusMessageIter *array,
1344 struct connman_network *network)
1346 struct connman_element *parent = connman_network_get_element(network);
1347 DBusMessageIter dict;
1348 const char *interface = NULL;
1350 DBG("network %p", network);
1352 if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
1355 dbus_message_iter_recurse(array, &dict);
1357 while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1358 DBusMessageIter entry, value;
1361 dbus_message_iter_recurse(&dict, &entry);
1362 dbus_message_iter_get_basic(&entry, &key);
1366 dbus_message_iter_next(&entry);
1367 dbus_message_iter_recurse(&entry, &value);
1369 if (g_str_equal(key, "Interface") == TRUE) {
1372 dbus_message_iter_get_basic(&value, &interface);
1374 DBG("interface %s", interface);
1376 index = connman_inet_ifindex(interface);
1378 connman_network_set_index(network, index);
1380 connman_error("Can not find interface %s",
1384 } else if (g_str_equal(key, "Method") == TRUE) {
1387 dbus_message_iter_get_basic(&value, &method);
1388 if (g_strcmp0(method, "static") == 0) {
1390 parent->ipv4.method =
1391 CONNMAN_IPCONFIG_METHOD_FIXED;
1392 } else if (g_strcmp0(method, "dhcp") == 0) {
1394 parent->ipv4.method =
1395 CONNMAN_IPCONFIG_METHOD_DHCP;
1398 } else if (g_str_equal(key, "Address") == TRUE) {
1399 const char *address;
1401 dbus_message_iter_get_basic(&value, &address);
1403 DBG("address %s", address);
1405 parent->ipv4.address = g_strdup(address);
1406 } else if (g_str_equal(key, "Netmask") == TRUE) {
1407 const char *netmask;
1409 dbus_message_iter_get_basic(&value, &netmask);
1411 DBG("netmask %s", netmask);
1413 parent->ipv4.netmask = g_strdup(netmask);
1414 } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
1416 get_dns(&value, parent);
1417 } else if (g_str_equal(key, "Gateway") == TRUE) {
1418 const char *gateway;
1420 dbus_message_iter_get_basic(&value, &gateway);
1422 DBG("gateway %s", gateway);
1424 parent->ipv4.gateway = g_strdup(gateway);
1427 dbus_message_iter_next(&dict);
1430 /* deactive, oFono send NULL inteface before deactive signal */
1431 if (interface == NULL)
1432 connman_network_set_index(network, -1);
1435 static void cleanup_ipconfig(struct connman_network *network)
1437 struct connman_element *parent = connman_network_get_element(network);
1439 g_free(parent->ipv4.address);
1440 parent->ipv4.address = NULL;
1442 g_free(parent->ipv4.netmask);
1443 parent->ipv4.netmask = NULL;
1445 g_free(parent->ipv4.nameserver);
1446 parent->ipv4.nameserver = NULL;
1448 g_free(parent->ipv4.gateway);
1449 parent->ipv4.gateway = NULL;
1451 parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
1455 static void set_connected(struct connman_network *network,
1456 connman_bool_t connected)
1458 struct connman_element *parent = connman_network_get_element(network);
1459 enum connman_ipconfig_method method = parent->ipv4.method;
1462 case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
1463 case CONNMAN_IPCONFIG_METHOD_OFF:
1464 case CONNMAN_IPCONFIG_METHOD_MANUAL:
1467 case CONNMAN_IPCONFIG_METHOD_FIXED:
1468 connman_network_set_method(network, method);
1470 if (connected == FALSE)
1471 cleanup_ipconfig(network);
1473 connman_network_set_connected(network, connected);
1476 case CONNMAN_IPCONFIG_METHOD_DHCP:
1477 connman_network_set_method(network, method);
1479 connman_network_set_connected(network, connected);
1484 static gboolean context_changed(DBusConnection *connection,
1485 DBusMessage *message, void *user_data)
1487 const char *path = dbus_message_get_path(message);
1488 struct connman_network *network;
1489 DBusMessageIter iter, value;
1492 DBG("path %s", path);
1494 network = g_hash_table_lookup(network_hash, path);
1495 if (network == NULL)
1498 if (!pending_network_is_available(network)) {
1499 remove_network(network);
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, "Settings") == TRUE)
1512 update_settings(&value, network);
1513 else if (g_str_equal(key, "Active") == TRUE) {
1516 dbus_message_iter_get_basic(&value, &active);
1518 set_connected(network, active);
1525 static guint reg_watch;
1526 static guint sim_watch;
1527 static guint gprs_watch;
1528 static guint modem_watch;
1529 static guint modem_added_watch;
1530 static guint modem_removed_watch;
1531 static guint context_watch;
1533 static int ofono_init(void)
1537 connection = connman_dbus_get_connection();
1538 if (connection == NULL)
1541 watch = g_dbus_add_service_watch(connection, OFONO_SERVICE,
1542 ofono_connect, ofono_disconnect, NULL, NULL);
1544 reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1545 OFONO_REGISTRATION_INTERFACE,
1550 gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1551 OFONO_GPRS_INTERFACE,
1556 modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1557 OFONO_MODEM_INTERFACE,
1562 sim_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1563 OFONO_SIM_INTERFACE,
1568 modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1569 OFONO_MANAGER_INTERFACE,
1574 modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1575 OFONO_MANAGER_INTERFACE,
1580 context_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
1581 OFONO_CONTEXT_INTERFACE,
1586 if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
1587 reg_watch == 0 || sim_watch == 0 ||
1588 modem_added_watch == 0 || modem_removed_watch == 0 ||
1589 context_watch == 0) {
1594 err = connman_network_driver_register(&network_driver);
1598 err = connman_device_driver_register(&modem_driver);
1600 connman_network_driver_unregister(&network_driver);
1607 g_dbus_remove_watch(connection, watch);
1608 g_dbus_remove_watch(connection, sim_watch);
1609 g_dbus_remove_watch(connection, reg_watch);
1610 g_dbus_remove_watch(connection, gprs_watch);
1611 g_dbus_remove_watch(connection, modem_watch);
1612 g_dbus_remove_watch(connection, modem_added_watch);
1613 g_dbus_remove_watch(connection, modem_removed_watch);
1614 g_dbus_remove_watch(connection, context_watch);
1616 dbus_connection_unref(connection);
1621 static void ofono_exit(void)
1623 g_dbus_remove_watch(connection, watch);
1624 g_dbus_remove_watch(connection, sim_watch);
1625 g_dbus_remove_watch(connection, reg_watch);
1626 g_dbus_remove_watch(connection, gprs_watch);
1627 g_dbus_remove_watch(connection, modem_watch);
1628 g_dbus_remove_watch(connection, modem_added_watch);
1629 g_dbus_remove_watch(connection, modem_removed_watch);
1630 g_dbus_remove_watch(connection, context_watch);
1632 ofono_disconnect(connection, NULL);
1634 connman_device_driver_unregister(&modem_driver);
1635 connman_network_driver_unregister(&network_driver);
1637 dbus_connection_unref(connection);
1640 CONNMAN_PLUGIN_DEFINE(ofono, "oFono telephony plugin", VERSION,
1641 CONNMAN_PLUGIN_PRIORITY_DEFAULT, ofono_init, ofono_exit)