iridium: override generic initialization

We must send ATZ alone and once reply received, wait some time before sending
the next initialization commands. Otherwise, the next commands will receive
garbage as reply. The only way to handle this is to override the whole generic
initialization phase.

1 files changed, 98 insertions, 0 deletions

diff --git a/plugins/mm-broadband-modem-iridium.c b/plugins/mm-broadband-modem-iridium.c
index d8667b1c..9e4d72c5 100644
--- a/plugins/mm-broadband-modem-iridium.c
+++ b/plugins/mm-broadband-modem-iridium.c
@@ -41,6 +41,100 @@ G_DEFINE_TYPE_EXTENDED (MMBroadbandModemIridium, mm_broadband_modem_iridium, MM_
                         G_IMPLEMENT_INTERFACE (MM_TYPE_IFACE_MODEM_3GPP, iface_modem_3gpp_init));
 
 /*****************************************************************************/
+/* Initializing the modem (Modem interface) */
+
+static gboolean
+modem_init_finish (MMIfaceModem *self,
+                   GAsyncResult *res,
+                   GError **error)
+{
+    return !g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error);
+}
+
+static const MMBaseModemAtCommand modem_init_sequence[] = {
+    /* Init command */
+    { "E0 V1", 3, FALSE, NULL },
+    { "+CMEE=1", 3, FALSE, NULL },
+    { NULL }
+};
+
+static void
+init_sequence_ready (MMBroadbandModem *self,
+                     GAsyncResult *res,
+                     GSimpleAsyncResult *simple)
+{
+    GError *error = NULL;
+
+    mm_base_modem_at_sequence_finish (MM_BASE_MODEM (self), res, NULL, &error);
+    if (error)
+        g_simple_async_result_take_error (simple, error);
+    else
+        g_simple_async_result_set_op_res_gboolean (simple, TRUE);
+    g_simple_async_result_complete (simple);
+    g_object_unref (simple);
+}
+
+static gboolean
+after_atz_sleep_cb (GSimpleAsyncResult *simple)
+{
+    MMBaseModem *self;
+
+    self = MM_BASE_MODEM (g_async_result_get_source_object (G_ASYNC_RESULT (simple)));
+    /* Now, run the remaining sequence */
+    mm_base_modem_at_sequence (self,
+                               modem_init_sequence,
+                               NULL,  /* response_processor_context */
+                               NULL,  /* response_processor_context_free */
+                               NULL,  /* cancellable */
+                               (GAsyncReadyCallback)init_sequence_ready,
+                               simple);
+    g_object_unref (self);
+    return FALSE;
+}
+
+static void
+atz_ready (MMBroadbandModem *self,
+           GAsyncResult *res,
+           GSimpleAsyncResult *simple)
+{
+    GError *error = NULL;
+
+    mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, &error);
+    if (error) {
+        g_simple_async_result_take_error (simple, error);
+        g_simple_async_result_complete (simple);
+        g_object_unref (simple);
+        return;
+    }
+
+    /* Once ATZ reply is received, we need to wait a bit before going on,
+     * otherwise, the next commands given will receive garbage as reply
+     * (500ms should be enough) */
+    g_timeout_add (500, (GSourceFunc)after_atz_sleep_cb, simple);
+}
+
+static void
+modem_init (MMIfaceModem *self,
+            GAsyncReadyCallback callback,
+            gpointer user_data)
+{
+    GSimpleAsyncResult *result;
+
+    result = g_simple_async_result_new (G_OBJECT (self),
+                                        callback,
+                                        user_data,
+                                        modem_init);
+    /* First, send ATZ alone */
+    mm_base_modem_at_command (MM_BASE_MODEM (self),
+                              "Z",
+                              3,
+                              TRUE,
+                              NULL, /* cancellable */
+                              (GAsyncReadyCallback)atz_ready,
+                              result);
+}
+
+/*****************************************************************************/
 /* Operator Code and Name loading (3GPP interface) */
 
 static gchar *
@@ -255,6 +349,10 @@ mm_broadband_modem_iridium_init (MMBroadbandModemIridium *self)
 static void
 iface_modem_init (MMIfaceModem *iface)
 {
+    /* Initialization */
+    iface->modem_init = modem_init;
+    iface->modem_init_finish = modem_init_finish;
+
     /* Create Iridium-specific SIM */
     iface->create_sim = create_sim;
     iface->create_sim_finish = create_sim_finish;