#endif
#include <errno.h>
+#include <stdlib.h>
#include <gdbus.h>
#include <string.h>
+#include <stdint.h>
#define CONNMAN_API_SUBJECT_TO_CHANGE
#include <connman/plugin.h>
-#include <connman/element.h>
#include <connman/device.h>
#include <connman/network.h>
#include <connman/dbus.h>
-#include <connman/inet.h>
#include <connman/log.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 ".DataConnectionManager"
#define OFONO_SIM_INTERFACE OFONO_SERVICE ".SimManager"
-#define OFONO_PRI_CONTEXT_INTERFACE OFONO_SERVICE ".PrimaryDataContext"
-#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 MODEM_ADDED "ModemAdded"
+#define MODEM_REMOVED "ModemRemoved"
#define PROPERTY_CHANGED "PropertyChanged"
+#define CONTEXT_ADDED "ContextAdded"
+#define CONTEXT_REMOVED "ContextRemoved"
+
#define GET_PROPERTIES "GetProperties"
#define SET_PROPERTY "SetProperty"
-#define CREATE_CONTEXT "CreateContext"
+#define GET_MODEMS "GetModems"
-#define TIMEOUT 5000
+#define TIMEOUT 40000
-#define CONTEXT_NAME "3G Connection"
-#define CONTEXT_TYPE "internet"
+enum ofono_api {
+ OFONO_API_SIM = 0x1,
+ OFONO_API_NETREG = 0x2,
+ OFONO_API_CM = 0x4,
+};
static DBusConnection *connection;
-static GHashTable *modem_hash = NULL;
+static GHashTable *modem_hash;
struct modem_data {
char *path;
+
struct connman_device *device;
- gboolean available;
-};
-static int modem_probe(struct connman_device *device)
-{
- DBG("device %p", device);
+ /* Modem Interface */
+ char *serial;
+ connman_bool_t powered;
+ connman_bool_t online;
+ uint8_t interfaces;
- return 0;
-}
+ connman_bool_t set_powered;
+ connman_bool_t set_online;
-static void modem_remove(struct connman_device *device)
-{
- DBG("device %p", device);
-}
+ /* ConnectionManager Interface */
+ connman_bool_t attached;
+
+ /* SimManager Interface */
+ char *imsi;
+
+ /* pending calls */
+ DBusPendingCall *call_set_property;
+ DBusPendingCall *call_get_properties;
+};
+
+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 (path == NULL)
- return -EINVAL;
+ if (modem->call_set_property != NULL) {
+ connman_error("Pending SetProperty");
+ return -EBUSY;
+ }
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 int gprs_change_powered(const char *path, dbus_bool_t powered)
+static void get_properties_reply(DBusPendingCall *call, void *user_data)
{
- DBG("path %s powered %d", path, powered);
+ struct property_info *info = user_data;
+ DBusMessageIter array, dict;
+ DBusMessage *reply;
+ DBusError error;
- return set_property(path, OFONO_GPRS_INTERFACE, "Powered",
- DBUS_TYPE_BOOLEAN, &powered,
- NULL, NULL, NULL);
-}
+ DBG("%s path %s %s", info->modem->path, info->path, info->interface);
-static int modem_enable(struct connman_device *device)
-{
- const char *path = connman_device_get_string(device, "Path");
+ info->modem->call_get_properties = NULL;
- DBG("device %p, path, %s", device, path);
+ dbus_error_init(&error);
- return gprs_change_powered(path, TRUE);
-}
+ reply = dbus_pending_call_steal_reply(call);
-static int modem_disable(struct connman_device *device)
-{
- const char *path = connman_device_get_string(device, "Path");
+ if (dbus_set_error_from_message(&error, reply)) {
+ connman_error("Failed to get properties: %s %s: %s %s",
+ info->path, info->interface,
+ error.name, error.message);
+ dbus_error_free(&error);
- DBG("device %p, path %s", device, path);
+ goto done;
+ }
- return gprs_change_powered(path, FALSE);
-}
+ if (dbus_message_iter_init(reply, &array) == FALSE)
+ goto done;
-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,
-};
+ if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
+ goto done;
-static char *get_ident(const char *path)
-{
- char *pos;
+ dbus_message_iter_recurse(&array, &dict);
+
+ if (info->get_properties_cb != NULL)
+ (*info->get_properties_cb)(info->modem, &dict);
- if (*path != '/')
- return NULL;
+done:
- pos = strrchr(path, '/');
- if (pos == NULL)
- return NULL;
+ dbus_message_unref(reply);
- return g_strdup(pos + 1);
+ dbus_pending_call_unref(call);
}
-static void create_service(struct connman_network *network)
+static int get_properties(const char *path, const char *interface,
+ get_properties_cb notify,
+ struct modem_data *modem)
{
- const char *path;
- char *group;
+ DBusMessage *message;
+ struct property_info *info;
- DBG("");
+ DBG("%s path %s %s", modem->path, path, interface);
- path = connman_network_get_string(network, "Path");
+ if (modem->call_get_properties != NULL) {
+ connman_error("Pending GetProperties");
+ return -EBUSY;
+ }
- group = get_ident(path);
+ message = dbus_message_new_method_call(OFONO_SERVICE, path,
+ interface, GET_PROPERTIES);
+ if (message == NULL)
+ return -ENOMEM;
- connman_network_set_group(network, group);
+ 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;
+ }
- g_free(group);
-}
+ if (modem->call_get_properties == NULL) {
+ connman_error("D-Bus connection not available");
+ dbus_message_unref(message);
+ return -EINVAL;
+ }
-static void set_network_name_reply(DBusPendingCall *call, void *user_data)
-{
- struct connman_network *network = user_data;
- DBusMessage *reply;
- DBusMessageIter array, dict;
+ info = g_try_new0(struct property_info, 1);
+ if (info == NULL) {
+ dbus_message_unref(message);
+ return -ENOMEM;
+ }
- DBG("network %p", network);
+ info->modem = modem;
+ info->path = path;
+ info->interface = interface;
+ info->get_properties_cb = notify;
- reply = dbus_pending_call_steal_reply(call);
+ dbus_pending_call_set_notify(modem->call_get_properties,
+ get_properties_reply, info, g_free);
- if (dbus_message_iter_init(reply, &array) == FALSE)
- goto done;
+ dbus_message_unref(message);
- if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
- goto done;
+ return -EINPROGRESS;
+}
- dbus_message_iter_recurse(&array, &dict);
+static void modem_set_online_reply(struct modem_data *modem,
+ connman_bool_t success)
+{
+ DBG("%s", modem->path);
- while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
- DBusMessageIter entry, value;
- const char *key;
+ if (success == TRUE) {
+ /*
+ * Don't handle do anything on success here. oFono will send
+ * the change via PropertyChanged singal.
+ */
+ return;
+ }
- dbus_message_iter_recurse(&dict, &entry);
- dbus_message_iter_get_basic(&entry, &key);
+ modem->set_online = FALSE;
+}
- dbus_message_iter_next(&entry);
- dbus_message_iter_recurse(&entry, &value);
+static int modem_set_online(struct modem_data *modem)
+{
+ DBG("%s", modem->path);
- /*
- * 'Operator' is deprecated since version 0.20, but
- * keep it here for backward compatibility reasons.
- */
- if (g_str_equal(key, "Operator") == TRUE ||
- g_str_equal(key, "Name") == TRUE) {
- const char *name;
-
- dbus_message_iter_get_basic(&value, &name);
- connman_network_set_name(network, name);
- create_service(network);
- } else if (g_strcmp0(key, "Status") == 0) {
- const char *status;
- connman_bool_t roaming;
-
- dbus_message_iter_get_basic(&value, &status);
- if (g_strcmp0(status, "roaming") == 0)
- roaming = TRUE;
- else if (g_strcmp0(status, "registered") == 0)
- roaming = FALSE;
- else {
- dbus_message_iter_next(&dict);
- continue;
- }
+ modem->set_online = TRUE;
- connman_network_set_roaming(network, roaming);
- connman_network_update(network);
- }
+ return set_property(modem, modem->path,
+ OFONO_MODEM_INTERFACE,
+ "Online", DBUS_TYPE_BOOLEAN,
+ &modem->set_online,
+ modem_set_online_reply);
+}
- dbus_message_iter_next(&dict);
- }
-done:
- dbus_message_unref(reply);
+static int modem_set_powered(struct modem_data *modem)
+{
+ DBG("%s", modem->path);
- dbus_pending_call_unref(call);
+ modem->set_powered = TRUE;
+
+ return set_property(modem, modem->path,
+ OFONO_MODEM_INTERFACE,
+ "Powered", DBUS_TYPE_BOOLEAN,
+ &modem->set_powered,
+ NULL);
}
-static void set_network_name(struct connman_network *network)
+static connman_bool_t has_interface(uint8_t interfaces,
+ enum ofono_api api)
{
- struct connman_device *device;
- DBusMessage *message;
- DBusPendingCall *call;
- const char *path;
+ if ((interfaces & api) == api)
+ return TRUE;
- device = connman_network_get_device(network);
+ return FALSE;
+}
- path = connman_device_get_string(device, "Path");
- if (path == NULL)
- return;
+static uint8_t extract_interfaces(DBusMessageIter *array)
+{
+ DBusMessageIter entry;
+ uint8_t interfaces = 0;
- DBG("path %s", path);
+ dbus_message_iter_recurse(array, &entry);
- message = dbus_message_new_method_call(OFONO_SERVICE, path,
- OFONO_REGISTRATION_INTERFACE, GET_PROPERTIES);
- if (message == NULL)
- return;
+ while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
+ const char *name;
- dbus_message_set_auto_start(message, FALSE);
+ dbus_message_iter_get_basic(&entry, &name);
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to get operator name");
- goto done;
- }
+ 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;
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- goto done;
+ dbus_message_iter_next(&entry);
}
- dbus_pending_call_set_notify(call, set_network_name_reply,
- (void *)network, NULL);
-
-done:
- dbus_message_unref(message);
+ return interfaces;
}
-static void config_network_reply(DBusPendingCall *call, void *user_data)
+static connman_bool_t ready_to_create_device(struct modem_data *modem)
{
- struct connman_network *network = user_data;
- DBusMessage *reply;
- DBusMessageIter array, dict;
- gboolean internet_type = FALSE;
-
- DBG("network %p", network);
+ /*
+ * 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;
- reply = dbus_pending_call_steal_reply(call);
+ if (modem->imsi != NULL || modem->serial != NULL)
+ return TRUE;
- if (dbus_message_iter_init(reply, &array) == FALSE)
- goto done;
+ return FALSE;
+}
- if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
- goto done;
+static void create_device(struct modem_data *modem)
+{
+ struct connman_device *device;
+ char *uninitialized_var(ident);
- dbus_message_iter_recurse(&array, &dict);
+ DBG("%s", modem->path);
- while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
- DBusMessageIter entry, value;
- const char *key;
+ if (modem->imsi != NULL)
+ ident = modem->imsi;
+ else if (modem->serial != NULL)
+ ident = modem->serial;
- dbus_message_iter_recurse(&dict, &entry);
- dbus_message_iter_get_basic(&entry, &key);
+ if (connman_dbus_validate_ident(ident) == FALSE)
+ ident = connman_dbus_encode_string(ident);
+ else
+ ident = g_strdup(ident);
- dbus_message_iter_next(&entry);
- dbus_message_iter_recurse(&entry, &value);
+ device = connman_device_create(ident, CONNMAN_DEVICE_TYPE_CELLULAR);
+ if (device == NULL)
+ goto out;
- if (g_str_equal(key, "Type") == TRUE) {
- const char *type;
+ DBG("device %p", device);
- dbus_message_iter_get_basic(&value, &type);
- if (g_strcmp0(type, "internet") == 0) {
- internet_type = TRUE;
+ connman_device_set_ident(device, ident);
- connman_network_set_protocol(network,
- CONNMAN_NETWORK_PROTOCOL_IP);
- set_network_name(network);
- } else {
- internet_type = FALSE;
+ connman_device_set_string(device, "Path", modem->path);
- connman_network_set_protocol(network,
- CONNMAN_NETWORK_PROTOCOL_UNKNOWN);
- }
- }
+ connman_device_set_data(device, modem);
- dbus_message_iter_next(&dict);
+ if (connman_device_register(device) < 0) {
+ connman_error("Failed to register cellular device");
+ connman_device_unref(device);
+ goto out;
}
-done:
- dbus_message_unref(reply);
+ modem->device = device;
- dbus_pending_call_unref(call);
+out:
+ g_free(ident);
}
-static void config_network(struct connman_network *network, const char *path)
+static void destroy_device(struct modem_data *modem)
{
- DBusMessage *message;
- DBusPendingCall *call;
+ DBG("%s", modem->path);
- DBG("path %s", path);
+ connman_device_set_powered(modem->device, FALSE);
- message = dbus_message_new_method_call(OFONO_SERVICE, path,
- OFONO_PRI_CONTEXT_INTERFACE, GET_PROPERTIES);
- if (message == NULL)
- return;
+ connman_device_unregister(modem->device);
+ connman_device_unref(modem->device);
- dbus_message_set_auto_start(message, FALSE);
+ modem->device = NULL;
+}
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to get Primary Context");
- goto done;
- }
+static gboolean context_changed(DBusConnection *connection,
+ DBusMessage *message,
+ void *user_data)
+{
+ return TRUE;
+}
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- goto done;
- }
+static gboolean cm_context_added(DBusConnection *connection,
+ DBusMessage *message,
+ void *user_data)
+{
+ return TRUE;
+}
- dbus_pending_call_set_notify(call, config_network_reply,
- (void *)network, NULL);
+static gboolean cm_context_removed(DBusConnection *connection,
+ DBusMessage *message,
+ void *user_data)
+{
+ return TRUE;
+}
-done:
- dbus_message_unref(message);
+static gboolean netreg_changed(DBusConnection *connection, DBusMessage *message,
+ void *user_data)
+{
+ return TRUE;
}
-static gboolean registration_changed(DBusConnection *connection,
- DBusMessage *message, void *user_data)
+static gboolean cm_changed(DBusConnection *connection, DBusMessage *message,
+ void *user_data)
{
const char *path = dbus_message_get_path(message);
- struct connman_network *network = user_data;
+ struct modem_data *modem;
DBusMessageIter iter, value;
const char *key;
- DBG("path %s", path);
+ modem = g_hash_table_lookup(modem_hash, path);
+ if (modem == NULL)
+ return TRUE;
if (dbus_message_iter_init(message, &iter) == FALSE)
return TRUE;
dbus_message_iter_get_basic(&iter, &key);
- DBG("key %s", key);
-
dbus_message_iter_next(&iter);
dbus_message_iter_recurse(&iter, &value);
- if (g_strcmp0(key, "Name") == 0 ||
- g_strcmp0(key, "Operator") == 0) {
- const char *name;
-
- dbus_message_iter_get_basic(&value, &name);
- DBG("name %s", name);
- connman_network_set_name(network, name);
- create_service(network);
- } else if (g_strcmp0(key, "Strength") == 0) {
- connman_uint8_t strength;
-
- dbus_message_iter_get_basic(&value, &strength);
- connman_network_set_strength(network, strength);
- connman_network_update(network);
- } else if (g_strcmp0(key, "Status") == 0) {
- const char *status;
- connman_bool_t roaming;
-
- dbus_message_iter_get_basic(&value, &status);
- if (g_strcmp0(status, "roaming") == 0)
- roaming = TRUE;
- else if (g_strcmp0(status, "registered") == 0)
- roaming = FALSE;
- else
- return TRUE;
+ if (g_str_equal(key, "Attached") == TRUE) {
+ dbus_message_iter_get_basic(&value, &modem->attached);
- connman_network_set_roaming(network, roaming);
- connman_network_update(network);
+ DBG("%s Attached %d", modem->path, modem->attached);
}
return TRUE;
}
-static int network_probe(struct connman_network *network)
+static void cm_properties_reply(struct modem_data *modem, DBusMessageIter *dict)
{
- const char *path;
- guint reg_watch;
-
- reg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
- OFONO_REGISTRATION_INTERFACE,
- PROPERTY_CHANGED,
- registration_changed,
- network, NULL);
- if (reg_watch == 0)
- return -EIO;
+ DBG("%s", modem->path);
- connman_network_set_data(network, GUINT_TO_POINTER(reg_watch));
+ while (dbus_message_iter_get_arg_type(dict) == DBUS_TYPE_DICT_ENTRY) {
+ DBusMessageIter entry, value;
+ const char *key;
- path = connman_network_get_string(network, "Path");
+ dbus_message_iter_recurse(dict, &entry);
+ dbus_message_iter_get_basic(&entry, &key);
- DBG("network %p path %s", network, path);
+ dbus_message_iter_next(&entry);
+ dbus_message_iter_recurse(&entry, &value);
- config_network(network, path);
+ if (g_str_equal(key, "Attached") == TRUE) {
+ dbus_message_iter_get_basic(&value, &modem->attached);
- return 0;
-}
+ DBG("%s Attached %d", modem->path,
+ modem->attached);
-static struct connman_network *pending_network;
+ return;
+ }
-static gboolean pending_network_is_available(
- struct connman_network *pending_network)
-{
- struct connman_device *device;
- struct connman_network *network;
- const char *identifier;
- char *ident;
-
- /* Modem may be removed during waiting for active reply */
- device = connman_network_get_device(pending_network);
- if (device == NULL) {
- DBG("Modem is removed");
- return FALSE;
+ dbus_message_iter_next(dict);
}
+}
- identifier = connman_network_get_identifier(pending_network);
-
- ident = g_strdup(identifier);
-
- connman_network_unref(pending_network);
-
- /* network may be removed during waiting for active reply */
- network = connman_device_get_network(device, ident);
+static int cm_get_properties(struct modem_data *modem)
+{
+ return get_properties(modem->path, OFONO_CM_INTERFACE,
+ cm_properties_reply, modem);
+}
- g_free(ident);
+static void update_sim_imsi(struct modem_data *modem,
+ const char *imsi)
+{
+ DBG("%s imsi %s", modem->path, imsi);
- if (network == NULL)
- return FALSE;
+ if (g_strcmp0(modem->imsi, imsi) == 0)
+ return;
- return TRUE;
+ g_free(modem->imsi);
+ modem->imsi = g_strdup(imsi);
}
-static void set_active_reply(DBusPendingCall *call, void *user_data)
-{
- DBusMessage *reply;
- DBusError error;
- struct connman_network *network = user_data;
-
- DBG("network %p", network);
-
- reply = dbus_pending_call_steal_reply(call);
-
- if (pending_network_is_available(network) == FALSE)
- goto done;
-
- dbus_error_init(&error);
- if (dbus_set_error_from_message(&error, reply)) {
- if (connman_network_get_index(network) < 0)
- connman_network_set_error(network,
- CONNMAN_NETWORK_ERROR_ASSOCIATE_FAIL);
-
- pending_network = NULL;
-
- connman_error("SetProperty(Active) %s %s",
- error.name, error.message);
-
- dbus_error_free(&error);
- } else
- pending_network = network;
-
-done:
- dbus_message_unref(reply);
-
- dbus_pending_call_unref(call);
-}
-
-static int set_network_active(struct connman_network *network,
- dbus_bool_t active)
-{
- int error;
-
- const char *path = connman_network_get_string(network, "Path");
-
- DBG("network %p, path %s, active %d", network, path, active);
-
- error = set_property(path, OFONO_PRI_CONTEXT_INTERFACE,
- "Active", DBUS_TYPE_BOOLEAN, &active,
- set_active_reply, network, NULL);
- if (active == FALSE && error == -EINPROGRESS)
- error = 0;
-
- return error;
-}
-
-static void set_apn(struct connman_network *network)
-{
- const char *apn, *path;
-
- apn = connman_network_get_string(network, "Cellular.APN");
- if (apn == NULL)
- return;
-
- path = connman_network_get_string(network, "Path");
- if (path == NULL)
- return;
-
- DBG("path %s, apn %s", path, apn);
-
- set_property(path, OFONO_PRI_CONTEXT_INTERFACE,
- "AccessPointName", DBUS_TYPE_STRING, &apn,
- NULL, NULL, NULL);
-}
-
-static int network_connect(struct connman_network *network)
-{
- if (connman_network_get_index(network) >= 0)
- return -EISCONN;
-
- return set_network_active(network, TRUE);
-}
-
-static int network_disconnect(struct connman_network *network)
-{
- if (connman_network_get_index(network) < 0)
- return -ENOTCONN;
-
- return set_network_active(network, FALSE);
-}
-
-static void network_remove(struct connman_network *network)
-{
- guint reg_watch;
-
- DBG("network %p", network);
-
- reg_watch = GPOINTER_TO_UINT(connman_network_get_data(network));
- g_dbus_remove_watch(connection, reg_watch);
-}
-
-static int network_setup(struct connman_network *network, const char *key)
-{
- DBG("");
-
- if (g_strcmp0(key, "Cellular.APN") == 0)
- set_apn(network);
-
- return 0;
-}
-
-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,
-};
-
-static void add_network(struct connman_device *device, const char *path)
-{
- struct connman_network *network;
- char *ident;
- const char *mcc;
- const char *mnc;
-
- DBG("device %p path %s", device, path);
-
- network = connman_device_get_network(device, path);
- if (network != NULL)
- return;
-
- ident = get_ident(path);
-
- network = connman_network_create(ident,
- CONNMAN_NETWORK_TYPE_CELLULAR);
- if (network == NULL)
- return;
-
- g_free(ident);
-
- connman_network_set_string(network, "Path", path);
- connman_network_set_available(network, TRUE);
- connman_network_set_index(network, -1);
-
- mcc = connman_device_get_string(device, "MCC");
- if (mcc != NULL)
- connman_network_set_string(network, "Cellular.MCC", mcc);
-
- mnc = connman_device_get_string(device, "MNC");
- if (mnc != NULL)
- connman_network_set_string(network, "Cellular.MNC", mnc);
-
- connman_device_add_network(device, network);
-}
-
-static void add_networks(struct connman_device *device, DBusMessageIter *array)
-{
- DBusMessageIter entry;
-
- DBG("");
-
- dbus_message_iter_recurse(array, &entry);
-
- while (dbus_message_iter_get_arg_type(&entry) ==
- DBUS_TYPE_OBJECT_PATH) {
- const char *path;
-
- dbus_message_iter_get_basic(&entry, &path);
-
- add_network(device, path);
-
- dbus_message_iter_next(&entry);
- }
-}
-
-static void create_context_reply(DBusPendingCall *call, void *user_data)
-{
- DBusMessage *reply;
- DBusError error;
-
- DBG("");
-
- dbus_error_init(&error);
-
- reply = dbus_pending_call_steal_reply(call);
-
- if (dbus_set_error_from_message(&error, reply)) {
- connman_error("CreateContext() %s %s",
- error.name, error.message);
- dbus_error_free(&error);
- }
-
- dbus_message_unref(reply);
-
- dbus_pending_call_unref(call);
-}
-
-static void add_default_context(DBusMessageIter *array,
- const char *path, const char *name, const char *type)
-{
- DBusMessageIter entry;
- DBusMessage *message;
- DBusPendingCall *call;
-
- if (path == NULL)
- return;
-
- DBG("");
-
- dbus_message_iter_recurse(array, &entry);
-
- if (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_OBJECT_PATH)
- return;
-
- DBG("path %s, name %s, type %s", path, name, type);
-
- message = dbus_message_new_method_call(OFONO_SERVICE, path,
- OFONO_GPRS_INTERFACE, CREATE_CONTEXT);
- if (message == NULL)
- return;
-
- dbus_message_set_auto_start(message, FALSE);
-
- dbus_message_append_args(message, DBUS_TYPE_STRING,
- &name, DBUS_TYPE_STRING,
- &type, DBUS_TYPE_INVALID);
-
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to create default context");
- dbus_message_unref(message);
- return;
- }
-
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- dbus_message_unref(message);
- return;
- }
-
- dbus_pending_call_set_notify(call, create_context_reply, NULL, NULL);
-
- dbus_message_unref(message);
-}
-
-static void check_networks_reply(DBusPendingCall *call, void *user_data)
-{
- char *path = user_data;
- struct modem_data *modem;
- struct connman_device *device;
- DBusMessage *reply;
- DBusMessageIter array, dict, contexts;
- dbus_bool_t attached;
-
- DBG("path %s", path);
-
- modem = g_hash_table_lookup(modem_hash, path);
- if (modem == NULL || modem->device == NULL)
- return;
-
- device = modem->device;
-
- reply = dbus_pending_call_steal_reply(call);
-
- 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);
-
- 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);
-
- DBG("key %s", key);
-
- if (g_str_equal(key, "Attached") == TRUE) {
- dbus_message_iter_get_basic(&value, &attached);
- DBG("Attached %d", attached);
- } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
- const char *path;
-
- path = connman_device_get_string(device, "Path");
- contexts = value;
- add_default_context(&contexts, path,
- CONTEXT_NAME, CONTEXT_TYPE);
- } else if (g_str_equal(key, "Powered") == TRUE) {
- dbus_bool_t powered;
-
- dbus_message_iter_get_basic(&value, &powered);
-
- connman_device_set_powered(device, powered);
- }
-
- dbus_message_iter_next(&dict);
- }
-
- if (attached == TRUE)
- add_networks(device, &contexts);
-
-done:
- dbus_message_unref(reply);
-
- dbus_pending_call_unref(call);
-}
-
-static void check_networks(struct modem_data *modem)
-{
- DBusMessage *message;
- DBusPendingCall *call;
-
- DBG("modem %p", modem);
-
- if (modem == NULL)
- return;
-
- if (modem->device == NULL)
- return;
-
- message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
- OFONO_GPRS_INTERFACE, GET_PROPERTIES);
- if (message == NULL)
- return;
-
- dbus_message_set_auto_start(message, FALSE);
-
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to get ofono GPRS");
- goto done;
- }
-
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- goto done;
- }
-
- dbus_pending_call_set_notify(call, check_networks_reply,
- g_strdup(modem->path), g_free);
-
-done:
- dbus_message_unref(message);
-}
-
-static void add_device(const char *path, const char *imsi,
- const char *mcc, const char *mnc)
-{
- struct modem_data *modem;
- struct connman_device *device;
-
- DBG("path %s imsi %s", path, imsi);
-
- if (path == NULL)
- return;
-
- if (imsi == NULL)
- return;
-
- modem = g_hash_table_lookup(modem_hash, path);
- if (modem == NULL)
- return;
-
- device = connman_device_create(imsi, CONNMAN_DEVICE_TYPE_CELLULAR);
- if (device == NULL)
- return;
-
- connman_device_set_ident(device, imsi);
-
- connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE);
-
- connman_device_set_string(device, "Path", path);
- if (mcc != NULL)
- connman_device_set_string(device, "MCC", mcc);
- if (mnc != NULL)
- connman_device_set_string(device, "MNC", mnc);
-
- if (connman_device_register(device) < 0) {
- connman_device_unref(device);
- return;
- }
-
- modem->device = device;
-
- check_networks(modem);
-}
-
-static void sim_properties_reply(DBusPendingCall *call, void *user_data)
-{
- const char *path = user_data;
- const char *imsi;
- char *mcc = NULL;
- char *mnc = NULL;
- /* If MobileNetworkCodeLength is not provided, mnc_length is 0 */
- unsigned char mnc_length = 0;
- DBusMessage *reply;
- DBusMessageIter array, dict;
-
- DBG("path %s", path);
-
- reply = dbus_pending_call_steal_reply(call);
-
- 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);
-
- 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, "SubscriberIdentity") == TRUE)
- dbus_message_iter_get_basic(&value, &imsi);
- /*
- * 'MobileNetworkCodeLength' is deprecated since version 0.20, but
- * keep it here for backward compatibility reasons.
- */
- else if (g_str_equal(key, "MobileNetworkCodeLength") == TRUE)
- dbus_message_iter_get_basic(&value,
- (void *) &mnc_length);
- else if (g_str_equal(key, "MobileCountryCode") == TRUE)
- dbus_message_iter_get_basic(&value,
- (void *) &mcc);
- else if (g_str_equal(key, "MobileNetworkCode") == TRUE)
- dbus_message_iter_get_basic(&value,
- (void *) &mnc);
-
- dbus_message_iter_next(&dict);
- }
-
- if (mnc_length == 2 || mnc_length == 3) {
- mcc = g_strndup(imsi, 3);
- mnc = g_strndup(imsi + 3, mnc_length);
- }
-
- add_device(path, imsi, mcc, mnc);
-
- if (mnc_length == 2 || mnc_length == 3) {
- g_free(mcc);
- g_free(mnc);
- }
-
-done:
- dbus_message_unref(reply);
-
- dbus_pending_call_unref(call);
-}
-
-static void get_imsi(const char *path)
-{
- DBusMessage *message;
- DBusPendingCall *call;
-
- DBG("path %s", path);
-
- message = dbus_message_new_method_call(OFONO_SERVICE, path,
- OFONO_SIM_INTERFACE, GET_PROPERTIES);
- if (message == NULL)
- return;
-
- dbus_message_set_auto_start(message, FALSE);
-
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to get ofono modem sim");
- goto done;
- }
-
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- goto done;
- }
-
- dbus_pending_call_set_notify(call, sim_properties_reply,
- g_strdup(path), g_free);
-
-done:
- dbus_message_unref(message);
-}
-
-static int modem_change_powered(const char *path, dbus_bool_t powered)
-{
- DBG("path %s powered %d", path, powered);
-
- return set_property(path, OFONO_MODEM_INTERFACE, "Powered",
- DBUS_TYPE_BOOLEAN, &powered,
- NULL, NULL, NULL);
-}
-
-static struct modem_data *add_modem(const char *path)
+static gboolean sim_changed(DBusConnection *connection, DBusMessage *message,
+ void *user_data)
{
+ const char *path = dbus_message_get_path(message);
struct modem_data *modem;
-
- if (path == NULL)
- return NULL;
+ DBusMessageIter iter, value;
+ const char *key;
modem = g_hash_table_lookup(modem_hash, path);
- if (modem != NULL) {
- modem->available = TRUE;
-
- return modem;
- }
-
- modem = g_try_new0(struct modem_data, 1);
if (modem == NULL)
- return NULL;
-
- modem->path = g_strdup(path);
- modem->device = NULL;
- modem->available = TRUE;
-
- g_hash_table_insert(modem_hash, g_strdup(path), modem);
-
- return modem;
-}
-
-static gboolean modem_has_gprs(DBusMessageIter *array)
-{
- DBusMessageIter entry;
-
- dbus_message_iter_recurse(array, &entry);
-
- while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
- const char *interface;
-
- dbus_message_iter_get_basic(&entry, &interface);
-
- if (g_strcmp0(OFONO_GPRS_INTERFACE, interface) == 0)
- return TRUE;
-
- dbus_message_iter_next(&entry);
- }
-
- return FALSE;
-}
-
-static void modem_properties_reply(DBusPendingCall *call, void *user_data)
-{
- DBusMessage *reply;
- DBusError error;
- DBusMessageIter array, dict;
- const char *path = user_data;
-
- DBG("path %s", path);
-
- reply = dbus_pending_call_steal_reply(call);
-
- dbus_error_init(&error);
-
- if (dbus_set_error_from_message(&error, reply)) {
- connman_error("Modem.GetProperties(%s) %s %s",
- path, error.name, error.message);
- dbus_error_free(&error);
- goto done;
- }
-
- if (dbus_message_iter_init(reply, &array) == FALSE)
- goto done;
+ return TRUE;
- if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
- goto done;
+ if (dbus_message_iter_init(message, &iter) == FALSE)
+ return TRUE;
- dbus_message_iter_recurse(&array, &dict);
+ dbus_message_iter_get_basic(&iter, &key);
- while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
- DBusMessageIter entry, value;
- const char *key;
- dbus_bool_t powered;
+ dbus_message_iter_next(&iter);
+ dbus_message_iter_recurse(&iter, &value);
- dbus_message_iter_recurse(&dict, &entry);
- dbus_message_iter_get_basic(&entry, &key);
+ if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
+ char *imsi;
- dbus_message_iter_next(&entry);
- dbus_message_iter_recurse(&entry, &value);
+ dbus_message_iter_get_basic(&value, &imsi);
- if (g_str_equal(key, "Powered") == TRUE) {
- dbus_message_iter_get_basic(&value, &powered);
+ update_sim_imsi(modem, imsi);
- if (powered == FALSE) {
- modem_change_powered(path, TRUE);
- break;
- }
- } else if (g_str_equal(key, "Interfaces") == TRUE) {
- if (modem_has_gprs(&value) == TRUE)
- get_imsi(path);
+ if (modem->online == FALSE) {
+ modem_set_online(modem);
+ } else if (has_interface(modem->interfaces,
+ OFONO_API_CM) == TRUE) {
+ if (ready_to_create_device(modem) == TRUE)
+ create_device(modem);
}
-
- dbus_message_iter_next(&dict);
- }
-
-done:
- dbus_message_unref(reply);
-
- dbus_pending_call_unref(call);
-}
-
-static void get_modem_properties(struct modem_data *modem)
-{
- DBusMessage *message;
- DBusPendingCall *call;
-
- DBG("path %s", modem->path);
-
- if (modem->path == NULL)
- return;
-
- message = dbus_message_new_method_call(OFONO_SERVICE, modem->path,
- OFONO_MODEM_INTERFACE, GET_PROPERTIES);
- if (message == NULL)
- return;
-
- dbus_message_set_auto_start(message, FALSE);
-
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to get ofono modem");
- goto done;
- }
-
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- goto done;
- }
-
- dbus_pending_call_set_notify(call, modem_properties_reply,
- g_strdup(modem->path), g_free);
-
-done:
- dbus_message_unref(message);
-}
-
-static void mask_unavailable(gpointer key, gpointer value, gpointer user_data)
-{
- struct modem_data *modem = value;
-
- modem->available = FALSE;
-}
-
-static void modems_set_unavailable()
-{
- g_hash_table_foreach(modem_hash, mask_unavailable, NULL);
-}
-
-static void cleanup_modem(gpointer key, gpointer value, gpointer user_data)
-{
- struct modem_data *modem = value;
-
- if (modem->available == FALSE)
- g_hash_table_remove(modem_hash, key);
-}
-
-static void cleanup_modems()
-{
- g_hash_table_foreach(modem_hash, cleanup_modem, NULL);
-}
-
-static void update_modems(DBusMessageIter *array)
-{
- DBusMessageIter entry;
-
- dbus_message_iter_recurse(array, &entry);
-
- modems_set_unavailable();
-
- while (dbus_message_iter_get_arg_type(&entry) ==
- DBUS_TYPE_OBJECT_PATH) {
- const char *path;
- struct modem_data *modem;
-
- dbus_message_iter_get_basic(&entry, &path);
-
- modem = add_modem(path);
- if (modem != NULL)
- get_modem_properties(modem);
-
- dbus_message_iter_next(&entry);
}
- cleanup_modems();
+ return TRUE;
}
-static void manager_properties_reply(DBusPendingCall *call, void *user_data)
+static void sim_properties_reply(struct modem_data *modem,
+ DBusMessageIter *dict)
{
- DBusMessage *reply;
- DBusError error;
- DBusMessageIter array, dict;
-
- DBG("");
-
- reply = dbus_pending_call_steal_reply(call);
-
- dbus_error_init(&error);
-
- if (dbus_set_error_from_message(&error, reply)) {
- connman_error("ModemManager.GetProperties() %s %s",
- error.name, error.message);
- dbus_error_free(&error);
- 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);
+ DBG("%s", modem->path);
- 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;
- 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, "Modems") == TRUE) {
- update_modems(&value);
- break;
- }
-
- dbus_message_iter_next(&dict);
- }
-
-done:
- dbus_message_unref(reply);
-
- dbus_pending_call_unref(call);
-}
-
-static void modem_remove_device(struct modem_data *modem)
-{
- if (modem->device == NULL)
- return;
-
- connman_device_unregister(modem->device);
- connman_device_unref(modem->device);
-
- modem->device = NULL;
-}
-
-static void remove_modem(gpointer data)
-{
- struct modem_data *modem = data;
-
- g_free(modem->path);
-
- modem_remove_device(modem);
-
- g_free(modem);
-}
-
-static void ofono_connect(DBusConnection *connection, void *user_data)
-{
- DBusMessage *message;
- DBusPendingCall *call;
-
- DBG("connection %p", connection);
-
- modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
- g_free, remove_modem);
-
- message = dbus_message_new_method_call(OFONO_SERVICE, "/",
- OFONO_MANAGER_INTERFACE, GET_PROPERTIES);
- if (message == NULL)
- return;
-
- dbus_message_set_auto_start(message, FALSE);
+ if (g_str_equal(key, "SubscriberIdentity") == TRUE) {
+ char *imsi;
- if (dbus_connection_send_with_reply(connection, message,
- &call, TIMEOUT) == FALSE) {
- connman_error("Failed to get ofono modems");
- goto done;
- }
+ dbus_message_iter_get_basic(&value, &imsi);
- if (call == NULL) {
- connman_error("D-Bus connection not available");
- goto done;
- }
+ update_sim_imsi(modem, imsi);
- dbus_pending_call_set_notify(call, manager_properties_reply,
- NULL, NULL);
+ if (modem->online == FALSE) {
+ modem_set_online(modem);
+ break;
+ }
-done:
- dbus_message_unref(message);
+ if (has_interface(modem->interfaces, OFONO_API_CM) == TRUE) {
+ if (ready_to_create_device(modem) == TRUE)
+ create_device(modem);
+ if (modem->device != NULL)
+ cm_get_properties(modem);
+ }
+ return;
+ }
+ dbus_message_iter_next(dict);
+ }
}
-static void ofono_disconnect(DBusConnection *connection, void *user_data)
+static int sim_get_properties(struct modem_data *modem)
{
- DBG("connection %p", connection);
-
- if (modem_hash == NULL)
- return;
-
- g_hash_table_destroy(modem_hash);
-
- modem_hash = NULL;
+ return get_properties(modem->path, OFONO_SIM_INTERFACE,
+ sim_properties_reply, modem);
}
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;
dbus_message_iter_recurse(&iter, &value);
if (g_str_equal(key, "Powered") == TRUE) {
- dbus_bool_t powered;
+ dbus_message_iter_get_basic(&value, &modem->powered);
+
+ DBG("%s Powered %d", modem->path, modem->powered);
+
+ if (modem->powered == FALSE)
+ modem_set_powered(modem);
+ } else if (g_str_equal(key, "Online") == TRUE) {
+ dbus_message_iter_get_basic(&value, &modem->online);
+
+ DBG("%s Online %d", modem->path, modem->online);
- dbus_message_iter_get_basic(&value, &powered);
- if (powered == TRUE)
+ if (modem->online == FALSE)
return TRUE;
- modem_remove_device(modem);
+ if (has_interface(modem->interfaces, OFONO_API_CM) == FALSE)
+ return TRUE;
+ if (ready_to_create_device(modem) == TRUE)
+ create_device(modem);
+ if (modem->device != NULL)
+ cm_get_properties(modem);
} else if (g_str_equal(key, "Interfaces") == TRUE) {
- if (modem_has_gprs(&value) == TRUE) {
- if (modem->device == NULL)
- get_imsi(modem->path);
- } else if (modem->device != NULL)
- modem_remove_device(modem);
+ modem->interfaces = extract_interfaces(&value);
+
+ DBG("%s Interfaces 0x%02x", modem->path,
+ modem->interfaces);
+
+ if (has_interface(modem->interfaces, 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);
+ return TRUE;
+ }
+ }
+
+ if (has_interface(modem->interfaces, OFONO_API_CM) == TRUE) {
+ if (ready_to_create_device(modem) == TRUE)
+ create_device(modem);
+ if (modem->device != NULL)
+ cm_get_properties(modem);
+ } else {
+ if (modem->device != NULL)
+ destroy_device(modem);
+ }
+ } 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_CM) == TRUE) {
+ if (ready_to_create_device(modem) == TRUE)
+ create_device(modem);
+ if (modem->device != NULL)
+ cm_get_properties(modem);
+ }
}
return TRUE;
}
-static gboolean gprs_changed(DBusConnection *connection, DBusMessage *message,
- void *user_data)
+static void add_modem(const char *path, DBusMessageIter *prop)
{
- const char *path = dbus_message_get_path(message);
struct modem_data *modem;
- DBusMessageIter iter, value;
- const char *key;
- DBG("path %s", path);
+ 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 TRUE;
+ return;
- if (dbus_message_iter_init(message, &iter) == FALSE)
- return TRUE;
+ modem->path = g_strdup(path);
- dbus_message_iter_get_basic(&iter, &key);
+ g_hash_table_insert(modem_hash, g_strdup(path), modem);
- dbus_message_iter_next(&iter);
- dbus_message_iter_recurse(&iter, &value);
+ while (dbus_message_iter_get_arg_type(prop) == DBUS_TYPE_DICT_ENTRY) {
+ DBusMessageIter entry, value;
+ const char *key;
- if (g_str_equal(key, "Attached") == TRUE) {
- dbus_bool_t attached;
+ dbus_message_iter_recurse(prop, &entry);
+ dbus_message_iter_get_basic(&entry, &key);
- dbus_message_iter_get_basic(&value, &attached);
+ dbus_message_iter_next(&entry);
+ dbus_message_iter_recurse(&entry, &value);
- DBG("Attached %d", attached);
+ if (g_str_equal(key, "Powered") == TRUE) {
+ dbus_message_iter_get_basic(&value, &modem->powered);
- if (attached == TRUE)
- check_networks(modem);
- else if (modem->device != NULL)
- connman_device_remove_all_networks(modem->device);
+ DBG("%s Powered %d", modem->path, modem->powered);
+ } else if (g_str_equal(key, "Online") == TRUE) {
+ dbus_message_iter_get_basic(&value, &modem->online);
- } else if (g_str_equal(key, "PrimaryContexts") == TRUE) {
- check_networks(modem);
- } else if (g_str_equal(key, "Powered") == TRUE) {
- dbus_bool_t powered;
+ DBG("%s Online %d", modem->path, modem->online);
+ } else if (g_str_equal(key, "Interfaces") == TRUE) {
+ modem->interfaces = extract_interfaces(&value);
- if (modem->device == NULL)
- return TRUE;
+ 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, &powered);
- connman_device_set_powered(modem->device, powered);
+ dbus_message_iter_get_basic(&value, &serial);
+ modem->serial = g_strdup(serial);
+
+ DBG("%s Serial %s", modem->path, modem->serial);
+ }
+
+ dbus_message_iter_next(prop);
}
- return TRUE;
+ if (modem->powered == FALSE) {
+ modem_set_powered(modem);
+ } else if (has_interface(modem->interfaces, OFONO_API_SIM) == TRUE) {
+ sim_get_properties(modem);
+ } else if (has_interface(modem->interfaces, OFONO_API_CM) == TRUE) {
+ if (ready_to_create_device(modem) == TRUE)
+ create_device(modem);
+ if (modem->device != NULL)
+ cm_get_properties(modem);
+ }
}
-static gboolean manager_changed(DBusConnection *connection,
- DBusMessage *message, void *user_data)
+static void remove_modem(gpointer data)
{
- const char *path = dbus_message_get_path(message);
- DBusMessageIter iter, value;
- const char *key;
+ struct modem_data *modem = data;
- DBG("path %s", path);
+ DBG("%s", modem->path);
- if (dbus_message_iter_init(message, &iter) == FALSE)
- return TRUE;
+ if (modem->call_set_property != NULL)
+ dbus_pending_call_cancel(modem->call_set_property);
- dbus_message_iter_get_basic(&iter, &key);
+ if (modem->call_get_properties != NULL)
+ dbus_pending_call_cancel(modem->call_get_properties);
- dbus_message_iter_next(&iter);
- dbus_message_iter_recurse(&iter, &value);
+ if (modem->device != NULL)
+ destroy_device(modem);
- if (g_str_equal(key, "Modems") == TRUE)
- update_modems(&value);
+ g_free(modem->serial);
+ g_free(modem->imsi);
+ g_free(modem->path);
- return TRUE;
+ g_free(modem);
}
-static void get_dns(DBusMessageIter *array, struct connman_element *parent)
+static gboolean modem_added(DBusConnection *connection,
+ DBusMessage *message, void *user_data)
{
- DBusMessageIter entry;
- gchar *nameserver = NULL, *nameserver_old = NULL;
+ DBusMessageIter iter, properties;
+ const char *path;
DBG("");
- dbus_message_iter_recurse(array, &entry);
+ if (dbus_message_iter_init(message, &iter) == FALSE)
+ return TRUE;
- while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
- const char *dns;
+ dbus_message_iter_get_basic(&iter, &path);
- dbus_message_iter_get_basic(&entry, &dns);
+ dbus_message_iter_next(&iter);
+ dbus_message_iter_recurse(&iter, &properties);
- DBG("dns %s", dns);
+ add_modem(path, &properties);
- if (nameserver == NULL) {
+ return TRUE;
+}
- nameserver = g_strdup(dns);
- } else {
+static gboolean modem_removed(DBusConnection *connection,
+ DBusMessage *message, void *user_data)
+{
+ DBusMessageIter iter;
+ const char *path;
- nameserver_old = nameserver;
- nameserver = g_strdup_printf("%s %s",
- nameserver_old, dns);
- g_free(nameserver_old);
- }
+ DBG("");
- dbus_message_iter_next(&entry);
- }
+ if (dbus_message_iter_init(message, &iter) == FALSE)
+ return TRUE;
- parent->ipv4.nameserver = nameserver;
+ dbus_message_iter_get_basic(&iter, &path);
+
+ g_hash_table_remove(modem_hash, path);
+
+ return TRUE;
}
-static void update_settings(DBusMessageIter *array,
- struct connman_element *parent)
+static void manager_get_modems_reply(DBusPendingCall *call, void *user_data)
{
- DBusMessageIter dict;
- const char *interface = NULL;
+ DBusMessage *reply;
+ DBusError error;
+ DBusMessageIter array, dict;
DBG("");
- if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY)
- return;
-
- dbus_message_iter_recurse(array, &dict);
+ reply = dbus_pending_call_steal_reply(call);
- while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
- DBusMessageIter entry, value;
- const char *key;
+ dbus_error_init(&error);
- dbus_message_iter_recurse(&dict, &entry);
- dbus_message_iter_get_basic(&entry, &key);
+ if (dbus_set_error_from_message(&error, reply) == TRUE) {
+ connman_error("%s", error.message);
+ dbus_error_free(&error);
+ goto done;
+ }
- dbus_message_iter_next(&entry);
- dbus_message_iter_recurse(&entry, &value);
+ if (dbus_message_iter_init(reply, &array) == FALSE)
+ goto done;
- if (g_str_equal(key, "Interface") == TRUE) {
- int index;
+ dbus_message_iter_recurse(&array, &dict);
- dbus_message_iter_get_basic(&value, &interface);
+ while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_STRUCT) {
+ DBusMessageIter value, properties;
+ const char *path;
- DBG("interface %s", interface);
+ dbus_message_iter_recurse(&dict, &value);
+ dbus_message_iter_get_basic(&value, &path);
- index = connman_inet_ifindex(interface);
- if (index >= 0) {
- connman_network_set_index(
- pending_network, index);
- } else {
- connman_error("Can not find interface %s",
- interface);
- break;
- }
- } else if (g_str_equal(key, "Method") == TRUE) {
- const char *method;
+ dbus_message_iter_next(&value);
+ dbus_message_iter_recurse(&value, &properties);
- dbus_message_iter_get_basic(&value, &method);
- if (g_strcmp0(method, "static") == 0) {
+ add_modem(path, &properties);
- parent->ipv4.method =
- CONNMAN_IPCONFIG_METHOD_FIXED;
- } else if (g_strcmp0(method, "dhcp") == 0) {
+ dbus_message_iter_next(&dict);
+ }
- parent->ipv4.method =
- CONNMAN_IPCONFIG_METHOD_DHCP;
- break;
- }
- } else if (g_str_equal(key, "Address") == TRUE) {
- const char *address;
+done:
+ dbus_message_unref(reply);
- dbus_message_iter_get_basic(&value, &address);
+ dbus_pending_call_unref(call);
+}
- DBG("address %s", address);
+static int manager_get_modems(void)
+{
+ DBusMessage *message;
+ DBusPendingCall *call;
- parent->ipv4.address = g_strdup(address);
- } else if (g_str_equal(key, "Netmask") == TRUE) {
- const char *netmask;
+ DBG("");
- dbus_message_iter_get_basic(&value, &netmask);
+ message = dbus_message_new_method_call(OFONO_SERVICE, "/",
+ OFONO_MANAGER_INTERFACE, GET_MODEMS);
+ if (message == NULL)
+ return -ENOMEM;
- DBG("netmask %s", netmask);
+ if (dbus_connection_send_with_reply(connection, message,
+ &call, TIMEOUT) == FALSE) {
+ connman_error("Failed to call GetModems()");
+ dbus_message_unref(message);
+ return -EINVAL;
+ }
- parent->ipv4.netmask = g_strdup(netmask);
- } else if (g_str_equal(key, "DomainNameServers") == TRUE) {
+ if (call == NULL) {
+ connman_error("D-Bus connection not available");
+ dbus_message_unref(message);
+ return -EINVAL;
+ }
- get_dns(&value, parent);
- } else if (g_str_equal(key, "Gateway") == TRUE) {
- const char *gateway;
+ dbus_pending_call_set_notify(call, manager_get_modems_reply,
+ NULL, NULL);
- dbus_message_iter_get_basic(&value, &gateway);
+ dbus_message_unref(message);
- DBG("gateway %s", gateway);
+ return -EINPROGRESS;
+}
- parent->ipv4.gateway = g_strdup(gateway);
- }
+static void ofono_connect(DBusConnection *conn, void *user_data)
+{
+ DBG("");
- dbus_message_iter_next(&dict);
- }
+ modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal,
+ g_free, remove_modem);
+ if (modem_hash == NULL)
+ return;
- /* deactive, oFono send NULL inteface before deactive signal */
- if (interface == NULL)
- connman_network_set_index(pending_network, -1);
+ manager_get_modems();
}
-static void cleanup_ipconfig(struct connman_element *parent)
+static void ofono_disconnect(DBusConnection *conn, void *user_data)
{
- g_free(parent->ipv4.address);
- parent->ipv4.address = NULL;
+ DBG("");
- g_free(parent->ipv4.netmask);
- parent->ipv4.netmask = NULL;
+ if (modem_hash == NULL)
+ return;
- g_free(parent->ipv4.nameserver);
- parent->ipv4.nameserver = NULL;
+ g_hash_table_destroy(modem_hash);
+ modem_hash = NULL;
+}
- g_free(parent->ipv4.gateway);
- parent->ipv4.gateway = NULL;
+static int network_probe(struct connman_network *network)
+{
+ DBG("network %p", network);
- parent->ipv4.method = CONNMAN_IPCONFIG_METHOD_UNKNOWN;
+ return 0;
}
-static int static_network_set_connected(
- struct connman_network *pending_network,
- struct connman_element *parent,
- connman_bool_t connected)
+static void network_remove(struct connman_network *network)
{
- if (connected == FALSE)
- cleanup_ipconfig(parent);
+ DBG("network %p", network);
+}
- connman_network_set_connected(pending_network, connected);
+static int network_connect(struct connman_network *network)
+{
+ DBG("network %p", network);
return 0;
}
-static gboolean pri_context_changed(DBusConnection *connection,
- DBusMessage *message, void *user_data)
+static int network_disconnect(struct connman_network *network)
{
- const char *path = dbus_message_get_path(message);
- struct connman_element *parent;
- const char *pending_path;
- DBusMessageIter iter, value;
- const char *key;
+ DBG("network %p", network);
- DBG("pending_network %p, path %s", pending_network, path);
+ return 0;
+}
- if (pending_network == NULL)
- return TRUE;
+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,
+};
- pending_path = connman_network_get_string(pending_network, "Path");
- if (g_strcmp0(pending_path, path) != 0)
- return TRUE;
+static int modem_probe(struct connman_device *device)
+{
+ struct modem_data *modem = connman_device_get_data(device);
- parent = connman_network_get_element(pending_network);
+ DBG("%s device %p", modem->path, device);
- if (dbus_message_iter_init(message, &iter) == FALSE)
- return TRUE;
+ return 0;
+}
- dbus_message_iter_get_basic(&iter, &key);
+static void modem_remove(struct connman_device *device)
+{
+ struct modem_data *modem = connman_device_get_data(device);
- dbus_message_iter_next(&iter);
- dbus_message_iter_recurse(&iter, &value);
+ DBG("%s device %p", modem->path, device);
+}
- if (g_str_equal(key, "Settings") == TRUE) {
-
- update_settings(&value, parent);
- } else if (g_str_equal(key, "Active") == TRUE) {
- dbus_bool_t active;
-
- dbus_message_iter_get_basic(&value, &active);
-
- switch (parent->ipv4.method) {
- case CONNMAN_IPCONFIG_METHOD_UNKNOWN:
- case CONNMAN_IPCONFIG_METHOD_OFF:
- case CONNMAN_IPCONFIG_METHOD_MANUAL:
- break;
- case CONNMAN_IPCONFIG_METHOD_FIXED:
- connman_network_set_method(pending_network,
- CONNMAN_IPCONFIG_METHOD_FIXED);
-
- if (static_network_set_connected(
- pending_network, parent, active) < 0)
- set_network_active(pending_network, FALSE);
- break;
- case CONNMAN_IPCONFIG_METHOD_DHCP:
- connman_network_set_method(pending_network,
- CONNMAN_IPCONFIG_METHOD_DHCP);
- connman_network_set_connected(pending_network, active);
- break;
- }
+static int modem_enable(struct connman_device *device)
+{
+ struct modem_data *modem = connman_device_get_data(device);
- pending_network = NULL;
- }
+ DBG("%s device %p", modem->path, device);
- return TRUE;
+ return 0;
+}
+
+static int modem_disable(struct connman_device *device)
+{
+ struct modem_data *modem = connman_device_get_data(device);
+
+ DBG("%s device %p", modem->path, device);
+
+ return 0;
}
+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 guint watch;
-static guint gprs_watch;
+static guint modem_added_watch;
+static guint modem_removed_watch;
static guint modem_watch;
-static guint manager_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 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);
- gprs_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
- OFONO_GPRS_INTERFACE,
- PROPERTY_CHANGED,
- gprs_changed,
+ modem_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
+ OFONO_MANAGER_INTERFACE,
+ MODEM_ADDED,
+ modem_added,
+ NULL, NULL);
+
+ 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,
modem_changed,
NULL, NULL);
- manager_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
- OFONO_MANAGER_INTERFACE,
+ 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,
- manager_changed,
+ sim_changed,
+ NULL, NULL);
+
+ context_added_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
+ OFONO_CM_INTERFACE,
+ CONTEXT_ADDED,
+ cm_context_added,
+ NULL, NULL);
+
+ 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,
- OFONO_PRI_CONTEXT_INTERFACE,
+ OFONO_CONTEXT_INTERFACE,
+ PROPERTY_CHANGED,
+ context_changed,
+ NULL, NULL);
+
+ netreg_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
+ OFONO_NETREG_INTERFACE,
PROPERTY_CHANGED,
- pri_context_changed,
+ netreg_changed,
NULL, NULL);
- if (watch == 0 || gprs_watch == 0 || modem_watch == 0 ||
- manager_watch == 0 || context_watch == 0) {
+
+ 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) {
err = -EIO;
goto remove;
}
return 0;
remove:
- g_dbus_remove_watch(connection, watch);
- g_dbus_remove_watch(connection, gprs_watch);
- g_dbus_remove_watch(connection, modem_watch);
- g_dbus_remove_watch(connection, manager_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_removed_watch);
+ g_dbus_remove_watch(connection, modem_added_watch);
+ g_dbus_remove_watch(connection, watch);
dbus_connection_unref(connection);
return err;
static void ofono_exit(void)
{
- g_dbus_remove_watch(connection, watch);
- g_dbus_remove_watch(connection, gprs_watch);
- g_dbus_remove_watch(connection, modem_watch);
- g_dbus_remove_watch(connection, manager_watch);
- g_dbus_remove_watch(connection, context_watch);
+ DBG("");
- ofono_disconnect(connection, NULL);
+ if (modem_hash != NULL) {
+ g_hash_table_destroy(modem_hash);
+ modem_hash = NULL;
+ }
connman_device_driver_unregister(&modem_driver);
connman_network_driver_unregister(&network_driver);
+ 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);
}