cinterion: implement access technology loading logic

1 files changed, 250 insertions, 0 deletions

diff --git a/plugins/mm-broadband-modem-cinterion.c b/plugins/mm-broadband-modem-cinterion.c
index d518005e..1c9ef6eb 100644
--- a/plugins/mm-broadband-modem-cinterion.c
+++ b/plugins/mm-broadband-modem-cinterion.c
@@ -41,6 +41,9 @@ G_DEFINE_TYPE_EXTENDED (MMBroadbandModemCinterion, mm_broadband_modem_cinterion,
                         G_IMPLEMENT_INTERFACE (MM_TYPE_IFACE_MODEM_3GPP, iface_modem_3gpp_init));
 
 struct _MMBroadbandModemCinterionPrivate {
+    /* Flag to know if we should try AT^SIND or not to get psinfo */
+    gboolean sind_psinfo;
+
     /* Command to go into sleep mode */
     gchar *sleep_mode_cmd;
 
@@ -176,6 +179,248 @@ modem_power_down (MMIfaceModem *self,
 }
 
 /*****************************************************************************/
+/* ACCESS TECHNOLOGIES */
+
+static gboolean
+load_access_technologies_finish (MMIfaceModem *self,
+                                 GAsyncResult *res,
+                                 MMModemAccessTechnology *access_technologies,
+                                 guint *mask,
+                                 GError **error)
+{
+    if (g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error))
+        return FALSE;
+
+    *access_technologies = (MMModemAccessTechnology) GPOINTER_TO_UINT (
+        g_simple_async_result_get_op_res_gpointer (
+            G_SIMPLE_ASYNC_RESULT (res)));
+    *mask = MM_MODEM_ACCESS_TECHNOLOGY_ANY;
+    return TRUE;
+}
+
+static MMModemAccessTechnology
+get_access_technology_from_smong_gprs_status (const gchar *gprs_status,
+                                              GError **error)
+{
+    if (strlen (gprs_status) == 1) {
+        switch (gprs_status[0]) {
+        case '0':
+            return MM_MODEM_ACCESS_TECHNOLOGY_UNKNOWN;
+        case '1':
+        case '2':
+            return MM_MODEM_ACCESS_TECHNOLOGY_GPRS;
+        case '3':
+        case '4':
+            return MM_MODEM_ACCESS_TECHNOLOGY_EDGE;
+        default:
+            break;
+        }
+    }
+
+    g_set_error (error,
+                 MM_CORE_ERROR,
+                 MM_CORE_ERROR_INVALID_ARGS,
+                 "Couldn't get network capabilities, "
+                 "invalid GPRS status value: '%s'",
+                 gprs_status);
+    return MM_MODEM_ACCESS_TECHNOLOGY_UNKNOWN;
+}
+
+static void
+smong_query_ready (MMBroadbandModemCinterion *self,
+                   GAsyncResult *res,
+                   GSimpleAsyncResult *operation_result)
+{
+    const gchar *response;
+    GError *error = NULL;
+    GMatchInfo *match_info = NULL;
+    GRegex *regex;
+
+    response = mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, &error);
+    if (!response) {
+        /* Let the error be critical. */
+        g_simple_async_result_take_error (operation_result, error);
+        g_simple_async_result_complete (operation_result);
+        g_object_unref (operation_result);
+        return;
+    }
+
+    /* The AT^SMONG command returns a cell info table, where the second
+     * column identifies the "GPRS status", which is exactly what we want.
+     * So we'll try to read that second number in the values row.
+     *
+     * AT^SMONG
+     * GPRS Monitor
+     * BCCH  G  PBCCH  PAT MCC  MNC  NOM  TA      RAC    # Cell #
+     * 0776  1  -      -   214   03  2    00      01
+     * OK
+     */
+    regex = g_regex_new (".*GPRS Monitor\\r\\n"
+                         "BCCH\\s*G.*\\r\\n"
+                         "(\\d*)\\s*(\\d*)\\s*", 0, 0, NULL);
+    if (g_regex_match_full (regex, response, strlen (response), 0, 0, &match_info, NULL)) {
+        gchar *gprs_status;
+        MMModemAccessTechnology act;
+
+        gprs_status = g_match_info_fetch (match_info, 2);
+        act = get_access_technology_from_smong_gprs_status (gprs_status, &error);
+        g_free (gprs_status);
+
+        if (error)
+            g_simple_async_result_take_error (operation_result, error);
+        else {
+            /* We'll default to use SMONG then */
+            self->priv->sind_psinfo = FALSE;
+            g_simple_async_result_set_op_res_gpointer (operation_result,
+                                                       GUINT_TO_POINTER (act),
+                                                       NULL);
+        }
+    } else {
+        /* We'll reset here the flag to try to use SIND/psinfo the next time */
+        self->priv->sind_psinfo = TRUE;
+
+        g_simple_async_result_set_error (operation_result,
+                                         MM_CORE_ERROR,
+                                         MM_CORE_ERROR_INVALID_ARGS,
+                                         "Couldn't get network capabilities, "
+                                         "invalid SMONG reply: '%s'",
+                                         response);
+    }
+
+    g_match_info_free (match_info);
+    g_regex_unref (regex);
+
+    g_simple_async_result_complete (operation_result);
+    g_object_unref (operation_result);
+}
+
+static MMModemAccessTechnology
+get_access_technology_from_psinfo (const gchar *psinfo,
+                                   GError **error)
+{
+    if (strlen (psinfo) == 1) {
+        switch (psinfo[0]) {
+        case '0':
+            return MM_MODEM_ACCESS_TECHNOLOGY_UNKNOWN;
+        case '1':
+        case '2':
+            return MM_MODEM_ACCESS_TECHNOLOGY_GPRS;
+        case '3':
+        case '4':
+            return MM_MODEM_ACCESS_TECHNOLOGY_EDGE;
+        case '5':
+        case '6':
+            return MM_MODEM_ACCESS_TECHNOLOGY_UMTS;
+        case '7':
+        case '8':
+            return MM_MODEM_ACCESS_TECHNOLOGY_HSDPA;
+        default:
+            break;
+        }
+    }
+
+    g_set_error (error,
+                 MM_CORE_ERROR,
+                 MM_CORE_ERROR_INVALID_ARGS,
+                 "Couldn't get network capabilities, "
+                 "invalid psinfo value: '%s'",
+                 psinfo);
+    return MM_MODEM_ACCESS_TECHNOLOGY_UNKNOWN;
+}
+
+static void
+sind_query_ready (MMBroadbandModemCinterion *self,
+                  GAsyncResult *res,
+                  GSimpleAsyncResult *operation_result)
+{
+    const gchar *response;
+    GError *error = NULL;
+    GMatchInfo *match_info = NULL;
+    GRegex *regex;
+
+    response = mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, &error);
+    if (!response) {
+        /* Let the error be critical. */
+        g_simple_async_result_take_error (operation_result, error);
+        g_simple_async_result_complete (operation_result);
+        g_object_unref (operation_result);
+        return;
+    }
+
+    /* The AT^SIND? command replies a list of several different indicators.
+     * We will only look for 'psinfo' which is the one which may tell us
+     * the available network access technology. Note that only 3G-enabled
+     * devices seem to have this indicator.
+     *
+     * AT+SIND?
+     * ^SIND: battchg,1,1
+     * ^SIND: signal,1,99
+     * ...
+     */
+    regex = g_regex_new ("\\r\\n\\^SIND:\\s*psinfo,\\s*(\\d*),\\s*(\\d*)", 0, 0, NULL);
+    if (g_regex_match_full (regex, response, strlen (response), 0, 0, &match_info, NULL)) {
+        MMModemAccessTechnology act;
+        gchar *ind_value;
+
+        ind_value = g_match_info_fetch (match_info, 2);
+        act = get_access_technology_from_psinfo (ind_value, &error);
+        g_free (ind_value);
+        g_simple_async_result_set_op_res_gpointer (operation_result, GUINT_TO_POINTER (act), NULL);
+        g_simple_async_result_complete (operation_result);
+        g_object_unref (operation_result);
+    } else {
+        /* If there was no 'psinfo' indicator, we'll try AT^SMONG and read the cell
+         * info table. */
+        mm_base_modem_at_command (
+            MM_BASE_MODEM (self),
+            "^SMONG",
+            3,
+            FALSE,
+            NULL, /* cancellable */
+            (GAsyncReadyCallback)smong_query_ready,
+            operation_result);
+    }
+
+    g_match_info_free (match_info);
+    g_regex_unref (regex);
+}
+
+static void
+load_access_technologies (MMIfaceModem *self,
+                          GAsyncReadyCallback callback,
+                          gpointer user_data)
+{
+    MMBroadbandModemCinterion *broadband = MM_BROADBAND_MODEM_CINTERION (self);
+    GSimpleAsyncResult *result;
+
+    result = g_simple_async_result_new (G_OBJECT (self),
+                                        callback,
+                                        user_data,
+                                        load_access_technologies);
+
+    if (broadband->priv->sind_psinfo) {
+        mm_base_modem_at_command (
+            MM_BASE_MODEM (self),
+            "^SIND?",
+            3,
+            FALSE,
+            NULL, /* cancellable */
+            (GAsyncReadyCallback)sind_query_ready,
+            result);
+        return;
+    }
+
+    mm_base_modem_at_command (
+        MM_BASE_MODEM (self),
+        "^SMONG",
+        3,
+        FALSE,
+        NULL, /* cancellable */
+        (GAsyncReadyCallback)smong_query_ready,
+        result);
+}
+
+/*****************************************************************************/
 /* SUPPORTED MODES */
 
 static MMModemMode
@@ -348,6 +593,9 @@ mm_broadband_modem_cinterion_init (MMBroadbandModemCinterion *self)
     self->priv = G_TYPE_INSTANCE_GET_PRIVATE ((self),
                                               MM_TYPE_BROADBAND_MODEM_CINTERION,
                                               MMBroadbandModemCinterionPrivate);
+
+    /* Set defaults */
+    self->priv->sind_psinfo = TRUE; /* Initially, always try to get psinfo */
 }
 
 static void
@@ -365,6 +613,8 @@ iface_modem_init (MMIfaceModem *iface)
 {
     iface->load_supported_modes = load_supported_modes;
     iface->load_supported_modes_finish = load_supported_modes_finish;
+    iface->load_access_technologies = load_access_technologies;
+    iface->load_access_technologies_finish = load_access_technologies_finish;
     iface->setup_flow_control = setup_flow_control;
     iface->setup_flow_control_finish = setup_flow_control_finish;
     iface->modem_power_down = modem_power_down;