broadband-modem-qmi: implement 3GPP registration checks for NAS >= 1.8
This commit is contained in:
Aleksander Morgado
@@ -2940,6 +2940,434 @@ get_serving_system_ready (QmiClientNas *client,
|
|||||||
run_registration_checks_context_complete_and_free (ctx);
|
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
|
static void
|
||||||
modem_3gpp_run_registration_checks (MMIfaceModem3gpp *self,
|
modem_3gpp_run_registration_checks (MMIfaceModem3gpp *self,
|
||||||
gboolean cs_supported,
|
gboolean cs_supported,
|
||||||
@@ -2965,6 +3393,15 @@ modem_3gpp_run_registration_checks (MMIfaceModem3gpp *self,
|
|||||||
ctx->cs_supported = cs_supported;
|
ctx->cs_supported = cs_supported;
|
||||||
ctx->ps_supported = ps_supported;
|
ctx->ps_supported = ps_supported;
|
||||||
|
|
||||||
|
/* 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,
|
qmi_client_nas_get_serving_system (ctx->client,
|
||||||
NULL,
|
NULL,
|
||||||
10,
|
10,
|
||||||
|
|||||||
Reference in New Issue
Block a user