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.
2012-03-15 14:15:08 +01:00
parent 7e31470066
commit b14bf797f1
1 changed files with 98 additions and 0 deletions
@@ -40,6 +40,100 @@ G_DEFINE_TYPE_EXTENDED (MMBroadbandModemIridium, mm_broadband_modem_iridium, MM_
                        G_IMPLEMENT_INTERFACE (MM_TYPE_IFACE_MODEM, iface_modem_init)
                        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) */

@@ -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;