xmm: implement power management operations

This commit is contained in:
Aleksander Morgado
2018-08-08 14:05:54 +02:00
committed by Dan Williams
parent 36e09ef441
commit 6e9bf39ecf
4 changed files with 200 additions and 0 deletions

View File

@@ -73,6 +73,12 @@ iface_modem_init (MMIfaceModem *iface)
iface->load_current_bands_finish = mm_shared_xmm_load_current_bands_finish;
iface->set_current_bands = mm_shared_xmm_set_current_bands;
iface->set_current_bands_finish = mm_shared_xmm_set_current_bands_finish;
/* power up/down already managed via MBIM */
iface->modem_power_off = mm_shared_xmm_power_off;
iface->modem_power_off_finish = mm_shared_xmm_power_off_finish;
iface->reset = mm_shared_xmm_reset;
iface->reset_finish = mm_shared_xmm_reset_finish;
}
static void

View File

@@ -73,6 +73,17 @@ iface_modem_init (MMIfaceModem *iface)
iface->load_current_bands_finish = mm_shared_xmm_load_current_bands_finish;
iface->set_current_bands = mm_shared_xmm_set_current_bands;
iface->set_current_bands_finish = mm_shared_xmm_set_current_bands_finish;
iface->load_power_state = mm_shared_xmm_load_power_state;
iface->load_power_state_finish = mm_shared_xmm_load_power_state_finish;
iface->modem_power_up = mm_shared_xmm_power_up;
iface->modem_power_up_finish = mm_shared_xmm_power_up_finish;
iface->modem_power_down = mm_shared_xmm_power_down;
iface->modem_power_down_finish = mm_shared_xmm_power_down_finish;
iface->modem_power_off = mm_shared_xmm_power_off;
iface->modem_power_off_finish = mm_shared_xmm_power_off_finish;
iface->reset = mm_shared_xmm_reset;
iface->reset_finish = mm_shared_xmm_reset_finish;
}
static void

View File

@@ -535,6 +535,158 @@ out:
g_free (command);
}
/*****************************************************************************/
/* Power state loading (Modem interface) */
MMModemPowerState
mm_shared_xmm_load_power_state_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error)
{
guint state;
const gchar *response;
response = mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, error);
if (!response)
return MM_MODEM_POWER_STATE_UNKNOWN;
if (!mm_3gpp_parse_cfun_query_response (response, &state, error))
return MM_MODEM_POWER_STATE_UNKNOWN;
switch (state) {
case 1:
return MM_MODEM_POWER_STATE_ON;
case 4:
return MM_MODEM_POWER_STATE_LOW;
default:
break;
}
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED,
"Unknown +CFUN state: %u", state);
return MM_MODEM_POWER_STATE_UNKNOWN;
}
void
mm_shared_xmm_load_power_state (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data)
{
mm_base_modem_at_command (MM_BASE_MODEM (self),
"+CFUN?",
3,
FALSE,
callback,
user_data);
}
/*****************************************************************************/
/* Modem power up/down/off (Modem interface) */
static gboolean
common_modem_power_operation_finish (MMSharedXmm *self,
GAsyncResult *res,
GError **error)
{
return g_task_propagate_boolean (G_TASK (res), error);
}
static void
power_operation_ready (MMBaseModem *self,
GAsyncResult *res,
GTask *task)
{
GError *error = NULL;
if (!mm_base_modem_at_command_finish (self, res, &error))
g_task_return_error (task, error);
else
g_task_return_boolean (task, TRUE);
g_object_unref (task);
}
static void
common_modem_power_operation (MMSharedXmm *self,
const gchar *command,
GAsyncReadyCallback callback,
gpointer user_data)
{
GTask *task;
task = g_task_new (self, NULL, callback, user_data);
mm_base_modem_at_command (MM_BASE_MODEM (self),
command,
30,
FALSE,
(GAsyncReadyCallback) power_operation_ready,
task);
}
gboolean
mm_shared_xmm_reset_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error)
{
return common_modem_power_operation_finish (MM_SHARED_XMM (self), res, error);
}
void
mm_shared_xmm_reset (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data)
{
common_modem_power_operation (MM_SHARED_XMM (self), "+CFUN=16", callback, user_data);
}
gboolean
mm_shared_xmm_power_off_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error)
{
return common_modem_power_operation_finish (MM_SHARED_XMM (self), res, error);
}
void
mm_shared_xmm_power_off (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data)
{
common_modem_power_operation (MM_SHARED_XMM (self), "+CPWROFF", callback, user_data);
}
gboolean
mm_shared_xmm_power_down_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error)
{
return common_modem_power_operation_finish (MM_SHARED_XMM (self), res, error);
}
void
mm_shared_xmm_power_down (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data)
{
common_modem_power_operation (MM_SHARED_XMM (self), "+CFUN=4", callback, user_data);
}
gboolean
mm_shared_xmm_power_up_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error)
{
return common_modem_power_operation_finish (MM_SHARED_XMM (self), res, error);
}
void
mm_shared_xmm_power_up (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data)
{
common_modem_power_operation (MM_SHARED_XMM (self), "+CFUN=1", callback, user_data);
}
/*****************************************************************************/
static void

View File

@@ -82,4 +82,35 @@ gboolean mm_shared_xmm_set_current_bands_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error);
void mm_shared_xmm_load_power_state (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data);
MMModemPowerState mm_shared_xmm_load_power_state_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error);
void mm_shared_xmm_power_up (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data);
gboolean mm_shared_xmm_power_up_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error);
void mm_shared_xmm_power_down (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data);
gboolean mm_shared_xmm_power_down_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error);
void mm_shared_xmm_power_off (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data);
gboolean mm_shared_xmm_power_off_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error);
void mm_shared_xmm_reset (MMIfaceModem *self,
GAsyncReadyCallback callback,
gpointer user_data);
gboolean mm_shared_xmm_reset_finish (MMIfaceModem *self,
GAsyncResult *res,
GError **error);
#endif /* MM_SHARED_XMM_H */