diff options
author | Daniele Palmas <dnlplm@gmail.com> | 2016-02-22 13:32:22 +0100 |
---|---|---|
committer | Aleksander Morgado <aleksander@aleksander.es> | 2016-02-24 11:22:14 +0100 |
commit | c8a26e472e05e8a02be881ad97cd9d15cd636f94 (patch) | |
tree | 4ea3164c7649bb563e72fc5e91ed02567915428f | |
parent | 6e7ff47109058e553beb4d9044a302d78e17944c (diff) |
telit: add current modes setting
This patch adds current modes setting in Telit plugin
-rw-r--r-- | plugins/telit/mm-broadband-modem-telit.c | 98 |
1 files changed, 98 insertions, 0 deletions
diff --git a/plugins/telit/mm-broadband-modem-telit.c b/plugins/telit/mm-broadband-modem-telit.c index d4b0a424..0127314c 100644 --- a/plugins/telit/mm-broadband-modem-telit.c +++ b/plugins/telit/mm-broadband-modem-telit.c @@ -654,6 +654,102 @@ load_current_modes (MMIfaceModem *self, } /*****************************************************************************/ +/* Set current modes (Modem interface) */ + +static gboolean +set_current_modes_finish (MMIfaceModem *self, + GAsyncResult *res, + GError **error) +{ + return !g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error); +} + +static void +ws46_set_ready (MMIfaceModem *self, + GAsyncResult *res, + GSimpleAsyncResult *operation_result) +{ + GError *error = NULL; + + mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, &error); + if (error) + /* Let the error be critical. */ + g_simple_async_result_take_error (operation_result, error); + else + g_simple_async_result_set_op_res_gboolean (operation_result, TRUE); + g_simple_async_result_complete (operation_result); + g_object_unref (operation_result); +} + +static void +set_current_modes (MMIfaceModem *self, + MMModemMode allowed, + MMModemMode preferred, + GAsyncReadyCallback callback, + gpointer user_data) +{ + GSimpleAsyncResult *result; + gchar *command; + gint ws46_mode = -1; + + result = g_simple_async_result_new (G_OBJECT (self), + callback, + user_data, + set_current_modes); + + if (allowed == MM_MODEM_MODE_2G) + ws46_mode = 12; + else if (allowed == MM_MODEM_MODE_3G) + ws46_mode = 22; + else if (allowed == MM_MODEM_MODE_4G) + ws46_mode = 28; + else if (allowed == (MM_MODEM_MODE_2G | MM_MODEM_MODE_3G)) { + if (mm_iface_modem_is_3gpp_lte (self)) + ws46_mode = 29; + else + ws46_mode = 25; + } else if (allowed == (MM_MODEM_MODE_2G | MM_MODEM_MODE_4G)) + ws46_mode = 30; + else if (allowed == (MM_MODEM_MODE_3G | MM_MODEM_MODE_4G)) + ws46_mode = 31; + else if (allowed == (MM_MODEM_MODE_2G | MM_MODEM_MODE_3G | MM_MODEM_MODE_4G) || + allowed == MM_MODEM_MODE_ANY) + ws46_mode = 25; + + /* Telit modems do not support preferred mode selection */ + if ((ws46_mode < 0) || (preferred != MM_MODEM_MODE_NONE)) { + gchar *allowed_str; + gchar *preferred_str; + + allowed_str = mm_modem_mode_build_string_from_mask (allowed); + preferred_str = mm_modem_mode_build_string_from_mask (preferred); + g_simple_async_result_set_error (result, + MM_CORE_ERROR, + MM_CORE_ERROR_FAILED, + "Requested mode (allowed: '%s', preferred: '%s') not " + "supported by the modem.", + allowed_str, + preferred_str); + g_free (allowed_str); + g_free (preferred_str); + + g_simple_async_result_complete_in_idle (result); + g_object_unref (result); + return; + } + + command = g_strdup_printf ("AT+WS46=%d", ws46_mode); + mm_base_modem_at_command ( + MM_BASE_MODEM (self), + command, + 10, + FALSE, + (GAsyncReadyCallback)ws46_set_ready, + result); + g_free (command); +} + +/*****************************************************************************/ /* Load supported modes (Modem interface) */ static GArray * @@ -837,6 +933,8 @@ iface_modem_init (MMIfaceModem *iface) iface->load_supported_modes_finish = load_supported_modes_finish; iface->load_current_modes = load_current_modes; iface->load_current_modes_finish = load_current_modes_finish; + iface->set_current_modes = set_current_modes; + iface->set_current_modes_finish = set_current_modes_finish; } static void |