/* * * 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 #include "ofono.h" #include "common.h" #include "simutil.h" #include "util.h" #define NETWORK_REGISTRATION_INTERFACE "org.ofono.NetworkRegistration" #define NETWORK_OPERATOR_INTERFACE "org.ofono.NetworkOperator" #define NETWORK_REGISTRATION_FLAG_REQUESTING_OPLIST 0x1 #define NETWORK_REGISTRATION_FLAG_PENDING 0x2 #define NETWORK_REGISTRATION_FLAG_HOME_SHOW_PLMN 0x4 #define NETWORK_REGISTRATION_FLAG_ROAMING_SHOW_SPN 0x8 #define AUTO_REGISTER 1 /* How often we update the operator list, in seconds */ #define OPERATOR_LIST_UPDATE_TIME 300 static GSList *g_drivers = NULL; /* 27.007 Section 7.3 */ enum operator_status { OPERATOR_STATUS_UNKNOWN = 0, OPERATOR_STATUS_AVAILABLE = 1, OPERATOR_STATUS_CURRENT = 2, OPERATOR_STATUS_FORBIDDEN = 3 }; struct ofono_netreg { int status; int location; int cellid; int technology; struct network_operator_data *current_operator; GSList *operator_list; struct ofono_network_registration_ops *ops; int flags; DBusMessage *pending; int signal_strength; char *spname; struct sim_spdi *spdi; struct sim_eons *eons; gint opscan_source; struct ofono_sim *sim; unsigned int sim_watch; unsigned int sim_ready_watch; const struct ofono_netreg_driver *driver; void *driver_data; struct ofono_atom *atom; }; static void operator_list_callback(const struct ofono_error *error, int total, const struct ofono_network_operator *list, void *data); static void current_operator_callback(const struct ofono_error *error, const struct ofono_network_operator *current, void *data); static void signal_strength_callback(const struct ofono_error *error, int strength, void *data); static void registration_status_callback(const struct ofono_error *error, int status, int lac, int ci, int tech, void *data); struct network_operator_data { struct ofono_network_operator *info; const struct sim_eons_operator_info *eons_info; struct ofono_netreg *netreg; }; static inline const char *network_operator_status_to_string(int status) { switch (status) { case OPERATOR_STATUS_AVAILABLE: return "available"; case OPERATOR_STATUS_CURRENT: return "current"; case OPERATOR_STATUS_FORBIDDEN: return "forbidden"; } return "unknown"; } static inline const char *registration_status_to_string(int status) { switch (status) { case NETWORK_REGISTRATION_STATUS_NOT_REGISTERED: return "unregistered"; case NETWORK_REGISTRATION_STATUS_REGISTERED: return "registered"; case NETWORK_REGISTRATION_STATUS_SEARCHING: return "searching"; case NETWORK_REGISTRATION_STATUS_DENIED: return "denied"; case NETWORK_REGISTRATION_STATUS_UNKNOWN: return "unknown"; case NETWORK_REGISTRATION_STATUS_ROAMING: return "roaming"; } return ""; } static inline const char *registration_tech_to_string(int tech) { switch (tech) { case ACCESS_TECHNOLOGY_GSM: return "GSM"; case ACCESS_TECHNOLOGY_GSM_COMPACT: return "GSMCompact"; case ACCESS_TECHNOLOGY_UTRAN: return "UTRAN"; case ACCESS_TECHNOLOGY_GSM_EGPRS: return "GSM+EGPRS"; case ACCESS_TECHNOLOGY_UTRAN_HSDPA: return "UTRAN+HSDPA"; case ACCESS_TECHNOLOGY_UTRAN_HSUPA: return "UTRAN+HSUPA"; case ACCESS_TECHNOLOGY_UTRAN_HSDPA_HSUPA: return "UTRAN+HSDPA+HSUPA"; case ACCESS_TECHNOLOGY_EUTRAN: return "EUTRAN"; default: return ""; } } static void register_callback(const struct ofono_error *error, void *data) { struct ofono_netreg *netreg = data; DBusConnection *conn = ofono_dbus_get_connection(); DBusMessage *reply; if (!netreg->pending) goto out; if (error->type == OFONO_ERROR_TYPE_NO_ERROR) reply = dbus_message_new_method_return(netreg->pending); else reply = __ofono_error_failed(netreg->pending); g_dbus_send_message(conn, reply); dbus_message_unref(netreg->pending); netreg->pending = NULL; out: netreg->flags &= ~NETWORK_REGISTRATION_FLAG_PENDING; if (netreg->driver->registration_status) netreg->driver->registration_status(netreg, registration_status_callback, netreg); } /* Must use g_strfreev on network_operators */ static void network_operator_populate_registered(struct ofono_netreg *netreg, char ***network_operators) { DBusConnection *conn = ofono_dbus_get_connection(); char **children; int i; int prefix_len; int num_children; GSList *l; char path[256]; char mnc[OFONO_MAX_MNC_LENGTH + 1]; char mcc[OFONO_MAX_MCC_LENGTH + 1]; int op_path_len; prefix_len = snprintf(path, sizeof(path), "%s/operator", __ofono_atom_get_path(netreg->atom)); if (!dbus_connection_list_registered(conn, path, &children)) { ofono_debug("Unable to obtain registered NetworkOperator(s)"); *network_operators = g_try_new0(char *, 1); return; } for (i = 0; children[i]; i++) ; num_children = i; *network_operators = g_try_new0(char *, num_children + 1); /* Enough to store '/' + MCC + MNC + null */ op_path_len = prefix_len; op_path_len += OFONO_MAX_MCC_LENGTH + OFONO_MAX_MNC_LENGTH + 2; /* Quoting 27.007: "The list of operators shall be in order: home * network, networks referenced in SIM or active application in the * UICC (GSM or USIM) in the following order: HPLMN selector, User * controlled PLMN selector, Operator controlled PLMN selector and * PLMN selector (in the SIM or GSM application), and other networks." * Thus we must make sure we return the list in the same order, * if possible. Luckily the operator_list is stored in order already */ i = 0; for (l = netreg->operator_list; l; l = l->next) { struct network_operator_data *opd = l->data; struct ofono_network_operator *op = opd->info; int j; for (j = 0; children[j]; j++) { sscanf(children[j], "%3[0-9]%[0-9]", mcc, mnc); if (!strcmp(op->mcc, mcc) && !strcmp(op->mnc, mnc)) { (*network_operators)[i] = g_try_new(char, op_path_len); snprintf((*network_operators)[i], op_path_len, "%s/%s", path, children[j]); ++i; } } } dbus_free_string_array(children); } static void network_operator_destroy(gpointer userdata) { struct network_operator_data *op = userdata; g_free(op->info); g_free(op); } static gint network_operator_compare(gconstpointer a, gconstpointer b) { const struct network_operator_data *opda = a; const struct ofono_network_operator *opa = opda->info; const struct ofono_network_operator *opb = b; int comp1; int comp2; comp1 = strcmp(opa->mcc, opb->mcc); comp2 = strcmp(opa->mnc, opb->mnc); return comp1 != 0 ? comp1 : comp2; } static inline const char *network_operator_build_path(struct ofono_netreg *netreg, const struct ofono_network_operator *oper) { static char path[256]; snprintf(path, sizeof(path), "%s/operator/%s%s", __ofono_atom_get_path(netreg->atom), oper->mcc, oper->mnc); return path; } static void network_operator_emit_available_operators(struct ofono_netreg *netreg) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path = __ofono_atom_get_path(netreg->atom); char **network_operators; network_operator_populate_registered(netreg, &network_operators); ofono_dbus_signal_array_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "AvailableOperators", DBUS_TYPE_OBJECT_PATH, &network_operators); g_strfreev(network_operators); } static void set_network_operator_status(struct ofono_netreg *netreg, struct network_operator_data *opd, int status) { struct ofono_network_operator *op = opd->info; DBusConnection *conn = ofono_dbus_get_connection(); const char *status_str; const char *path; if (op->status == status) return; op->status = status; status_str = network_operator_status_to_string(status); path = network_operator_build_path(netreg, op); ofono_dbus_signal_property_changed(conn, path, NETWORK_OPERATOR_INTERFACE, "Status", DBUS_TYPE_STRING, &status_str); } static void set_network_operator_technology(struct ofono_netreg *netreg, struct network_operator_data *opd, int tech) { struct ofono_network_operator *op = opd->info; DBusConnection *conn = ofono_dbus_get_connection(); const char *tech_str; const char *path; if (op->tech == tech) return; op->tech = tech; tech_str = registration_tech_to_string(tech); path = network_operator_build_path(netreg, op); ofono_dbus_signal_property_changed(conn, path, NETWORK_OPERATOR_INTERFACE, "Technology", DBUS_TYPE_STRING, &tech_str); } static char *get_operator_display_name(struct ofono_netreg *netreg) { struct network_operator_data *current = netreg->current_operator; struct ofono_network_operator *op; const char *plmn; static char name[1024]; int len = sizeof(name); int home_or_spdi; /* The name displayed to user depends on whether we're in a home * PLMN or roaming and on configuration bits from the SIM, all * together there are four cases to consider. */ if (!current) { g_strlcpy(name, "", len); return name; } op = current->info; plmn = op->name; if (current->eons_info && current->eons_info->longname) plmn = current->eons_info->longname; if (!netreg->spname || strlen(netreg->spname) == 0) { g_strlcpy(name, plmn, len); return name; } if (netreg->status == NETWORK_REGISTRATION_STATUS_REGISTERED) home_or_spdi = TRUE; else home_or_spdi = sim_spdi_lookup(netreg->spdi, op->mcc, op->mnc); if (home_or_spdi) if (netreg->flags & NETWORK_REGISTRATION_FLAG_HOME_SHOW_PLMN) /* Case 1 */ snprintf(name, len, "%s (%s)", netreg->spname, plmn); else /* Case 2 */ snprintf(name, len, "%s", netreg->spname); else if (netreg->flags & NETWORK_REGISTRATION_FLAG_ROAMING_SHOW_SPN) /* Case 3 */ snprintf(name, len, "%s (%s)", netreg->spname, plmn); else /* Case 4 */ snprintf(name, len, "%s", plmn); return name; } static void set_network_operator_name(struct ofono_netreg *netreg, struct network_operator_data *opd, const char *name) { struct ofono_network_operator *op = opd->info; DBusConnection *conn = ofono_dbus_get_connection(); const char *path; const char *operator; if (!strncmp(op->name, name, OFONO_MAX_OPERATOR_NAME_LENGTH)) return; strncpy(op->name, name, OFONO_MAX_OPERATOR_NAME_LENGTH); op->name[OFONO_MAX_OPERATOR_NAME_LENGTH] = '\0'; /* If we have Enhanced Operator Name info on the SIM, we always use * that, so do not need to emit the signal here */ if (opd->eons_info && opd->eons_info->longname) return; path = network_operator_build_path(netreg, op); ofono_dbus_signal_property_changed(conn, path, NETWORK_OPERATOR_INTERFACE, "Name", DBUS_TYPE_STRING, &name); if (opd == netreg->current_operator) { const char *path = __ofono_atom_get_path(netreg->atom); operator = get_operator_display_name(netreg); ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Operator", DBUS_TYPE_STRING, &operator); } } static void set_network_operator_eons_info(struct ofono_netreg *netreg, struct network_operator_data *opd, const struct sim_eons_operator_info *eons_info) { DBusConnection *conn = ofono_dbus_get_connection(); const struct sim_eons_operator_info *old_eons_info = opd->eons_info; const char *path; const char *oldname; const char *newname; const char *oldinfo; const char *newinfo; if (!old_eons_info && !eons_info) return; path = network_operator_build_path(netreg, opd->info); opd->eons_info = eons_info; if (old_eons_info && old_eons_info->longname) oldname = old_eons_info->longname; else oldname = opd->info->name; if (eons_info && eons_info->longname) newname = eons_info->longname; else newname = opd->info->name; if (oldname != newname && strcmp(oldname, newname)) { ofono_dbus_signal_property_changed(conn, path, NETWORK_OPERATOR_INTERFACE, "Name", DBUS_TYPE_STRING, &newname); if (opd == netreg->current_operator) { const char *npath = __ofono_atom_get_path(netreg->atom); const char *operator = get_operator_display_name(netreg); ofono_dbus_signal_property_changed(conn, npath, NETWORK_REGISTRATION_INTERFACE, "Operator", DBUS_TYPE_STRING, &operator); } } if (old_eons_info && old_eons_info->info) oldinfo = old_eons_info->info; else oldinfo = ""; if (eons_info && eons_info->info) newname = eons_info->info; else newinfo = ""; if (oldname != newname && strcmp(oldname, newname)) ofono_dbus_signal_property_changed(conn, path, NETWORK_OPERATOR_INTERFACE, "AdditionalInformation", DBUS_TYPE_STRING, &newinfo); } static DBusMessage *network_operator_get_properties(DBusConnection *conn, DBusMessage *msg, void *data) { struct network_operator_data *opd = data; DBusMessage *reply; DBusMessageIter iter; DBusMessageIter dict; const char *name = opd->info->name; const char *status = network_operator_status_to_string(opd->info->status); if (opd->eons_info && opd->eons_info->longname) name = opd->eons_info->longname; 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); ofono_dbus_dict_append(&dict, "Name", DBUS_TYPE_STRING, &name); ofono_dbus_dict_append(&dict, "Status", DBUS_TYPE_STRING, &status); if (*opd->info->mcc != '\0') { const char *mcc = opd->info->mcc; ofono_dbus_dict_append(&dict, "MobileCountryCode", DBUS_TYPE_STRING, &mcc); } if (*opd->info->mnc != '\0') { const char *mnc = opd->info->mnc; ofono_dbus_dict_append(&dict, "MobileNetworkCode", DBUS_TYPE_STRING, &mnc); } if (opd->info->tech != -1) { const char *technology = registration_tech_to_string(opd->info->tech); ofono_dbus_dict_append(&dict, "Technology", DBUS_TYPE_STRING, &technology); } if (opd->eons_info && opd->eons_info->info) { const char *additional = opd->eons_info->info; ofono_dbus_dict_append(&dict, "AdditionalInformation", DBUS_TYPE_STRING, &additional); } dbus_message_iter_close_container(&iter, &dict); return reply; } static DBusMessage *network_operator_register(DBusConnection *conn, DBusMessage *msg, void *data) { struct network_operator_data *op = data; struct ofono_netreg *netreg = op->netreg; if (netreg->flags & NETWORK_REGISTRATION_FLAG_PENDING) return __ofono_error_busy(msg); if (netreg->driver->register_manual == NULL) return __ofono_error_not_implemented(msg); netreg->flags |= NETWORK_REGISTRATION_FLAG_PENDING; netreg->pending = dbus_message_ref(msg); netreg->driver->register_manual(netreg, op->info, register_callback, netreg); return NULL; } static GDBusMethodTable network_operator_methods[] = { { "GetProperties", "", "a{sv}", network_operator_get_properties }, { "Register", "", "", network_operator_register, G_DBUS_METHOD_FLAG_ASYNC }, { } }; static GDBusSignalTable network_operator_signals[] = { { "PropertyChanged", "sv" }, { } }; static struct network_operator_data * network_operator_dbus_register(struct ofono_netreg *netreg, const struct ofono_network_operator *op, enum operator_status status) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path; struct network_operator_data *opd = NULL; path = network_operator_build_path(netreg, op); opd = g_try_new(struct network_operator_data, 1); if (!opd) goto err; opd->info = g_memdup(op, sizeof(struct ofono_network_operator)); if (opd->info == NULL) goto err; opd->info->status = status; opd->netreg = netreg; opd->eons_info = NULL; if (netreg->eons) opd->eons_info = sim_eons_lookup(netreg->eons, op->mcc, op->mnc); if (!g_dbus_register_interface(conn, path, NETWORK_OPERATOR_INTERFACE, network_operator_methods, network_operator_signals, NULL, opd, network_operator_destroy)) goto err; return opd; err: if (opd) network_operator_destroy(opd); ofono_error("Could not register NetworkOperator %s", path); return NULL; } static gboolean network_operator_dbus_unregister(struct ofono_netreg *netreg, struct network_operator_data *opd) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path = network_operator_build_path(netreg, opd->info); return g_dbus_unregister_interface(conn, path, NETWORK_OPERATOR_INTERFACE); } static DBusMessage *network_get_properties(DBusConnection *conn, DBusMessage *msg, void *data) { struct ofono_netreg *netreg = data; DBusMessage *reply; DBusMessageIter iter; DBusMessageIter dict; const char *status = registration_status_to_string(netreg->status); const char *operator; char **network_operators; 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); ofono_dbus_dict_append(&dict, "Status", DBUS_TYPE_STRING, &status); if (netreg->location != -1) { dbus_uint16_t location = netreg->location; ofono_dbus_dict_append(&dict, "LocationAreaCode", DBUS_TYPE_UINT16, &location); } if (netreg->cellid != -1) { dbus_uint32_t cellid = netreg->cellid; ofono_dbus_dict_append(&dict, "CellId", DBUS_TYPE_UINT32, &cellid); } if (netreg->technology != -1) { const char *technology = registration_tech_to_string(netreg->technology); ofono_dbus_dict_append(&dict, "Technology", DBUS_TYPE_STRING, &technology); } operator = get_operator_display_name(netreg); ofono_dbus_dict_append(&dict, "Operator", DBUS_TYPE_STRING, &operator); network_operator_populate_registered(netreg, &network_operators); ofono_dbus_dict_append_array(&dict, "AvailableOperators", DBUS_TYPE_OBJECT_PATH, &network_operators); g_strfreev(network_operators); if (netreg->signal_strength != -1) { dbus_uint16_t strength = netreg->signal_strength; ofono_dbus_dict_append(&dict, "Strength", DBUS_TYPE_UINT16, &strength); } dbus_message_iter_close_container(&iter, &dict); return reply; } static DBusMessage *network_register(DBusConnection *conn, DBusMessage *msg, void *data) { struct ofono_netreg *netreg = data; if (netreg->flags & NETWORK_REGISTRATION_FLAG_PENDING) return __ofono_error_busy(msg); if (netreg->driver->register_auto == NULL) return __ofono_error_not_implemented(msg); netreg->flags |= NETWORK_REGISTRATION_FLAG_PENDING; netreg->pending = dbus_message_ref(msg); netreg->driver->register_auto(netreg, register_callback, netreg); return NULL; } static DBusMessage *network_deregister(DBusConnection *conn, DBusMessage *msg, void *data) { struct ofono_netreg *netreg = data; if (netreg->flags & NETWORK_REGISTRATION_FLAG_PENDING) return __ofono_error_busy(msg); if (netreg->driver->deregister == NULL) return __ofono_error_not_implemented(msg); netreg->flags |= NETWORK_REGISTRATION_FLAG_PENDING; netreg->pending = dbus_message_ref(msg); netreg->driver->deregister(netreg, register_callback, netreg); return NULL; } static GDBusMethodTable network_registration_methods[] = { { "GetProperties", "", "a{sv}", network_get_properties }, { "Register", "", "", network_register, G_DBUS_METHOD_FLAG_ASYNC }, { "Deregister", "", "", network_deregister, G_DBUS_METHOD_FLAG_ASYNC }, { } }; static GDBusSignalTable network_registration_signals[] = { { "PropertyChanged", "sv" }, { } }; static void update_network_operator_list(struct ofono_netreg *netreg) { if (netreg->flags & NETWORK_REGISTRATION_FLAG_REQUESTING_OPLIST) return; if (!netreg->driver->list_operators) return; netreg->flags |= NETWORK_REGISTRATION_FLAG_REQUESTING_OPLIST; netreg->driver->list_operators(netreg, operator_list_callback, netreg); } static gboolean update_network_operator_list_cb(void *user_data) { struct ofono_netreg *netreg = user_data; update_network_operator_list(netreg); return TRUE; } static gboolean update_network_operator_list_init(void *user_data) { struct ofono_netreg *netreg = user_data; update_network_operator_list(netreg); netreg->opscan_source = g_timeout_add_seconds(OPERATOR_LIST_UPDATE_TIME, update_network_operator_list_cb, netreg); return FALSE; } static void set_registration_status(struct ofono_netreg *netreg, int status) { const char *str_status = registration_status_to_string(status); const char *path = __ofono_atom_get_path(netreg->atom); DBusConnection *conn = ofono_dbus_get_connection(); netreg->status = status; ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Status", DBUS_TYPE_STRING, &str_status); } static void set_registration_location(struct ofono_netreg *netreg, int lac) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path = __ofono_atom_get_path(netreg->atom); dbus_uint16_t dbus_lac = lac; if (lac > 0xffff) return; netreg->location = lac; if (netreg->location == -1) return; ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "LocationAreaCode", DBUS_TYPE_UINT16, &dbus_lac); } static void set_registration_cellid(struct ofono_netreg *netreg, int ci) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path = __ofono_atom_get_path(netreg->atom); dbus_uint32_t dbus_ci = ci; netreg->cellid = ci; if (netreg->cellid == -1) return; ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "CellId", DBUS_TYPE_UINT32, &dbus_ci); } static void set_registration_technology(struct ofono_netreg *netreg, int tech) { const char *tech_str = registration_tech_to_string(tech); DBusConnection *conn = ofono_dbus_get_connection(); const char *path = __ofono_atom_get_path(netreg->atom); netreg->technology = tech; if (netreg->technology == -1) return; ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Technology", DBUS_TYPE_STRING, &tech_str); } void ofono_netreg_status_notify(struct ofono_netreg *netreg, int status, int lac, int ci, int tech) { if (!netreg) return; if (netreg->status != status) set_registration_status(netreg, status); if (netreg->location != lac) set_registration_location(netreg, lac); if (netreg->cellid != ci) set_registration_cellid(netreg, ci); if (netreg->technology != tech) set_registration_technology(netreg, tech); if (netreg->status == NETWORK_REGISTRATION_STATUS_REGISTERED || netreg->status == NETWORK_REGISTRATION_STATUS_ROAMING) { if (netreg->driver->current_operator) netreg->driver->current_operator(netreg, current_operator_callback, netreg); } else { struct ofono_error error; error.type = OFONO_ERROR_TYPE_NO_ERROR; error.error = 0; current_operator_callback(&error, NULL, netreg); netreg->signal_strength = -1; } } static void operator_list_callback(const struct ofono_error *error, int total, const struct ofono_network_operator *list, void *data) { struct ofono_netreg *netreg = data; GSList *n = NULL; GSList *o; int i; gboolean need_to_emit = FALSE; netreg->flags &= ~NETWORK_REGISTRATION_FLAG_REQUESTING_OPLIST; if (error->type != OFONO_ERROR_TYPE_NO_ERROR) { ofono_debug("Error occurred during operator list"); return; } for (i = 0; i < total; i++) { o = g_slist_find_custom(netreg->operator_list, &list[i], network_operator_compare); if (o) { /* Update and move to a new list */ set_network_operator_status(netreg, o->data, list[i].status); set_network_operator_technology(netreg, o->data, list[i].tech); set_network_operator_name(netreg, o->data, list[i].name); n = g_slist_prepend(n, o->data); netreg->operator_list = g_slist_remove(netreg->operator_list, o->data); } else { /* New operator */ struct network_operator_data *opd; opd = network_operator_dbus_register(netreg, &list[i], list[i].status); if (!opd) continue; n = g_slist_prepend(n, opd); need_to_emit = TRUE; } } if (n) n = g_slist_reverse(n); if (netreg->operator_list) need_to_emit = TRUE; for (o = netreg->operator_list; o; o = o->next) network_operator_dbus_unregister(netreg, o->data); g_slist_free(netreg->operator_list); netreg->operator_list = n; if (need_to_emit) network_operator_emit_available_operators(netreg); } static void current_operator_callback(const struct ofono_error *error, const struct ofono_network_operator *current, void *data) { DBusConnection *conn = ofono_dbus_get_connection(); struct ofono_netreg *netreg = data; const char *path = __ofono_atom_get_path(netreg->atom); GSList *op = NULL; const char *operator; DBG("%p, %p", netreg, netreg->current_operator); if (error->type != OFONO_ERROR_TYPE_NO_ERROR) { ofono_debug("Error during current operator"); return; } if (!netreg->current_operator && !current) return; /* We got a new network operator, reset the previous one's status */ /* It will be updated properly later */ if (netreg->current_operator && (!current || network_operator_compare(netreg->current_operator, current))) set_network_operator_status(netreg, netreg->current_operator, OPERATOR_STATUS_AVAILABLE); if (current) op = g_slist_find_custom(netreg->operator_list, current, network_operator_compare); if (op) { set_network_operator_status(netreg, op->data, OPERATOR_STATUS_CURRENT); set_network_operator_technology(netreg, op->data, current->tech); set_network_operator_name(netreg, op->data, current->name); if (netreg->current_operator == op->data) return; netreg->current_operator = op->data; goto emit; } if (current) { struct network_operator_data *opd; opd = network_operator_dbus_register(netreg, current, OPERATOR_STATUS_CURRENT); if (!opd) return; netreg->current_operator = opd; netreg->operator_list = g_slist_append(netreg->operator_list, opd); network_operator_emit_available_operators(netreg); } else { /* We don't free this here because operator is registered */ /* Taken care of elsewhere */ netreg->current_operator = NULL; } emit: operator = get_operator_display_name(netreg); ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Operator", DBUS_TYPE_STRING, &operator); } static void registration_status_callback(const struct ofono_error *error, int status, int lac, int ci, int tech, void *data) { struct ofono_netreg *netreg = data; if (error->type != OFONO_ERROR_TYPE_NO_ERROR) { ofono_debug("Error during registration status query"); return; } ofono_netreg_status_notify(netreg, status, lac, ci, tech); } static void init_registration_status(const struct ofono_error *error, int status, int lac, int ci, int tech, void *data) { struct ofono_netreg *netreg = data; if (error->type != OFONO_ERROR_TYPE_NO_ERROR) { ofono_debug("Error during registration status query"); return; } ofono_netreg_status_notify(netreg, status, lac, ci, tech); /* Bootstrap our signal strength value without waiting for the * stack to report it */ if (netreg->status == NETWORK_REGISTRATION_STATUS_REGISTERED || netreg->status == NETWORK_REGISTRATION_STATUS_ROAMING) { if (netreg->driver->strength) netreg->driver->strength(netreg, signal_strength_callback, netreg); } if (AUTO_REGISTER && (status == NETWORK_REGISTRATION_STATUS_NOT_REGISTERED || status == NETWORK_REGISTRATION_STATUS_DENIED)) netreg->driver->register_auto(netreg, register_callback, netreg); } void ofono_netreg_strength_notify(struct ofono_netreg *netreg, int strength) { DBusConnection *conn = ofono_dbus_get_connection(); if (netreg->signal_strength == strength) return; /* Theoretically we can get signal strength even when not registered * to any network. However, what do we do with it in that case? */ if (netreg->status != NETWORK_REGISTRATION_STATUS_REGISTERED && netreg->status != NETWORK_REGISTRATION_STATUS_ROAMING) return; netreg->signal_strength = strength; if (strength != -1) { const char *path = __ofono_atom_get_path(netreg->atom); dbus_uint16_t strength = netreg->signal_strength; ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Strength", DBUS_TYPE_UINT16, &strength); } } static void signal_strength_callback(const struct ofono_error *error, int strength, void *data) { struct ofono_netreg *netreg = data; if (error->type != OFONO_ERROR_TYPE_NO_ERROR) { ofono_debug("Error during signal strength query"); return; } ofono_netreg_strength_notify(netreg, strength); } static void sim_opl_read_cb(int ok, enum ofono_sim_file_structure structure, int length, int record, const unsigned char *data, int record_length, void *userdata) { struct ofono_netreg *netreg = userdata; int total; GSList *l; if (!ok) { if (record > 0) goto optimize; return; } if (structure != OFONO_SIM_FILE_STRUCTURE_FIXED) return; if (record_length < 8 || length < record_length) return; total = length / record_length; sim_eons_add_opl_record(netreg->eons, data, record_length); if (record != total) return; optimize: sim_eons_optimize(netreg->eons); for (l = netreg->operator_list; l; l = l->next) { struct network_operator_data *opd = l->data; const struct sim_eons_operator_info *eons_info; eons_info = sim_eons_lookup(netreg->eons, opd->info->mcc, opd->info->mnc); set_network_operator_eons_info(netreg, opd, eons_info); } } static void sim_pnn_read_cb(int ok, enum ofono_sim_file_structure structure, int length, int record, const unsigned char *data, int record_length, void *userdata) { struct ofono_netreg *netreg = userdata; int total; if (!ok) goto check; if (structure != OFONO_SIM_FILE_STRUCTURE_FIXED) return; if (length < 3 || record_length < 3 || length < record_length) return; total = length / record_length; if (!netreg->eons) netreg->eons = sim_eons_new(total); sim_eons_add_pnn_record(netreg->eons, record, data, record_length); if (record != total) return; check: /* If PNN is not present then OPL is not useful, don't * retrieve it. If OPL is not there then PNN[1] will * still be used for the HPLMN and/or EHPLMN, if PNN * is present. */ if (netreg->eons && !sim_eons_pnn_is_empty(netreg->eons)) ofono_sim_read(netreg->sim, SIM_EFOPL_FILEID, sim_opl_read_cb, netreg); } static void sim_spdi_read_cb(int ok, enum ofono_sim_file_structure structure, int length, int record, const unsigned char *data, int record_length, void *userdata) { struct ofono_netreg *netreg = userdata; struct network_operator_data *current = netreg->current_operator; if (!ok) return; if (structure != OFONO_SIM_FILE_STRUCTURE_TRANSPARENT) return; netreg->spdi = sim_spdi_new(data, length); if (!current) return; if (netreg->status == NETWORK_REGISTRATION_STATUS_ROAMING) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path = __ofono_atom_get_path(netreg->atom); const char *operator; if (!sim_spdi_lookup(netreg->spdi, current->info->mcc, current->info->mnc)) return; operator = get_operator_display_name(netreg); ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Operator", DBUS_TYPE_STRING, &operator); } } static void sim_spn_read_cb(int ok, enum ofono_sim_file_structure structure, int length, int record, const unsigned char *data, int record_length, void *userdata) { struct ofono_netreg *netreg = userdata; unsigned char dcbyte; char *spn; if (!ok) return; if (structure != OFONO_SIM_FILE_STRUCTURE_TRANSPARENT) return; dcbyte = data[0]; /* TS 31.102 says: * * the string shall use: * * - either the SMS default 7-bit coded alphabet as defined in * TS 23.038 [5] with bit 8 set to 0. The string shall be left * justified. Unused bytes shall be set to 'FF'. * * - or one of the UCS2 code options defined in the annex of TS * 31.101 [11]. * * 31.101 has no such annex though. 51.101 refers to Annex B of * itself which is not there either. 11.11 contains the same * paragraph as 51.101 and has an Annex B which we implement. */ spn = sim_string_to_utf8(data + 1, length - 1); if (!spn) { ofono_error("EFspn read successfully, but couldn't parse"); return; } if (strlen(spn) == 0) { g_free(spn); return; } netreg->spname = spn; ofono_sim_read(netreg->sim, SIM_EFSPDI_FILEID, sim_spdi_read_cb, netreg); if (dcbyte & SIM_EFSPN_DC_HOME_PLMN_BIT) netreg->flags |= NETWORK_REGISTRATION_FLAG_HOME_SHOW_PLMN; if (!(dcbyte & SIM_EFSPN_DC_ROAMING_SPN_BIT)) netreg->flags |= NETWORK_REGISTRATION_FLAG_ROAMING_SHOW_SPN; if (netreg->current_operator) { DBusConnection *conn = ofono_dbus_get_connection(); const char *path = __ofono_atom_get_path(netreg->atom); const char *operator; operator = get_operator_display_name(netreg); ofono_dbus_signal_property_changed(conn, path, NETWORK_REGISTRATION_INTERFACE, "Operator", DBUS_TYPE_STRING, &operator); } } int ofono_netreg_get_location(struct ofono_netreg *netreg) { if (netreg == NULL) return -1; return netreg->location; } int ofono_netreg_get_cellid(struct ofono_netreg *netreg) { if (netreg == NULL) return -1; return netreg->cellid; } int ofono_netreg_get_status(struct ofono_netreg *netreg) { if (netreg == NULL) return -1; return netreg->status; } int ofono_netreg_get_technology(struct ofono_netreg *netreg) { if (netreg == NULL) return -1; return netreg->technology; } const struct ofono_network_operator * ofono_netreg_get_operator(struct ofono_netreg *netreg) { if (netreg == NULL) return NULL; if (netreg->current_operator == NULL) return NULL; return netreg->current_operator->info; } int ofono_netreg_driver_register(const struct ofono_netreg_driver *d) { DBG("driver: %p, name: %s", d, d->name); if (d->probe == NULL) return -EINVAL; g_drivers = g_slist_prepend(g_drivers, (void *)d); return 0; } void ofono_netreg_driver_unregister(const struct ofono_netreg_driver *d) { DBG("driver: %p, name: %s", d, d->name); g_drivers = g_slist_remove(g_drivers, (void *)d); } static void netreg_unregister(struct ofono_atom *atom) { struct ofono_netreg *netreg = __ofono_atom_get_data(atom); DBusConnection *conn = ofono_dbus_get_connection(); struct ofono_modem *modem = __ofono_atom_get_modem(atom); const char *path = __ofono_atom_get_path(atom); GSList *l; if (netreg->sim_watch) { __ofono_modem_remove_atom_watch(modem, netreg->sim_watch); netreg->sim_watch = 0; } if (netreg->sim_ready_watch) { ofono_sim_remove_ready_watch(netreg->sim, netreg->sim_ready_watch); netreg->sim_ready_watch = 0; netreg->sim = NULL; } if (netreg->opscan_source) { g_source_remove(netreg->opscan_source); netreg->opscan_source = 0; } for (l = netreg->operator_list; l; l = l->next) network_operator_dbus_unregister(netreg, l->data); g_slist_free(netreg->operator_list); netreg->operator_list = NULL; g_dbus_unregister_interface(conn, path, NETWORK_REGISTRATION_INTERFACE); ofono_modem_remove_interface(modem, NETWORK_REGISTRATION_INTERFACE); } static void netreg_remove(struct ofono_atom *atom) { struct ofono_netreg *netreg = __ofono_atom_get_data(atom); DBG("atom: %p", atom); if (netreg == NULL) return; if (netreg->driver && netreg->driver->remove) netreg->driver->remove(netreg); if (netreg->eons) sim_eons_free(netreg->eons); if (netreg->spdi) sim_spdi_free(netreg->spdi); if (netreg->spname) g_free(netreg->spname); g_free(netreg); } struct ofono_netreg *ofono_netreg_create(struct ofono_modem *modem, unsigned int vendor, const char *driver, void *data) { struct ofono_netreg *netreg; GSList *l; if (driver == NULL) return NULL; netreg = g_try_new0(struct ofono_netreg, 1); if (netreg == NULL) return NULL; netreg->status = NETWORK_REGISTRATION_STATUS_UNKNOWN; netreg->location = -1; netreg->cellid = -1; netreg->technology = -1; netreg->signal_strength = -1; netreg->atom = __ofono_modem_add_atom(modem, OFONO_ATOM_TYPE_NETREG, netreg_remove, netreg); for (l = g_drivers; l; l = l->next) { const struct ofono_netreg_driver *drv = l->data; if (g_strcmp0(drv->name, driver)) continue; if (drv->probe(netreg, vendor, data) < 0) continue; netreg->driver = drv; break; } return netreg; } static void netreg_sim_ready(void *userdata) { struct ofono_netreg *netreg = userdata; ofono_sim_read(netreg->sim, SIM_EFPNN_FILEID, sim_pnn_read_cb, netreg); ofono_sim_read(netreg->sim, SIM_EFSPN_FILEID, sim_spn_read_cb, netreg); if (netreg->driver->list_operators) netreg->opscan_source = g_timeout_add_seconds(5, update_network_operator_list_init, netreg); if (netreg->driver->registration_status) netreg->driver->registration_status(netreg, init_registration_status, netreg); } static void netreg_sim_watch(struct ofono_atom *atom, enum ofono_atom_watch_condition cond, void *data) { struct ofono_netreg *netreg = data; if (cond == OFONO_ATOM_WATCH_CONDITION_UNREGISTERED) { netreg->sim = NULL; netreg->sim_ready_watch = 0; return; } netreg->sim = __ofono_atom_get_data(atom); netreg->sim_ready_watch = ofono_sim_add_ready_watch(netreg->sim, netreg_sim_ready, netreg, NULL); if (ofono_sim_get_ready(netreg->sim)) netreg_sim_ready(netreg); } void ofono_netreg_register(struct ofono_netreg *netreg) { DBusConnection *conn = ofono_dbus_get_connection(); struct ofono_modem *modem = __ofono_atom_get_modem(netreg->atom); const char *path = __ofono_atom_get_path(netreg->atom); struct ofono_atom *sim_atom; if (!g_dbus_register_interface(conn, path, NETWORK_REGISTRATION_INTERFACE, network_registration_methods, network_registration_signals, NULL, netreg, NULL)) { ofono_error("Could not create %s interface", NETWORK_REGISTRATION_INTERFACE); return; } ofono_modem_add_interface(modem, NETWORK_REGISTRATION_INTERFACE); netreg->sim_watch = __ofono_modem_add_atom_watch(modem, OFONO_ATOM_TYPE_SIM, netreg_sim_watch, netreg, NULL); sim_atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_SIM); if (sim_atom && __ofono_atom_get_registered(sim_atom)) netreg_sim_watch(sim_atom, OFONO_ATOM_WATCH_CONDITION_REGISTERED, netreg); __ofono_atom_register(netreg->atom, netreg_unregister); } void ofono_netreg_remove(struct ofono_netreg *netreg) { __ofono_atom_free(netreg->atom); } void ofono_netreg_set_data(struct ofono_netreg *netreg, void *data) { netreg->driver_data = data; } void *ofono_netreg_get_data(struct ofono_netreg *netreg) { return netreg->driver_data; }