[PATCH v3] telit-plugin: handle QSS unsolicited due to power state transitions

Carlo Lobrano c.lobrano at gmail.com
Mon Sep 4 06:05:15 UTC 2017


Please, ignore the previous v3 patch... I wasn't compiling the right
project and missed some errors.

On 4 September 2017 at 07:59, Carlo Lobrano <c.lobrano at gmail.com> wrote:

> When transitioning between power-low and power-on modes, Telit modems
> switch the SIM off/on, which leads to the emission of #QSS unsolicited not
> related to actual SIM swaps.
>
> To handle this #QSS unsolicited, this patch:
>
> * disables reacting on #QSS unsolicited when modem_power_down is received
> * implements modem_after_power_up that:
>     - checks whether the SIM has been changed, matching cached SIM
>       Identifier with the value in the current SIM. If SIM Identifier,
>       is different, sim hot swap ports detected is called.
>     - re-enables reacting on #QSS unsolicited
> ---
>
> Hi Aleksander,
>
> I should have fixed all the problems, but I'm still not sure about
> base-sim's implementation of mm_base_sim_load_sim_identifier and
> mm_base_sim_load_sim_identifier_finish.
> I saw that, generally, similar functions have their own ..._ready
> counterpart,
> and maybe a GTask that takes care of caller's callback,
> but I think I shouldn't need it and let the caller's callback do all the
> job. However, as I said, I'm not really sure this is right.
>
> ---
>  plugins/telit/mm-broadband-modem-telit.c | 181
> ++++++++++++++++++++++++++++++-
>  src/mm-base-sim.c                        |  51 +++++++++
>  src/mm-base-sim.h                        |  80 +++++++-------
>  3 files changed, 271 insertions(+), 41 deletions(-)
>
> diff --git a/plugins/telit/mm-broadband-modem-telit.c
> b/plugins/telit/mm-broadband-modem-telit.c
> index a9fc5f0..ac2c620 100644
> --- a/plugins/telit/mm-broadband-modem-telit.c
> +++ b/plugins/telit/mm-broadband-modem-telit.c
> @@ -58,6 +58,7 @@ struct _MMBroadbandModemTelitPrivate {
>      MMTelitCsimLockState csim_lock_state;
>      GTask *csim_lock_task;
>      guint csim_lock_timeout_id;
> +    gboolean parse_qss;
>  };
>
>  /***********************************************************
> ******************/
> @@ -151,10 +152,15 @@ telit_qss_unsolicited_handler (MMPortSerialAt *port,
>      }
>
>      if (cur_qss_status != prev_qss_status)
> -        mm_dbg ("QSS handler: status changed '%s -> %s",
> +        mm_dbg ("QSS handler: status changed '%s -> %s'",
>                  mm_telit_qss_status_get_string (prev_qss_status),
>                  mm_telit_qss_status_get_string (cur_qss_status));
>
> +    if (self->priv->parse_qss == FALSE) {
> +        mm_dbg ("QSS: message ignored");
> +        return;
> +    }
> +
>      if ((prev_qss_status == QSS_STATUS_SIM_REMOVED && cur_qss_status !=
> QSS_STATUS_SIM_REMOVED) ||
>          (prev_qss_status > QSS_STATUS_SIM_REMOVED && cur_qss_status ==
> QSS_STATUS_SIM_REMOVED)) {
>          mm_info ("QSS handler: SIM swap detected");
> @@ -903,14 +909,175 @@ modem_load_unlock_retries (MMIfaceModem *self,
>  }
>
>  /***********************************************************
> ******************/
> +/* Modem after power up (Modem interface) */
> +typedef enum {
> +    AFTER_POWER_UP_STEP_FIRST,
> +    AFTER_POWER_UP_STEP_GET_SIM_IDENTIFIER,
> +    AFTER_POWER_UP_STEP_ENABLE_QSS_PARSING,
> +    AFTER_POWER_UP_STEP_LAST
> +} ModemAfterPowerUpStep;
> +
> +typedef struct {
> +    gboolean has_sim_changed;
> +    guint retries;
> +    ModemAfterPowerUpStep step;
> +} AfterPowerUpContext;
> +
> +static void after_power_up_step (GTask *task);
> +
> +static gboolean
> +modem_after_power_up_finish (MMIfaceModem *self,
> +                             GAsyncResult *res,
> +                             GError **error)
> +{
> +    return g_task_propagate_boolean (G_TASK (res), error);
> +}
> +
> +static void
> +load_sim_identifier_ready (MMBaseSim *sim,
> +                           GAsyncResult *res,
> +                           GTask *task)
> +{
> +    AfterPowerUpContext *ctx;
> +    GError *error = NULL;
> +    gchar *current_simid;
> +    gchar *cached_simid;
> +
> +    ctx = g_task_get_task_data (task);
> +
> +    cached_simid = (gchar *)mm_gdbus_sim_get_sim_identifier
> (MM_GDBUS_SIM (sim));
> +    current_simid = mm_base_sim_load_sim_identifier_finish (sim, res,
> &error);
> +
> +    if (error) {
> +        if (g_error_matches (error, MM_CORE_ERROR,
> MM_CORE_ERROR_UNSUPPORTED)) {
> +            mm_warn ("could not load SIM identifier: %s", error->message);
> +            g_clear_error (error);
> +            goto out;
> +        }
> +
> +        if (ctx->retries-- > 0) {
> +            mm_warn ("could not load SIM identifier: %s (%d retries
> left)",
> +                     error->message, ctx->retries);
> +            g_clear_error (&error);
> +            g_timeout_add_seconds (1, (GSourceFunc) after_power_up_step,
> task);
> +            return;
> +        }
> +
> +        mm_warn ("could not load SIM identifier: %s", error->message);
> +        g_clear_error (&error);
> +        goto out;
> +    }
> +
> +    if (g_strcmp0 (current_simid, cached_simid) != 0) {
> +        mm_warn ("sim identifier has changed: possible SIM swap during
> power down/low");
> +        ctx->has_sim_changed = TRUE;
> +    }
> +
> +out:
> +    g_free (current_simid);
> +    ctx->step++;
> +    after_power_up_step (task);
> +}
> +
> +static void
> +after_power_up_step (GTask *task)
> +{
> +    AfterPowerUpContext *ctx;
> +    MMBroadbandModemTelit *self;
> +    MMBaseSim *sim = NULL;
> +
> +    ctx = g_task_get_task_data (task);
> +    self = g_task_get_source_object (task);
> +
> +    g_object_get (MM_BROADBAND_MODEM_TELIT (self),
> +                  MM_IFACE_MODEM_SIM, &sim,
> +                  NULL);
> +    if (!sim) {
> +        g_task_return_new_error (task,
> +                                 MM_CORE_ERROR,
> +                                 MM_CORE_ERROR_FAILED,
> +                                 "could not acquire sim object");
> +        return;
> +    }
> +
> +    switch (ctx->step) {
> +    case AFTER_POWER_UP_STEP_FIRST:
> +        /* Fall back on next step */
> +        ctx->step++;
> +    case AFTER_POWER_UP_STEP_GET_SIM_IDENTIFIER:
> +        mm_base_sim_load_sim_identifier (sim,
> +                                         (GAsyncReadyCallback)load_sim_
> identifier_ready,
> +                                         task);
> +        g_object_unref (sim);
> +        return;
> +    case AFTER_POWER_UP_STEP_ENABLE_QSS_PARSING:
> +        mm_dbg ("Stop ignoring #QSS");
> +        self->priv->parse_qss = TRUE;
> +
> +        /* Fall back on next step */
> +        ctx->step++;
> +    case AFTER_POWER_UP_STEP_LAST:
> +        if (ctx->has_sim_changed)
> +            mm_broadband_modem_update_sim_hot_swap_detected
> (MM_BROADBAND_MODEM (self));
> +
> +        g_task_return_boolean (task, TRUE);
> +        g_object_unref (task);
> +        break;
> +    default:
> +        g_assert_not_reached ();
> +    }
> +}
> +
> +static void
> +modem_after_power_up (MMIfaceModem *self,
> +                      GAsyncReadyCallback callback,
> +                      gpointer user_data)
> +{
> +    GTask *task;
> +    AfterPowerUpContext *ctx;
> +
> +    ctx = g_new0 (AfterPowerUpContext, 1);
> +    ctx->step = AFTER_POWER_UP_STEP_FIRST;
> +    ctx->has_sim_changed = FALSE;
> +    ctx->retries = 3;
> +
> +    task = g_task_new (self, NULL, callback, user_data);
> +    g_task_set_task_data (task, ctx, (GDestroyNotify) g_free);
> +
> +    after_power_up_step (task);
> +}
> +
> +
> +/**********************************************************
> *******************/
>  /* Modem power down (Modem interface) */
>
> +static void
> +telit_modem_power_down_ready (MMBaseModem *self,
> +                              GAsyncResult *res,
> +                              GTask *task)
> +{
> +    GError *error = NULL;
> +
> +    if (mm_base_modem_at_command_finish (self, res, &error)) {
> +        mm_dbg ("Ignore #QSS unsolicited during power down/low");
> +        MM_BROADBAND_MODEM_TELIT (self)->priv->parse_qss = FALSE;
> +    }
> +
> +    if (error) {
> +        mm_err ("modem power down: %s", error->message)
> +        g_clear_error (&error);
> +    }
> +
> +    g_task_return_boolean (task, TRUE);
> +    g_object_unref (task);
> +}
> +
>  static gboolean
>  modem_power_down_finish (MMIfaceModem *self,
>                           GAsyncResult *res,
>                           GError **error)
>  {
> -    return !!mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res,
> error);
> +    return g_task_propagate_boolean (G_TASK (res), error);
>  }
>
>  static void
> @@ -918,12 +1085,15 @@ modem_power_down (MMIfaceModem *self,
>                    GAsyncReadyCallback callback,
>                    gpointer user_data)
>  {
> +    GTask *task;
> +
> +    task = g_task_new (self, NULL, callback, user_data);
>      mm_base_modem_at_command (MM_BASE_MODEM (self),
>                                "+CFUN=4",
>                                20,
>                                FALSE,
> -                              callback,
> -                              user_data);
> +                              (GAsyncReadyCallback)
> telit_modem_power_down_ready,
> +                              task);
>  }
>
>  /***********************************************************
> ******************/
> @@ -1457,6 +1627,7 @@ mm_broadband_modem_telit_init (MMBroadbandModemTelit
> *self)
>      self->priv->csim_lock_support = FEATURE_SUPPORT_UNKNOWN;
>      self->priv->csim_lock_state = CSIM_LOCK_STATE_UNKNOWN;
>      self->priv->qss_status = QSS_STATUS_UNKNOWN;
> +    self->priv->parse_qss = TRUE;
>  }
>
>  static void
> @@ -1474,6 +1645,8 @@ iface_modem_init (MMIfaceModem *iface)
>      iface->load_unlock_retries = modem_load_unlock_retries;
>      iface->reset = modem_reset;
>      iface->reset_finish = modem_reset_finish;
> +    iface->modem_after_power_up = modem_after_power_up;
> +    iface->modem_after_power_up_finish = modem_after_power_up_finish;
>      iface->modem_power_down = modem_power_down;
>      iface->modem_power_down_finish = modem_power_down_finish;
>      iface->load_access_technologies = load_access_technologies;
> diff --git a/src/mm-base-sim.c b/src/mm-base-sim.c
> index f3525e0..d03f342 100644
> --- a/src/mm-base-sim.c
> +++ b/src/mm-base-sim.c
> @@ -701,6 +701,57 @@ mm_base_sim_send_puk (MMBaseSim *self,
>  }
>
>  /***********************************************************
> ******************/
> +/* LOAD SIM IDENTIFIER */
> +gchar *
> +mm_base_sim_load_sim_identifier_finish (MMBaseSim *self,
> +                                        GAsyncResult *res,
> +                                        GError **error) {
> +    GError *inner_error = NULL;
> +    gchar *simid;
> +
> +    if (g_async_result_is_tagged (res, mm_base_sim_load_sim_identifier)
> ||
> +        !MM_BASE_SIM_GET_CLASS (self)->load_sim_identifier_finish) {
> +        inner_error = g_error_new (MM_CORE_ERROR,
> MM_CORE_ERROR_UNSUPPORTED,
> +                                   "not implemented");
> +        g_propagate_error (error, inner_error);
> +        return NULL;
> +    }
> +
> +    simid = MM_BASE_SIM_GET_CLASS (self)->load_sim_identifier_finish
> (self, res, &inner_error);
> +    if (inner_error) {
> +        g_propagate_error (error, inner_error);
> +        return NULL;
> +    }
> +
> +    return simid;
> +}
> +
> +void
> +mm_base_sim_load_sim_identifier (MMBaseSim *self,
> +                                 GAsyncReadyCallback callback,
> +                                 gpointer user_data)
> +{
> +    if (!MM_BASE_SIM_GET_CLASS (self)->load_sim_identifier &&
> +        !MM_BASE_SIM_GET_CLASS (self)->load_sim_identifier_finish) {
> +        g_task_report_new_error (self,
> +                                 callback,
> +                                 user_data,
> +                                 mm_base_sim_load_sim_identifier,
> +                                 MM_CORE_ERROR,
> +                                 MM_CORE_ERROR_UNSUPPORTED,
> +                                 "not implemented");
> +        return;
> +    }
> +
> +    MM_BASE_SIM_GET_CLASS (self)->load_sim_identifier (
> +            self,
> +            (GAsyncReadyCallback)callback,
> +            user_data);
> +
> +    return;
> +}
> +
> +/**********************************************************
> *******************/
>  /* SEND PIN (DBus call handling) */
>
>  typedef struct {
> diff --git a/src/mm-base-sim.h b/src/mm-base-sim.h
> index 1903994..22f02c8 100644
> --- a/src/mm-base-sim.h
> +++ b/src/mm-base-sim.h
> @@ -50,8 +50,7 @@ struct _MMBaseSim {
>
>  struct _MMBaseSimClass {
>      MmGdbusSimSkeletonClass parent;
> -
> -    /* Load SIM identifier (async) */
> +/* Load SIM identifier (async) */
>      void    (* load_sim_identifier)        (MMBaseSim *self,
>                                              GAsyncReadyCallback callback,
>                                              gpointer user_data);
> @@ -129,40 +128,47 @@ struct _MMBaseSimClass {
>
>  GType mm_base_sim_get_type (void);
>
> -void         mm_base_sim_new               (MMBaseModem *modem,
> -                                            GCancellable *cancellable,
> -                                            GAsyncReadyCallback callback,
> -                                            gpointer user_data);
> -MMBaseSim   *mm_base_sim_new_finish        (GAsyncResult  *res,
> -                                            GError       **error);
> -
> -void         mm_base_sim_initialize        (MMBaseSim *self,
> -                                            GCancellable *cancellable,
> -                                            GAsyncReadyCallback callback,
> -                                            gpointer user_data);
> -gboolean     mm_base_sim_initialize_finish (MMBaseSim *self,
> -                                            GAsyncResult *result,
> -                                            GError **error);
> -
> -void         mm_base_sim_send_pin          (MMBaseSim *self,
> -                                            const gchar *pin,
> -                                            GAsyncReadyCallback callback,
> -                                            gpointer user_data);
> -gboolean     mm_base_sim_send_pin_finish   (MMBaseSim *self,
> -                                            GAsyncResult *res,
> -                                            GError **error);
> -
> -void         mm_base_sim_send_puk          (MMBaseSim *self,
> -                                            const gchar *puk,
> -                                            const gchar *new_pin,
> -                                            GAsyncReadyCallback callback,
> -                                            gpointer user_data);
> -gboolean     mm_base_sim_send_puk_finish   (MMBaseSim *self,
> -                                            GAsyncResult *res,
> -                                            GError **error);
> -
> -void         mm_base_sim_export            (MMBaseSim *self);
> -
> -const gchar *mm_base_sim_get_path          (MMBaseSim *sim);
> +void         mm_base_sim_new                        (MMBaseModem *modem,
> +                                                     GCancellable
> *cancellable,
> +                                                     GAsyncReadyCallback
> callback,
> +                                                     gpointer user_data);
> +MMBaseSim   *mm_base_sim_new_finish                 (GAsyncResult  *res,
> +                                                     GError
>  **error);
> +
> +void         mm_base_sim_initialize                 (MMBaseSim *self,
> +                                                     GCancellable
> *cancellable,
> +                                                     GAsyncReadyCallback
> callback,
> +                                                     gpointer user_data);
> +gboolean     mm_base_sim_initialize_finish          (MMBaseSim *self,
> +                                                     GAsyncResult *result,
> +                                                     GError **error);
> +
> +void         mm_base_sim_send_pin                   (MMBaseSim *self,
> +                                                     const gchar *pin,
> +                                                     GAsyncReadyCallback
> callback,
> +                                                     gpointer user_data);
> +gboolean     mm_base_sim_send_pin_finish            (MMBaseSim *self,
> +                                                     GAsyncResult *res,
> +                                                     GError **error);
> +
> +void         mm_base_sim_send_puk                   (MMBaseSim *self,
> +                                                     const gchar *puk,
> +                                                     const gchar *new_pin,
> +                                                     GAsyncReadyCallback
> callback,
> +                                                     gpointer user_data);
> +gboolean     mm_base_sim_send_puk_finish            (MMBaseSim *self,
> +                                                     GAsyncResult *res,
> +                                                     GError **error);
> +
> +void         mm_base_sim_export                     (MMBaseSim *self);
> +
> +const gchar *mm_base_sim_get_path                   (MMBaseSim *sim);
> +
> +void          mm_base_sim_load_sim_identifier        (MMBaseSim *self,
> +                                                     GAsyncReadyCallback
> callback,
> +                                                     gpointer user_data);
> +gchar       *mm_base_sim_load_sim_identifier_finish (MMBaseSim *self,
> +                                                     GAsyncResult *res,
> +                                                     GError **error);
>
>  #endif /* MM_BASE_SIM_H */
> --
> 2.9.3
>
>
-------------- next part --------------
An HTML attachment was scrubbed...
URL: <https://lists.freedesktop.org/archives/modemmanager-devel/attachments/20170904/df12b241/attachment-0001.html>


More information about the ModemManager-devel mailing list