diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/mm-broadband-modem-qmi.c | 148 |
1 files changed, 148 insertions, 0 deletions
diff --git a/src/mm-broadband-modem-qmi.c b/src/mm-broadband-modem-qmi.c index ea2ddce2..464cf890 100644 --- a/src/mm-broadband-modem-qmi.c +++ b/src/mm-broadband-modem-qmi.c @@ -34,6 +34,151 @@ G_DEFINE_TYPE_EXTENDED (MMBroadbandModemQmi, mm_broadband_modem_qmi, MM_TYPE_BRO G_IMPLEMENT_INTERFACE (MM_TYPE_IFACE_MODEM, iface_modem_init)); /*****************************************************************************/ + +static gboolean +ensure_qmi_client (MMBroadbandModemQmi *self, + QmiService service, + QmiClient **o_client, + GAsyncReadyCallback callback, + gpointer user_data) +{ + QmiClient *client; + + client = mm_qmi_port_peek_client (mm_base_modem_peek_port_qmi (MM_BASE_MODEM (self)), service); + if (!client) { + g_simple_async_report_error_in_idle (G_OBJECT (self), + callback, + user_data, + MM_CORE_ERROR, + MM_CORE_ERROR_FAILED, + "Couldn't peek client for service '%s'", + qmi_service_get_string (service)); + return FALSE; + } + + *o_client = client; + return TRUE; +} + +/*****************************************************************************/ +/* Capabilities loading (Modem interface) */ + +static MMModemCapability +modem_load_current_capabilities_finish (MMIfaceModem *self, + GAsyncResult *res, + GError **error) +{ + MMModemCapability caps; + gchar *caps_str; + + if (g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error)) + return MM_MODEM_CAPABILITY_NONE; + + caps = ((MMModemCapability) GPOINTER_TO_UINT ( + g_simple_async_result_get_op_res_gpointer ( + G_SIMPLE_ASYNC_RESULT (res)))); + caps_str = mm_modem_capability_build_string_from_mask (caps); + mm_dbg ("loaded current capabilities: %s", caps_str); + g_free (caps_str); + return caps; +} + +static MMModemCapability +qmi_network_to_modem_capability (QmiDmsRadioInterface network) +{ + switch (network) { + case QMI_DMS_RADIO_INTERFACE_CDMA20001X: + return MM_MODEM_CAPABILITY_CDMA_EVDO; + case QMI_DMS_RADIO_INTERFACE_EVDO: + return MM_MODEM_CAPABILITY_CDMA_EVDO; + case QMI_DMS_RADIO_INTERFACE_GSM: + return MM_MODEM_CAPABILITY_GSM_UMTS; + case QMI_DMS_RADIO_INTERFACE_UMTS: + return MM_MODEM_CAPABILITY_GSM_UMTS; + case QMI_DMS_RADIO_INTERFACE_LTE: + return MM_MODEM_CAPABILITY_LTE; + default: + mm_warn ("Unhandled QMI radio interface received (%u)", + (guint)network); + return MM_MODEM_CAPABILITY_NONE; + } +} + +static void +dms_get_capabilities_ready (QmiClientDms *client, + GAsyncResult *res, + GSimpleAsyncResult *simple) +{ + QmiMessageDmsGetCapabilitiesOutput *output = NULL; + GError *error = NULL; + + output = qmi_client_dms_get_capabilities_finish (client, res, &error); + if (!output) { + g_prefix_error (&error, "QMI operation failed: "); + g_simple_async_result_take_error (simple, error); + } else if (!qmi_message_dms_get_capabilities_output_get_result (output, &error)) { + g_prefix_error (&error, "Couldn't get Capabilities: "); + g_simple_async_result_take_error (simple, error); + } else { + guint i; + guint mask = MM_MODEM_CAPABILITY_NONE; + GArray *radio_interface_list; + + qmi_message_dms_get_capabilities_output_get_info ( + output, + NULL, /* info_max_tx_channel_rate */ + NULL, /* info_max_rx_channel_rate */ + NULL, /* info_data_service_capability */ + NULL, /* info_sim_capability */ + &radio_interface_list, + NULL); + + for (i = 0; i < radio_interface_list->len; i++) { + mask |= qmi_network_to_modem_capability (g_array_index (radio_interface_list, + QmiDmsRadioInterface, + i)); + } + + g_simple_async_result_set_op_res_gpointer (simple, + GUINT_TO_POINTER (mask), + NULL); + } + + if (output) + qmi_message_dms_get_capabilities_output_unref (output); + + g_simple_async_result_complete (simple); + g_object_unref (simple); +} + +static void +modem_load_current_capabilities (MMIfaceModem *self, + GAsyncReadyCallback callback, + gpointer user_data) +{ + GSimpleAsyncResult *result; + QmiClient *client = NULL; + + if (!ensure_qmi_client (MM_BROADBAND_MODEM_QMI (self), + QMI_SERVICE_DMS, &client, + callback, user_data)) + return; + + result = g_simple_async_result_new (G_OBJECT (self), + callback, + user_data, + modem_load_current_capabilities); + + mm_dbg ("loading current capabilities..."); + qmi_client_dms_get_capabilities (QMI_CLIENT_DMS (client), + NULL, + 5, + NULL, + (GAsyncReadyCallback)dms_get_capabilities_ready, + result); +} + +/*****************************************************************************/ /* First initialization step */ typedef struct { @@ -227,6 +372,9 @@ finalize (GObject *object) static void iface_modem_init (MMIfaceModem *iface) { + /* Initialization steps */ + iface->load_current_capabilities = modem_load_current_capabilities; + iface->load_current_capabilities_finish = modem_load_current_capabilities_finish; } static void |