diff options
Diffstat (limited to 'src/plugins/mbm/mm-sim-mbm.c')
| -rw-r--r-- | src/plugins/mbm/mm-sim-mbm.c | 242 |
1 files changed, 242 insertions, 0 deletions
diff --git a/src/plugins/mbm/mm-sim-mbm.c b/src/plugins/mbm/mm-sim-mbm.c new file mode 100644 index 00000000..d3f73954 --- /dev/null +++ b/src/plugins/mbm/mm-sim-mbm.c @@ -0,0 +1,242 @@ +/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */ +/* + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * 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: + * + * Copyright (C) 2012 Aleksander Morgado <aleksander@gnu.org> + */ + +#include <config.h> +#include <stdio.h> +#include <stdlib.h> +#include <unistd.h> +#include <string.h> +#include <ctype.h> + +#include <ModemManager.h> +#define _LIBMM_INSIDE_MM +#include <libmm-glib.h> + +#include "mm-log-object.h" +#include "mm-base-modem-at.h" +#include "mm-sim-mbm.h" + +G_DEFINE_TYPE (MMSimMbm, mm_sim_mbm, MM_TYPE_BASE_SIM) + +/*****************************************************************************/ +/* SEND PIN/PUK (Generic implementation) */ + +typedef struct { + MMBaseModem *modem; + guint retries; +} SendPinPukContext; + +static void +send_pin_puk_context_free (SendPinPukContext *ctx) +{ + g_object_unref (ctx->modem); + g_slice_free (SendPinPukContext, ctx); +} + +static gboolean +common_send_pin_puk_finish (MMBaseSim *self, + GAsyncResult *res, + GError **error) +{ + return g_task_propagate_boolean (G_TASK (res), error); +} + +static void wait_for_unlocked_status (GTask *task); + +static void +cpin_query_ready (MMBaseModem *modem, + GAsyncResult *res, + GTask *task) +{ + + const gchar *result; + + result = mm_base_modem_at_command_finish (modem, res, NULL); + if (result && strstr (result, "READY")) { + /* All done! */ + g_task_return_boolean (task, TRUE); + g_object_unref (task); + return; + } + + /* Need to recheck */ + wait_for_unlocked_status (task); +} + +static gboolean +cpin_query_cb (GTask *task) +{ + SendPinPukContext *ctx; + + ctx = g_task_get_task_data (task); + mm_base_modem_at_command (ctx->modem, + "+CPIN?", + 20, + FALSE, + (GAsyncReadyCallback)cpin_query_ready, + task); + return G_SOURCE_REMOVE; +} + +static void +wait_for_unlocked_status (GTask *task) +{ + MMSimMbm *self; + SendPinPukContext *ctx; + + self = g_task_get_source_object (task); + ctx = g_task_get_task_data (task); + + /* Oops... :/ */ + if (ctx->retries == 0) { + g_task_return_new_error (task, + MM_CORE_ERROR, + MM_CORE_ERROR_FAILED, + "PIN was sent but modem didn't report unlocked"); + g_object_unref (task); + return; + } + + /* Check status */ + ctx->retries--; + mm_obj_dbg (self, "scheduling lock state check..."); + g_timeout_add_seconds (1, (GSourceFunc)cpin_query_cb, task); +} + +static void +send_pin_puk_ready (MMBaseModem *modem, + GAsyncResult *res, + GTask *task) +{ + SendPinPukContext *ctx; + GError *error = NULL; + + mm_base_modem_at_command_finish (modem, res, &error); + if (error) { + g_task_return_error (task, error); + g_object_unref (task); + return; + } + + /* No explicit error sending the PIN/PUK, now check status until we have the + * expected lock status */ + ctx = g_task_get_task_data (task); + ctx->retries = 3; + wait_for_unlocked_status (task); +} + +static void +common_send_pin_puk (MMBaseSim *self, + const gchar *pin, + const gchar *puk, + GAsyncReadyCallback callback, + gpointer user_data) +{ + SendPinPukContext *ctx; + GTask *task; + gchar *command; + + ctx = g_slice_new (SendPinPukContext); + g_object_get (self, + MM_BASE_SIM_MODEM, &ctx->modem, + NULL); + + task = g_task_new (self, NULL, callback, user_data); + g_task_set_task_data (task, ctx, (GDestroyNotify)send_pin_puk_context_free); + + command = (puk ? + g_strdup_printf ("+CPIN=\"%s\",\"%s\"", puk, pin) : + g_strdup_printf ("+CPIN=\"%s\"", pin)); + mm_base_modem_at_command (ctx->modem, + command, + 3, + FALSE, + (GAsyncReadyCallback)send_pin_puk_ready, + task); + g_free (command); +} + +static void +send_puk (MMBaseSim *self, + const gchar *puk, + const gchar *new_pin, + GAsyncReadyCallback callback, + gpointer user_data) +{ + common_send_pin_puk (self, new_pin, puk, callback, user_data); +} + +static void +send_pin (MMBaseSim *self, + const gchar *pin, + GAsyncReadyCallback callback, + gpointer user_data) +{ + common_send_pin_puk (self, pin, NULL, callback, user_data); +} + +/*****************************************************************************/ + +MMBaseSim * +mm_sim_mbm_new_finish (GAsyncResult *res, + GError **error) +{ + GObject *source; + GObject *sim; + + source = g_async_result_get_source_object (res); + sim = g_async_initable_new_finish (G_ASYNC_INITABLE (source), res, error); + g_object_unref (source); + + if (!sim) + return NULL; + + /* Only export valid SIMs */ + mm_base_sim_export (MM_BASE_SIM (sim)); + + return MM_BASE_SIM (sim); +} + +void +mm_sim_mbm_new (MMBaseModem *modem, + GCancellable *cancellable, + GAsyncReadyCallback callback, + gpointer user_data) +{ + g_async_initable_new_async (MM_TYPE_SIM_MBM, + G_PRIORITY_DEFAULT, + cancellable, + callback, + user_data, + MM_BASE_SIM_MODEM, modem, + "active", TRUE, /* by default always active */ + NULL); +} + +static void +mm_sim_mbm_init (MMSimMbm *self) +{ +} + +static void +mm_sim_mbm_class_init (MMSimMbmClass *klass) +{ + MMBaseSimClass *base_sim_class = MM_BASE_SIM_CLASS (klass); + + base_sim_class->send_pin = send_pin; + base_sim_class->send_pin_finish = common_send_pin_puk_finish; + base_sim_class->send_puk = send_puk; + base_sim_class->send_puk_finish = common_send_pin_puk_finish; +} |