diff options
author | lvmaorui <ZRMaorui.Lu@fibocom.com> | 2021-05-26 16:09:51 +0800 |
---|---|---|
committer | Aleksander Morgado <aleksander@aleksander.es> | 2021-10-13 13:14:10 +0200 |
commit | 07a6b6032b16bae5bd9eb963d51bac6141d79e67 (patch) | |
tree | 62dd148e536f5f8336f6ed8485283bdfe3dfe565 /cli | |
parent | 1f321bd79d4e64ff96603c602a283d789ef0b4d1 (diff) |
mmcli:add SAR command --sar-status/--sar-enable/--sar-disable/--set-power-level
Diffstat (limited to 'cli')
-rw-r--r-- | cli/Makefile.am | 1 | ||||
-rw-r--r-- | cli/mmcli-modem-sar.c | 370 | ||||
-rw-r--r-- | cli/mmcli-output.c | 3 | ||||
-rw-r--r-- | cli/mmcli-output.h | 3 | ||||
-rw-r--r-- | cli/mmcli.c | 11 | ||||
-rw-r--r-- | cli/mmcli.h | 9 |
6 files changed, 397 insertions, 0 deletions
diff --git a/cli/Makefile.am b/cli/Makefile.am index 4bd21378..820d5d3a 100644 --- a/cli/Makefile.am +++ b/cli/Makefile.am @@ -28,6 +28,7 @@ mmcli_SOURCES = \ mmcli-modem-voice.c \ mmcli-modem-time.c \ mmcli-modem-firmware.c \ + mmcli-modem-sar.c \ mmcli-modem-signal.c \ mmcli-modem-oma.c \ mmcli-bearer.c \ diff --git a/cli/mmcli-modem-sar.c b/cli/mmcli-modem-sar.c new file mode 100644 index 00000000..4f78f21b --- /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-set-enable", 0, 0, G_OPTION_ARG_NONE, &sar_enable_flag, + "Enable dynamic SAR", + NULL + }, + { "sar-set-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 (); +} diff --git a/cli/mmcli-output.c b/cli/mmcli-output.c index 6e88792d..9be366e1 100644 --- a/cli/mmcli-output.c +++ b/cli/mmcli-output.c @@ -69,6 +69,7 @@ static SectionInfo section_infos[] = { [MMC_S_MODEM_FIRMWARE] = { "Firmware" }, [MMC_S_MODEM_FIRMWARE_FASTBOOT] = { "Fastboot settings" }, [MMC_S_MODEM_VOICE] = { "Voice" }, + [MMC_S_MODEM_SAR] = { "SAR" }, [MMC_S_BEARER_GENERAL] = { "General" }, [MMC_S_BEARER_STATUS] = { "Status" }, [MMC_S_BEARER_PROPERTIES] = { "Properties" }, @@ -283,6 +284,8 @@ static FieldInfo field_infos[] = { [MMC_F_SIM_PROPERTIES_OPERATOR_NAME] = { "sim.properties.operator-name", "operator name", MMC_S_SIM_PROPERTIES, }, [MMC_F_SIM_PROPERTIES_EMERGENCY_NUMBERS] = { "sim.properties.emergency-numbers", "emergency numbers", MMC_S_SIM_PROPERTIES, }, [MMC_F_SIM_PROPERTIES_PREFERRED_NETWORKS] = { "sim.properties.preferred-networks", "preferred networks", MMC_S_SIM_PROPERTIES, }, + [MMC_F_SAR_STATE] = { "modem.sar.state", "enabled", MMC_S_MODEM_SAR, }, + [MMC_F_SAR_POWER_LEVEL] = { "modem.sar.power-level", "power level", MMC_S_MODEM_SAR, }, [MMC_F_MODEM_LIST_DBUS_PATH] = { "modem-list", "modems", MMC_S_UNKNOWN, }, [MMC_F_SMS_LIST_DBUS_PATH] = { "modem.messaging.sms", "sms messages", MMC_S_UNKNOWN, }, [MMC_F_CALL_LIST_DBUS_PATH] = { "modem.voice.call", "calls", MMC_S_UNKNOWN, }, diff --git a/cli/mmcli-output.h b/cli/mmcli-output.h index 1a8f934a..0c74159f 100644 --- a/cli/mmcli-output.h +++ b/cli/mmcli-output.h @@ -66,6 +66,7 @@ typedef enum { MMC_S_MODEM_FIRMWARE, MMC_S_MODEM_FIRMWARE_FASTBOOT, MMC_S_MODEM_VOICE, + MMC_S_MODEM_SAR, MMC_S_BEARER_GENERAL, MMC_S_BEARER_STATUS, MMC_S_BEARER_PROPERTIES, @@ -301,6 +302,8 @@ typedef enum { MMC_F_SIM_PROPERTIES_OPERATOR_NAME, MMC_F_SIM_PROPERTIES_EMERGENCY_NUMBERS, MMC_F_SIM_PROPERTIES_PREFERRED_NETWORKS, + MMC_F_SAR_STATE, + MMC_F_SAR_POWER_LEVEL, /* Lists */ MMC_F_MODEM_LIST_DBUS_PATH, MMC_F_SMS_LIST_DBUS_PATH, diff --git a/cli/mmcli.c b/cli/mmcli.c index eff1b512..e10267a3 100644 --- a/cli/mmcli.c +++ b/cli/mmcli.c @@ -230,6 +230,8 @@ main (gint argc, gchar **argv) g_option_context_add_group (context, mmcli_modem_firmware_get_option_group ()); g_option_context_add_group (context, + mmcli_modem_sar_get_option_group ()); + g_option_context_add_group (context, mmcli_modem_signal_get_option_group ()); g_option_context_add_group (context, mmcli_modem_oma_get_option_group ()); @@ -402,6 +404,13 @@ main (gint argc, gchar **argv) else mmcli_modem_firmware_run_synchronous (connection); } + /* Modem SAR options? */ + else if (mmcli_modem_sar_options_enabled ()) { + if (async_flag) + mmcli_modem_sar_run_asynchronous (connection, cancellable); + else + mmcli_modem_sar_run_synchronous (connection); + } /* Modem Signal options? */ else if (mmcli_modem_signal_options_enabled ()) { if (async_flag) @@ -458,6 +467,8 @@ main (gint argc, gchar **argv) mmcli_modem_time_shutdown (); } else if (mmcli_modem_firmware_options_enabled ()) { mmcli_modem_firmware_shutdown (); + } else if (mmcli_modem_sar_options_enabled ()) { + mmcli_modem_sar_shutdown (); } else if (mmcli_modem_signal_options_enabled ()) { mmcli_modem_signal_shutdown (); } else if (mmcli_modem_oma_options_enabled ()) { diff --git a/cli/mmcli.h b/cli/mmcli.h index 99d6091e..de5cc804 100644 --- a/cli/mmcli.h +++ b/cli/mmcli.h @@ -125,6 +125,15 @@ void mmcli_modem_firmware_run_asynchronous (GDBusConnection *connecti void mmcli_modem_firmware_run_synchronous (GDBusConnection *connection); void mmcli_modem_firmware_shutdown (void); +/* SAR group */ +GOptionGroup *mmcli_modem_sar_get_option_group (void); +gboolean mmcli_modem_sar_options_enabled (void); +void mmcli_modem_sar_run_asynchronous (GDBusConnection *connection, + GCancellable *cancellable); +void mmcli_modem_sar_run_synchronous (GDBusConnection *connection); +void mmcli_modem_sar_shutdown (void); + + /* Signal group */ GOptionGroup *mmcli_modem_signal_get_option_group (void); gboolean mmcli_modem_signal_options_enabled (void); |