diff options
Diffstat (limited to 'cli/mmcli-modem-sar.c')
-rw-r--r-- | cli/mmcli-modem-sar.c | 370 |
1 files changed, 370 insertions, 0 deletions
diff --git a/cli/mmcli-modem-sar.c b/cli/mmcli-modem-sar.c new file mode 100644 index 00000000..3c97ca68 --- /dev/null +++ b/cli/mmcli-modem-sar.c @@ -0,0 +1,370 @@ +/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */ +/* + * mmcli -- Control modem status & access information from the command line + * + * This program is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see <http://www.gnu.org/licenses/>. + * + * Copyright (C) 2021 Fibocom Wireless Inc. + */ + +#include "config.h" + +#include <stdio.h> +#include <stdlib.h> +#include <locale.h> +#include <string.h> + +#include <glib.h> +#include <gio/gio.h> + +#define _LIBMM_INSIDE_MMCLI +#include <libmm-glib.h> + +#include "mmcli.h" +#include "mmcli-common.h" +#include "mmcli-output.h" + +/* Context */ +typedef struct { + MMManager *manager; + GCancellable *cancellable; + MMObject *object; + MMModemSar *modem_sar; +} Context; +static Context *ctx; + +/* Options */ +static gboolean status_flag; +static gboolean sar_enable_flag; +static gboolean sar_disable_flag; +static gint power_level_int = -1; + +static GOptionEntry entries[] = { + { "sar-status", 0, 0, G_OPTION_ARG_NONE, &status_flag, + "Current status of the SAR", + NULL + }, + { "sar-enable", 0, 0, G_OPTION_ARG_NONE, &sar_enable_flag, + "Enable dynamic SAR", + NULL + }, + { "sar-disable", 0, 0, G_OPTION_ARG_NONE, &sar_disable_flag, + "Disable dynamic SAR", + NULL + }, + { "sar-set-power-level", 0, 0, G_OPTION_ARG_INT, &power_level_int, + "Set current dynamic SAR power level for all antennas on the device", + "[power level]" + }, + { NULL } +}; + +GOptionGroup * +mmcli_modem_sar_get_option_group (void) +{ + GOptionGroup *group; + + group = g_option_group_new ("sar", + "SAR options:", + "Show SAR options", + NULL, + NULL); + g_option_group_add_entries (group, entries); + + return group; +} + +gboolean +mmcli_modem_sar_options_enabled (void) +{ + static guint n_actions = 0; + static gboolean checked = FALSE; + + if (checked) + return !!n_actions; + + n_actions = (status_flag + + sar_enable_flag + + sar_disable_flag + + (power_level_int >= 0)); + + if (n_actions > 1) { + g_printerr ("error: too many SAR actions requested\n"); + exit (EXIT_FAILURE); + } + + if (status_flag) + mmcli_force_sync_operation (); + + checked = TRUE; + return !!n_actions; +} + +static void +context_free (void) +{ + if (!ctx) + return; + + if (ctx->cancellable) + g_object_unref (ctx->cancellable); + if (ctx->modem_sar) + g_object_unref (ctx->modem_sar); + if (ctx->object) + g_object_unref (ctx->object); + if (ctx->manager) + g_object_unref (ctx->manager); + g_free (ctx); +} + +static void +ensure_modem_sar (void) +{ + if (!ctx->modem_sar) { + g_printerr ("error: modem has no SAR capabilities\n"); + exit (EXIT_FAILURE); + } + + /* Success */ +} + +void +mmcli_modem_sar_shutdown (void) +{ + context_free (); +} + +static void +print_sar_status (void) +{ + guint power_level = 0; + gboolean sar_state; + + sar_state = mm_modem_sar_get_state (ctx->modem_sar); + power_level = mm_modem_sar_get_power_level (ctx->modem_sar); + + mmcli_output_string (MMC_F_SAR_STATE, sar_state ? "yes" : "no"); + mmcli_output_string_take (MMC_F_SAR_POWER_LEVEL, g_strdup_printf ("%d", power_level)); + mmcli_output_dump (); +} + +static void +enable_process_reply (gboolean result, + const GError *error) +{ + if (!result) { + g_printerr ("error: couldn't enable SAR: '%s'\n", + error ? error->message : "unknown error"); + exit (EXIT_FAILURE); + } + + g_print ("Successfully enabled SAR\n"); +} + +static void +disable_process_reply (gboolean result, + const GError *error) +{ + if (!result) { + g_printerr ("error: couldn't disable SAR: '%s'\n", + error ? error->message : "unknown error"); + exit (EXIT_FAILURE); + } + + g_print ("Successfully disabled SAR\n"); +} + +static void +enable_ready (MMModemSar *modem, + GAsyncResult *result) +{ + gboolean res; + GError *error = NULL; + + res = mm_modem_sar_enable_finish (modem, result, &error); + enable_process_reply (res, error); + + mmcli_async_operation_done (); +} + +static void +disable_ready (MMModemSar *modem, + GAsyncResult *result) +{ + gboolean res; + GError *error = NULL; + + res = mm_modem_sar_enable_finish (modem, result, &error); + disable_process_reply (res, error); + + mmcli_async_operation_done (); +} + +static void +set_power_level_process_reply (gboolean result, + const GError *error) +{ + if (!result) { + g_printerr ("error: couldn't set the SAR power level: '%s'\n", + error ? error->message : "unknown error"); + exit (EXIT_FAILURE); + } + + g_print ("Successfully set the SAR power level\n"); +} + +static void +set_power_level_ready (MMModemSar *modem, + GAsyncResult *result) +{ + gboolean res; + GError *error = NULL; + + res = mm_modem_sar_set_power_level_finish (modem, result, &error); + set_power_level_process_reply (res, error); + + mmcli_async_operation_done (); +} + +static void +get_modem_ready (GObject *source, + GAsyncResult *result) +{ + ctx->object = mmcli_get_modem_finish (result, &ctx->manager); + ctx->modem_sar = mm_object_get_modem_sar (ctx->object); + + /* Setup operation timeout */ + if (ctx->modem_sar) + mmcli_force_operation_timeout (G_DBUS_PROXY (ctx->modem_sar)); + + ensure_modem_sar (); + + g_assert (!status_flag); + + /* Request to enable SAR */ + if (sar_enable_flag) { + g_debug ("Asynchronously enabling SAR ..."); + mm_modem_sar_enable (ctx->modem_sar, + TRUE, + ctx->cancellable, + (GAsyncReadyCallback)enable_ready, + NULL); + return; + } + + /* Request to disable SAR */ + if (sar_disable_flag) { + g_debug ("Asynchronously disabling SAR ..."); + mm_modem_sar_enable (ctx->modem_sar, + FALSE, + ctx->cancellable, + (GAsyncReadyCallback)disable_ready, + NULL); + return; + } + + /* Request to set power level of SAR */ + if (power_level_int >= 0) { + g_debug ("Asynchronously starting set sar power level to %u ...", power_level_int); + mm_modem_sar_set_power_level (ctx->modem_sar, + power_level_int, + ctx->cancellable, + (GAsyncReadyCallback)set_power_level_ready, + NULL); + return; + } + + g_warn_if_reached (); +} + +void +mmcli_modem_sar_run_asynchronous (GDBusConnection *connection, + GCancellable *cancellable) +{ + /* Initialize context */ + ctx = g_new0 (Context, 1); + if (cancellable) + ctx->cancellable = g_object_ref (cancellable); + + /* Get proper modem */ + mmcli_get_modem (connection, + mmcli_get_common_modem_string (), + cancellable, + (GAsyncReadyCallback)get_modem_ready, + NULL); +} + +void +mmcli_modem_sar_run_synchronous (GDBusConnection *connection) +{ + GError *error = NULL; + + /* Initialize context */ + ctx = g_new0 (Context, 1); + ctx->object = mmcli_get_modem_sync (connection, + mmcli_get_common_modem_string (), + &ctx->manager); + ctx->modem_sar = mm_object_get_modem_sar (ctx->object); + + /* Setup operation timeout */ + if (ctx->modem_sar) + mmcli_force_operation_timeout (G_DBUS_PROXY (ctx->modem_sar)); + + ensure_modem_sar (); + + /* Request to get status? */ + if (status_flag) { + g_debug ("Printing SAR status..."); + print_sar_status (); + return; + } + + /* Request to enable SAR */ + if (sar_enable_flag) { + gboolean result; + g_debug ("Synchronously enabling SAR ..."); + result = mm_modem_sar_enable_sync (ctx->modem_sar, + TRUE, + ctx->cancellable, + &error); + enable_process_reply (result, error); + return; + } + + /* Request to disable SAR */ + if (sar_disable_flag) { + gboolean result; + g_debug ("Synchronously disabling SAR ..."); + result = mm_modem_sar_enable_sync (ctx->modem_sar, + FALSE, + ctx->cancellable, + &error); + disable_process_reply (result, error); + return; + } + + /* Request to set power level of SAR */ + if (power_level_int >=0 ) { + gboolean result; + g_debug ("Synchronously starting set power level to %u ...", power_level_int); + result = mm_modem_sar_set_power_level_sync (ctx->modem_sar, + power_level_int, + ctx->cancellable, + &error); + set_power_level_process_reply (result, error); + return; + } + + g_warn_if_reached (); +} |