port-probe: enable probing for Capabilities

1 files changed, 121 insertions, 0 deletions

diff --git a/src/mm-port-probe-at-command.c b/src/mm-port-probe-at-command.c
index 840cc4e3..72a49f1b 100644
--- a/src/mm-port-probe-at-command.c
+++ b/src/mm-port-probe-at-command.c
@@ -15,6 +15,9 @@
  * Copyright (C) 2011 Aleksander Morgado <aleksander@gnu.org>
  */
 
+#define _GNU_SOURCE  /* for strcasestr */
+#include <string.h>
+
 #include <glib.h>
 
 #include "mm-errors.h"
@@ -69,3 +72,121 @@ mm_port_probe_at_command_get_probing (void)
 {
     return at_probing;
 }
+
+/* ---- CAPABILITIES probing ---- */
+
+struct modem_caps {
+	gchar *name;
+	guint32 bits;
+};
+
+static const struct modem_caps modem_caps[] = {
+	{ "+CGSM",     MM_PORT_PROBE_CAPABILITY_GSM     },
+	{ "+CIS707-A", MM_PORT_PROBE_CAPABILITY_IS707_A },
+	{ "+CIS707A",  MM_PORT_PROBE_CAPABILITY_IS707_A }, /* Cmotech */
+	{ "+CIS707",   MM_PORT_PROBE_CAPABILITY_IS707_A },
+	{ "CIS707",    MM_PORT_PROBE_CAPABILITY_IS707_A }, /* Qualcomm Gobi */
+	{ "+CIS707P",  MM_PORT_PROBE_CAPABILITY_IS707_P },
+	{ "CIS-856",   MM_PORT_PROBE_CAPABILITY_IS856   },
+	{ "+IS-856",   MM_PORT_PROBE_CAPABILITY_IS856   }, /* Cmotech */
+	{ "CIS-856-A", MM_PORT_PROBE_CAPABILITY_IS856_A },
+	{ "CIS-856A",  MM_PORT_PROBE_CAPABILITY_IS856_A }, /* Kyocera KPC680 */
+	{ "+DS",       MM_PORT_PROBE_CAPABILITY_DS      },
+	{ "+ES",       MM_PORT_PROBE_CAPABILITY_ES      },
+	{ "+MS",       MM_PORT_PROBE_CAPABILITY_MS      },
+	{ "+FCLASS",   MM_PORT_PROBE_CAPABILITY_FCLASS  },
+	{ NULL }
+};
+
+static gboolean
+parse_caps_gcap (const gchar *response,
+                 const GError *error,
+                 GValue *result,
+                 GError **result_error)
+{
+    const struct modem_caps *cap = modem_caps;
+    guint32 ret = 0;
+
+    /* Some modems (Huawei E160g) won't respond to +GCAP with no SIM, but
+     * will respond to ATI.  Ignore the error and continue.
+     */
+    if (response && strstr (response, "+CME ERROR:"))
+        return FALSE;
+
+    while (cap->name) {
+        if (strstr (response, cap->name))
+            ret |= cap->bits;
+        cap++;
+    }
+
+    /* No result built? */
+    if (ret == 0)
+        return FALSE;
+
+    g_value_init (result, G_TYPE_UINT);
+    g_value_set_uint (result, (guint)ret);
+    return TRUE;
+}
+
+static gboolean
+parse_caps_cpin (const gchar *response,
+                 const GError *error,
+                 GValue *result,
+                 GError **result_error)
+{
+    if (strcasestr (response, "SIM PIN") ||
+        strcasestr (response, "SIM PUK") ||
+        strcasestr (response, "PH-SIM PIN") ||
+        strcasestr (response, "PH-FSIM PIN") ||
+        strcasestr (response, "PH-FSIM PUK") ||
+        strcasestr (response, "SIM PIN2") ||
+        strcasestr (response, "SIM PUK2") ||
+        strcasestr (response, "PH-NET PIN") ||
+        strcasestr (response, "PH-NET PUK") ||
+        strcasestr (response, "PH-NETSUB PIN") ||
+        strcasestr (response, "PH-NETSUB PUK") ||
+        strcasestr (response, "PH-SP PIN") ||
+        strcasestr (response, "PH-SP PUK") ||
+        strcasestr (response, "PH-CORP PIN") ||
+        strcasestr (response, "PH-CORP PUK") ||
+        strcasestr (response, "READY")) {
+        /* At least, it's a GSM modem */
+        g_value_init (result, G_TYPE_UINT);
+        g_value_set_uint (result, MM_PORT_PROBE_CAPABILITY_GSM);
+        return TRUE;
+    }
+    return FALSE;
+}
+
+static gboolean
+parse_caps_cgmm (const gchar *response,
+                 const GError *error,
+                 GValue *result,
+                 GError **result_error)
+{
+    if (strstr (response, "GSM900") ||
+        strstr (response, "GSM1800") ||
+        strstr (response, "GSM1900") ||
+        strstr (response, "GSM850")) {
+        /* At least, it's a GSM modem */
+        g_value_init (result, G_TYPE_UINT);
+        g_value_set_uint (result, MM_PORT_PROBE_CAPABILITY_GSM);
+        return TRUE;
+    }
+    return FALSE;
+}
+
+static const MMPortProbeAtCommand capabilities_probing[] = {
+    { "+GCAP",  parse_caps_gcap },
+    { "I",      parse_caps_gcap },
+    { "+CPIN?", parse_caps_cpin },
+    { "+CGMM",  parse_caps_cgmm },
+    { NULL }
+};
+
+const MMPortProbeAtCommand *
+mm_port_probe_at_command_get_capabilities_probing (void)
+{
+    return capabilities_probing;
+}
+