broadband-modem-qmi: implement 3GPP registration checks for NAS >= 1.8

1 files changed, 443 insertions, 6 deletions

diff --git a/src/mm-broadband-modem-qmi.c b/src/mm-broadband-modem-qmi.c
index a74b0a43..12a9708c 100644
--- a/src/mm-broadband-modem-qmi.c
+++ b/src/mm-broadband-modem-qmi.c
@@ -2940,6 +2940,434 @@ get_serving_system_ready (QmiClientNas *client,
     run_registration_checks_context_complete_and_free (ctx);
 }
 
+static gboolean
+process_common_info (QmiNasServiceStatus service_status,
+                     gboolean domain_valid,
+                     QmiNasNetworkServiceDomain domain,
+                     gboolean roaming_status_valid,
+                     QmiNasRoamingStatus roaming_status,
+                     gboolean forbidden_valid,
+                     gboolean forbidden,
+                     gboolean lac_valid,
+                     guint16 lac,
+                     gboolean cid_valid,
+                     guint32 cid,
+                     gboolean network_id_valid,
+                     const gchar *mcc,
+                     const gchar *mnc,
+                     MMModem3gppRegistrationState *mm_cs_registration_state,
+                     MMModem3gppRegistrationState *mm_ps_registration_state,
+                     guint16 *mm_lac,
+                     guint32 *mm_cid,
+                     gchar **mm_operator_id)
+{
+    MMModem3gppRegistrationState tmp_registration_state;
+    gboolean apply_cs;
+    gboolean apply_ps;
+
+    if (service_status != QMI_NAS_SERVICE_STATUS_LIMITED &&
+        service_status != QMI_NAS_SERVICE_STATUS_AVAILABLE &&
+        service_status != QMI_NAS_SERVICE_STATUS_LIMITED_REGIONAL)
+        return FALSE;
+
+    /* If we don't have domain, unknown */
+    if (!domain_valid)
+        tmp_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    else if (domain == QMI_NAS_NETWORK_SERVICE_DOMAIN_NONE)
+        tmp_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_SEARCHING;
+    else if (domain == QMI_NAS_NETWORK_SERVICE_DOMAIN_UNKNOWN)
+        tmp_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    else {
+        /* If we have CS or PS service domain, assume registered for now */
+        if (domain == QMI_NAS_NETWORK_SERVICE_DOMAIN_CS)
+            apply_ps = FALSE;
+        else if (domain == QMI_NAS_NETWORK_SERVICE_DOMAIN_PS)
+            apply_cs = FALSE;
+
+        /* Check if we really are roaming or forbidden */
+        if (forbidden_valid && forbidden)
+            tmp_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_DENIED;
+        else {
+            if (roaming_status_valid && roaming_status == QMI_NAS_ROAMING_STATUS_ON)
+                tmp_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_ROAMING;
+            else
+                tmp_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_HOME;
+
+            /* If we're registered either at home or roaming, try to get LAC/CID */
+            if (lac_valid)
+                *mm_lac = lac;
+            if (cid_valid)
+                *mm_cid = cid;
+        }
+    }
+
+    if (apply_cs)
+        *mm_cs_registration_state = tmp_registration_state;
+    if (apply_ps)
+        *mm_cs_registration_state = tmp_registration_state;
+
+    if (network_id_valid) {
+        *mm_operator_id = g_malloc (7);
+        memcpy (*mm_operator_id, mcc, 3);
+        if (mnc[2] == 0xFF) {
+            memcpy (*mm_operator_id, mnc, 2);
+            (*mm_operator_id)[5] = '\0';
+        } else {
+            memcpy (*mm_operator_id, mnc, 3);
+            (*mm_operator_id)[6] = '\0';
+        }
+    }
+
+    return TRUE;
+}
+
+static gboolean
+process_gsm_info (QmiMessageNasGetSystemInfoOutput *output,
+                  MMModemAccessTechnology *mm_access_technologies,
+                  MMModem3gppRegistrationState *mm_cs_registration_state,
+                  MMModem3gppRegistrationState *mm_ps_registration_state,
+                  guint16 *mm_lac,
+                  guint32 *mm_cid,
+                  gchar **mm_operator_id)
+{
+    QmiNasServiceStatus service_status;
+    gboolean domain_valid;
+    QmiNasNetworkServiceDomain domain;
+    gboolean roaming_status_valid;
+    QmiNasRoamingStatus roaming_status;
+    gboolean forbidden_valid;
+    gboolean forbidden;
+    gboolean lac_valid;
+    guint16 lac;
+    gboolean cid_valid;
+    guint32 cid;
+    gboolean network_id_valid;
+    const gchar *mcc;
+    const gchar *mnc;
+    gboolean egprs_support_valid;
+    gboolean egprs_support;
+
+    *mm_ps_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    *mm_cs_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    *mm_lac = 0;
+    *mm_cid = 0;
+    g_free (*mm_operator_id);
+    *mm_operator_id = NULL;
+
+    if (!qmi_message_nas_get_system_info_output_get_gsm_service_status (
+            output,
+            &service_status,
+            NULL, /* true_service_status */
+            NULL, /* preferred_data_path */
+            NULL) ||
+        !qmi_message_nas_get_system_info_output_get_gsm_system_info (
+            output,
+            &domain_valid,         &domain,
+            NULL, NULL, /* service_capability */
+            &roaming_status_valid, &roaming_status,
+            &forbidden_valid,      &forbidden,
+            &lac_valid,            &lac,
+            &cid_valid,            &cid,
+            NULL, NULL, NULL, /* registration_reject_info */
+            &network_id_valid,     &mcc, &mnc,
+            &egprs_support_valid,  &egprs_support,
+            NULL, NULL, /* dtm_support */
+            NULL)) {
+        mm_dbg ("No GSM service reported");
+        /* No GSM service */
+        return FALSE;
+    }
+
+    if (!process_common_info (service_status,
+                              domain_valid,         domain,
+                              roaming_status_valid, roaming_status,
+                              forbidden_valid,      forbidden,
+                              lac_valid,            lac,
+                              cid_valid,            cid,
+                              network_id_valid,     mcc, mnc,
+                              mm_cs_registration_state,
+                              mm_ps_registration_state,
+                              mm_lac,
+                              mm_cid,
+                              mm_operator_id)) {
+        mm_dbg ("No GSM service registered");
+        return FALSE;
+    }
+
+    *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_GSM;
+    if (egprs_support_valid && egprs_support)
+        *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_EDGE;
+
+    return TRUE;
+}
+
+static gboolean
+process_wcdma_info (QmiMessageNasGetSystemInfoOutput *output,
+                    MMModemAccessTechnology *mm_access_technologies,
+                    MMModem3gppRegistrationState *mm_cs_registration_state,
+                    MMModem3gppRegistrationState *mm_ps_registration_state,
+                    guint16 *mm_lac,
+                    guint32 *mm_cid,
+                    gchar **mm_operator_id)
+{
+    QmiNasServiceStatus service_status;
+    gboolean domain_valid;
+    QmiNasNetworkServiceDomain domain;
+    gboolean roaming_status_valid;
+    QmiNasRoamingStatus roaming_status;
+    gboolean forbidden_valid;
+    gboolean forbidden;
+    gboolean lac_valid;
+    guint16 lac;
+    gboolean cid_valid;
+    guint32 cid;
+    gboolean network_id_valid;
+    const gchar *mcc;
+    const gchar *mnc;
+    gboolean hs_service_valid;
+    QmiNasWcdmaHsService hs_service;
+
+    *mm_ps_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    *mm_cs_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    *mm_lac = 0;
+    *mm_cid = 0;
+    g_free (*mm_operator_id);
+    *mm_operator_id = NULL;
+
+    if (!qmi_message_nas_get_system_info_output_get_wcdma_service_status (
+            output,
+            &service_status,
+            NULL, /* true_service_status */
+            NULL, /* preferred_data_path */
+            NULL) ||
+        !qmi_message_nas_get_system_info_output_get_wcdma_system_info (
+            output,
+            &domain_valid,         &domain,
+            NULL, NULL, /* service_capability */
+            &roaming_status_valid, &roaming_status,
+            &forbidden_valid,      &forbidden,
+            &lac_valid,            &lac,
+            &cid_valid,            &cid,
+            NULL, NULL, NULL, /* registration_reject_info */
+            &network_id_valid,     &mcc, &mnc,
+            NULL, NULL, /* hs_call_status */
+            &hs_service_valid,     &hs_service,
+            NULL, NULL, /* primary_scrambling_code */
+            NULL)) {
+        mm_dbg ("No WCDMA service reported");
+        /* No GSM service */
+        return FALSE;
+    }
+
+    if (!process_common_info (service_status,
+                              domain_valid,         domain,
+                              roaming_status_valid, roaming_status,
+                              forbidden_valid,      forbidden,
+                              lac_valid,            lac,
+                              cid_valid,            cid,
+                              network_id_valid,     mcc, mnc,
+                              mm_cs_registration_state,
+                              mm_ps_registration_state,
+                              mm_lac,
+                              mm_cid,
+                              mm_operator_id)) {
+        mm_dbg ("No WCDMA service registered");
+        return FALSE;
+    }
+
+    *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_UMTS;
+    if (hs_service_valid) {
+        switch (hs_service) {
+        case QMI_NAS_WCDMA_HS_SERVICE_HSDPA_HSUPA_UNSUPPORTED:
+            break;
+        case QMI_NAS_WCDMA_HS_SERVICE_HSDPA_SUPPORTED:
+            *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_HSDPA;
+            break;
+        case QMI_NAS_WCDMA_HS_SERVICE_HSUPA_SUPPORTED:
+            *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_HSUPA;
+            break;
+        case QMI_NAS_WCDMA_HS_SERVICE_HSDPA_HSUPA_SUPPORTED:
+            *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_HSPA;
+            break;
+        case QMI_NAS_WCDMA_HS_SERVICE_HSDPA_PLUS_SUPPORTED:
+        case QMI_NAS_WCDMA_HS_SERVICE_HSDPA_PLUS_HSUPA_SUPPORTED:
+        case QMI_NAS_WCDMA_HS_SERVICE_DC_HSDPA_PLUS_SUPPORTED:
+        case QMI_NAS_WCDMA_HS_SERVICE_DC_HSDPA_PLUS_HSUPA_SUPPORTED:
+            *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_HSPA_PLUS;
+            break;
+        }
+    }
+
+    return TRUE;
+}
+
+static gboolean
+process_lte_info (QmiMessageNasGetSystemInfoOutput *output,
+                  MMModemAccessTechnology *mm_access_technologies,
+                  MMModem3gppRegistrationState *mm_cs_registration_state,
+                  MMModem3gppRegistrationState *mm_ps_registration_state,
+                  guint16 *mm_lac,
+                  guint32 *mm_cid,
+                  gchar **mm_operator_id)
+{
+    QmiNasServiceStatus service_status;
+    gboolean domain_valid;
+    QmiNasNetworkServiceDomain domain;
+    gboolean roaming_status_valid;
+    QmiNasRoamingStatus roaming_status;
+    gboolean forbidden_valid;
+    gboolean forbidden;
+    gboolean lac_valid;
+    guint16 lac;
+    gboolean cid_valid;
+    guint32 cid;
+    gboolean network_id_valid;
+    const gchar *mcc;
+    const gchar *mnc;
+
+    *mm_ps_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    *mm_cs_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    *mm_lac = 0;
+    *mm_cid = 0;
+    g_free (*mm_operator_id);
+    *mm_operator_id = NULL;
+
+    if (!qmi_message_nas_get_system_info_output_get_lte_service_status (
+            output,
+            &service_status,
+            NULL, /* true_service_status */
+            NULL, /* preferred_data_path */
+            NULL) ||
+        !qmi_message_nas_get_system_info_output_get_lte_system_info (
+            output,
+            &domain_valid,         &domain,
+            NULL, NULL, /* service_capability */
+            &roaming_status_valid, &roaming_status,
+            &forbidden_valid,      &forbidden,
+            &lac_valid,            &lac,
+            &cid_valid,            &cid,
+            NULL, NULL, NULL, /* registration_reject_info */
+            &network_id_valid,     &mcc, &mnc,
+            NULL, NULL, /* tac */
+            NULL)) {
+        mm_dbg ("No LTE service reported");
+        /* No GSM service */
+        return FALSE;
+    }
+
+    if (!process_common_info (service_status,
+                              domain_valid,         domain,
+                              roaming_status_valid, roaming_status,
+                              forbidden_valid,      forbidden,
+                              lac_valid,            lac,
+                              cid_valid,            cid,
+                              network_id_valid,     mcc, mnc,
+                              mm_cs_registration_state,
+                              mm_ps_registration_state,
+                              mm_lac,
+                              mm_cid,
+                              mm_operator_id)) {
+        mm_dbg ("No LTE service registered");
+        return FALSE;
+    }
+
+    *mm_access_technologies |= MM_MODEM_ACCESS_TECHNOLOGY_LTE;
+    return TRUE;
+}
+
+static void
+get_system_info_ready (QmiClientNas *client,
+                       GAsyncResult *res,
+                       RunRegistrationChecksContext *ctx)
+{
+    QmiMessageNasGetSystemInfoOutput *output;
+    GError *error = NULL;
+    MMModemAccessTechnology access_technologies;
+    MMModem3gppRegistrationState cs_registration_state;
+    MMModem3gppRegistrationState ps_registration_state;
+    guint16 lac;
+    guint32 cid;
+    gchar *operator_id;
+
+    output = qmi_client_nas_get_system_info_finish (client, res, &error);
+    if (!output) {
+        g_prefix_error (&error, "QMI operation failed: ");
+        g_simple_async_result_take_error (ctx->result, error);
+        run_registration_checks_context_complete_and_free (ctx);
+        return;
+    }
+
+    if (!qmi_message_nas_get_system_info_output_get_result (output, &error)) {
+        g_prefix_error (&error, "Couldn't get system info: ");
+        g_simple_async_result_take_error (ctx->result, error);
+        qmi_message_nas_get_system_info_output_unref (output);
+        run_registration_checks_context_complete_and_free (ctx);
+        return;
+    }
+
+    access_technologies = 0;
+    ps_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    cs_registration_state = MM_MODEM_3GPP_REGISTRATION_STATE_UNKNOWN;
+    lac = 0;
+    cid = 0;
+    operator_id = NULL;
+
+    /* Process infos, with the following priority:
+     *   LTE > WCDMA > GSM
+     * The first one giving results will be the one reported.
+     */
+    if (!process_lte_info (output,
+                           &access_technologies,
+                           &cs_registration_state,
+                           &ps_registration_state,
+                           &lac,
+                           &cid,
+                           &operator_id) &&
+        !process_wcdma_info (output,
+                             &access_technologies,
+                             &cs_registration_state,
+                             &ps_registration_state,
+                             &lac,
+                             &cid,
+                             &operator_id) &&
+        !process_gsm_info (output,
+                           &access_technologies,
+                           &cs_registration_state,
+                           &ps_registration_state,
+                           &lac,
+                           &cid,
+                           &operator_id)) {
+        mm_dbg ("No service (GSM, WCDMA or LTE) reported");
+    }
+
+    /* Cache current operator ID */
+    if (operator_id) {
+        g_free (ctx->self->priv->current_operator_id);
+        ctx->self->priv->current_operator_id = operator_id;
+    }
+
+    /* Report new registration states */
+    if (ctx->cs_supported)
+        mm_iface_modem_3gpp_update_cs_registration_state (
+            MM_IFACE_MODEM_3GPP (ctx->self),
+            cs_registration_state,
+            access_technologies,
+            lac,
+            cid);
+
+    if (ctx->ps_supported)
+        mm_iface_modem_3gpp_update_ps_registration_state (
+            MM_IFACE_MODEM_3GPP (ctx->self),
+            ps_registration_state,
+            access_technologies,
+            lac,
+            cid);
+
+    g_simple_async_result_set_op_res_gboolean (ctx->result, TRUE);
+    qmi_message_nas_get_system_info_output_unref (output);
+    run_registration_checks_context_complete_and_free (ctx);
+}
+
 static void
 modem_3gpp_run_registration_checks (MMIfaceModem3gpp *self,
                                     gboolean cs_supported,
@@ -2965,12 +3393,21 @@ modem_3gpp_run_registration_checks (MMIfaceModem3gpp *self,
     ctx->cs_supported = cs_supported;
     ctx->ps_supported = ps_supported;
 
-    qmi_client_nas_get_serving_system (ctx->client,
-                                       NULL,
-                                       10,
-                                       NULL,
-                                       (GAsyncReadyCallback)get_serving_system_ready,
-                                       ctx);
+    /* System Info was added in NAS 1.8 */
+    if (qmi_client_check_version (client, 1, 8))
+        qmi_client_nas_get_system_info (ctx->client,
+                                        NULL,
+                                        10,
+                                        NULL,
+                                        (GAsyncReadyCallback)get_system_info_ready,
+                                        ctx);
+    else
+        qmi_client_nas_get_serving_system (ctx->client,
+                                           NULL,
+                                           10,
+                                           NULL,
+                                           (GAsyncReadyCallback)get_serving_system_ready,
+                                           ctx);
 }
 
 /*****************************************************************************/