broadband-modem: implement generic QCDM access technology checks
For modems that don't implement vendor-specific access technology checks, try to get the access technology via QCDM if the modem has a QCDM port.
This commit is contained in:
Dan Williams
@@ -1745,6 +1745,338 @@ modem_load_signal_quality (MMIfaceModem *self,
|
|||||||
signal_quality_context_complete_and_free (ctx);
|
signal_quality_context_complete_and_free (ctx);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************/
|
||||||
|
/* Load access technology (Modem interface) */
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
MMModemAccessTechnology access_technologies;
|
||||||
|
guint mask;
|
||||||
|
} AccessTechAndMask;
|
||||||
|
|
||||||
|
static gboolean
|
||||||
|
modem_load_access_technologies_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
MMModemAccessTechnology *access_technologies,
|
||||||
|
guint *mask,
|
||||||
|
GError **error)
|
||||||
|
{
|
||||||
|
AccessTechAndMask *tech;
|
||||||
|
|
||||||
|
if (g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error))
|
||||||
|
return FALSE;
|
||||||
|
|
||||||
|
tech = g_simple_async_result_get_op_res_gpointer (G_SIMPLE_ASYNC_RESULT (res));
|
||||||
|
g_assert (tech);
|
||||||
|
|
||||||
|
*access_technologies = tech->access_technologies;
|
||||||
|
*mask = tech->mask;
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
MMBroadbandModem *self;
|
||||||
|
GSimpleAsyncResult *result;
|
||||||
|
MMQcdmSerialPort *port;
|
||||||
|
|
||||||
|
guint32 opmode;
|
||||||
|
guint32 sysmode;
|
||||||
|
gboolean hybrid;
|
||||||
|
|
||||||
|
gboolean wcdma_open;
|
||||||
|
gboolean evdo_open;
|
||||||
|
} AccessTechContext;
|
||||||
|
|
||||||
|
static void
|
||||||
|
access_tech_context_complete_and_free (AccessTechContext *ctx)
|
||||||
|
{
|
||||||
|
AccessTechAndMask *tech;
|
||||||
|
MMModemAccessTechnology act = MM_MODEM_ACCESS_TECHNOLOGY_UNKNOWN;
|
||||||
|
guint mask = MM_MODEM_ACCESS_TECHNOLOGY_UNKNOWN;
|
||||||
|
|
||||||
|
mm_dbg ("QCDM operating mode: %d", ctx->opmode);
|
||||||
|
mm_dbg ("QCDM system mode: %d", ctx->sysmode);
|
||||||
|
mm_dbg ("QCDM hybrid pref: %d", ctx->hybrid);
|
||||||
|
mm_dbg ("QCDM WCDMA open: %d", ctx->wcdma_open);
|
||||||
|
mm_dbg ("QCDM EVDO open: %d", ctx->evdo_open);
|
||||||
|
|
||||||
|
if (ctx->opmode == QCDM_CMD_CM_SUBSYS_STATE_INFO_OPERATING_MODE_ONLINE) {
|
||||||
|
switch (ctx->sysmode) {
|
||||||
|
case QCDM_CMD_CM_SUBSYS_STATE_INFO_SYSTEM_MODE_CDMA:
|
||||||
|
if (!ctx->hybrid || !ctx->evdo_open) {
|
||||||
|
act = MM_MODEM_ACCESS_TECHNOLOGY_1XRTT;
|
||||||
|
mask = MM_IFACE_MODEM_CDMA_ALL_ACCESS_TECHNOLOGIES_MASK;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
/* Fall through */
|
||||||
|
case QCDM_CMD_CM_SUBSYS_STATE_INFO_SYSTEM_MODE_HDR:
|
||||||
|
/* Assume EVDOr0; can't yet determine r0 vs. rA with QCDM */
|
||||||
|
if (ctx->evdo_open)
|
||||||
|
act = MM_MODEM_ACCESS_TECHNOLOGY_EVDO0;
|
||||||
|
mask = MM_IFACE_MODEM_CDMA_ALL_ACCESS_TECHNOLOGIES_MASK;
|
||||||
|
break;
|
||||||
|
case QCDM_CMD_CM_SUBSYS_STATE_INFO_SYSTEM_MODE_GSM:
|
||||||
|
case QCDM_CMD_CM_SUBSYS_STATE_INFO_SYSTEM_MODE_WCDMA:
|
||||||
|
case QCDM_CMD_CM_SUBSYS_STATE_INFO_SYSTEM_MODE_GW:
|
||||||
|
if (ctx->wcdma_open) {
|
||||||
|
/* Assume UMTS; can't yet determine UMTS/HSxPA/HSPA+ with QCDM */
|
||||||
|
act = MM_MODEM_ACCESS_TECHNOLOGY_UMTS;
|
||||||
|
} else {
|
||||||
|
/* Assume GPRS; can't yet determine GSM/GPRS/EDGE with QCDM */
|
||||||
|
act = MM_MODEM_ACCESS_TECHNOLOGY_GPRS;
|
||||||
|
}
|
||||||
|
mask = MM_IFACE_MODEM_3GPP_ALL_ACCESS_TECHNOLOGIES_MASK;
|
||||||
|
break;
|
||||||
|
case QCDM_CMD_CM_SUBSYS_STATE_INFO_SYSTEM_MODE_LTE:
|
||||||
|
act = MM_MODEM_ACCESS_TECHNOLOGY_LTE;
|
||||||
|
mask = MM_IFACE_MODEM_3GPP_ALL_ACCESS_TECHNOLOGIES_MASK;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
tech = g_new0 (AccessTechAndMask, 1);
|
||||||
|
tech->access_technologies = act;
|
||||||
|
tech->mask = mask;
|
||||||
|
|
||||||
|
g_simple_async_result_set_op_res_gpointer (ctx->result, tech, g_free);
|
||||||
|
g_simple_async_result_complete (ctx->result);
|
||||||
|
|
||||||
|
g_object_unref (ctx->result);
|
||||||
|
g_object_unref (ctx->self);
|
||||||
|
if (ctx->port)
|
||||||
|
g_object_unref (ctx->port);
|
||||||
|
g_free (ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
access_tech_qcdm_wcdma_ready (MMQcdmSerialPort *port,
|
||||||
|
GByteArray *response,
|
||||||
|
GError *error,
|
||||||
|
AccessTechContext *ctx)
|
||||||
|
{
|
||||||
|
QcdmResult *result;
|
||||||
|
gint err = QCDM_SUCCESS;
|
||||||
|
guint8 l1;
|
||||||
|
|
||||||
|
if (error) {
|
||||||
|
g_simple_async_result_set_from_error (ctx->result, error);
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Parse the response */
|
||||||
|
result = qcdm_cmd_wcdma_subsys_state_info_result ((const gchar *) response->data,
|
||||||
|
response->len,
|
||||||
|
&err);
|
||||||
|
if (result) {
|
||||||
|
qcdm_result_get_u8 (result, QCDM_CMD_WCDMA_SUBSYS_STATE_INFO_ITEM_L1_STATE, &l1);
|
||||||
|
qcdm_result_unref (result);
|
||||||
|
|
||||||
|
if (l1 == QCDM_WCDMA_L1_STATE_PCH ||
|
||||||
|
l1 == QCDM_WCDMA_L1_STATE_FACH ||
|
||||||
|
l1 == QCDM_WCDMA_L1_STATE_DCH)
|
||||||
|
ctx->wcdma_open = TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
access_tech_qcdm_gsm_ready (MMQcdmSerialPort *port,
|
||||||
|
GByteArray *response,
|
||||||
|
GError *error,
|
||||||
|
AccessTechContext *ctx)
|
||||||
|
{
|
||||||
|
GByteArray *cmd;
|
||||||
|
QcdmResult *result;
|
||||||
|
gint err = QCDM_SUCCESS;
|
||||||
|
guint8 opmode = 0;
|
||||||
|
guint8 sysmode = 0;
|
||||||
|
|
||||||
|
if (error) {
|
||||||
|
g_simple_async_result_set_from_error (ctx->result, error);
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Parse the response */
|
||||||
|
result = qcdm_cmd_gsm_subsys_state_info_result ((const gchar *) response->data,
|
||||||
|
response->len,
|
||||||
|
&err);
|
||||||
|
if (!result) {
|
||||||
|
g_simple_async_result_set_error (ctx->result,
|
||||||
|
MM_CORE_ERROR,
|
||||||
|
MM_CORE_ERROR_FAILED,
|
||||||
|
"Failed to parse GSM subsys command result: %d",
|
||||||
|
err);
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
qcdm_result_get_u8 (result, QCDM_CMD_GSM_SUBSYS_STATE_INFO_ITEM_CM_OP_MODE, &opmode);
|
||||||
|
qcdm_result_get_u8 (result, QCDM_CMD_GSM_SUBSYS_STATE_INFO_ITEM_CM_SYS_MODE, &sysmode);
|
||||||
|
qcdm_result_unref (result);
|
||||||
|
|
||||||
|
ctx->opmode = opmode;
|
||||||
|
ctx->sysmode = sysmode;
|
||||||
|
|
||||||
|
/* WCDMA subsystem state */
|
||||||
|
cmd = g_byte_array_sized_new (50);
|
||||||
|
cmd->len = qcdm_cmd_wcdma_subsys_state_info_new ((char *) cmd->data, 50);
|
||||||
|
g_assert (cmd->len);
|
||||||
|
|
||||||
|
mm_qcdm_serial_port_queue_command (port,
|
||||||
|
cmd,
|
||||||
|
3,
|
||||||
|
NULL,
|
||||||
|
(MMQcdmSerialResponseFn) access_tech_qcdm_wcdma_ready,
|
||||||
|
ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
access_tech_qcdm_hdr_ready (MMQcdmSerialPort *port,
|
||||||
|
GByteArray *response,
|
||||||
|
GError *error,
|
||||||
|
AccessTechContext *ctx)
|
||||||
|
{
|
||||||
|
QcdmResult *result;
|
||||||
|
gint err = QCDM_SUCCESS;
|
||||||
|
guint8 session = 0;
|
||||||
|
guint8 almp = 0;
|
||||||
|
|
||||||
|
if (error) {
|
||||||
|
g_simple_async_result_set_from_error (ctx->result, error);
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Parse the response */
|
||||||
|
result = qcdm_cmd_hdr_subsys_state_info_result ((const gchar *) response->data,
|
||||||
|
response->len,
|
||||||
|
&err);
|
||||||
|
if (result) {
|
||||||
|
qcdm_result_get_u8 (result, QCDM_CMD_HDR_SUBSYS_STATE_INFO_ITEM_SESSION_STATE, &session);
|
||||||
|
qcdm_result_get_u8 (result, QCDM_CMD_HDR_SUBSYS_STATE_INFO_ITEM_ALMP_STATE, &almp);
|
||||||
|
qcdm_result_unref (result);
|
||||||
|
|
||||||
|
if (session == QCDM_CMD_HDR_SUBSYS_STATE_INFO_SESSION_STATE_OPEN &&
|
||||||
|
(almp == QCDM_CMD_HDR_SUBSYS_STATE_INFO_ALMP_STATE_IDLE ||
|
||||||
|
almp == QCDM_CMD_HDR_SUBSYS_STATE_INFO_ALMP_STATE_CONNECTED))
|
||||||
|
ctx->evdo_open = TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
access_tech_qcdm_cdma_ready (MMQcdmSerialPort *port,
|
||||||
|
GByteArray *response,
|
||||||
|
GError *error,
|
||||||
|
AccessTechContext *ctx)
|
||||||
|
{
|
||||||
|
GByteArray *cmd;
|
||||||
|
QcdmResult *result;
|
||||||
|
gint err = QCDM_SUCCESS;
|
||||||
|
guint32 hybrid;
|
||||||
|
|
||||||
|
if (error) {
|
||||||
|
g_simple_async_result_set_from_error (ctx->result, error);
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Parse the response */
|
||||||
|
result = qcdm_cmd_cm_subsys_state_info_result ((const gchar *) response->data,
|
||||||
|
response->len,
|
||||||
|
&err);
|
||||||
|
if (!result) {
|
||||||
|
g_simple_async_result_set_error (ctx->result,
|
||||||
|
MM_CORE_ERROR,
|
||||||
|
MM_CORE_ERROR_FAILED,
|
||||||
|
"Failed to parse CM subsys command result: %d",
|
||||||
|
err);
|
||||||
|
access_tech_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
qcdm_result_get_u32 (result, QCDM_CMD_CM_SUBSYS_STATE_INFO_ITEM_OPERATING_MODE, &ctx->opmode);
|
||||||
|
qcdm_result_get_u32 (result, QCDM_CMD_CM_SUBSYS_STATE_INFO_ITEM_SYSTEM_MODE, &ctx->sysmode);
|
||||||
|
qcdm_result_get_u32 (result, QCDM_CMD_CM_SUBSYS_STATE_INFO_ITEM_HYBRID_PREF, &hybrid);
|
||||||
|
qcdm_result_unref (result);
|
||||||
|
|
||||||
|
ctx->hybrid = !!hybrid;
|
||||||
|
|
||||||
|
/* HDR subsystem state */
|
||||||
|
cmd = g_byte_array_sized_new (50);
|
||||||
|
cmd->len = qcdm_cmd_hdr_subsys_state_info_new ((char *) cmd->data, 50);
|
||||||
|
g_assert (cmd->len);
|
||||||
|
|
||||||
|
mm_qcdm_serial_port_queue_command (port,
|
||||||
|
cmd,
|
||||||
|
3,
|
||||||
|
NULL,
|
||||||
|
(MMQcdmSerialResponseFn) access_tech_qcdm_hdr_ready,
|
||||||
|
ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
modem_load_access_technologies (MMIfaceModem *self,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data)
|
||||||
|
{
|
||||||
|
MMQcdmSerialPort *port;
|
||||||
|
AccessTechContext *ctx;
|
||||||
|
GByteArray *cmd;
|
||||||
|
|
||||||
|
mm_dbg ("loading access technologies via QCDM...");
|
||||||
|
|
||||||
|
/* For modems where only QCDM provides detailed information, try to
|
||||||
|
* get access technologies via the various QCDM subsystems.
|
||||||
|
*/
|
||||||
|
port = mm_base_modem_peek_port_qcdm (MM_BASE_MODEM (self));
|
||||||
|
if (!port) {
|
||||||
|
g_simple_async_report_error_in_idle (G_OBJECT (self),
|
||||||
|
callback,
|
||||||
|
user_data,
|
||||||
|
MM_CORE_ERROR,
|
||||||
|
MM_CORE_ERROR_UNSUPPORTED,
|
||||||
|
"Cannot get access technology without a QCDM port");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
ctx = g_new0 (AccessTechContext, 1);
|
||||||
|
ctx->self = g_object_ref (self);
|
||||||
|
ctx->port = g_object_ref (port);
|
||||||
|
ctx->result = g_simple_async_result_new (G_OBJECT (self),
|
||||||
|
callback,
|
||||||
|
user_data,
|
||||||
|
modem_load_access_technologies);
|
||||||
|
|
||||||
|
if (mm_iface_modem_is_3gpp (self)) {
|
||||||
|
cmd = g_byte_array_sized_new (50);
|
||||||
|
cmd->len = qcdm_cmd_gsm_subsys_state_info_new ((char *) cmd->data, 50);
|
||||||
|
g_assert (cmd->len);
|
||||||
|
|
||||||
|
mm_qcdm_serial_port_queue_command (port,
|
||||||
|
cmd,
|
||||||
|
3,
|
||||||
|
NULL,
|
||||||
|
(MMQcdmSerialResponseFn) access_tech_qcdm_gsm_ready,
|
||||||
|
ctx);
|
||||||
|
} else if (mm_iface_modem_is_cdma (self)) {
|
||||||
|
cmd = g_byte_array_sized_new (50);
|
||||||
|
cmd->len = qcdm_cmd_cm_subsys_state_info_new ((char *) cmd->data, 50);
|
||||||
|
g_assert (cmd->len);
|
||||||
|
|
||||||
|
mm_qcdm_serial_port_queue_command (port,
|
||||||
|
cmd,
|
||||||
|
3,
|
||||||
|
NULL,
|
||||||
|
(MMQcdmSerialResponseFn) access_tech_qcdm_cdma_ready,
|
||||||
|
ctx);
|
||||||
|
} else
|
||||||
|
g_assert_not_reached ();
|
||||||
|
}
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
/* Setup/Cleanup unsolicited events (3GPP interface) */
|
/* Setup/Cleanup unsolicited events (3GPP interface) */
|
||||||
|
|
||||||
@@ -8602,6 +8934,9 @@ iface_modem_init (MMIfaceModem *iface)
|
|||||||
iface->create_bearer_finish = modem_create_bearer_finish;
|
iface->create_bearer_finish = modem_create_bearer_finish;
|
||||||
iface->command = modem_command;
|
iface->command = modem_command;
|
||||||
iface->command_finish = modem_command_finish;
|
iface->command_finish = modem_command_finish;
|
||||||
|
|
||||||
|
iface->load_access_technologies = modem_load_access_technologies;
|
||||||
|
iface->load_access_technologies_finish = modem_load_access_technologies_finish;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void
|
static void
|
||||||
|
|||||||
Reference in New Issue
Block a user