/* * * oFono - Open Source Telephony * * Copyright (C) 2008-2009 Intel Corporation. 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 * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA * */ #ifdef HAVE_CONFIG_H #include #endif #include #include #include #include #include "ofono.h" #include "driver.h" #include "common.h" #include "cssn.h" #include "sim.h" #define MODEM_FLAG_INITIALIZING_ATTRS 1 static GSList *g_modem_list = NULL; static int g_next_modem_id = 1; struct ofono_modem_data { char *manufacturer; char *model; char *revision; char *serial; GSList *interface_list; int flags; unsigned int idlist; struct ofono_modem_attribute_ops *ops; DBusMessage *pending; guint interface_update; }; struct ofono_atom { enum ofono_atom_type type; void (*destruct)(struct ofono_atom *atom); void (*unregister)(struct ofono_atom *atom); void *data; }; unsigned int __ofono_modem_alloc_callid(struct ofono_modem *modem) { struct ofono_modem_data *d = modem->modem_info; unsigned int i; for (i = 1; i < sizeof(d->idlist) * 8; i++) { if (d->idlist & (0x1 << i)) continue; d->idlist |= (0x1 << i); return i; } return 0; } void __ofono_modem_release_callid(struct ofono_modem *modem, int id) { struct ofono_modem_data *d = modem->modem_info; d->idlist &= ~(0x1 << id); } void ofono_modem_set_userdata(struct ofono_modem *modem, void *userdata) { if (modem) modem->userdata = userdata; } void *ofono_modem_get_userdata(struct ofono_modem *modem) { if (modem) return modem->userdata; return NULL; } const char *ofono_modem_get_path(struct ofono_modem *modem) { if (modem) return modem->path; return NULL; } struct ofono_atom *__ofono_modem_add_atom(struct ofono_modem *modem, enum ofono_atom_type type, void (*destruct)(struct ofono_atom *), void *data) { struct ofono_atom *atom; if (modem == NULL) return NULL; atom = g_new0(struct ofono_atom, 1); atom->type = type; atom->destruct = destruct; atom->data = data; modem->atoms = g_slist_prepend(modem->atoms, atom); return atom; } void *__ofono_atom_get_data(struct ofono_atom *atom) { return atom->data; } void __ofono_atom_register(struct ofono_atom *atom, void (*unregister)(struct ofono_atom *)) { atom->unregister = unregister; } void __ofono_atom_unregister(struct ofono_atom *atom) { if (atom->unregister) atom->unregister(atom); } struct ofono_atom *__ofono_modem_find_atom(struct ofono_modem *modem, enum ofono_atom_type type) { GSList *l; struct ofono_atom *atom; if (modem == NULL) return NULL; for (l = modem->atoms; l; l = l->next) { atom = l->data; if (atom->type == type) return atom; } return NULL; } void __ofono_modem_remove_atom(struct ofono_modem *modem, struct ofono_atom *atom) { if (modem == NULL) return; modem->atoms = g_slist_remove(modem->atoms, atom); __ofono_atom_unregister(atom); if (atom->destruct) atom->destruct(atom); g_free(atom); } static void remove_all_atoms(struct ofono_modem *modem) { GSList *l; struct ofono_atom *atom; if (modem == NULL) return; for (l = modem->atoms; l; l = l->next) { atom = l->data; __ofono_atom_unregister(atom); if (atom->destruct) atom->destruct(atom); g_free(atom); } g_slist_free(modem->atoms); modem->atoms = NULL; } static void modem_free(gpointer data) { struct ofono_modem *modem = data; GSList *l; if (modem == NULL) return; for (l = modem->modem_info->interface_list; l; l = l->next) g_free(l->data); g_slist_free(modem->modem_info->interface_list); g_free(modem->modem_info->manufacturer); g_free(modem->modem_info->serial); g_free(modem->modem_info->revision); g_free(modem->modem_info->model); if (modem->modem_info->pending) dbus_message_unref(modem->modem_info->pending); if (modem->modem_info->interface_update) g_source_remove(modem->modem_info->interface_update); g_free(modem->modem_info); g_free(modem->path); g_free(modem); } static DBusMessage *generate_properties_reply(struct ofono_modem *modem, DBusConnection *conn, DBusMessage *msg) { struct ofono_modem_data *info = modem->modem_info; DBusMessage *reply; DBusMessageIter iter; DBusMessageIter dict; char **interfaces; int i; GSList *l; reply = dbus_message_new_method_return(msg); if (!reply) return NULL; dbus_message_iter_init_append(reply, &iter); dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY, OFONO_PROPERTIES_ARRAY_SIGNATURE, &dict); if (info->manufacturer) ofono_dbus_dict_append(&dict, "Manufacturer", DBUS_TYPE_STRING, &info->manufacturer); if (info->model) ofono_dbus_dict_append(&dict, "Model", DBUS_TYPE_STRING, &info->model); if (info->revision) ofono_dbus_dict_append(&dict, "Revision", DBUS_TYPE_STRING, &info->revision); if (info->serial) ofono_dbus_dict_append(&dict, "Serial", DBUS_TYPE_STRING, &info->serial); interfaces = g_new0(char *, g_slist_length(info->interface_list) + 1); for (i = 0, l = info->interface_list; l; l = l->next, i++) interfaces[i] = l->data; ofono_dbus_dict_append_array(&dict, "Interfaces", DBUS_TYPE_STRING, &interfaces); g_free(interfaces); dbus_message_iter_close_container(&iter, &dict); return reply; } static DBusMessage *modem_get_properties(DBusConnection *conn, DBusMessage *msg, void *data) { struct ofono_modem *modem = data; if (modem->modem_info->flags & MODEM_FLAG_INITIALIZING_ATTRS) { modem->modem_info->pending = dbus_message_ref(msg); return NULL; } return generate_properties_reply(modem, conn, msg); } static GDBusMethodTable modem_methods[] = { { "GetProperties", "", "a{sv}", modem_get_properties, G_DBUS_METHOD_FLAG_ASYNC }, { } }; static GDBusSignalTable modem_signals[] = { { "PropertyChanged", "sv" }, { } }; static gboolean trigger_interface_update(void *data) { struct ofono_modem *modem = data; struct ofono_modem_data *info = modem->modem_info; DBusConnection *conn = ofono_dbus_get_connection(); char **interfaces; GSList *l; int i; interfaces = g_new0(char *, g_slist_length(info->interface_list) + 1); for (i = 0, l = info->interface_list; l; l = l->next, i++) interfaces[i] = l->data; ofono_dbus_signal_array_property_changed(conn, modem->path, OFONO_MODEM_INTERFACE, "Interfaces", DBUS_TYPE_STRING, &interfaces); g_free(interfaces); info->interface_update = 0; return FALSE; } void ofono_modem_add_interface(struct ofono_modem *modem, const char *interface) { struct ofono_modem_data *info = modem->modem_info; info->interface_list = g_slist_prepend(info->interface_list, g_strdup(interface)); if (info->interface_update == 0) info->interface_update = g_timeout_add(0, trigger_interface_update, modem); } void ofono_modem_remove_interface(struct ofono_modem *modem, const char *interface) { struct ofono_modem_data *info = modem->modem_info; GSList *found = g_slist_find_custom(info->interface_list, interface, (GCompareFunc) strcmp); if (!found) { ofono_error("Interface %s not found on the interface_list", interface); return; } g_free(found->data); info->interface_list = g_slist_remove(info->interface_list, found->data); if (info->interface_update == 0) info->interface_update = g_timeout_add(0, trigger_interface_update, modem); } static void finish_attr_query(struct ofono_modem *modem) { DBusConnection *conn = ofono_dbus_get_connection(); DBusMessage *reply; modem->modem_info->flags &= ~MODEM_FLAG_INITIALIZING_ATTRS; if (!modem->modem_info->pending) return; reply = generate_properties_reply(modem, conn, modem->modem_info->pending); if (reply) g_dbus_send_message(conn, reply); dbus_message_unref(modem->modem_info->pending); modem->modem_info->pending = NULL; } static void query_serial_cb(const struct ofono_error *error, const char *serial, void *user) { struct ofono_modem *modem = user; if (error->type == OFONO_ERROR_TYPE_NO_ERROR) modem->modem_info->serial = g_strdup(serial); finish_attr_query(modem); } static void query_serial(struct ofono_modem *modem) { if (!modem->modem_info->ops->query_serial) { finish_attr_query(modem); return; } modem->modem_info->ops->query_serial(modem, query_serial_cb, modem); } static void query_revision_cb(const struct ofono_error *error, const char *revision, void *user) { struct ofono_modem *modem = user; if (error->type == OFONO_ERROR_TYPE_NO_ERROR) modem->modem_info->revision = g_strdup(revision); query_serial(modem); } static void query_revision(struct ofono_modem *modem) { if (!modem->modem_info->ops->query_revision) { query_serial(modem); return; } modem->modem_info->ops->query_revision(modem, query_revision_cb, modem); } static void query_model_cb(const struct ofono_error *error, const char *model, void *user) { struct ofono_modem *modem = user; if (error->type == OFONO_ERROR_TYPE_NO_ERROR) modem->modem_info->model = g_strdup(model); query_revision(modem); } static void query_model(struct ofono_modem *modem) { if (!modem->modem_info->ops->query_model) { /* If model is not supported, don't bother querying revision */ query_serial(modem); return; } modem->modem_info->ops->query_model(modem, query_model_cb, modem); } static void query_manufacturer_cb(const struct ofono_error *error, const char *manufacturer, void *user) { struct ofono_modem *modem = user; if (error->type == OFONO_ERROR_TYPE_NO_ERROR) modem->modem_info->manufacturer = g_strdup(manufacturer); query_model(modem); } static gboolean query_manufacturer(gpointer user) { struct ofono_modem *modem = user; if (!modem->modem_info->ops->query_manufacturer) { query_model(modem); return FALSE; } modem->modem_info->ops->query_manufacturer(modem, query_manufacturer_cb, modem); return FALSE; } static struct ofono_modem *modem_create(int id, struct ofono_modem_attribute_ops *ops) { char path[128]; DBusConnection *conn = ofono_dbus_get_connection(); struct ofono_modem *modem; modem = g_try_new0(struct ofono_modem, 1); if (modem == NULL) return modem; modem->modem_info = g_try_new0(struct ofono_modem_data, 1); if (modem->modem_info == NULL) { g_free(modem); return NULL; } modem->id = id; modem->modem_info->ops = ops; snprintf(path, sizeof(path), "/modem%d", modem->id); modem->path = g_strdup(path); if (!g_dbus_register_interface(conn, path, OFONO_MODEM_INTERFACE, modem_methods, modem_signals, NULL, modem, modem_free)) { ofono_error("Modem interface init failed on path %s", path); modem_free(modem); return NULL; } ofono_sim_manager_init(modem); ofono_cssn_init(modem); modem->modem_info->flags |= MODEM_FLAG_INITIALIZING_ATTRS; g_timeout_add(0, query_manufacturer, modem); return modem; } static void modem_remove(struct ofono_modem *modem) { DBusConnection *conn = ofono_dbus_get_connection(); /* Need to make a copy to keep gdbus happy */ char *path = g_strdup(modem->path); ofono_debug("Removing modem: %s", modem->path); remove_all_atoms(modem); ofono_cssn_exit(modem); ofono_sim_manager_exit(modem); g_dbus_unregister_interface(conn, path, OFONO_MODEM_INTERFACE); g_free(path); } /* Clients only need to free *modems */ const char **__ofono_modem_get_list() { GSList *l; int i; struct ofono_modem *modem; const char **modems; modems = g_new0(const char *, g_slist_length(g_modem_list) + 1); for (l = g_modem_list, i = 0; l; l = l->next, i++) { modem = l->data; modems[i] = modem->path; } return modems; } struct ofono_modem *ofono_modem_register(struct ofono_modem_attribute_ops *ops) { struct ofono_modem *modem; DBusConnection *conn = ofono_dbus_get_connection(); const char **modems; modem = modem_create(g_next_modem_id, ops); if (modem == NULL) return 0; ++g_next_modem_id; __ofono_history_probe_drivers(modem); g_modem_list = g_slist_prepend(g_modem_list, modem); modems = __ofono_modem_get_list(); if (modems) { ofono_dbus_signal_array_property_changed(conn, OFONO_MANAGER_PATH, OFONO_MANAGER_INTERFACE, "Modems", DBUS_TYPE_OBJECT_PATH, &modems); g_free(modems); } return modem; } int ofono_modem_unregister(struct ofono_modem *m) { struct ofono_modem *modem = m; DBusConnection *conn = ofono_dbus_get_connection(); const char **modems; if (modem == NULL) return -1; __ofono_history_remove_drivers(modem); modem_remove(modem); g_modem_list = g_slist_remove(g_modem_list, modem); modems = __ofono_modem_get_list(); if (modems) { ofono_dbus_signal_array_property_changed(conn, OFONO_MANAGER_PATH, OFONO_MANAGER_INTERFACE, "Modems", DBUS_TYPE_OBJECT_PATH, &modems); g_free(modems); } return 0; }