|
Packit |
d14447 |
/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
|
|
Packit |
d14447 |
/*
|
|
Packit |
d14447 |
* This program is free software; you can redistribute it and/or modify
|
|
Packit |
d14447 |
* it under the terms of the GNU General Public License as published by
|
|
Packit |
d14447 |
* the Free Software Foundation; either version 2 of the License, or
|
|
Packit |
d14447 |
* (at your option) any later version.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* This program is distributed in the hope that it will be useful,
|
|
Packit |
d14447 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
d14447 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
Packit |
d14447 |
* GNU General Public License for more details:
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Copyright 2018 Google LLC.
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
#include <string.h>
|
|
Packit |
d14447 |
#include <glib.h>
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
#include "mm-enums-types.h"
|
|
Packit |
d14447 |
#include "mm-errors-types.h"
|
|
Packit |
d14447 |
#include "mm-common-helpers.h"
|
|
Packit |
d14447 |
#include "mm-pco.h"
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* SECTION: mm-pco
|
|
Packit |
d14447 |
* @title: MMPco
|
|
Packit |
d14447 |
* @short_description: Helper object to handle 3GPP PCO.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* The #MMPco is an object handling the raw 3GPP Protocol Configuration Options
|
|
Packit |
d14447 |
* (PCO) that the modem has received from the network.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* This object is retrieved with mm_modem_3gpp_get_pco().
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
G_DEFINE_TYPE (MMPco, mm_pco, G_TYPE_OBJECT);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
struct _MMPcoPrivate {
|
|
Packit |
d14447 |
/* Session ID, signature 'u' */
|
|
Packit |
d14447 |
guint32 session_id;
|
|
Packit |
d14447 |
/* Flag indicating if the PCO data is complete or partial, signature 'b' */
|
|
Packit |
d14447 |
gboolean is_complete;
|
|
Packit |
d14447 |
/* Raw PCO data, signature 'ay' */
|
|
Packit |
d14447 |
GBytes *data;
|
|
Packit |
d14447 |
};
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
static GBytes *
|
|
Packit |
d14447 |
_g_variant_get_bytes (GVariant *variant)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
GByteArray *byte_array;
|
|
Packit |
d14447 |
guint num_bytes;
|
|
Packit |
d14447 |
GVariantIter iter;
|
|
Packit |
d14447 |
guint8 byte;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_assert (g_variant_is_of_type (variant, G_VARIANT_TYPE ("ay")));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
num_bytes = g_variant_n_children (variant);
|
|
Packit |
d14447 |
if (num_bytes == 0)
|
|
Packit |
d14447 |
return NULL;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
byte_array = g_byte_array_sized_new (num_bytes);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_variant_iter_init (&iter, variant);
|
|
Packit |
d14447 |
while (g_variant_iter_loop (&iter, "y", &byte))
|
|
Packit |
d14447 |
g_byte_array_append (byte_array, &byte, sizeof (byte));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return g_byte_array_free_to_bytes (byte_array);
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_get_session_id:
|
|
Packit |
d14447 |
* @self: a #MMPco.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Gets the session ID associated with the PCO.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Returns: the session ID.
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
guint32
|
|
Packit |
d14447 |
mm_pco_get_session_id (MMPco *self)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_return_val_if_fail (MM_IS_PCO (self), G_MAXUINT32);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return self->priv->session_id;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
void
|
|
Packit |
d14447 |
mm_pco_set_session_id (MMPco *self,
|
|
Packit |
d14447 |
guint32 session_id)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_return_if_fail (MM_IS_PCO (self));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
self->priv->session_id = session_id;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_is_complete:
|
|
Packit |
d14447 |
* @self: a #MMPco.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Gets the complete flag that indicates whether the PCO data contains the
|
|
Packit |
d14447 |
* complete PCO structure received from the network.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Returns: %TRUE if the PCO data contains the complete PCO structure, %FALSE otherwise.
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
gboolean
|
|
Packit |
d14447 |
mm_pco_is_complete (MMPco *self)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_return_val_if_fail (MM_IS_PCO (self), FALSE);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return self->priv->is_complete;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
void
|
|
Packit |
d14447 |
mm_pco_set_complete (MMPco *self,
|
|
Packit |
d14447 |
gboolean is_complete)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_return_if_fail (MM_IS_PCO (self));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
self->priv->is_complete = is_complete;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_get_data:
|
|
Packit |
d14447 |
* @self: a #MMPco.
|
|
Packit |
d14447 |
* @data_size: (out): Size of the PCO data, if any given.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Gets the PCO data in raw bytes.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Returns: (transfer none): the PCO data, or %NULL if it doesn't contain any.
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
const guint8 *
|
|
Packit |
d14447 |
mm_pco_get_data (MMPco *self,
|
|
Packit |
d14447 |
gsize *data_size)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_return_val_if_fail (MM_IS_PCO (self), NULL);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return g_bytes_get_data (self->priv->data, data_size);
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
void
|
|
Packit |
d14447 |
mm_pco_set_data (MMPco *self,
|
|
Packit |
d14447 |
const guint8 *data,
|
|
Packit |
d14447 |
gsize data_size)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_return_if_fail (MM_IS_PCO (self));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_bytes_unref (self->priv->data);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
self->priv->data = (data && data_size) ? g_bytes_new (data, data_size)
|
|
Packit |
d14447 |
: NULL;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_from_variant:
|
|
Packit |
d14447 |
* @variant: A variant with the PCO information.
|
|
Packit |
d14447 |
* @error: Return location for error or %NULL.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Creates a new #MMPco object with the values exposed in
|
|
Packit |
d14447 |
* the variant.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Returns: (transfer full): A #MMPco or %NULL if @error is set. The returned value should be freed with g_object_unref().
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
MMPco *
|
|
Packit |
d14447 |
mm_pco_from_variant (GVariant *variant,
|
|
Packit |
d14447 |
GError **error)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
MMPco *pco;
|
|
Packit |
d14447 |
GVariant *pco_data = NULL;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
pco = mm_pco_new ();
|
|
Packit |
d14447 |
if (!variant)
|
|
Packit |
d14447 |
return pco;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
if (!g_variant_is_of_type (variant, G_VARIANT_TYPE ("(ubay)"))) {
|
|
Packit |
d14447 |
g_set_error (error,
|
|
Packit |
d14447 |
MM_CORE_ERROR,
|
|
Packit |
d14447 |
MM_CORE_ERROR_INVALID_ARGS,
|
|
Packit |
d14447 |
"Cannot create PCO from variant: "
|
|
Packit |
d14447 |
"invalid variant type received");
|
|
Packit |
d14447 |
g_object_unref (pco);
|
|
Packit |
d14447 |
return NULL;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_variant_get (variant, "(ub@ay)",
|
|
Packit |
d14447 |
&pco->priv->session_id,
|
|
Packit |
d14447 |
&pco->priv->is_complete,
|
|
Packit |
d14447 |
&pco_data);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_bytes_unref (pco->priv->data);
|
|
Packit |
d14447 |
pco->priv->data = _g_variant_get_bytes (pco_data);
|
|
Packit |
d14447 |
g_variant_unref (pco_data);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return pco;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_to_variant:
|
|
Packit |
d14447 |
* @self: a #MMPco.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Gets a GVariant representation with signature "(ubay)" of @self.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Returns: (transfer full): A #GVariant representation of the #MMPco object. The returned value should be freed with g_variant_unref().
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
GVariant *
|
|
Packit |
d14447 |
mm_pco_to_variant (MMPco *self)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
GVariantBuilder builder;
|
|
Packit |
d14447 |
gsize i, pco_data_size;
|
|
Packit |
d14447 |
const guint8 *pco_data;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/* Allow NULL */
|
|
Packit |
d14447 |
if (!self)
|
|
Packit |
d14447 |
return NULL;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_return_val_if_fail (MM_IS_PCO (self), NULL);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_variant_builder_init (&builder, G_VARIANT_TYPE ("(ubay)"));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_variant_builder_add (&builder, "u", self->priv->session_id);
|
|
Packit |
d14447 |
g_variant_builder_add (&builder, "b", self->priv->is_complete);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_variant_builder_open (&builder, G_VARIANT_TYPE ("ay"));
|
|
Packit |
d14447 |
if (self->priv->data) {
|
|
Packit |
d14447 |
pco_data = g_bytes_get_data (self->priv->data, &pco_data_size);
|
|
Packit |
d14447 |
for (i = 0; i < pco_data_size; ++i)
|
|
Packit |
d14447 |
g_variant_builder_add (&builder, "y", pco_data[i]);
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
g_variant_builder_close (&builder);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return g_variant_ref_sink (g_variant_builder_end (&builder));
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_list_free:
|
|
Packit |
d14447 |
* @pco_list: (transfer full)(element-type ModemManager.Pco): a #GList of #MMPco.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Frees all of the memory used by a #GList of #MMPco.
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
void
|
|
Packit |
d14447 |
mm_pco_list_free (GList *pco_list)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
g_list_free_full (pco_list, g_object_unref);
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/**
|
|
Packit |
d14447 |
* mm_pco_list_add:
|
|
Packit |
d14447 |
* @pco_list: (transfer full)(element-type ModemManager.Pco): a #GList of #MMPco.
|
|
Packit |
d14447 |
* @pco: (transfer none): a #MMPco to add to the given list.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Adds a #MMPco to a given PCO list. #MMPco objects stored in the order of
|
|
Packit |
d14447 |
* their session ID. An existing PCO with the same session ID is overwritten
|
|
Packit |
d14447 |
* with the new value.
|
|
Packit |
d14447 |
*
|
|
Packit |
d14447 |
* Returns: (transfer full)(element-type ModemManager.Pco): the new start of an updated or newly allocated #GList of #MMPco.
|
|
Packit |
d14447 |
*/
|
|
Packit |
d14447 |
GList *
|
|
Packit |
d14447 |
mm_pco_list_add (GList *pco_list,
|
|
Packit |
d14447 |
MMPco *pco)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
GList *iter;
|
|
Packit |
d14447 |
guint32 session_id;
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_return_val_if_fail (pco != NULL, pco_list);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
session_id = mm_pco_get_session_id (pco);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
for (iter = g_list_first (pco_list); iter; iter = g_list_next (iter)) {
|
|
Packit |
d14447 |
MMPco *iter_pco = iter->data;
|
|
Packit |
d14447 |
guint32 iter_session_id = mm_pco_get_session_id (iter_pco);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
if (iter_session_id < session_id)
|
|
Packit |
d14447 |
continue;
|
|
Packit |
d14447 |
else if (iter_session_id == session_id) {
|
|
Packit |
d14447 |
iter->data = g_object_ref (pco);
|
|
Packit |
d14447 |
g_object_unref (iter_pco);
|
|
Packit |
d14447 |
return pco_list;
|
|
Packit |
d14447 |
} else
|
|
Packit |
d14447 |
break;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
return g_list_insert_before (pco_list, iter, g_object_ref (pco));
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
/*****************************************************************************/
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
MMPco *
|
|
Packit |
d14447 |
mm_pco_new (void)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
return (MM_PCO (g_object_new (MM_TYPE_PCO, NULL)));
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
static void
|
|
Packit |
d14447 |
mm_pco_init (MMPco *self)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
self->priv = G_TYPE_INSTANCE_GET_PRIVATE (self, MM_TYPE_PCO, MMPcoPrivate);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
self->priv->session_id = G_MAXUINT32;
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
static void
|
|
Packit |
d14447 |
finalize (GObject *object)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
MMPco *self = MM_PCO (object);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_bytes_unref (self->priv->data);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
G_OBJECT_CLASS (mm_pco_parent_class)->finalize (object);
|
|
Packit |
d14447 |
}
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
static void
|
|
Packit |
d14447 |
mm_pco_class_init (MMPcoClass *klass)
|
|
Packit |
d14447 |
{
|
|
Packit |
d14447 |
GObjectClass *object_class = G_OBJECT_CLASS (klass);
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
g_type_class_add_private (object_class, sizeof (MMPcoPrivate));
|
|
Packit |
d14447 |
|
|
Packit |
d14447 |
object_class->finalize = finalize;
|
|
Packit |
d14447 |
}
|