biscuit/pkgs/qmi-nmea/qmicli-qos.c

431 lines
13 KiB
C

/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
/*
* qmicli -- Command line interface to control QMI devices
*
* 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) 2018 Aleksander Morgado <aleksander@aleksander.es>
*/
#include "config.h"
#include <stdio.h>
#include <stdlib.h>
#include <locale.h>
#include <string.h>
#include <glib.h>
#include <gio/gio.h>
#include <libqmi-glib.h>
#include "qmicli.h"
#include "qmicli-helpers.h"
#if defined HAVE_QMI_SERVICE_QOS
#undef VALIDATE_UNKNOWN
#define VALIDATE_UNKNOWN(str) (str ? str : "unknown")
/* Context */
typedef struct {
QmiDevice *device;
QmiClientQos *client;
GCancellable *cancellable;
} Context;
static Context *ctx;
/* Options */
static gint get_flow_status_int = -1;
static gboolean get_network_status_flag;
static gint swi_read_data_stats_int = -1;
static gboolean reset_flag;
static gboolean noop_flag;
static GOptionEntry entries[] = {
#if defined HAVE_QMI_MESSAGE_QOS_GET_FLOW_STATUS
{ "qos-get-flow-status", 0, 0, G_OPTION_ARG_INT, &get_flow_status_int,
"Get QoS flow status",
"[QoS ID]"
},
#endif
#if defined HAVE_QMI_MESSAGE_QOS_GET_NETWORK_STATUS
{ "qos-get-network-status", 0, 0, G_OPTION_ARG_NONE, &get_network_status_flag,
"Gets the network status",
NULL
},
#endif
#if defined HAVE_QMI_MESSAGE_QOS_SWI_READ_DATA_STATS
{ "qos-swi-read-data-stats", 0, 0, G_OPTION_ARG_INT, &swi_read_data_stats_int,
"Read data stats (Sierra Wireless specific)",
"[APN ID]"
},
#endif
#if defined HAVE_QMI_MESSAGE_QOS_RESET
{ "qos-reset", 0, 0, G_OPTION_ARG_NONE, &reset_flag,
"Reset the service state",
NULL
},
#endif
{ "qos-noop", 0, 0, G_OPTION_ARG_NONE, &noop_flag,
"Just allocate or release a QOS client. Use with `--client-no-release-cid' and/or `--client-cid'",
NULL
},
{ NULL, 0, 0, 0, NULL, NULL, NULL }
};
GOptionGroup *
qmicli_qos_get_option_group (void)
{
GOptionGroup *group;
group = g_option_group_new ("qos",
"QoS options:",
"Show Quality of Service options",
NULL,
NULL);
g_option_group_add_entries (group, entries);
return group;
}
gboolean
qmicli_qos_options_enabled (void)
{
static guint n_actions = 0;
static gboolean checked = FALSE;
if (checked)
return !!n_actions;
n_actions = ((get_flow_status_int >= 0) +
get_network_status_flag +
(swi_read_data_stats_int >= 0) +
reset_flag +
noop_flag);
if (n_actions > 1) {
g_printerr ("error: too many QoS actions requested\n");
exit (EXIT_FAILURE);
}
checked = TRUE;
return !!n_actions;
}
static void
context_free (Context *context)
{
if (!context)
return;
if (context->cancellable)
g_object_unref (context->cancellable);
if (context->device)
g_object_unref (context->device);
if (context->client)
g_object_unref (context->client);
g_slice_free (Context, context);
}
static void
operation_shutdown (gboolean operation_status)
{
/* Cleanup context and finish async operation */
context_free (ctx);
qmicli_async_operation_done (operation_status, FALSE);
}
#if defined HAVE_QMI_MESSAGE_QOS_GET_FLOW_STATUS
static void
get_flow_status_ready (QmiClientQos *client,
GAsyncResult *res)
{
QmiMessageQosGetFlowStatusOutput *output;
GError *error = NULL;
QmiQosStatus flow_status;
output = qmi_client_qos_get_flow_status_finish (client, res, &error);
if (!output) {
g_printerr ("error: operation failed: %s\n", error->message);
g_error_free (error);
operation_shutdown (FALSE);
return;
}
if (!qmi_message_qos_get_flow_status_output_get_result (output, &error)) {
g_printerr ("error: couldn't get QoS flow status: %s\n", error->message);
g_error_free (error);
qmi_message_qos_get_flow_status_output_unref (output);
operation_shutdown (FALSE);
return;
}
qmi_message_qos_get_flow_status_output_get_value (output, &flow_status, NULL);
g_print ("[%s] QoS flow status: %s\n",
qmi_device_get_path_display (ctx->device),
qmi_qos_status_get_string (flow_status));
qmi_message_qos_get_flow_status_output_unref (output);
operation_shutdown (TRUE);
}
#endif /* HAVE_QMI_MESSAGE_QOS_GET_FLOW_STATUS */
#if defined HAVE_QMI_MESSAGE_QOS_GET_NETWORK_STATUS
static void
get_network_status_ready (QmiClientQos *client,
GAsyncResult *res)
{
QmiMessageQosGetNetworkStatusOutput *output;
GError *error = NULL;
gboolean qos_supported;
output = qmi_client_qos_get_network_status_finish (client, res, &error);
if (!output) {
g_printerr ("error: operation failed: %s\n", error->message);
g_error_free (error);
operation_shutdown (FALSE);
return;
}
if (!qmi_message_qos_get_network_status_output_get_result (output, &error)) {
g_printerr ("error: couldn't get network status: %s\n", error->message);
g_error_free (error);
qmi_message_qos_get_network_status_output_unref (output);
operation_shutdown (FALSE);
return;
}
qmi_message_qos_get_network_status_output_get_qos_supported (output, &qos_supported, NULL);
g_print ("[%s] QoS %ssupported in network\n",
qmi_device_get_path_display (ctx->device),
qos_supported ? "" : "not ");
qmi_message_qos_get_network_status_output_unref (output);
operation_shutdown (TRUE);
}
#endif /* HAVE_QMI_MESSAGE_QOS_GET_NETWORK_STATUS */
#if defined HAVE_QMI_MESSAGE_QOS_SWI_READ_DATA_STATS
static void
swi_read_data_stats_ready (QmiClientQos *client,
GAsyncResult *res)
{
QmiMessageQosSwiReadDataStatsOutput *output;
GError *error = NULL;
guint32 apn_id = 0;
guint32 apn_tx_packets = 0;
guint32 apn_tx_packets_dropped = 0;
guint32 apn_rx_packets = 0;
guint64 apn_tx_bytes = 0;
guint64 apn_tx_bytes_dropped = 0;
guint64 apn_rx_bytes = 0;
GArray *flow = NULL;
output = qmi_client_qos_swi_read_data_stats_finish (client, res, &error);
if (!output) {
g_printerr ("error: operation failed: %s\n", error->message);
g_error_free (error);
operation_shutdown (FALSE);
return;
}
if (!qmi_message_qos_swi_read_data_stats_output_get_result (output, &error)) {
g_printerr ("error: couldn't read data stats: %s\n", error->message);
g_error_free (error);
qmi_message_qos_swi_read_data_stats_output_unref (output);
operation_shutdown (FALSE);
return;
}
g_print ("[%s] QoS data stats read\n",
qmi_device_get_path_display (ctx->device));
if (qmi_message_qos_swi_read_data_stats_output_get_apn (
output,
&apn_id,
&apn_tx_packets,
&apn_tx_packets_dropped,
&apn_rx_packets,
&apn_tx_bytes,
&apn_tx_bytes_dropped,
&apn_rx_bytes,
NULL)) {
g_print (" APN ID: %u\n", apn_id);
g_print (" TX packets: %u\n", apn_tx_packets);
g_print (" TX packets dropped: %u\n", apn_tx_packets_dropped);
g_print (" RX packets: %u\n", apn_rx_packets);
g_print (" TX bytes: %" G_GUINT64_FORMAT "\n", apn_tx_bytes);
g_print (" TX bytes dropped: %" G_GUINT64_FORMAT "\n", apn_tx_bytes_dropped);
g_print (" RX bytes: %" G_GUINT64_FORMAT "\n", apn_rx_bytes);
}
if (qmi_message_qos_swi_read_data_stats_output_get_flow (
output,
&flow,
NULL)) {
guint i;
for (i = 0; i < flow->len; i++) {
QmiMessageQosSwiReadDataStatsOutputFlowElement *element;
element = &g_array_index(flow, QmiMessageQosSwiReadDataStatsOutputFlowElement, i);
g_print (" Flow %u\n", i);
g_print (" Bearer ID: %u\n", element->bearer_id);
g_print (" TX packets: %u\n", element->tx_packets);
g_print (" TX packets dropped: %u\n", element->tx_packets_dropped);
g_print (" TX bytes: %" G_GUINT64_FORMAT "\n", element->tx_bytes);
g_print (" TX bytes dropped: %" G_GUINT64_FORMAT "\n", element->tx_bytes_dropped);
}
}
qmi_message_qos_swi_read_data_stats_output_unref (output);
operation_shutdown (TRUE);
}
#endif /* HAVE_QMI_MESSAGE_QOS_SWI_READ_DATA_STATS */
#if defined HAVE_QMI_MESSAGE_QOS_RESET
static void
reset_ready (QmiClientQos *client,
GAsyncResult *res)
{
QmiMessageQosResetOutput *output;
GError *error = NULL;
output = qmi_client_qos_reset_finish (client, res, &error);
if (!output) {
g_printerr ("error: operation failed: %s\n", error->message);
g_error_free (error);
operation_shutdown (FALSE);
return;
}
if (!qmi_message_qos_reset_output_get_result (output, &error)) {
g_printerr ("error: couldn't reset the QoS service: %s\n", error->message);
g_error_free (error);
qmi_message_qos_reset_output_unref (output);
operation_shutdown (FALSE);
return;
}
g_print ("[%s] Successfully performed QoS service reset\n",
qmi_device_get_path_display (ctx->device));
qmi_message_qos_reset_output_unref (output);
operation_shutdown (TRUE);
}
#endif /* HAVE_QMI_MESSAGE_QOS_RESET */
static gboolean
noop_cb (gpointer unused)
{
operation_shutdown (TRUE);
return FALSE;
}
void
qmicli_qos_run (QmiDevice *device,
QmiClientQos *client,
GCancellable *cancellable)
{
/* Initialize context */
ctx = g_slice_new (Context);
ctx->device = g_object_ref (device);
ctx->client = g_object_ref (client);
ctx->cancellable = g_object_ref (cancellable);
#if defined HAVE_QMI_MESSAGE_QOS_GET_FLOW_STATUS
if (get_flow_status_int >= 0) {
QmiMessageQosGetFlowStatusInput *input;
input = qmi_message_qos_get_flow_status_input_new ();
qmi_message_qos_get_flow_status_input_set_qos_id (input, get_flow_status_int, NULL);
g_debug ("Asynchronously getting QoS flow status...");
qmi_client_qos_get_flow_status (ctx->client,
input,
10,
ctx->cancellable,
(GAsyncReadyCallback)get_flow_status_ready,
NULL);
qmi_message_qos_get_flow_status_input_unref (input);
return;
}
#endif
#if defined HAVE_QMI_MESSAGE_QOS_GET_NETWORK_STATUS
if (get_network_status_flag) {
g_debug ("Asynchronously getting network status...");
qmi_client_qos_get_network_status (ctx->client,
NULL,
10,
ctx->cancellable,
(GAsyncReadyCallback)get_network_status_ready,
NULL);
return;
}
#endif
#if defined HAVE_QMI_MESSAGE_QOS_SWI_READ_DATA_STATS
if (swi_read_data_stats_int >= 0) {
QmiMessageQosSwiReadDataStatsInput *input;
input = qmi_message_qos_swi_read_data_stats_input_new ();
qmi_message_qos_swi_read_data_stats_input_set_apn_id (input, swi_read_data_stats_int, NULL);
g_debug ("Asynchronously reading data stats...");
qmi_client_qos_swi_read_data_stats (ctx->client,
input,
10,
ctx->cancellable,
(GAsyncReadyCallback)swi_read_data_stats_ready,
NULL);
qmi_message_qos_swi_read_data_stats_input_unref (input);
return;
}
#endif
#if defined HAVE_QMI_MESSAGE_QOS_RESET
if (reset_flag) {
g_debug ("Asynchronously resetting QoS service...");
qmi_client_qos_reset (ctx->client,
NULL,
10,
ctx->cancellable,
(GAsyncReadyCallback)reset_ready,
NULL);
return;
}
#endif
/* Just client allocate/release? */
if (noop_flag) {
g_idle_add (noop_cb, NULL);
return;
}
g_warn_if_reached ();
}
#endif /* HAVE_QMI_SERVICE_QOS */