X-Git-Url: http://review.tizen.org/git/?a=blobdiff_plain;f=plugins%2Fofono.c;h=f15c36d0955d4ebca91e7103571539d1fc107129;hb=1cb80dc2f268a341938430dfe135030c0a9f6ce5;hp=2af555d6b27a6d6ac0d45a6073ab71fb59edda8a;hpb=5db8e213f1e203156fa7db237381a2e715e5788b;p=framework%2Fconnectivity%2Fconnman.git diff --git a/plugins/ofono.c b/plugins/ofono.c index 2af555d..f15c36d 100644 --- a/plugins/ofono.c +++ b/plugins/ofono.c @@ -4,6 +4,7 @@ * * Copyright (C) 2007-2010 Intel Corporation. All rights reserved. * Copyright (C) 2010 Nokia Corporation and/or its subsidiary(-ies). + * Copyright (C) 2011 BWM Car IT GmbH. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as @@ -29,903 +30,1147 @@ #include #include +#include #define CONNMAN_API_SUBJECT_TO_CHANGE #include -#include #include #include -#include #include -#include +#include #include +#include #include "mcc.h" +#define uninitialized_var(x) x = x + #define OFONO_SERVICE "org.ofono" #define OFONO_MANAGER_INTERFACE OFONO_SERVICE ".Manager" #define OFONO_MODEM_INTERFACE OFONO_SERVICE ".Modem" -#define OFONO_GPRS_INTERFACE OFONO_SERVICE ".ConnectionManager" -#define OFONO_CONTEXT_INTERFACE OFONO_SERVICE ".ConnectionContext" #define OFONO_SIM_INTERFACE OFONO_SERVICE ".SimManager" -#define OFONO_REGISTRATION_INTERFACE OFONO_SERVICE ".NetworkRegistration" +#define OFONO_NETREG_INTERFACE OFONO_SERVICE ".NetworkRegistration" +#define OFONO_CM_INTERFACE OFONO_SERVICE ".ConnectionManager" +#define OFONO_CONTEXT_INTERFACE OFONO_SERVICE ".ConnectionContext" +#define OFONO_CDMA_CM_INTERFACE OFONO_SERVICE ".cdma.ConnectionManager" +#define OFONO_CDMA_NETREG_INTERFACE OFONO_SERVICE ".cdma.NetworkRegistration" +#define MODEM_ADDED "ModemAdded" +#define MODEM_REMOVED "ModemRemoved" #define PROPERTY_CHANGED "PropertyChanged" -#define GET_PROPERTIES "GetProperties" -#define SET_PROPERTY "SetProperty" #define CONTEXT_ADDED "ContextAdded" #define CONTEXT_REMOVED "ContextRemoved" -#define ADD_CONTEXT "AddContext" -#define GET_MODEMS "GetModems" -#define MODEM_ADDED "ModemAdded" -#define MODEM_REMOVED "ModemRemoved" +#define GET_PROPERTIES "GetProperties" +#define SET_PROPERTY "SetProperty" +#define GET_MODEMS "GetModems" +#define GET_CONTEXTS "GetContexts" #define TIMEOUT 40000 +enum ofono_api { + OFONO_API_SIM = 0x1, + OFONO_API_NETREG = 0x2, + OFONO_API_CM = 0x4, + OFONO_API_CDMA_NETREG = 0x8, + OFONO_API_CDMA_CM = 0x10, +}; + +/* + * The way this plugin works is following: + * + * powered -> SubscriberIdentity or Online = True -> gprs, context -> + * attached -> netreg -> ready + * + * Enabling and disabling modems are steered through the rfkill + * interface. That means when ConnMan toggles the rfkill bit oFono + * will add or remove the modems. + * + * ConnMan will always power up (set Powered and Online) the + * modems. No need to power them down because this will be done + * through the rfkill inteface. + */ + static DBusConnection *connection; -static GHashTable *modem_hash = NULL; +static GHashTable *modem_hash; +static GHashTable *context_hash; + +struct network_context { + char *path; + int index; + + enum connman_ipconfig_method ipv4_method; + struct connman_ipaddress *ipv4_address; + char *ipv4_nameservers; -static GHashTable *network_hash; + enum connman_ipconfig_method ipv6_method; + struct connman_ipaddress *ipv6_address; + char *ipv6_nameservers; +}; struct modem_data { char *path; + struct connman_device *device; - gboolean has_sim; - gboolean has_reg; - gboolean has_gprs; - gboolean available; - gboolean pending_online; - gboolean requested_online; - gboolean online; - - uint8_t strength, has_strength; + struct connman_network *network; + + struct network_context *context; + + /* Modem Interface */ + char *serial; + connman_bool_t powered; + connman_bool_t online; + uint8_t interfaces; + connman_bool_t ignore; + + connman_bool_t set_powered; + + /* CDMA ConnectionManager Interface */ + connman_bool_t cdma_cm_powered; + + /* ConnectionManager Interface */ + connman_bool_t attached; + connman_bool_t cm_powered; + + /* ConnectionContext Interface */ + connman_bool_t active; + connman_bool_t set_active; + + /* SimManager Interface */ + char *imsi; + + /* Netreg Interface */ + char *name; + uint8_t strength; + uint8_t data_strength; /* 1xEVDO signal strength */ + connman_bool_t roaming; + + /* pending calls */ + DBusPendingCall *call_set_property; + DBusPendingCall *call_get_properties; + DBusPendingCall *call_get_contexts; }; -static int modem_probe(struct connman_device *device) +static const char *api2string(enum ofono_api api) { - DBG("device %p", device); + switch (api) { + case OFONO_API_SIM: + return "sim"; + case OFONO_API_NETREG: + return "netreg"; + case OFONO_API_CM: + return "cm"; + case OFONO_API_CDMA_NETREG: + return "cdma-netreg"; + case OFONO_API_CDMA_CM: + return "cmda-cm"; + } - return 0; + return "unknown"; } -static void modem_remove(struct connman_device *device) +static char *get_ident(const char *path) { - DBG("device %p", device); + char *pos; + + if (*path != '/') + return NULL; + + pos = strrchr(path, '/'); + if (pos == NULL) + return NULL; + + return pos + 1; } -static int call_ofono(const char *path, - const char *interface, const char *method, - DBusPendingCallNotifyFunction notify, void *user_data, - DBusFreeFunction free_function, - int type, ...) +static struct network_context *network_context_alloc(const char *path) { - DBusMessage *message; - DBusPendingCall *call; - dbus_bool_t ok; - va_list va; + struct network_context *context; - DBG("path %s %s.%s", path, interface, method); + context = g_try_new0(struct network_context, 1); + if (context == NULL) + return NULL; - if (path == NULL) - return -EINVAL; + context->path = g_strdup(path); + context->index = -1; - message = dbus_message_new_method_call(OFONO_SERVICE, path, - interface, method); - if (message == NULL) - return -ENOMEM; + context->ipv4_method = CONNMAN_IPCONFIG_METHOD_UNKNOWN; + context->ipv4_address = NULL; + context->ipv4_nameservers = NULL; - dbus_message_set_auto_start(message, FALSE); + context->ipv6_method = CONNMAN_IPCONFIG_METHOD_UNKNOWN; + context->ipv6_address = NULL; + context->ipv6_nameservers = NULL; - va_start(va, type); - ok = dbus_message_append_args_valist(message, type, va); - va_end(va); + return context; +} - if (!ok) - return -ENOMEM; +static void network_context_free(struct network_context *context) +{ + g_free(context->path); - if (dbus_connection_send_with_reply(connection, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to call %s.%s", interface, method); - dbus_message_unref(message); - return -EINVAL; + connman_ipaddress_free(context->ipv4_address); + g_free(context->ipv4_nameservers); + + connman_ipaddress_free(context->ipv6_address); + g_free(context->ipv6_nameservers); + + free(context); +} + +static void set_connected(struct modem_data *modem) +{ + connman_bool_t setip = FALSE; + + DBG("%s", modem->path); + + connman_network_set_index(modem->network, modem->context->index); + + switch (modem->context->ipv4_method) { + case CONNMAN_IPCONFIG_METHOD_UNKNOWN: + case CONNMAN_IPCONFIG_METHOD_OFF: + case CONNMAN_IPCONFIG_METHOD_MANUAL: + case CONNMAN_IPCONFIG_METHOD_AUTO: + break; + + case CONNMAN_IPCONFIG_METHOD_FIXED: + connman_network_set_ipv4_method(modem->network, + modem->context->ipv4_method); + connman_network_set_ipaddress(modem->network, + modem->context->ipv4_address); + connman_network_set_nameservers(modem->network, + modem->context->ipv4_nameservers); + setip = TRUE; + break; + + case CONNMAN_IPCONFIG_METHOD_DHCP: + connman_network_set_ipv4_method(modem->network, + modem->context->ipv4_method); + setip = TRUE; + break; } - if (call == NULL) { - connman_error("D-Bus connection not available"); - dbus_message_unref(message); - return -EINVAL; + switch (modem->context->ipv6_method) { + case CONNMAN_IPCONFIG_METHOD_UNKNOWN: + case CONNMAN_IPCONFIG_METHOD_OFF: + case CONNMAN_IPCONFIG_METHOD_MANUAL: + case CONNMAN_IPCONFIG_METHOD_DHCP: + case CONNMAN_IPCONFIG_METHOD_AUTO: + break; + + case CONNMAN_IPCONFIG_METHOD_FIXED: + connman_network_set_ipv6_method(modem->network, + modem->context->ipv6_method); + connman_network_set_ipaddress(modem->network, + modem->context->ipv6_address); + setip = TRUE; + break; } - dbus_pending_call_set_notify(call, notify, user_data, free_function); + if (setip == TRUE) + connman_network_set_connected(modem->network, TRUE); +} - dbus_message_unref(message); +static void set_disconnected(struct modem_data *modem) +{ + DBG("%s", modem->path); - return -EINPROGRESS; + connman_network_set_connected(modem->network, FALSE); } +typedef void (*set_property_cb)(struct modem_data *data, + connman_bool_t success); +typedef void (*get_properties_cb)(struct modem_data *data, + DBusMessageIter *dict); + +struct property_info { + struct modem_data *modem; + const char *path; + const char *interface; + const char *property; + set_property_cb set_property_cb; + get_properties_cb get_properties_cb; +}; + static void set_property_reply(DBusPendingCall *call, void *user_data) { + struct property_info *info = user_data; DBusMessage *reply; DBusError error; - char const *name = user_data; + connman_bool_t success = TRUE; - DBG(""); + DBG("%s path %s %s.%s", info->modem->path, + info->path, info->interface, info->property); + + info->modem->call_set_property = NULL; dbus_error_init(&error); reply = dbus_pending_call_steal_reply(call); if (dbus_set_error_from_message(&error, reply)) { - connman_error("SetProperty(%s) %s %s", name, + connman_error("Failed to change property: %s %s.%s: %s %s", + info->path, info->interface, info->property, error.name, error.message); dbus_error_free(&error); + success = FALSE; } + if (info->set_property_cb != NULL) + (*info->set_property_cb)(info->modem, success); + dbus_message_unref(reply); dbus_pending_call_unref(call); } -static int set_property(const char *path, const char *interface, +static int set_property(struct modem_data *modem, + const char *path, const char *interface, const char *property, int type, void *value, - DBusPendingCallNotifyFunction notify, void *user_data, - DBusFreeFunction free_function) + set_property_cb notify) { DBusMessage *message; DBusMessageIter iter; - DBusPendingCall *call; + struct property_info *info; - DBG("path %s %s.%s", path, interface, property); + DBG("%s path %s %s.%s", modem->path, path, interface, property); - g_assert(notify == NULL ? free_function == NULL : 1); + if (modem->call_set_property != NULL) { + DBG("Cancel pending SetProperty"); - if (path == NULL) - return -EINVAL; + dbus_pending_call_cancel(modem->call_set_property); + modem->call_set_property = NULL; + } message = dbus_message_new_method_call(OFONO_SERVICE, path, interface, SET_PROPERTY); if (message == NULL) return -ENOMEM; - dbus_message_set_auto_start(message, FALSE); - dbus_message_iter_init_append(message, &iter); connman_dbus_property_append_basic(&iter, property, type, value); if (dbus_connection_send_with_reply(connection, message, - &call, TIMEOUT) == FALSE) { - connman_error("Failed to change \"%s\" property on %s", - property, interface); + &modem->call_set_property, TIMEOUT) == FALSE) { + connman_error("Failed to change property: %s %s.%s", + path, interface, property); dbus_message_unref(message); return -EINVAL; } - if (call == NULL) { + if (modem->call_set_property == NULL) { connman_error("D-Bus connection not available"); dbus_message_unref(message); return -EINVAL; } - if (notify == NULL) { - notify = set_property_reply; - user_data = (void *)property; - free_function = NULL; + info = g_try_new0(struct property_info, 1); + if (info == NULL) { + dbus_message_unref(message); + return -ENOMEM; } - dbus_pending_call_set_notify(call, notify, user_data, free_function); + info->modem = modem; + info->path = path; + info->interface = interface; + info->property = property; + info->set_property_cb = notify; + + dbus_pending_call_set_notify(modem->call_set_property, + set_property_reply, info, g_free); dbus_message_unref(message); return -EINPROGRESS; } -static void update_modem_online(struct modem_data *modem, - connman_bool_t online) -{ - DBG("modem %p path %s online %d", modem, modem->path, online); - - modem->online = online; - modem->requested_online = online; - modem->pending_online = FALSE; - - if (modem->device) - connman_device_set_powered(modem->device, online); -} - -static void set_online_reply(DBusPendingCall *call, void *user_data) +static void get_properties_reply(DBusPendingCall *call, void *user_data) { - struct modem_data *modem; + struct property_info *info = user_data; + DBusMessageIter array, dict; DBusMessage *reply; DBusError error; - gboolean result; - DBG("path %s", (char *)user_data); + DBG("%s path %s %s", info->modem->path, info->path, info->interface); - if (modem_hash == NULL) - return; + info->modem->call_get_properties = NULL; - modem = g_hash_table_lookup(modem_hash, user_data); - if (modem == NULL) - return; + dbus_error_init(&error); reply = dbus_pending_call_steal_reply(call); - dbus_error_init(&error); - if (dbus_set_error_from_message(&error, reply)) { - connman_error("SetProperty(Online) %s %s", + connman_error("Failed to get properties: %s %s: %s %s", + info->path, info->interface, error.name, error.message); dbus_error_free(&error); - result = modem->online; - } else - result = modem->requested_online; + goto done; + } + + if (dbus_message_iter_init(reply, &array) == FALSE) + goto done; + + if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY) + goto done; + + dbus_message_iter_recurse(&array, &dict); + + if (info->get_properties_cb != NULL) + (*info->get_properties_cb)(info->modem, &dict); - if (modem->pending_online) - update_modem_online(modem, result); +done: dbus_message_unref(reply); dbus_pending_call_unref(call); } -static int modem_change_online(char const *path, dbus_bool_t online) +static int get_properties(const char *path, const char *interface, + get_properties_cb notify, + struct modem_data *modem) { - struct modem_data *modem = g_hash_table_lookup(modem_hash, path); + DBusMessage *message; + struct property_info *info; - if (modem == NULL) - return -ENODEV; + DBG("%s path %s %s", modem->path, path, interface); - if (modem->online == (gboolean)online) - return -EALREADY; + if (modem->call_get_properties != NULL) { + connman_error("Pending GetProperties"); + return -EBUSY; + } - modem->requested_online = (gboolean)online; + message = dbus_message_new_method_call(OFONO_SERVICE, path, + interface, GET_PROPERTIES); + if (message == NULL) + return -ENOMEM; - return set_property(path, OFONO_MODEM_INTERFACE, "Online", - DBUS_TYPE_BOOLEAN, &online, - set_online_reply, - (void *)g_strdup(path), g_free); -} + if (dbus_connection_send_with_reply(connection, message, + &modem->call_get_properties, TIMEOUT) == FALSE) { + connman_error("Failed to call %s.GetProperties()", interface); + dbus_message_unref(message); + return -EINVAL; + } -static int modem_enable(struct connman_device *device) -{ - const char *path = connman_device_get_string(device, "Path"); + if (modem->call_get_properties == NULL) { + connman_error("D-Bus connection not available"); + dbus_message_unref(message); + return -EINVAL; + } - DBG("device %p, path, %s", device, path); + info = g_try_new0(struct property_info, 1); + if (info == NULL) { + dbus_message_unref(message); + return -ENOMEM; + } - return modem_change_online(path, TRUE); -} + info->modem = modem; + info->path = path; + info->interface = interface; + info->get_properties_cb = notify; -static int modem_disable(struct connman_device *device) -{ - const char *path = connman_device_get_string(device, "Path"); + dbus_pending_call_set_notify(modem->call_get_properties, + get_properties_reply, info, g_free); - DBG("device %p path %s", device, path); + dbus_message_unref(message); - return modem_change_online(path, FALSE); + return -EINPROGRESS; } -static struct connman_device_driver modem_driver = { - .name = "modem", - .type = CONNMAN_DEVICE_TYPE_CELLULAR, - .probe = modem_probe, - .remove = modem_remove, - .enable = modem_enable, - .disable = modem_disable, -}; - -static void modem_remove_device(struct modem_data *modem) +static void context_set_active_reply(struct modem_data *modem, + connman_bool_t success) { - DBG("modem %p path %s device %p", modem, modem->path, modem->device); + DBG("%s", modem->path); - if (modem->device == NULL) + if (success == TRUE) { + /* + * Don't handle do anything on success here. oFono will send + * the change via PropertyChanged singal. + */ return; + } - connman_device_remove_all_networks(modem->device); - connman_device_unregister(modem->device); - connman_device_unref(modem->device); + /* + * Active = True might fail due a timeout. That means oFono + * still tries to go online. If we retry to set Active = True, + * we just get a InProgress error message. Should we power + * cycle the modem in such cases? + */ + + if (modem->network == NULL) { + /* + * In the case where we power down the device + * we don't wait for the reply, therefore the network + * might already be gone. + */ + return; + } - modem->device = NULL; + connman_network_set_error(modem->network, + CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL); } -static void remove_modem(gpointer data) +static int context_set_active(struct modem_data *modem, + connman_bool_t active) { - struct modem_data *modem = data; + int err; - modem_remove_device(modem); + DBG("%s active %d", modem->path, active); - g_free(modem->path); + err = set_property(modem, modem->context->path, + OFONO_CONTEXT_INTERFACE, + "Active", DBUS_TYPE_BOOLEAN, + &active, + context_set_active_reply); - g_free(modem); -} + if (active == FALSE && err == -EINPROGRESS) + return 0; -static void remove_network(gpointer data) -{ - connman_network_unref(data); + return err; } -static char *get_ident(const char *path) +static void cdma_cm_set_powered_reply(struct modem_data *modem, + connman_bool_t success) { - char *pos; + DBG("%s", modem->path); - if (*path != '/') - return NULL; + if (success == TRUE) { + /* + * Don't handle do anything on success here. oFono will send + * the change via PropertyChanged singal. + */ + return; + } - pos = strrchr(path, '/'); - if (pos == NULL) - return NULL; + /* + * Powered = True might fail due a timeout. That means oFono + * still tries to go online. If we retry to set Powered = True, + * we just get a InProgress error message. Should we power + * cycle the modem in such cases? + */ + + if (modem->network == NULL) { + /* + * In the case where we power down the device + * we don't wait for the reply, therefore the network + * might already be gone. + */ + return; + } - return pos + 1; + connman_network_set_error(modem->network, + CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL); } -static void create_service(struct connman_network *network) +static int cdma_cm_set_powered(struct modem_data *modem, connman_bool_t powered) { - const char *path; - char *group; + int err; - DBG(""); + DBG("%s powered %d", modem->path, powered); - path = connman_network_get_string(network, "Path"); + err = set_property(modem, modem->path, OFONO_CDMA_CM_INTERFACE, + "Powered", DBUS_TYPE_BOOLEAN, + &powered, + cdma_cm_set_powered_reply); - group = get_ident(path); + if (powered == FALSE && err == -EINPROGRESS) + return 0; - connman_network_set_group(network, group); + return err; } -static int network_probe(struct connman_network *network) +static int modem_set_online(struct modem_data *modem, connman_bool_t online) { - return 0; + DBG("%s online %d", modem->path, online); + + return set_property(modem, modem->path, + OFONO_MODEM_INTERFACE, + "Online", DBUS_TYPE_BOOLEAN, + &online, + NULL); } -static gboolean pending_network_is_available(struct connman_network *network) +static int cm_set_powered(struct modem_data *modem, connman_bool_t powered) { - /* Modem or network may be removed */ - if (network == NULL || connman_network_get_device(network) == NULL) { - DBG("Modem or network was removed"); - return FALSE; - } + int err; - return TRUE; -} + DBG("%s powered %d", modem->path, powered); -static void set_active_reply(DBusPendingCall *call, void *user_data) -{ - char const *path = user_data; - DBusMessage *reply; - DBusError error; - struct connman_network *network; + err = set_property(modem, modem->path, + OFONO_CM_INTERFACE, + "Powered", DBUS_TYPE_BOOLEAN, + &powered, + NULL); - network = g_hash_table_lookup(network_hash, path); + if (powered == FALSE && err == -EINPROGRESS) + return 0; - DBG("path %s network %p", path, network); + return err; +} - reply = dbus_pending_call_steal_reply(call); +static int modem_set_powered(struct modem_data *modem, connman_bool_t powered) +{ + int err; - if (!pending_network_is_available(network)) - goto done; + DBG("%s powered %d", modem->path, powered); - dbus_error_init(&error); + modem->set_powered = powered; - if (dbus_set_error_from_message(&error, reply)) { - connman_error("SetProperty(Active) %s %s", - error.name, error.message); + err = set_property(modem, modem->path, + OFONO_MODEM_INTERFACE, + "Powered", DBUS_TYPE_BOOLEAN, + &powered, + NULL); - if (connman_network_get_index(network) < 0) - connman_network_set_error(network, - CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL); + if (powered == FALSE && err == -EINPROGRESS) + return 0; - dbus_error_free(&error); - } + return err; +} -done: - dbus_message_unref(reply); +static connman_bool_t has_interface(uint8_t interfaces, + enum ofono_api api) +{ + if ((interfaces & api) == api) + return TRUE; - dbus_pending_call_unref(call); + return FALSE; } -static int set_network_active(struct connman_network *network, - dbus_bool_t active) +static uint8_t extract_interfaces(DBusMessageIter *array) { - int error; + DBusMessageIter entry; + uint8_t interfaces = 0; + + dbus_message_iter_recurse(array, &entry); - const char *path = connman_network_get_string(network, "Path"); + while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) { + const char *name; - DBG("network %p, path %s, active %d", network, path, active); + dbus_message_iter_get_basic(&entry, &name); - error = set_property(path, OFONO_CONTEXT_INTERFACE, - "Active", DBUS_TYPE_BOOLEAN, &active, - set_active_reply, g_strdup(path), NULL); + if (g_str_equal(name, OFONO_SIM_INTERFACE) == TRUE) + interfaces |= OFONO_API_SIM; + else if (g_str_equal(name, OFONO_NETREG_INTERFACE) == TRUE) + interfaces |= OFONO_API_NETREG; + else if (g_str_equal(name, OFONO_CM_INTERFACE) == TRUE) + interfaces |= OFONO_API_CM; + else if (g_str_equal(name, OFONO_CDMA_CM_INTERFACE) == TRUE) + interfaces |= OFONO_API_CDMA_CM; + else if (g_str_equal(name, OFONO_CDMA_NETREG_INTERFACE) == TRUE) + interfaces |= OFONO_API_CDMA_NETREG; - if (active == FALSE && error == -EINPROGRESS) - error = 0; + dbus_message_iter_next(&entry); + } - return error; + return interfaces; } -static void set_apn(struct connman_network *network) +static char *extract_nameservers(DBusMessageIter *array) { - const char *apn, *path; + DBusMessageIter entry; + char *nameservers = NULL; + char *tmp; - apn = connman_network_get_string(network, "Cellular.APN"); - if (apn == NULL) - return; + dbus_message_iter_recurse(array, &entry); - path = connman_network_get_string(network, "Path"); - if (path == NULL) - return; + while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) { + const char *nameserver; + + dbus_message_iter_get_basic(&entry, &nameserver); + + if (nameservers == NULL) { + nameservers = g_strdup(nameserver); + } else { + tmp = nameservers; + nameservers = g_strdup_printf("%s %s", tmp, nameserver); + g_free(tmp); + } - DBG("path %s, apn %s", path, apn); + dbus_message_iter_next(&entry); + } - set_property(path, OFONO_CONTEXT_INTERFACE, - "AccessPointName", DBUS_TYPE_STRING, &apn, - NULL, NULL, NULL); + return nameservers; } -static int network_connect(struct connman_network *network) +static void extract_ipv4_settings(DBusMessageIter *array, + struct network_context *context) { - DBG("network %p", network); + DBusMessageIter dict; + char *address = NULL, *netmask = NULL, *gateway = NULL; + char *nameservers = NULL; + const char *interface = NULL; + int index = -1; - if (connman_network_get_index(network) >= 0) - return -EISCONN; + if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) + return; - return set_network_active(network, TRUE); -} + dbus_message_iter_recurse(array, &dict); -static int network_disconnect(struct connman_network *network) -{ - DBG("network %p", network); + while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key, *val; - if (connman_network_get_index(network) < 0) - return -ENOTCONN; + dbus_message_iter_recurse(&dict, &entry); + dbus_message_iter_get_basic(&entry, &key); - return set_network_active(network, FALSE); -} + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); -static void network_remove(struct connman_network *network) -{ - char const *path = connman_network_get_string(network, "Path"); + if (g_str_equal(key, "Interface") == TRUE) { + dbus_message_iter_get_basic(&value, &interface); - DBG("network %p path %s", network, path); + DBG("Interface %s", interface); - g_hash_table_remove(network_hash, path); -} + index = connman_inet_ifindex(interface); -static int network_setup(struct connman_network *network, const char *key) -{ - if (g_strcmp0(key, "Cellular.APN") == 0) - set_apn(network); + DBG("index %d", index); + } else if (g_str_equal(key, "Method") == TRUE) { + dbus_message_iter_get_basic(&value, &val); - return 0; -} + DBG("Method %s", val); -static struct connman_network_driver network_driver = { - .name = "network", - .type = CONNMAN_NETWORK_TYPE_CELLULAR, - .probe = network_probe, - .remove = network_remove, - .connect = network_connect, - .disconnect = network_disconnect, - .setup = network_setup, -}; + if (g_strcmp0(val, "static") == 0) { + context->ipv4_method = CONNMAN_IPCONFIG_METHOD_FIXED; + } else if (g_strcmp0(val, "dhcp") == 0) { + context->ipv4_method = CONNMAN_IPCONFIG_METHOD_DHCP; + break; + } + } else if (g_str_equal(key, "Address") == TRUE) { + dbus_message_iter_get_basic(&value, &val); + + address = g_strdup(val); -static void update_settings(DBusMessageIter *array, - struct connman_network *network); + DBG("Address %s", address); + } else if (g_str_equal(key, "Netmask") == TRUE) { + dbus_message_iter_get_basic(&value, &val); -static void set_connected(struct connman_network *network, - connman_bool_t connected); + netmask = g_strdup(val); -static int add_network(struct connman_device *device, - const char *path, DBusMessageIter *dict) -{ - struct modem_data *modem = connman_device_get_data(device); - struct connman_network *network; - char *ident; - const char *hash_path; - char const *operator; - char const *reg_status; - dbus_bool_t active = FALSE; + DBG("Netmask %s", netmask); + } else if (g_str_equal(key, "DomainNameServers") == TRUE) { + nameservers = extract_nameservers(&value); - DBG("modem %p device %p path %s", modem, device, path); + DBG("Nameservers %s", nameservers); + } else if (g_str_equal(key, "Gateway") == TRUE) { + dbus_message_iter_get_basic(&value, &val); - ident = get_ident(path); + gateway = g_strdup(val); - network = connman_device_get_network(device, ident); - if (network != NULL) - return -EALREADY; + DBG("Gateway %s", gateway); + } - network = g_hash_table_lookup(network_hash, path); - if (network != NULL) { - DBG("path %p already exists with device %p", path, - connman_network_get_device(network)); - if (connman_network_get_device(network)) - return -EALREADY; - g_hash_table_remove(network_hash, path); + dbus_message_iter_next(&dict); } - network = connman_network_create(ident, CONNMAN_NETWORK_TYPE_CELLULAR); - if (network == NULL) - return -ENOMEM; + if (index < 0) + goto out; - connman_network_set_string(network, "Path", path); - hash_path = connman_network_get_string(network, "Path"); - if (hash_path == NULL) - goto error; + if (context->ipv4_method != CONNMAN_IPCONFIG_METHOD_FIXED) + goto out; - create_service(network); + context->ipv4_address = connman_ipaddress_alloc(CONNMAN_IPCONFIG_TYPE_IPV4); + if (context->ipv4_address == NULL) + goto out; - connman_network_ref(network); - g_hash_table_insert(network_hash, (char *)hash_path, network); + context->index = index; + connman_ipaddress_set_ipv4(context->ipv4_address, address, + netmask, gateway); - connman_network_set_available(network, TRUE); - connman_network_set_index(network, -1); + context->ipv4_nameservers = nameservers; - operator = connman_device_get_string(device, "Operator"); - if (operator) - connman_network_set_name(network, operator); +out: + if (context->ipv4_nameservers != nameservers) + g_free(nameservers); + + g_free(address); + g_free(netmask); + g_free(gateway); +} - if (modem->has_strength) - connman_network_set_strength(network, modem->strength); +static void extract_ipv6_settings(DBusMessageIter *array, + struct network_context *context) +{ + DBusMessageIter dict; + char *address = NULL, *gateway = NULL; + unsigned char prefix_length; + char *nameservers = NULL; + const char *interface = NULL; + int index = -1; - reg_status = connman_device_get_string(device, "RegistrationStatus"); + if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) + return; - if (!g_strcmp0(reg_status, "roaming")) - connman_network_set_roaming(network, TRUE); - else if (!g_strcmp0(reg_status, "registered")) - connman_network_set_roaming(network, FALSE); + dbus_message_iter_recurse(array, &dict); - while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { + while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) { DBusMessageIter entry, value; - const char *key; + const char *key, *val; - dbus_message_iter_recurse(dict, &entry); + dbus_message_iter_recurse(&dict, &entry); dbus_message_iter_get_basic(&entry, &key); dbus_message_iter_next(&entry); dbus_message_iter_recurse(&entry, &value); - if (g_str_equal(key, "Type")) { - const char *type; - - dbus_message_iter_get_basic(&value, &type); - if (g_strcmp0(type, "internet") != 0) { - DBG("path %p type %s", path, type); - goto error; - } - } else if (g_str_equal(key, "AccessPointName")) { - const char *ap; - - dbus_message_iter_get_basic(&value, &ap); + if (g_str_equal(key, "Interface") == TRUE) { + dbus_message_iter_get_basic(&value, &interface); - connman_network_set_string(network, "Cellular.APN", ap); - } else if (g_str_equal(key, "Settings")) - update_settings(&value, network); - else if (g_str_equal(key, "Active") == TRUE) - dbus_message_iter_get_basic(&value, &active); + DBG("Interface %s", interface); - dbus_message_iter_next(dict); - } + index = connman_inet_ifindex(interface); - if (connman_device_add_network(device, network) != 0) - goto error; + DBG("index %d", index); + } else if (g_str_equal(key, "Address") == TRUE) { + dbus_message_iter_get_basic(&value, &val); - if (active) - set_connected(network, active); + address = g_strdup(val); - return 0; + DBG("Address %s", address); + } else if (g_str_equal(key, "PrefixLength") == TRUE) { + dbus_message_iter_get_basic(&value, &prefix_length); -error: - connman_network_unref(network); - g_hash_table_remove(network_hash, hash_path); - return -EIO; -} + DBG("prefix length %d", prefix_length); + } else if (g_str_equal(key, "DomainNameServers") == TRUE) { + nameservers = extract_nameservers(&value); -static void check_networks_reply(DBusPendingCall *call, void *user_data) -{ - char *path = user_data; - struct modem_data *modem; - DBusMessage *reply; - DBusMessageIter array, entry, value, properties; + DBG("Nameservers %s", nameservers); + } else if (g_str_equal(key, "Gateway") == TRUE) { + dbus_message_iter_get_basic(&value, &val); - DBG("path %s", path); + gateway = g_strdup(val); - modem = g_hash_table_lookup(modem_hash, path); - if (modem == NULL) - return; - if (modem->device == NULL) - return; + DBG("Gateway %s", gateway); + } - reply = dbus_pending_call_steal_reply(call); + dbus_message_iter_next(&dict); + } - if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE) - goto done; + if (index < 0) + goto out; - dbus_message_iter_init(reply, &array); + context->ipv6_method = CONNMAN_IPCONFIG_METHOD_FIXED; - dbus_message_iter_recurse(&array, &entry); + context->ipv6_address = + connman_ipaddress_alloc(CONNMAN_IPCONFIG_TYPE_IPV6); + if (context->ipv6_address == NULL) + goto out; - while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRUCT) { - char const *network_path; + context->index = index; + connman_ipaddress_set_ipv6(context->ipv6_address, address, + prefix_length, gateway); - dbus_message_iter_recurse(&entry, &value); - dbus_message_iter_get_basic(&value, &network_path); + context->ipv6_nameservers = nameservers; - dbus_message_iter_next(&value); - dbus_message_iter_recurse(&value, &properties); +out: + if (context->ipv6_nameservers != nameservers) + g_free(nameservers); - add_network(modem->device, network_path, &properties); + g_free(address); + g_free(gateway); +} - dbus_message_iter_next(&entry); - } +static connman_bool_t ready_to_create_device(struct modem_data *modem) +{ + /* + * There are three different modem types which behave slightly + * different: + * - GSM modems will expose the SIM interface then the + * CM interface. + * - DUN modems will expose first a unique serial number (BDADDR) + * and then the CM interface. + * - CDMA modems will expose CM first and sometime later + * a unique serial number. + * + * This functions tests if we have the necessary information gathered + * before we are able to create a device. + */ + + if (modem->device != NULL) + return FALSE; -done: - dbus_message_unref(reply); + if (modem->imsi != NULL || modem->serial != NULL) + return TRUE; - dbus_pending_call_unref(call); + return FALSE; } -static void check_networks(struct modem_data *modem) +static void create_device(struct modem_data *modem) { - char const *path = modem->path; + struct connman_device *device; + char *uninitialized_var(ident); - DBG("modem %p path %s", modem, path); + DBG("%s", modem->path); - call_ofono(path, OFONO_GPRS_INTERFACE, "GetContexts", - check_networks_reply, g_strdup(path), g_free, - DBUS_TYPE_INVALID); -} + if (modem->imsi != NULL) + ident = modem->imsi; + else if (modem->serial != NULL) + ident = modem->serial; -static void modem_operator_name_changed(struct modem_data *modem, - char const *name) -{ - struct connman_device *device = modem->device; - GHashTableIter i; - gpointer value; + if (connman_dbus_validate_ident(ident) == FALSE) + ident = connman_dbus_encode_string(ident); + else + ident = g_strdup(ident); + device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_CELLULAR); if (device == NULL) - return; + goto out; + + DBG("device %p", device); - connman_device_set_string(device, "Operator", name); + connman_device_set_ident(device, ident); - for (g_hash_table_iter_init(&i, network_hash); - g_hash_table_iter_next(&i, NULL, &value);) { - struct connman_network *network = value; + connman_device_set_string(device, "Path", modem->path); - if (connman_network_get_device(network) == device) { - connman_network_set_name(network, name); - connman_network_update(network); - } + connman_device_set_data(device, modem); + + if (connman_device_register(device) < 0) { + connman_error("Failed to register cellular device"); + connman_device_unref(device); + goto out; } + + modem->device = device; + + connman_device_set_powered(modem->device, modem->online); +out: + g_free(ident); } -static void modem_strength_changed(struct modem_data *modem, uint8_t strength) +static void destroy_device(struct modem_data *modem) { - struct connman_device *device = modem->device; - GHashTableIter i; - gpointer value; + DBG("%s", modem->path); - modem->strength = strength; - modem->has_strength = TRUE; + connman_device_set_powered(modem->device, FALSE); - if (device == NULL) - return; + if (modem->network != NULL) { + connman_device_remove_network(modem->device, modem->network); + connman_network_unref(modem->network); + modem->network = NULL; + } - for (g_hash_table_iter_init(&i, network_hash); - g_hash_table_iter_next(&i, NULL, &value);) { - struct connman_network *network = value; + connman_device_unregister(modem->device); + connman_device_unref(modem->device); - if (connman_network_get_device(network) == device) { - connman_network_set_strength(network, strength); - connman_network_update(network); - } - } + modem->device = NULL; } -static void modem_roaming_changed(struct modem_data *modem, - char const *status) +static void add_network(struct modem_data *modem) { - struct connman_device *device = modem->device; - connman_bool_t roaming; - GHashTableIter i; - gpointer value; + const char *group; - if (device == NULL) - return; + DBG("%s", modem->path); - connman_device_set_string(device, "RegistrationStatus", status); + if (modem->network != NULL) + return; - if (g_str_equal(status, "roaming")) - roaming = TRUE; - else if (g_str_equal(status, "registered")) - roaming = FALSE; - else + modem->network = connman_network_create(modem->context->path, + CONNMAN_NETWORK_TYPE_CELLULAR); + if (modem->network == NULL) return; - for (g_hash_table_iter_init(&i, network_hash); - g_hash_table_iter_next(&i, NULL, &value);) { - struct connman_network *network = value; + DBG("network %p", modem->network); - if (connman_network_get_device(network) == device) { - connman_network_set_roaming(network, roaming); - connman_network_update(network); - } - } -} + connman_network_set_data(modem->network, modem); -static void modem_registration_changed(struct modem_data *modem, - DBusMessageIter *entry) -{ - DBusMessageIter iter; - const char *key; - int type; - connman_uint8_t strength; - char const *name, *status, *mcc_s; + connman_network_set_string(modem->network, "Path", + modem->context->path); - dbus_message_iter_get_basic(entry, &key); + connman_network_set_index(modem->network, modem->context->index); - DBG("key %s", key); + if (modem->name != NULL) + connman_network_set_name(modem->network, modem->name); + else + connman_network_set_name(modem->network, ""); - dbus_message_iter_next(entry); + connman_network_set_strength(modem->network, modem->strength); - dbus_message_iter_recurse(entry, &iter); + group = get_ident(modem->context->path); + connman_network_set_group(modem->network, group); - type = dbus_message_iter_get_arg_type(&iter); - if (type != DBUS_TYPE_BYTE && type != DBUS_TYPE_STRING) - return; + connman_network_set_available(modem->network, TRUE); - if (g_str_equal(key, "Name") && type == DBUS_TYPE_STRING) { - dbus_message_iter_get_basic(&iter, &name); - modem_operator_name_changed(modem, name); - } else if (g_str_equal(key, "Strength") && type == DBUS_TYPE_BYTE) { - dbus_message_iter_get_basic(&iter, &strength); - modem_strength_changed(modem, strength); - } else if (g_str_equal(key, "Status") && type == DBUS_TYPE_STRING) { - dbus_message_iter_get_basic(&iter, &status); - modem_roaming_changed(modem, status); - } else if (g_str_equal(key, "MobileCountryCode") && - type == DBUS_TYPE_STRING) { - int mcc; - char *alpha2; - - dbus_message_iter_get_basic(&iter, &mcc_s); - - mcc = atoi(mcc_s); - if (mcc > 799) - return; + connman_network_set_bool(modem->network, "Roaming", + modem->roaming); - alpha2 = mcc_country_codes[mcc - 200]; - connman_technology_set_regdom(alpha2); + if (connman_device_add_network(modem->device, modem->network) < 0) { + connman_network_unref(modem->network); + modem->network = NULL; + return; } + /* + * Create the ipconfig layer before trying to connect. Withouth + * the ipconfig layer the core is not ready to process errors. + */ + connman_network_set_index(modem->network, -1); } -static gboolean reg_changed(DBusConnection *connection, - DBusMessage *message, void *user_data) +static void remove_network(struct modem_data *modem) { - const char *path = dbus_message_get_path(message); - struct modem_data *modem; - DBusMessageIter iter; + DBG("%s", modem->path); - DBG("path %s", path); - - modem = g_hash_table_lookup(modem_hash, path); - if (modem == NULL) - return TRUE; + if (modem->network == NULL) + return; - if (dbus_message_iter_init(message, &iter)) - modem_registration_changed(modem, &iter); + DBG("network %p", modem->network); - return TRUE; + connman_device_remove_network(modem->device, modem->network); + connman_network_unref(modem->network); + modem->network = NULL; } -static void check_registration_reply(DBusPendingCall *call, void *user_data) +static int add_cm_context(struct modem_data *modem, const char *context_path, + DBusMessageIter *dict) { - char const *path = user_data; - struct modem_data *modem; - DBusMessage *reply; - DBusMessageIter array, dict, entry; + const char *context_type; + struct network_context *context = NULL; + connman_bool_t active = FALSE; - DBG("path %s", path); + DBG("%s context path %s", modem->path, context_path); - modem = g_hash_table_lookup(modem_hash, path); - if (modem == NULL) - return; + if (modem->context != NULL) { + /* + * We have already assigned a context to this modem + * and we do only support one Internet context. + */ + return -EALREADY; + } - reply = dbus_pending_call_steal_reply(call); + context = network_context_alloc(context_path); + if (context == NULL) + return -ENOMEM; - if (dbus_message_iter_init(reply, &array) == FALSE) - goto done; + while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key; - if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY) - goto done; + dbus_message_iter_recurse(dict, &entry); + dbus_message_iter_get_basic(&entry, &key); - dbus_message_iter_recurse(&array, &dict); - while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) { - dbus_message_iter_recurse(&dict, &entry); - modem_registration_changed(modem, &entry); - dbus_message_iter_next(&dict); + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); + + if (g_str_equal(key, "Type") == TRUE) { + dbus_message_iter_get_basic(&value, &context_type); + + DBG("%s context %s type %s", modem->path, + context_path, context_type); + } else if (g_str_equal(key, "Settings") == TRUE) { + DBG("%s Settings", modem->path); + + extract_ipv4_settings(&value, context); + } else if (g_str_equal(key, "IPv6.Settings") == TRUE) { + DBG("%s IPv6.Settings", modem->path); + + extract_ipv6_settings(&value, context); + } else if (g_str_equal(key, "Active") == TRUE) { + dbus_message_iter_get_basic(&value, &active); + + DBG("%s Active %d", modem->path, active); + } + + dbus_message_iter_next(dict); } -done: - dbus_message_unref(reply); + if (g_strcmp0(context_type, "internet") != 0) { + network_context_free(context); + return -EINVAL; + } - dbus_pending_call_unref(call); + modem->context = context; + modem->active = active; + + g_hash_table_replace(context_hash, g_strdup(context_path), modem); + + return 0; } -static void check_registration(struct modem_data *modem) +static void remove_cm_context(struct modem_data *modem, + const char *context_path) { - char const *path = modem->path; + if (modem->context == NULL) + return; - DBG("modem %p path %s", modem, path); + g_hash_table_remove(context_hash, context_path); - call_ofono(path, OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES, - check_registration_reply, g_strdup(path), g_free, - DBUS_TYPE_INVALID); + network_context_free(modem->context); + modem->context = NULL; } -static void add_device(const char *path, const char *imsi) +static gboolean context_changed(DBusConnection *connection, + DBusMessage *message, + void *user_data) { - struct modem_data *modem; - struct connman_device *device; - - DBG("path %s imsi %s", path, imsi); - - if (path == NULL) - return; + const char *context_path = dbus_message_get_path(message); + struct modem_data *modem = NULL; + DBusMessageIter iter, value; + const char *key; - if (imsi == NULL) - return; + DBG("context_path %s", context_path); - modem = g_hash_table_lookup(modem_hash, path); + modem = g_hash_table_lookup(context_hash, context_path); if (modem == NULL) - return; + return TRUE; - if (modem->device) { - if (!g_strcmp0(imsi, connman_device_get_ident(modem->device))) - return; + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; - modem_remove_device(modem); - } + dbus_message_iter_get_basic(&iter, &key); - if (strlen(imsi) == 0) - return; + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); - device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR); - if (device == NULL) - return; + /* + * oFono guarantees the ordering of Settings and + * Active. Settings will always be send before Active = True. + * That means we don't have to order here. + */ + if (g_str_equal(key, "Settings") == TRUE) { + DBG("%s Settings", modem->path); - connman_device_set_ident(device, imsi); + extract_ipv4_settings(&value, modem->context); + } else if (g_str_equal(key, "IPv6.Settings") == TRUE) { + DBG("%s IPv6.Settings", modem->path); - connman_device_set_string(device, "Path", path); + extract_ipv6_settings(&value, modem->context); + } else if (g_str_equal(key, "Active") == TRUE) { + dbus_message_iter_get_basic(&value, &modem->active); - connman_device_set_data(device, modem); + DBG("%s Active %d", modem->path, modem->active); - if (connman_device_register(device) < 0) { - connman_device_unref(device); - return; + if (modem->active == TRUE) + set_connected(modem); + else + set_disconnected(modem); } - modem->device = device; - - if (modem->has_reg) - check_registration(modem); - if (modem->has_gprs) - check_networks(modem); + return TRUE; } -static void sim_properties_reply(DBusPendingCall *call, void *user_data) +static void cm_get_contexts_reply(DBusPendingCall *call, void *user_data) { - const char *path = user_data; - const char *imsi = NULL; + struct modem_data *modem = user_data; + DBusMessageIter array, dict, entry, value; DBusMessage *reply; - DBusMessageIter array, dict; + DBusError error; - DBG("path %s", path); + DBG("%s", modem->path); + + modem->call_get_contexts = NULL; reply = dbus_pending_call_steal_reply(call); + dbus_error_init(&error); + + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + goto done; + } + if (dbus_message_iter_init(reply, &array) == FALSE) goto done; @@ -934,20 +1179,17 @@ static void sim_properties_reply(DBusPendingCall *call, void *user_data) dbus_message_iter_recurse(&array, &dict); - while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) { - DBusMessageIter entry, value; - const char *key; + while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) { + const char *context_path; dbus_message_iter_recurse(&dict, &entry); - dbus_message_iter_get_basic(&entry, &key); + dbus_message_iter_get_basic(&entry, &context_path); dbus_message_iter_next(&entry); dbus_message_iter_recurse(&entry, &value); - if (g_str_equal(key, "SubscriberIdentity")) { - dbus_message_iter_get_basic(&value, &imsi); - add_device(path, imsi); - } + if (add_cm_context(modem, context_path, &value) == 0) + break; dbus_message_iter_next(&dict); } @@ -958,215 +1200,431 @@ done: dbus_pending_call_unref(call); } -static void get_imsi(const char *path) +static int cm_get_contexts(struct modem_data *modem) { - DBG("path %s", path); + DBusMessage *message; - call_ofono(path, OFONO_SIM_INTERFACE, GET_PROPERTIES, - sim_properties_reply, g_strdup(path), g_free, - DBUS_TYPE_INVALID); -} + DBG("%s", modem->path); -static int gprs_change_powered(const char *path, dbus_bool_t powered) -{ - DBG("path %s powered %d", path, powered); + if (modem->call_get_contexts != NULL) + return -EBUSY; - return set_property(path, OFONO_GPRS_INTERFACE, "Powered", - DBUS_TYPE_BOOLEAN, &powered, - NULL, NULL, NULL); -} + message = dbus_message_new_method_call(OFONO_SERVICE, modem->path, + OFONO_CM_INTERFACE, GET_CONTEXTS); + if (message == NULL) + return -ENOMEM; -static int modem_change_powered(const char *path, dbus_bool_t powered) -{ - DBG("path %s powered %d", path, powered); + if (dbus_connection_send_with_reply(connection, message, + &modem->call_get_contexts, TIMEOUT) == FALSE) { + connman_error("Failed to call GetContexts()"); + dbus_message_unref(message); + return -EINVAL; + } + + if (modem->call_get_contexts == NULL) { + connman_error("D-Bus connection not available"); + dbus_message_unref(message); + return -EINVAL; + } - return set_property(path, OFONO_MODEM_INTERFACE, "Powered", - DBUS_TYPE_BOOLEAN, &powered, - NULL, NULL, NULL); + dbus_pending_call_set_notify(modem->call_get_contexts, + cm_get_contexts_reply, + modem, NULL); + + dbus_message_unref(message); + + return -EINPROGRESS; } +static gboolean cm_context_added(DBusConnection *connection, + DBusMessage *message, + void *user_data) +{ + const char *path = dbus_message_get_path(message); + char *context_path; + struct modem_data *modem; + DBusMessageIter iter, properties; + + DBG("%s", path); + + modem = g_hash_table_lookup(modem_hash, context_path); + if (modem == NULL) + return TRUE; + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &context_path); + + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &properties); + + if (add_cm_context(modem, context_path, &properties) != 0) + return TRUE; -static gboolean modem_has_interface(DBusMessageIter *array, - char const *interface) + return TRUE; +} + +static gboolean cm_context_removed(DBusConnection *connection, + DBusMessage *message, + void *user_data) { - DBusMessageIter entry; + const char *path = dbus_message_get_path(message); + const char *context_path; + struct modem_data *modem; + DBusMessageIter iter; - dbus_message_iter_recurse(array, &entry); + DBG("context path %s", path); - while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) { - const char *element; + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; - dbus_message_iter_get_basic(&entry, &element); + dbus_message_iter_get_basic(&iter, &context_path); - if (g_strcmp0(interface, element) == 0) - return TRUE; + modem = g_hash_table_lookup(context_hash, context_path); + if (modem == NULL) + return TRUE; - dbus_message_iter_next(&entry); - } + remove_cm_context(modem, context_path); - return FALSE; + return TRUE; } -static gboolean modem_has_sim(DBusMessageIter *array) +static void netreg_update_name(struct modem_data *modem, + DBusMessageIter* value) { - return modem_has_interface(array, OFONO_SIM_INTERFACE); + char *name; + + dbus_message_iter_get_basic(value, &name); + + DBG("%s Name %s", modem->path, name); + + g_free(modem->name); + modem->name = g_strdup(name); + + if (modem->network == NULL) + return; + + connman_network_set_name(modem->network, modem->name); + connman_network_update(modem->network); } -static gboolean modem_has_reg(DBusMessageIter *array) +static void netreg_update_strength(struct modem_data *modem, + DBusMessageIter *value) { - return modem_has_interface(array, OFONO_REGISTRATION_INTERFACE); + dbus_message_iter_get_basic(value, &modem->strength); + + DBG("%s Strength %d", modem->path, modem->strength); + + if (modem->network == NULL) + return; + + /* + * GSM: + * We don't have 2 signal notifications we always report the strength + * signal. data_strength is always equal to 0. + * + * CDMA: + * In the case we have a data_strength signal (from 1xEVDO network) + * we don't need to update the value with strength signal (from 1xCDMA) + * because the modem is registered to 1xEVDO network for data call. + * In case we have no data_strength signal (not registered to 1xEVDO + * network), we must report the strength signal (registered to 1xCDMA + * network e.g slow mode). + */ + if (modem->data_strength != 0) + return; + + connman_network_set_strength(modem->network, modem->strength); + connman_network_update(modem->network); } -static gboolean modem_has_gprs(DBusMessageIter *array) +/* Retrieve 1xEVDO Data Strength signal */ +static void netreg_update_datastrength(struct modem_data *modem, + DBusMessageIter *value) { - return modem_has_interface(array, OFONO_GPRS_INTERFACE); + dbus_message_iter_get_basic(value, &modem->data_strength); + + DBG("%s Data Strength %d", modem->path, modem->data_strength); + + if (modem->network == NULL) + return; + + /* + * CDMA modem is not registered to 1xEVDO network, let + * update_signal_strength() reporting the value on the Strength signal + * notification. + */ + if (modem->data_strength == 0) + return; + + connman_network_set_strength(modem->network, modem->data_strength); + connman_network_update(modem->network); } -static void add_modem(const char *path, DBusMessageIter *prop) +static void netreg_update_roaming(struct modem_data *modem, + DBusMessageIter *value) { - struct modem_data *modem; - dbus_bool_t powered = FALSE; - dbus_bool_t online = FALSE; - dbus_bool_t has_online = FALSE; - dbus_bool_t locked = FALSE; - gboolean has_sim = FALSE; - gboolean has_reg = FALSE; - gboolean has_gprs = FALSE; + char *status; + connman_bool_t roaming; - modem = g_hash_table_lookup(modem_hash, path); + dbus_message_iter_get_basic(value, &status); - if (modem != NULL) + if (g_str_equal(status, "roaming") == TRUE) + roaming = TRUE; + else + roaming = FALSE; + + if (roaming == modem->roaming) return; - modem = g_try_new0(struct modem_data, 1); - if (modem == NULL) + modem->roaming = roaming; + + if (modem->network == NULL) return; - modem->path = g_strdup(path); - modem->device = NULL; - modem->available = TRUE; + connman_network_set_bool(modem->network, + "Roaming", modem->roaming); + connman_network_update(modem->network); +} - g_hash_table_insert(modem_hash, g_strdup(path), modem); +static void netreg_update_regdom(struct modem_data *modem, + DBusMessageIter *value) +{ + char *mobile_country_code; + char *alpha2; + int mcc; - while (dbus_message_iter_get_arg_type(prop) == DBUS_TYPE_DICT_ENTRY) { + dbus_message_iter_get_basic(value, &mobile_country_code); + + DBG("%s MobileContryCode %s", modem->path, mobile_country_code); + + + mcc = atoi(mobile_country_code); + if (mcc > 799) + return; + + alpha2 = mcc_country_codes[mcc - 200]; + connman_technology_set_regdom(alpha2); +} + +static gboolean netreg_changed(DBusConnection *connection, DBusMessage *message, + void *user_data) +{ + const char *path = dbus_message_get_path(message); + struct modem_data *modem; + DBusMessageIter iter, value; + const char *key; + + modem = g_hash_table_lookup(modem_hash, path); + if (modem == NULL) + return TRUE; + + if (modem->ignore == TRUE) + return TRUE; + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &key); + + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); + + if (g_str_equal(key, "Name") == TRUE) + netreg_update_name(modem, &value); + else if (g_str_equal(key, "Strength") == TRUE) + netreg_update_strength(modem, &value); + else if (g_str_equal(key, "Status") == TRUE) + netreg_update_roaming(modem, &value); + else if (g_str_equal(key, "MobileCountryCode") == TRUE) + netreg_update_regdom(modem, &value); + + return TRUE; +} + +static void netreg_properties_reply(struct modem_data *modem, + DBusMessageIter *dict) +{ + DBG("%s", modem->path); + + while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { DBusMessageIter entry, value; const char *key; - dbus_message_iter_recurse(prop, &entry); + dbus_message_iter_recurse(dict, &entry); dbus_message_iter_get_basic(&entry, &key); dbus_message_iter_next(&entry); dbus_message_iter_recurse(&entry, &value); - if (g_str_equal(key, "Powered") == TRUE) - dbus_message_iter_get_basic(&value, &powered); - else if (g_str_equal(key, "Lockdown") == TRUE) - dbus_message_iter_get_basic(&value, &locked); - else if (g_str_equal(key, "Online") == TRUE) { - has_online = TRUE; - dbus_message_iter_get_basic(&value, &online); - } else if (g_str_equal(key, "Interfaces") == TRUE) { - has_sim = modem_has_sim(&value); - has_reg = modem_has_reg(&value); - has_gprs = modem_has_gprs(&value); - } + if (g_str_equal(key, "Name") == TRUE) + netreg_update_name(modem, &value); + else if (g_str_equal(key, "Strength") == TRUE) + netreg_update_strength(modem, &value); + else if (g_str_equal(key, "Status") == TRUE) + netreg_update_roaming(modem, &value); + else if (g_str_equal(key, "MobileCountryCode") == TRUE) + netreg_update_regdom(modem, &value); - dbus_message_iter_next(prop); + dbus_message_iter_next(dict); } - if (locked) + if (modem->context == NULL) { + /* + * netgreg_get_properties() was issued after we got + * cm_get_contexts_reply() where we create the + * context. Though before we got the + * netreg_properties_reply the context was removed + * again. Therefore we have to skip the network + * creation. + */ return; + } + + add_network(modem); + + if (modem->active == TRUE) + set_connected(modem); +} + +static int netreg_get_properties(struct modem_data *modem) +{ + return get_properties(modem->path, OFONO_NETREG_INTERFACE, + netreg_properties_reply, modem); +} - if (!powered) - modem_change_powered(path, TRUE); +static void add_cdma_network(struct modem_data *modem) +{ + /* Be sure that device is created before adding CDMA network */ + if (modem->device == NULL) + return; + + /* + * CDMA modems don't need contexts for data call, however the current + * add_network() logic needs one, so we create one to proceed. + */ + if (modem->context == NULL) + modem->context = network_context_alloc(modem->path); - modem->has_sim = has_sim; - modem->has_reg = has_reg; - modem->has_gprs = has_gprs; + if (modem->name == NULL) + modem->name = g_strdup("CDMA Network"); - update_modem_online(modem, online); + add_network(modem); - if (has_sim) - get_imsi(path); + if (modem->cdma_cm_powered == TRUE) + set_connected(modem); } -static void manager_modems_reply(DBusPendingCall *call, void *user_data) +static gboolean cdma_netreg_changed(DBusConnection *connection, + DBusMessage *message, + void *user_data) { - DBusMessage *reply; - DBusError error; - DBusMessageIter array, dict; + const char *path = dbus_message_get_path(message); + struct modem_data *modem; + DBusMessageIter iter, value; + const char *key; DBG(""); - reply = dbus_pending_call_steal_reply(call); + modem = g_hash_table_lookup(modem_hash, path); + if (modem == NULL) + return TRUE; - if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE) - goto done; + if (modem->ignore == TRUE) + return TRUE; - dbus_error_init(&error); + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; - if (dbus_set_error_from_message(&error, reply)) { - connman_error("ModemManager.GetModems() %s %s", - error.name, error.message); - dbus_error_free(&error); - goto done; - } + dbus_message_iter_get_basic(&iter, &key); - if (dbus_message_iter_init(reply, &array) == FALSE) - goto done; + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); - dbus_message_iter_recurse(&array, &dict); + if (g_str_equal(key, "Name") == TRUE) + netreg_update_name(modem, &value); + else if (g_str_equal(key, "Strength") == TRUE) + netreg_update_strength(modem, &value); + else if (g_str_equal(key, "DataStrength") == TRUE) + netreg_update_datastrength(modem, &value); + else if (g_str_equal(key, "Status") == TRUE) + netreg_update_roaming(modem, &value); - while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) { - DBusMessageIter value, properties; - const char *modem_path; + add_cdma_network(modem); - dbus_message_iter_recurse(&dict, &value); - dbus_message_iter_get_basic(&value, &modem_path); + return TRUE; +} - dbus_message_iter_next(&value); - dbus_message_iter_recurse(&value, &properties); +static void cdma_netreg_properties_reply(struct modem_data *modem, + DBusMessageIter *dict) +{ + DBG("%s", modem->path); + + while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key; - /* Add modem */ - add_modem(modem_path, &properties); + dbus_message_iter_recurse(dict, &entry); + dbus_message_iter_get_basic(&entry, &key); - dbus_message_iter_next(&dict); + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); + + if (g_str_equal(key, "Name") == TRUE) + netreg_update_name(modem, &value); + else if (g_str_equal(key, "Strength") == TRUE) + netreg_update_strength(modem, &value); + else if (g_str_equal(key, "DataStrength") == TRUE) + netreg_update_datastrength(modem, &value); + else if (g_str_equal(key, "Status") == TRUE) + netreg_update_roaming(modem, &value); + + dbus_message_iter_next(dict); } -done: - dbus_message_unref(reply); + add_cdma_network(modem); +} - dbus_pending_call_unref(call); +static int cdma_netreg_get_properties(struct modem_data *modem) +{ + return get_properties(modem->path, OFONO_CDMA_NETREG_INTERFACE, + cdma_netreg_properties_reply, modem); } -static void ofono_connect(DBusConnection *connection, void *user_data) +static void cm_update_attached(struct modem_data *modem, + DBusMessageIter *value) { - DBG("connection %p", connection); + dbus_message_iter_get_basic(value, &modem->attached); - modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal, - g_free, remove_modem); + DBG("%s Attached %d", modem->path, modem->attached); - network_hash = g_hash_table_new_full(g_str_hash, g_str_equal, - NULL, remove_network); + if (modem->attached == FALSE) + return; - call_ofono("/", OFONO_MANAGER_INTERFACE, GET_MODEMS, - manager_modems_reply, NULL, NULL, - DBUS_TYPE_INVALID); + if (has_interface(modem->interfaces, + OFONO_API_NETREG) == FALSE) { + return; + } + + netreg_get_properties(modem); } -static void ofono_disconnect(DBusConnection *connection, void *user_data) +static void cm_update_powered(struct modem_data *modem, + DBusMessageIter *value) { - DBG("connection %p", connection); + dbus_message_iter_get_basic(value, &modem->cm_powered); - if (modem_hash == NULL) - return; + DBG("%s ConnnectionManager Powered %d", modem->path, + modem->cm_powered); - g_hash_table_destroy(modem_hash); + if (modem->cm_powered == TRUE) + return; - modem_hash = NULL; + cm_set_powered(modem, TRUE); } -static gboolean modem_changed(DBusConnection *connection, DBusMessage *message, +static gboolean cm_changed(DBusConnection *connection, DBusMessage *message, void *user_data) { const char *path = dbus_message_get_path(message); @@ -1174,12 +1632,68 @@ static gboolean modem_changed(DBusConnection *connection, DBusMessage *message, DBusMessageIter iter, value; const char *key; - DBG("path %s", path); + modem = g_hash_table_lookup(modem_hash, path); + if (modem == NULL) + return TRUE; + + if (modem->ignore == TRUE) + return TRUE; + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &key); + + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); + + if (g_str_equal(key, "Attached") == TRUE) + cm_update_attached(modem, &value); + else if (g_str_equal(key, "Powered") == TRUE) + cm_update_powered(modem, &value); + + return TRUE; +} + +static void cdma_cm_update_powered(struct modem_data *modem, + DBusMessageIter *value) +{ + dbus_message_iter_get_basic(value, &modem->cdma_cm_powered); + + DBG("%s CDMA cm Powered %d", modem->path, modem->cdma_cm_powered); + + if (modem->network == NULL) + return; + + if (modem->cdma_cm_powered == TRUE) + set_connected(modem); + else + set_disconnected(modem); +} + +static void cdma_cm_update_settings(struct modem_data *modem, + DBusMessageIter *value) +{ + DBG("%s Settings", modem->path); + + extract_ipv4_settings(value, modem->context); +} + +static gboolean cdma_cm_changed(DBusConnection *connection, + DBusMessage *message, void *user_data) +{ + const char *path = dbus_message_get_path(message); + struct modem_data *modem; + DBusMessageIter iter, value; + const char *key; modem = g_hash_table_lookup(modem_hash, path); if (modem == NULL) return TRUE; + if (modem->online == TRUE && modem->network == NULL) + cdma_netreg_get_properties(modem); + if (dbus_message_iter_init(message, &iter) == FALSE) return TRUE; @@ -1188,57 +1702,87 @@ static gboolean modem_changed(DBusConnection *connection, DBusMessage *message, dbus_message_iter_next(&iter); dbus_message_iter_recurse(&iter, &value); - if (g_str_equal(key, "Powered") == TRUE) { - dbus_bool_t powered; + if (g_str_equal(key, "Powered") == TRUE) + cdma_cm_update_powered(modem, &value); + if (g_str_equal(key, "Settings") == TRUE) + cdma_cm_update_settings(modem, &value); - dbus_message_iter_get_basic(&value, &powered); - if (powered == TRUE) - return TRUE; + return TRUE; +} + +static void cm_properties_reply(struct modem_data *modem, DBusMessageIter *dict) +{ + DBG("%s", modem->path); - modem->has_sim = FALSE; - modem->has_reg = FALSE; - modem->has_gprs = FALSE; + while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key; - modem_remove_device(modem); - } else if (g_str_equal(key, "Online") == TRUE) { - dbus_bool_t online; + dbus_message_iter_recurse(dict, &entry); + dbus_message_iter_get_basic(&entry, &key); - dbus_message_iter_get_basic(&value, &online); + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); + + if (g_str_equal(key, "Attached") == TRUE) + cm_update_attached(modem, &value); + else if (g_str_equal(key, "Powered") == TRUE) + cm_update_powered(modem, &value); + + dbus_message_iter_next(dict); + } +} - update_modem_online(modem, online); - } else if (g_str_equal(key, "Lockdown") == TRUE) { - dbus_bool_t locked; +static int cm_get_properties(struct modem_data *modem) +{ + return get_properties(modem->path, OFONO_CM_INTERFACE, + cm_properties_reply, modem); +} - dbus_message_iter_get_basic(&value, &locked); +static void cdma_cm_properties_reply(struct modem_data *modem, + DBusMessageIter *dict) +{ + DBG("%s", modem->path); - if (!locked) - modem_change_powered(path, TRUE); + if (modem->online == TRUE) + cdma_netreg_get_properties(modem); - } else if (g_str_equal(key, "Interfaces") == TRUE) { - gboolean has_sim = modem_has_sim(&value); - gboolean has_reg = modem_has_reg(&value); - gboolean added_reg = has_reg && !modem->has_reg; - gboolean has_gprs = modem_has_gprs(&value); - gboolean added_gprs = has_gprs && !modem->has_gprs; - - modem->has_sim = has_sim; - modem->has_reg = has_reg; - modem->has_gprs = has_gprs; - - if (modem->device == NULL) { - if (has_sim) - get_imsi(modem->path); - } else if (!has_sim) { - modem_remove_device(modem); - } else { - if (added_reg) - check_registration(modem); - if (added_gprs) - gprs_change_powered(modem->path, TRUE); - } + while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key; + + dbus_message_iter_recurse(dict, &entry); + dbus_message_iter_get_basic(&entry, &key); + + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); + + if (g_str_equal(key, "Powered") == TRUE) + cdma_cm_update_powered(modem, &value); + if (g_str_equal(key, "Settings") == TRUE) + cdma_cm_update_settings(modem, &value); + + dbus_message_iter_next(dict); } +} - return TRUE; +static int cdma_cm_get_properties(struct modem_data *modem) +{ + return get_properties(modem->path, OFONO_CDMA_CM_INTERFACE, + cdma_cm_properties_reply, modem); +} + +static void sim_update_imsi(struct modem_data *modem, + DBusMessageIter* value) +{ + char *imsi; + + dbus_message_iter_get_basic(value, &imsi); + + DBG("%s imsi %s", modem->path, imsi); + + g_free(modem->imsi); + modem->imsi = g_strdup(imsi); } static gboolean sim_changed(DBusConnection *connection, DBusMessage *message, @@ -1249,12 +1793,13 @@ static gboolean sim_changed(DBusConnection *connection, DBusMessage *message, DBusMessageIter iter, value; const char *key; - DBG("path %s", path); - modem = g_hash_table_lookup(modem_hash, path); if (modem == NULL) return TRUE; + if (modem->ignore == TRUE) + return TRUE; + if (dbus_message_iter_init(message, &iter) == FALSE) return TRUE; @@ -1264,85 +1809,370 @@ static gboolean sim_changed(DBusConnection *connection, DBusMessage *message, dbus_message_iter_recurse(&iter, &value); if (g_str_equal(key, "SubscriberIdentity") == TRUE) { - char *imsi; + sim_update_imsi(modem, &value); + + if (ready_to_create_device(modem) == FALSE) + return TRUE; + + /* + * This is a GSM modem. Create the device and + * register it at the core. Enabling (setting + * it online is done through the + * modem_enable() callback. + */ + create_device(modem); + } - dbus_message_iter_get_basic(&value, &imsi); + return TRUE; +} - add_device(path, imsi); - } else if (g_str_equal(key, "Present") == TRUE) { - dbus_bool_t present; +static void sim_properties_reply(struct modem_data *modem, + DBusMessageIter *dict) +{ + DBG("%s", modem->path); - dbus_message_iter_get_basic(&value, &present); + while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key; - if (present) - return TRUE; + dbus_message_iter_recurse(dict, &entry); + dbus_message_iter_get_basic(&entry, &key); + + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); + + if (g_str_equal(key, "SubscriberIdentity") == TRUE) { + sim_update_imsi(modem, &value); + + if (ready_to_create_device(modem) == FALSE) + return; + + /* + * This is a GSM modem. Create the device and + * register it at the core. Enabling (setting + * it online is done through the + * modem_enable() callback. + */ + create_device(modem); + + if (modem->online == FALSE) + return; + + /* + * The modem is already online and we have the CM interface. + * There will be no interface update and therefore our + * state machine will not go to next step. We have to + * trigger it from here. + */ + if (has_interface(modem->interfaces, OFONO_API_CM) == TRUE) { + cm_get_properties(modem); + cm_get_contexts(modem); + } + return; + } + + dbus_message_iter_next(dict); + } +} + +static int sim_get_properties(struct modem_data *modem) +{ + return get_properties(modem->path, OFONO_SIM_INTERFACE, + sim_properties_reply, modem); +} + +static connman_bool_t api_added(uint8_t old_iface, uint8_t new_iface, + enum ofono_api api) +{ + if (has_interface(old_iface, api) == FALSE && + has_interface(new_iface, api) == TRUE) { + DBG("%s added", api2string(api)); + return TRUE; + } + + return FALSE; +} + +static connman_bool_t api_removed(uint8_t old_iface, uint8_t new_iface, + enum ofono_api api) +{ + if (has_interface(old_iface, api) == TRUE && + has_interface(new_iface, api) == FALSE) { + DBG("%s removed", api2string(api)); + return TRUE; + } + + return FALSE; +} + +static void modem_update_interfaces(struct modem_data *modem, + uint8_t old_ifaces, + uint8_t new_ifaces) +{ + DBG("%s", modem->path); + + if (api_added(old_ifaces, new_ifaces, OFONO_API_SIM) == TRUE) { + if (modem->imsi == NULL && + modem->set_powered == FALSE) { + /* + * Only use do GetProperties() when + * device has not been powered up. + */ + sim_get_properties(modem); + } + } + + if (api_added(old_ifaces, new_ifaces, OFONO_API_CM) == TRUE) { + if (modem->device != NULL) { + cm_get_properties(modem); + cm_get_contexts(modem); + } + } + + if (api_added(old_ifaces, new_ifaces, OFONO_API_CDMA_CM) == TRUE) { + if (ready_to_create_device(modem) == TRUE) + create_device(modem); if (modem->device != NULL) - modem_remove_device(modem); + cdma_cm_get_properties(modem); + } - modem->has_gprs = FALSE; - modem->has_reg = FALSE; + if (api_added(old_ifaces, new_ifaces, OFONO_API_NETREG) == TRUE) { + if (modem->attached == TRUE) + netreg_get_properties(modem); } - return TRUE; + if (api_added(old_ifaces, new_ifaces, OFONO_API_CDMA_NETREG) == TRUE) { + cdma_netreg_get_properties(modem); + } + + if (api_removed(old_ifaces, new_ifaces, OFONO_API_CM) == TRUE) { + remove_cm_context(modem, modem->context->path); + } + + if (api_removed(old_ifaces, new_ifaces, OFONO_API_CDMA_CM) == TRUE) { + remove_cm_context(modem, modem->context->path); + } + + if (api_removed(old_ifaces, new_ifaces, OFONO_API_NETREG) == TRUE) { + remove_network(modem); + } + + if (api_removed(old_ifaces, new_ifaces, OFONO_API_CDMA_NETREG == TRUE)) { + remove_network(modem); + } } -static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message, +static gboolean modem_changed(DBusConnection *connection, DBusMessage *message, void *user_data) { - const char *path = dbus_message_get_path(message); - struct modem_data *modem; - DBusMessageIter iter, value; - const char *key; + const char *path = dbus_message_get_path(message); + struct modem_data *modem; + DBusMessageIter iter, value; + const char *key; + + modem = g_hash_table_lookup(modem_hash, path); + if (modem == NULL) + return TRUE; + + if (modem->ignore == TRUE) + return TRUE; + + if (dbus_message_iter_init(message, &iter) == FALSE) + return TRUE; + + dbus_message_iter_get_basic(&iter, &key); + + dbus_message_iter_next(&iter); + dbus_message_iter_recurse(&iter, &value); + + if (g_str_equal(key, "Powered") == TRUE) { + dbus_message_iter_get_basic(&value, &modem->powered); + + DBG("%s Powered %d", modem->path, modem->powered); + + if (modem->powered == FALSE) + modem_set_powered(modem, TRUE); + } else if (g_str_equal(key, "Online") == TRUE) { + dbus_message_iter_get_basic(&value, &modem->online); + + DBG("%s Online %d", modem->path, modem->online); + + if (modem->device == NULL) + return TRUE; + + connman_device_set_powered(modem->device, modem->online); + } else if (g_str_equal(key, "Interfaces") == TRUE) { + uint8_t interfaces; + + interfaces = extract_interfaces(&value); + + if (interfaces == modem->interfaces) + return TRUE; + + DBG("%s Interfaces 0x%02x", modem->path, interfaces); + + modem_update_interfaces(modem, modem->interfaces, interfaces); + + modem->interfaces = interfaces; + } else if (g_str_equal(key, "Serial") == TRUE) { + char *serial; + + dbus_message_iter_get_basic(&value, &serial); + + g_free(modem->serial); + modem->serial = g_strdup(serial); + + DBG("%s Serial %s", modem->path, modem->serial); + + if (has_interface(modem->interfaces, + OFONO_API_CDMA_CM) == TRUE) { + if (ready_to_create_device(modem) == TRUE) + create_device(modem); + } + } + + return TRUE; +} + +static void add_modem(const char *path, DBusMessageIter *prop) +{ + struct modem_data *modem; + + DBG("%s", path); + + modem = g_hash_table_lookup(modem_hash, path); + if (modem != NULL) { + /* + * When oFono powers up we ask for the modems and oFono is + * reporting with modem_added signal the modems. Only + * handle them once. + */ + return; + } + + modem = g_try_new0(struct modem_data, 1); + if (modem == NULL) + return; + + modem->path = g_strdup(path); + + g_hash_table_insert(modem_hash, g_strdup(path), modem); + + while (dbus_message_iter_get_arg_type(prop) == DBUS_TYPE_DICT_ENTRY) { + DBusMessageIter entry, value; + const char *key; + + dbus_message_iter_recurse(prop, &entry); + dbus_message_iter_get_basic(&entry, &key); + + dbus_message_iter_next(&entry); + dbus_message_iter_recurse(&entry, &value); + + if (g_str_equal(key, "Powered") == TRUE) { + dbus_message_iter_get_basic(&value, &modem->powered); + + DBG("%s Powered %d", modem->path, modem->powered); + } else if (g_str_equal(key, "Online") == TRUE) { + dbus_message_iter_get_basic(&value, &modem->online); + + DBG("%s Online %d", modem->path, modem->online); + } else if (g_str_equal(key, "Interfaces") == TRUE) { + modem->interfaces = extract_interfaces(&value); + + DBG("%s Interfaces 0x%02x", modem->path, + modem->interfaces); + } else if (g_str_equal(key, "Serial") == TRUE) { + char *serial; + + dbus_message_iter_get_basic(&value, &serial); + modem->serial = g_strdup(serial); + + DBG("%s Serial %s", modem->path, modem->serial); + } else if (g_str_equal(key, "Type") == TRUE) { + char *type; + + dbus_message_iter_get_basic(&value, &type); + + DBG("%s Type %s", modem->path, type); + if (g_strcmp0(type, "hardware") != 0) { + DBG("%s Ignore this modem", modem->path); + modem->ignore = TRUE; + } + } + + dbus_message_iter_next(prop); + } + + if (modem->ignore == TRUE) + return; + + if (modem->powered == FALSE) { + modem_set_powered(modem, TRUE); + return; + } + + modem_update_interfaces(modem, 0, modem->interfaces); +} + +static void modem_power_down(gpointer key, gpointer value, gpointer user_data) +{ + struct modem_data *modem = value; - DBG("path %s", path); + DBG("%s", modem->path); - modem = g_hash_table_lookup(modem_hash, path); - if (modem == NULL) - return TRUE; + if (modem->ignore == TRUE) + return; - if (dbus_message_iter_init(message, &iter) == FALSE) - return TRUE; + modem_set_powered(modem, FALSE); +} - dbus_message_iter_get_basic(&iter, &key); +static void remove_modem(gpointer data) +{ + struct modem_data *modem = data; - dbus_message_iter_next(&iter); - dbus_message_iter_recurse(&iter, &value); + DBG("%s", modem->path); - if (g_str_equal(key, "Attached") == TRUE) { - dbus_bool_t attached; + if (modem->call_set_property != NULL) + dbus_pending_call_cancel(modem->call_set_property); - dbus_message_iter_get_basic(&value, &attached); + if (modem->call_get_properties != NULL) + dbus_pending_call_cancel(modem->call_get_properties); - DBG("Attached %d", attached); + if (modem->call_get_contexts != NULL) + dbus_pending_call_cancel(modem->call_get_contexts); - if (attached == TRUE) - check_networks(modem); - else if (modem->device != NULL) - connman_device_remove_all_networks(modem->device); + if (modem->device != NULL) + destroy_device(modem); - } + if (modem->context != NULL) + remove_cm_context(modem, modem->context->path); - return TRUE; + g_free(modem->serial); + g_free(modem->name); + g_free(modem->imsi); + g_free(modem->path); + + g_free(modem); } static gboolean modem_added(DBusConnection *connection, DBusMessage *message, void *user_data) { DBusMessageIter iter, properties; - const char *modem_path; + const char *path; DBG(""); if (dbus_message_iter_init(message, &iter) == FALSE) return TRUE; - dbus_message_iter_get_basic(&iter, &modem_path); + dbus_message_iter_get_basic(&iter, &path); dbus_message_iter_next(&iter); dbus_message_iter_recurse(&iter, &properties); - add_modem(modem_path, &properties); + add_modem(path, &properties); return TRUE; } @@ -1351,267 +2181,289 @@ static gboolean modem_removed(DBusConnection *connection, DBusMessage *message, void *user_data) { DBusMessageIter iter; - const char *modem_path; + const char *path; DBG(""); if (dbus_message_iter_init(message, &iter) == FALSE) return TRUE; - dbus_message_iter_get_basic(&iter, &modem_path); + dbus_message_iter_get_basic(&iter, &path); - g_hash_table_remove(modem_hash, modem_path); + g_hash_table_remove(modem_hash, path); return TRUE; } - -static void get_dns(DBusMessageIter *array, struct connman_element *parent) +static void manager_get_modems_reply(DBusPendingCall *call, void *user_data) { - DBusMessageIter entry; - gchar *nameserver = NULL, *nameserver_old = NULL; + DBusMessage *reply; + DBusError error; + DBusMessageIter array, dict; DBG(""); - dbus_message_iter_recurse(array, &entry); + reply = dbus_pending_call_steal_reply(call); - while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) { - const char *dns; + dbus_error_init(&error); - dbus_message_iter_get_basic(&entry, &dns); + if (dbus_set_error_from_message(&error, reply) == TRUE) { + connman_error("%s", error.message); + dbus_error_free(&error); + goto done; + } - DBG("dns %s", dns); + if (dbus_message_iter_init(reply, &array) == FALSE) + goto done; - if (nameserver == NULL) { + dbus_message_iter_recurse(&array, &dict); - nameserver = g_strdup(dns); - } else { + while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) { + DBusMessageIter value, properties; + const char *path; - nameserver_old = nameserver; - nameserver = g_strdup_printf("%s %s", - nameserver_old, dns); - g_free(nameserver_old); - } + dbus_message_iter_recurse(&dict, &value); + dbus_message_iter_get_basic(&value, &path); - dbus_message_iter_next(&entry); + dbus_message_iter_next(&value); + dbus_message_iter_recurse(&value, &properties); + + add_modem(path, &properties); + + dbus_message_iter_next(&dict); } - parent->ipv4.nameserver = nameserver; +done: + dbus_message_unref(reply); + + dbus_pending_call_unref(call); } -static void update_settings(DBusMessageIter *array, - struct connman_network *network) +static int manager_get_modems(void) { - struct connman_element *parent = connman_network_get_element(network); - DBusMessageIter dict; - const char *interface = NULL; - - DBG("network %p", network); + DBusMessage *message; + DBusPendingCall *call; - if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) - return; + DBG(""); - dbus_message_iter_recurse(array, &dict); + message = dbus_message_new_method_call(OFONO_SERVICE, "/", + OFONO_MANAGER_INTERFACE, GET_MODEMS); + if (message == NULL) + return -ENOMEM; - while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) { - DBusMessageIter entry, value; - const char *key; + if (dbus_connection_send_with_reply(connection, message, + &call, TIMEOUT) == FALSE) { + connman_error("Failed to call GetModems()"); + dbus_message_unref(message); + return -EINVAL; + } - dbus_message_iter_recurse(&dict, &entry); - dbus_message_iter_get_basic(&entry, &key); + if (call == NULL) { + connman_error("D-Bus connection not available"); + dbus_message_unref(message); + return -EINVAL; + } - DBG("key %s", key); + dbus_pending_call_set_notify(call, manager_get_modems_reply, + NULL, NULL); - dbus_message_iter_next(&entry); - dbus_message_iter_recurse(&entry, &value); + dbus_message_unref(message); - if (g_str_equal(key, "Interface") == TRUE) { - int index; + return -EINPROGRESS; +} - dbus_message_iter_get_basic(&value, &interface); +static void ofono_connect(DBusConnection *conn, void *user_data) +{ + DBG(""); - DBG("interface %s", interface); + modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal, + g_free, remove_modem); + if (modem_hash == NULL) + return; - index = connman_inet_ifindex(interface); - if (index >= 0) { - connman_network_set_index(network, index); - } else { - connman_error("Can not find interface %s", - interface); - break; - } - } else if (g_str_equal(key, "Method") == TRUE) { - const char *method; + context_hash = g_hash_table_new_full(g_str_hash, g_str_equal, + g_free, NULL); + if (context_hash == NULL) { + g_hash_table_destroy(modem_hash); + return; + } - dbus_message_iter_get_basic(&value, &method); - if (g_strcmp0(method, "static") == 0) { + manager_get_modems(); +} - parent->ipv4.method = - CONNMAN_IPCONFIG_METHOD_FIXED; - } else if (g_strcmp0(method, "dhcp") == 0) { +static void ofono_disconnect(DBusConnection *conn, void *user_data) +{ + DBG(""); - parent->ipv4.method = - CONNMAN_IPCONFIG_METHOD_DHCP; - break; - } - } else if (g_str_equal(key, "Address") == TRUE) { - const char *address; + if (modem_hash == NULL || context_hash == NULL) + return; - dbus_message_iter_get_basic(&value, &address); + g_hash_table_destroy(modem_hash); + modem_hash = NULL; - DBG("address %s", address); + g_hash_table_destroy(context_hash); + context_hash = NULL; +} - parent->ipv4.address = g_strdup(address); - } else if (g_str_equal(key, "Netmask") == TRUE) { - const char *netmask; +static int network_probe(struct connman_network *network) +{ + struct modem_data *modem = connman_network_get_data(network); - dbus_message_iter_get_basic(&value, &netmask); + DBG("%s network %p", modem->path, network); - DBG("netmask %s", netmask); + return 0; +} - parent->ipv4.netmask = g_strdup(netmask); - } else if (g_str_equal(key, "DomainNameServers") == TRUE) { +static void network_remove(struct connman_network *network) +{ + struct modem_data *modem = connman_network_get_data(network); - get_dns(&value, parent); - } else if (g_str_equal(key, "Gateway") == TRUE) { - const char *gateway; + DBG("%s network %p", modem->path, network); +} - dbus_message_iter_get_basic(&value, &gateway); +static int network_connect(struct connman_network *network) +{ + struct modem_data *modem = connman_network_get_data(network); - DBG("gateway %s", gateway); + DBG("%s network %p", modem->path, network); - parent->ipv4.gateway = g_strdup(gateway); - } + if (has_interface(modem->interfaces, OFONO_API_CM) == TRUE) + return context_set_active(modem, TRUE); + else if (has_interface(modem->interfaces, OFONO_API_CDMA_CM) == TRUE) + return cdma_cm_set_powered(modem, TRUE); - dbus_message_iter_next(&dict); - } + connman_error("Connection manager interface not available"); - /* deactive, oFono send NULL inteface before deactive signal */ - if (interface == NULL) - connman_network_set_index(network, -1); + return -ENOSYS; } -static void cleanup_ipconfig(struct connman_network *network) +static int network_disconnect(struct connman_network *network) { - struct connman_element *parent = connman_network_get_element(network); + struct modem_data *modem = connman_network_get_data(network); - g_free(parent->ipv4.address); - parent->ipv4.address = NULL; + DBG("%s network %p", modem->path, network); - g_free(parent->ipv4.netmask); - parent->ipv4.netmask = NULL; + if (has_interface(modem->interfaces, OFONO_API_CM) == TRUE) + return context_set_active(modem, FALSE); + else if (has_interface(modem->interfaces, OFONO_API_CDMA_CM) == TRUE) + return cdma_cm_set_powered(modem, FALSE); - g_free(parent->ipv4.nameserver); - parent->ipv4.nameserver = NULL; + connman_error("Connection manager interface not available"); - g_free(parent->ipv4.gateway); - parent->ipv4.gateway = NULL; - - parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN; + return -ENOSYS; } +static struct connman_network_driver network_driver = { + .name = "network", + .type = CONNMAN_NETWORK_TYPE_CELLULAR, + .probe = network_probe, + .remove = network_remove, + .connect = network_connect, + .disconnect = network_disconnect, +}; -static void set_connected(struct connman_network *network, - connman_bool_t connected) +static int modem_probe(struct connman_device *device) { - struct connman_element *parent = connman_network_get_element(network); - enum connman_ipconfig_method method = parent->ipv4.method; - - switch (method) { - case CONNMAN_IPCONFIG_METHOD_UNKNOWN: - case CONNMAN_IPCONFIG_METHOD_OFF: - case CONNMAN_IPCONFIG_METHOD_MANUAL: - case CONNMAN_IPCONFIG_METHOD_AUTO: - return; - - case CONNMAN_IPCONFIG_METHOD_FIXED: - connman_network_set_ipv4_method(network, method); - - connman_network_set_connected(network, connected); + struct modem_data *modem = connman_device_get_data(device); - if (connected == FALSE) - cleanup_ipconfig(network); + DBG("%s device %p", modem->path, device); - break; + return 0; +} - case CONNMAN_IPCONFIG_METHOD_DHCP: - connman_network_set_ipv4_method(network, method); +static void modem_remove(struct connman_device *device) +{ + struct modem_data *modem = connman_device_get_data(device); - connman_network_set_connected(network, connected); - break; - } + DBG("%s device %p", modem->path, device); } -static gboolean context_changed(DBusConnection *connection, - DBusMessage *message, void *user_data) +static int modem_enable(struct connman_device *device) { - const char *path = dbus_message_get_path(message); - struct connman_network *network; - DBusMessageIter iter, value; - const char *key; + struct modem_data *modem = connman_device_get_data(device); - DBG("path %s", path); + DBG("%s device %p", modem->path, device); - network = g_hash_table_lookup(network_hash, path); - if (network == NULL) - return TRUE; + if (modem->online == TRUE) + return 0; - if (!pending_network_is_available(network)) { - remove_network(network); - return TRUE; - } + return modem_set_online(modem, TRUE); +} - if (dbus_message_iter_init(message, &iter) == FALSE) - return TRUE; +static int modem_disable(struct connman_device *device) +{ + struct modem_data *modem = connman_device_get_data(device); - dbus_message_iter_get_basic(&iter, &key); + DBG("%s device %p", modem->path, device); - dbus_message_iter_next(&iter); - dbus_message_iter_recurse(&iter, &value); + if (modem->online == FALSE) + return 0; - if (g_str_equal(key, "Settings") == TRUE) - update_settings(&value, network); - else if (g_str_equal(key, "Active") == TRUE) { - dbus_bool_t active; + return modem_set_online(modem, FALSE); +} - dbus_message_iter_get_basic(&value, &active); +static struct connman_device_driver modem_driver = { + .name = "modem", + .type = CONNMAN_DEVICE_TYPE_CELLULAR, + .probe = modem_probe, + .remove = modem_remove, + .enable = modem_enable, + .disable = modem_disable, +}; - set_connected(network, active); - } +static int tech_probe(struct connman_technology *technology) +{ + return 0; +} - return TRUE; +static void tech_remove(struct connman_technology *technology) +{ } +static struct connman_technology_driver tech_driver = { + .name = "cellular", + .type = CONNMAN_SERVICE_TYPE_CELLULAR, + .probe = tech_probe, + .remove = tech_remove, +}; + static guint watch; -static guint reg_watch; -static guint sim_watch; -static guint gprs_watch; -static guint modem_watch; static guint modem_added_watch; static guint modem_removed_watch; +static guint modem_watch; +static guint cm_watch; +static guint sim_watch; +static guint context_added_watch; +static guint context_removed_watch; +static guint netreg_watch; static guint context_watch; +static guint cdma_cm_watch; +static guint cdma_netreg_watch; static int ofono_init(void) { int err; + DBG(""); + connection = connman_dbus_get_connection(); if (connection == NULL) return -EIO; - watch = g_dbus_add_service_watch(connection, OFONO_SERVICE, - ofono_connect, ofono_disconnect, NULL, NULL); + watch = g_dbus_add_service_watch(connection, + OFONO_SERVICE, ofono_connect, + ofono_disconnect, NULL, NULL); - reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL, - OFONO_REGISTRATION_INTERFACE, - PROPERTY_CHANGED, - reg_changed, + modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_MANAGER_INTERFACE, + MODEM_ADDED, + modem_added, NULL, NULL); - gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL, - OFONO_GPRS_INTERFACE, - PROPERTY_CHANGED, - gprs_changed, + modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_MANAGER_INTERFACE, + MODEM_REMOVED, + modem_removed, NULL, NULL); modem_watch = g_dbus_add_signal_watch(connection, NULL, NULL, @@ -1620,22 +2472,28 @@ static int ofono_init(void) modem_changed, NULL, NULL); + cm_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_CM_INTERFACE, + PROPERTY_CHANGED, + cm_changed, + NULL, NULL); + sim_watch = g_dbus_add_signal_watch(connection, NULL, NULL, OFONO_SIM_INTERFACE, PROPERTY_CHANGED, sim_changed, NULL, NULL); - modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL, - OFONO_MANAGER_INTERFACE, - MODEM_ADDED, - modem_added, + context_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_CM_INTERFACE, + CONTEXT_ADDED, + cm_context_added, NULL, NULL); - modem_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL, - OFONO_MANAGER_INTERFACE, - MODEM_REMOVED, - modem_removed, + context_removed_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_CM_INTERFACE, + CONTEXT_REMOVED, + cm_context_removed, NULL, NULL); context_watch = g_dbus_add_signal_watch(connection, NULL, NULL, @@ -1644,10 +2502,31 @@ static int ofono_init(void) context_changed, NULL, NULL); - if (watch == 0 || gprs_watch == 0 || modem_watch == 0 || - reg_watch == 0 || sim_watch == 0 || - modem_added_watch == 0 || modem_removed_watch == 0 || - context_watch == 0) { + netreg_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_NETREG_INTERFACE, + PROPERTY_CHANGED, + netreg_changed, + NULL, NULL); + + cdma_cm_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_CDMA_CM_INTERFACE, + PROPERTY_CHANGED, + cdma_cm_changed, + NULL, NULL); + + cdma_netreg_watch = g_dbus_add_signal_watch(connection, NULL, NULL, + OFONO_CDMA_NETREG_INTERFACE, + PROPERTY_CHANGED, + cdma_netreg_changed, + NULL, NULL); + + + if (watch == 0 || modem_added_watch == 0 || modem_removed_watch == 0 || + modem_watch == 0 || cm_watch == 0 || sim_watch == 0 || + context_added_watch == 0 || + context_removed_watch == 0 || + context_watch == 0 || netreg_watch == 0 || + cdma_cm_watch == 0 || cdma_netreg_watch == 0) { err = -EIO; goto remove; } @@ -1662,18 +2541,28 @@ static int ofono_init(void) goto remove; } + err = connman_technology_driver_register(&tech_driver); + if (err < 0) { + connman_device_driver_unregister(&modem_driver); + connman_network_driver_unregister(&network_driver); + goto remove; + } + return 0; remove: - g_dbus_remove_watch(connection, watch); + g_dbus_remove_watch(connection, cdma_netreg_watch); + g_dbus_remove_watch(connection, cdma_cm_watch); + g_dbus_remove_watch(connection, netreg_watch); + g_dbus_remove_watch(connection, context_watch); + g_dbus_remove_watch(connection, context_removed_watch); + g_dbus_remove_watch(connection, context_added_watch); g_dbus_remove_watch(connection, sim_watch); - g_dbus_remove_watch(connection, reg_watch); - g_dbus_remove_watch(connection, gprs_watch); + g_dbus_remove_watch(connection, cm_watch); g_dbus_remove_watch(connection, modem_watch); - g_dbus_remove_watch(connection, modem_added_watch); g_dbus_remove_watch(connection, modem_removed_watch); - g_dbus_remove_watch(connection, context_watch); - + g_dbus_remove_watch(connection, modem_added_watch); + g_dbus_remove_watch(connection, watch); dbus_connection_unref(connection); return err; @@ -1681,20 +2570,44 @@ remove: static void ofono_exit(void) { - g_dbus_remove_watch(connection, watch); - g_dbus_remove_watch(connection, sim_watch); - g_dbus_remove_watch(connection, reg_watch); - g_dbus_remove_watch(connection, gprs_watch); - g_dbus_remove_watch(connection, modem_watch); - g_dbus_remove_watch(connection, modem_added_watch); - g_dbus_remove_watch(connection, modem_removed_watch); - g_dbus_remove_watch(connection, context_watch); + DBG(""); + + if (modem_hash != NULL) { + /* + * We should propably wait for the SetProperty() reply + * message, because ... + */ + g_hash_table_foreach(modem_hash, modem_power_down, NULL); + + /* + * ... here we will cancel the call. + */ + g_hash_table_destroy(modem_hash); + modem_hash = NULL; + } - ofono_disconnect(connection, NULL); + if (context_hash != NULL) { + g_hash_table_destroy(context_hash); + context_hash = NULL; + } + connman_technology_driver_unregister(&tech_driver); connman_device_driver_unregister(&modem_driver); connman_network_driver_unregister(&network_driver); + g_dbus_remove_watch(connection, cdma_netreg_watch); + g_dbus_remove_watch(connection, cdma_cm_watch); + g_dbus_remove_watch(connection, netreg_watch); + g_dbus_remove_watch(connection, context_watch); + g_dbus_remove_watch(connection, context_removed_watch); + g_dbus_remove_watch(connection, context_added_watch); + g_dbus_remove_watch(connection, sim_watch); + g_dbus_remove_watch(connection, cm_watch); + g_dbus_remove_watch(connection, modem_watch); + g_dbus_remove_watch(connection, modem_added_watch); + g_dbus_remove_watch(connection, modem_removed_watch); + g_dbus_remove_watch(connection, watch); + dbus_connection_unref(connection); }