mmcli:add SAR command --sar-status/--sar-enable/--sar-disable/--set-power-level

This commit is contained in:
lvmaorui
2021-05-26 16:09:51 +08:00
committed by Aleksander Morgado
parent 1f321bd79d
commit 07a6b6032b
6 changed files with 397 additions and 0 deletions

View File

@@ -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 \

370
cli/mmcli-modem-sar.c Normal file
View File

@@ -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 ();
}

View File

@@ -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, },

View File

@@ -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,

View File

@@ -229,6 +229,8 @@ main (gint argc, gchar **argv)
mmcli_modem_time_get_option_group ());
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,
@@ -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 ()) {

View File

@@ -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);