broadband-modem-qmi: implement custom power state loading

This commit is contained in:
Aleksander Morgado
2013-01-11 10:05:45 +01:00
parent e55b543d38
commit 696b879b6d
+93
View File
@@ -2055,6 +2055,97 @@ modem_power_up (MMIfaceModem *self,
user_data);
}
/*****************************************************************************/
/* Power state loading (Modem interface) */
static MMModemPowerState
load_power_state_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error)
{
if (g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error))
return MM_MODEM_POWER_STATE_UNKNOWN;
return (MMModemPowerState)GPOINTER_TO_UINT (g_simple_async_result_get_op_res_gpointer (G_SIMPLE_ASYNC_RESULT (res)));
}
static void
dms_get_operating_mode_ready (QmiClientDms *client,
GAsyncResult *res,
GSimpleAsyncResult *simple)
{
QmiMessageDmsGetOperatingModeOutput *output = NULL;
GError *error = NULL;
output = qmi_client_dms_get_operating_mode_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_operating_mode_output_get_result (output, &error)) {
g_prefix_error (&error, "Couldn't get operating mode: ");
g_simple_async_result_take_error (simple, error);
} else {
QmiDmsOperatingMode mode = QMI_DMS_OPERATING_MODE_UNKNOWN;
qmi_message_dms_get_operating_mode_output_get_mode (output, &mode, NULL);
switch (mode) {
case QMI_DMS_OPERATING_MODE_ONLINE:
g_simple_async_result_set_op_res_gpointer (simple, GUINT_TO_POINTER (MM_MODEM_POWER_STATE_ON), NULL);
break;
case QMI_DMS_OPERATING_MODE_LOW_POWER:
case QMI_DMS_OPERATING_MODE_PERSISTENT_LOW_POWER:
case QMI_DMS_OPERATING_MODE_MODE_ONLY_LOW_POWER:
g_simple_async_result_set_op_res_gpointer (simple, GUINT_TO_POINTER (MM_MODEM_POWER_STATE_LOW), NULL);
break;
case QMI_DMS_OPERATING_MODE_OFFLINE:
g_simple_async_result_set_op_res_gpointer (simple, GUINT_TO_POINTER (MM_MODEM_POWER_STATE_OFF), NULL);
break;
default:
g_simple_async_result_set_error (simple,
MM_CORE_ERROR,
MM_CORE_ERROR_FAILED,
"Unhandled power state: '%s' (%u)",
qmi_dms_operating_mode_get_string (mode),
mode);
break;
}
}
if (output)
qmi_message_dms_get_operating_mode_output_unref (output);
g_simple_async_result_complete (simple);
g_object_unref (simple);
}
static void
load_power_state (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,
load_power_state);
mm_dbg ("Getting device operating mode...");
qmi_client_dms_set_operating_mode (QMI_CLIENT_DMS (client),
NULL,
5,
NULL,
(GAsyncReadyCallback)dms_get_operating_mode_ready,
result);
}
/*****************************************************************************/
/* Create SIM (Modem interface) */
@@ -7378,6 +7469,8 @@ iface_modem_init (MMIfaceModem *iface)
iface->load_supported_modes_finish = modem_load_supported_modes_finish;
iface->modem_init_power_down = modem_power_down;
iface->modem_init_power_down_finish = modem_power_up_down_finish;
iface->load_power_state = load_power_state;
iface->load_power_state_finish = load_power_state_finish;
/* Enabling/disabling */
iface->modem_init = NULL;