--- Makefile.am | 3 + plugins/allowed-apns.c | 272 +++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 275 insertions(+) create mode 100644 plugins/allowed-apns.c diff --git a/Makefile.am b/Makefile.am index f1a89cc..c788149 100644 --- a/Makefile.am +++ b/Makefile.am @@ -572,6 +572,9 @@ builtin_sources += plugins/smart-messaging.c builtin_modules += push_notification builtin_sources += plugins/push-notification.c +builtin_modules += allowed_apns +builtin_sources += plugins/allowed-apns.c + sbin_PROGRAMS = src/ofonod src_ofonod_SOURCES = $(builtin_sources) $(gatchat_sources) src/ofono.ver \ diff --git a/plugins/allowed-apns.c b/plugins/allowed-apns.c new file mode 100644 index 0000000..77ede86 --- /dev/null +++ b/plugins/allowed-apns.c @@ -0,0 +1,272 @@ +/* + * + * oFono - Open Source Telephony + * + * Copyright (C) 2008-2016 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 <config.h> +#endif + +#include <stdio.h> +#include <string.h> +#include <errno.h> +#include <glib.h> +#include <ofono.h> +#include <simutil.h> + +#define OFONO_API_SUBJECT_TO_CHANGE +#include <ofono/plugin.h> +#include <ofono/log.h> +#include <ofono/modem.h> +#include <ofono/sim.h> +#include <ofono/dbus.h> +#include <gdbus.h> + +#define SIM_EFACL_FILEID 0x6f57 + +#define ALLOWED_ACCESS_POINTS_INTERFACE "org.ofono.AllowedAccessPoints" + +guint modemwatch_id; + +struct allowed_apns_ctx { + guint simwatch_id; + guint atomwatch_id; + struct ofono_modem *modem; + struct ofono_sim *sim; + struct ofono_sim_context *sim_context; + DBusMessage *pending; + DBusMessage *reply; +}; + +GSList *context_list; + +static void context_destroy(gpointer data) +{ + struct allowed_apns_ctx *ctx = data; + + if (ctx->simwatch_id) + ofono_sim_remove_state_watch(ctx->sim, + ctx->simwatch_id); + + if (ctx->atomwatch_id) + __ofono_modem_remove_atom_watch(ctx->modem, + ctx->atomwatch_id); + + if (ctx->sim_context) + ofono_sim_context_free(ctx->sim_context); + + context_list = g_slist_remove(context_list, ctx); + + g_free(ctx); +} + +static void sim_acl_read_cb(int ok, int total_length, int record, + const unsigned char *data, int record_length, + void *userdata) +{ + struct allowed_apns_ctx *ctx = userdata; + DBusMessage *reply = ctx->reply; + DBusMessageIter iter; + DBusMessageIter array; + struct simple_tlv_iter tlv_iter; + char *apn; + + if (!ok) { + reply = __ofono_error_failed(ctx->pending); + __ofono_dbus_pending_reply(&ctx->pending, reply); + return; + } + + reply = dbus_message_new_method_return(ctx->pending); + if (reply == NULL) + return; + + dbus_message_iter_init_append(reply, &iter); + + dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY, + DBUS_TYPE_STRING_AS_STRING, + &array); + + if (data[0] == 0) + goto done; + + simple_tlv_iter_init(&tlv_iter, &data[1], total_length - 1); + + while (simple_tlv_iter_next(&tlv_iter)) { + if (simple_tlv_iter_get_tag(&tlv_iter) != 0xDD) + continue; + + apn = g_strndup( + (char *) simple_tlv_iter_get_data(&tlv_iter), + simple_tlv_iter_get_length(&tlv_iter)); + + dbus_message_iter_append_basic(&array, + DBUS_TYPE_STRING, + &apn); + + g_free(apn); + } + +done: + dbus_message_iter_close_container(&iter, &array); + + __ofono_dbus_pending_reply(&ctx->pending, reply); +} + +static DBusMessage *get_allowed_apns(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + struct allowed_apns_ctx *ctx = data; + + if (ctx->pending) + return __ofono_error_busy(msg); + + ctx->pending = dbus_message_ref(msg); + + ofono_sim_read(ctx->sim_context, SIM_EFACL_FILEID, + OFONO_SIM_FILE_STRUCTURE_TRANSPARENT, + sim_acl_read_cb, ctx); + + return NULL; +} + +static const GDBusMethodTable allowed_apns_methods[] = { + { GDBUS_ASYNC_METHOD("GetAllowedAccessPoints", + NULL, GDBUS_ARGS({ "apnlist", "as" }), + get_allowed_apns) }, + { } +}; + +static void sim_state_watch(enum ofono_sim_state new_state, void *data) +{ + struct allowed_apns_ctx *ctx = data; + DBusConnection *conn = ofono_dbus_get_connection(); + + if (new_state != OFONO_SIM_STATE_READY) { + g_dbus_unregister_interface(conn, + ofono_modem_get_path(ctx->modem), + ALLOWED_ACCESS_POINTS_INTERFACE); + + ofono_modem_remove_interface(ctx->modem, + ALLOWED_ACCESS_POINTS_INTERFACE); + + return; + } + + if (!g_dbus_register_interface(conn, + ofono_modem_get_path(ctx->modem), + ALLOWED_ACCESS_POINTS_INTERFACE, + allowed_apns_methods, NULL, NULL, + ctx, NULL)) { + ofono_error("Cannot create %s Interface\n", + ALLOWED_ACCESS_POINTS_INTERFACE); + + return; + } + + ofono_modem_add_interface(ctx->modem, + ALLOWED_ACCESS_POINTS_INTERFACE); +} + +static void sim_watch(struct ofono_atom *atom, + enum ofono_atom_watch_condition cond, + void *data) +{ + struct allowed_apns_ctx *ctx = data; + + if (cond == OFONO_ATOM_WATCH_CONDITION_UNREGISTERED) { + if (ctx->sim_context) + ofono_sim_context_free(ctx->sim_context); + + return; + } + + ctx->sim = __ofono_atom_get_data(atom); + + ctx->sim_context = ofono_sim_context_create(ctx->sim); + + ctx->simwatch_id = ofono_sim_add_state_watch(ctx->sim, + sim_state_watch, + ctx, NULL); +} + +static gint context_list_modem_compare(gconstpointer data1, + gconstpointer data2) +{ + const struct allowed_apns_ctx *ctx = data1; + const struct ofono_modem *modem = data2; + return (ctx->modem == modem); +} + +static void modem_watch(struct ofono_modem *modem, + gboolean added, void *userdata) +{ + struct allowed_apns_ctx *ctx; + GSList *l; + + if (added == FALSE) { + l = g_slist_find_custom(context_list, + modem, context_list_modem_compare); + + if (l) { + ctx = l->data; + context_destroy(ctx); + context_list = g_slist_delete_link(context_list, l); + } + + return; + } + + ctx = g_try_new0(struct allowed_apns_ctx, 1); + if (ctx == NULL) + return; + + context_list = g_slist_prepend(context_list, ctx); + + ctx->modem = modem; + + ctx->atomwatch_id = __ofono_modem_add_atom_watch(ctx->modem, + OFONO_ATOM_TYPE_SIM, + sim_watch, ctx, NULL); +} + +static void call_modemwatch(struct ofono_modem *modem, void *userdata) +{ + modem_watch(modem, TRUE, userdata); +} + +static int allowed_apns_init(void) +{ + modemwatch_id = __ofono_modemwatch_add(modem_watch, NULL, NULL); + + __ofono_modem_foreach(call_modemwatch, NULL); + + return 0; +} + +static void allowed_apns_exit(void) +{ + __ofono_modemwatch_remove(modemwatch_id); + + g_slist_free_full(context_list, context_destroy); +} + +OFONO_PLUGIN_DEFINE(allowed_apns, "Plugin to read EFACL from SIM", + VERSION, OFONO_PLUGIN_PRIORITY_DEFAULT, + allowed_apns_init, allowed_apns_exit) -- 1.9.1