icera: add generic band handling functions
This commit is contained in:
Dan Williams
committed by
Aleksander Morgado
Aleksander Morgado
parent
b1c2e0ba5f
commit
a532c081d1
@@ -12,6 +12,7 @@
|
|||||||
*
|
*
|
||||||
* Copyright (C) 2010 - 2012 Red Hat, Inc.
|
* Copyright (C) 2010 - 2012 Red Hat, Inc.
|
||||||
* Copyright (C) 2012 Aleksander Morgado <aleksander@gnu.org>
|
* Copyright (C) 2012 Aleksander Morgado <aleksander@gnu.org>
|
||||||
|
* Copyright (C) 2012 Google Inc.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <config.h>
|
#include <config.h>
|
||||||
@@ -731,6 +732,348 @@ mm_iface_icera_modem_load_unlock_retries (MMIfaceModem *self,
|
|||||||
mm_iface_icera_modem_load_unlock_retries));
|
mm_iface_icera_modem_load_unlock_retries));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************/
|
||||||
|
/* Load supported bands (Modem interface) */
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
MMModemBand band;
|
||||||
|
const char *name;
|
||||||
|
} BandTable;
|
||||||
|
|
||||||
|
static BandTable modem_bands[] = {
|
||||||
|
/* Sort 3G first since it's preferred */
|
||||||
|
{ MM_MODEM_BAND_U2100, "FDD_BAND_I" },
|
||||||
|
{ MM_MODEM_BAND_U1900, "FDD_BAND_II" },
|
||||||
|
/*
|
||||||
|
* Several bands are forbidden to set and will always read as
|
||||||
|
* disabled, so we won't present them to the rest of
|
||||||
|
* modemmanager.
|
||||||
|
*/
|
||||||
|
/* { MM_MODEM_BAND_U1800, "FDD_BAND_III" }, */
|
||||||
|
/* { MM_MODEM_BAND_U17IV, "FDD_BAND_IV" }, */
|
||||||
|
/* { MM_MODEM_BAND_U800, "FDD_BAND_VI" }, */
|
||||||
|
{ MM_MODEM_BAND_U850, "FDD_BAND_V" },
|
||||||
|
{ MM_MODEM_BAND_U900, "FDD_BAND_VIII" },
|
||||||
|
{ MM_MODEM_BAND_G850, "G850" },
|
||||||
|
/* 2G second */
|
||||||
|
{ MM_MODEM_BAND_DCS, "DCS" },
|
||||||
|
{ MM_MODEM_BAND_EGSM, "EGSM" },
|
||||||
|
{ MM_MODEM_BAND_PCS, "PCS" },
|
||||||
|
/* And ANY last since it's most inclusive */
|
||||||
|
{ MM_MODEM_BAND_ANY, "ANY" },
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
GArray *
|
||||||
|
mm_iface_icera_modem_load_supported_bands_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GError **error)
|
||||||
|
{
|
||||||
|
/* Never fails */
|
||||||
|
return (GArray *) g_array_ref (g_simple_async_result_get_op_res_gpointer (
|
||||||
|
G_SIMPLE_ASYNC_RESULT (res)));
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
mm_iface_icera_modem_load_supported_bands (MMIfaceModem *self,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data)
|
||||||
|
{
|
||||||
|
GSimpleAsyncResult *result;
|
||||||
|
GArray *bands;
|
||||||
|
guint i;
|
||||||
|
|
||||||
|
result = g_simple_async_result_new (G_OBJECT (self),
|
||||||
|
callback,
|
||||||
|
user_data,
|
||||||
|
mm_iface_icera_modem_load_supported_bands);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The modem doesn't support telling us what bands are supported;
|
||||||
|
* list everything we know about.
|
||||||
|
*/
|
||||||
|
bands = g_array_sized_new (FALSE, FALSE, sizeof (MMModemBand), G_N_ELEMENTS (modem_bands));
|
||||||
|
for (i = 0 ; i < G_N_ELEMENTS (modem_bands) ; i++) {
|
||||||
|
if (modem_bands[i].band != MM_MODEM_BAND_ANY)
|
||||||
|
g_array_append_val(bands, modem_bands[i].band);
|
||||||
|
}
|
||||||
|
|
||||||
|
g_simple_async_result_set_op_res_gpointer (result,
|
||||||
|
bands,
|
||||||
|
(GDestroyNotify)g_array_unref);
|
||||||
|
g_simple_async_result_complete_in_idle (result);
|
||||||
|
g_object_unref (result);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************/
|
||||||
|
/* Load current bands (Modem interface) */
|
||||||
|
|
||||||
|
GArray *
|
||||||
|
mm_iface_icera_modem_load_current_bands_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GError **error)
|
||||||
|
{
|
||||||
|
if (g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error))
|
||||||
|
return NULL;
|
||||||
|
return (GArray *) g_array_ref (g_simple_async_result_get_op_res_gpointer (
|
||||||
|
G_SIMPLE_ASYNC_RESULT (res)));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
load_current_bands_ready (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GSimpleAsyncResult *operation_result)
|
||||||
|
{
|
||||||
|
GRegex *r;
|
||||||
|
GMatchInfo *info;
|
||||||
|
GArray *bands;
|
||||||
|
const gchar *response;
|
||||||
|
GError *error;
|
||||||
|
|
||||||
|
response = mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, &error);
|
||||||
|
if (!response) {
|
||||||
|
mm_dbg ("Couldn't query current bands: '%s'", error->message);
|
||||||
|
g_simple_async_result_take_error (operation_result, error);
|
||||||
|
g_simple_async_result_complete (operation_result);
|
||||||
|
g_object_unref (operation_result);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Response is a number of lines of the form:
|
||||||
|
* "EGSM": 0
|
||||||
|
* "FDD_BAND_I": 1
|
||||||
|
* ...
|
||||||
|
* with 1 and 0 indicating whether the particular band is enabled or not.
|
||||||
|
*/
|
||||||
|
r = g_regex_new ("^\"(\\w+)\": (\\d)",
|
||||||
|
G_REGEX_MULTILINE, G_REGEX_MATCH_NEWLINE_ANY,
|
||||||
|
NULL);
|
||||||
|
g_assert (r != NULL);
|
||||||
|
|
||||||
|
bands = g_array_sized_new (FALSE, FALSE, sizeof (MMModemBand),
|
||||||
|
G_N_ELEMENTS (modem_bands));
|
||||||
|
|
||||||
|
g_regex_match (r, response, 0, &info);
|
||||||
|
while (g_match_info_matches (info)) {
|
||||||
|
gchar *band, *enabled;
|
||||||
|
|
||||||
|
band = g_match_info_fetch (info, 1);
|
||||||
|
enabled = g_match_info_fetch (info, 2);
|
||||||
|
if (enabled[0] == '1') {
|
||||||
|
guint i;
|
||||||
|
for (i = 0 ; i < G_N_ELEMENTS (modem_bands); i++) {
|
||||||
|
if (!strcmp (band, modem_bands[i].name)) {
|
||||||
|
g_array_append_val (bands, modem_bands[i].band);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
g_free (band);
|
||||||
|
g_free (enabled);
|
||||||
|
g_match_info_next (info, NULL);
|
||||||
|
}
|
||||||
|
g_match_info_free (info);
|
||||||
|
g_regex_unref (r);
|
||||||
|
|
||||||
|
g_simple_async_result_set_op_res_gpointer (operation_result,
|
||||||
|
bands,
|
||||||
|
(GDestroyNotify)g_array_unref);
|
||||||
|
g_simple_async_result_complete (operation_result);
|
||||||
|
g_object_unref (operation_result);
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
mm_iface_icera_modem_load_current_bands (MMIfaceModem *self,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data)
|
||||||
|
{
|
||||||
|
GSimpleAsyncResult *result;
|
||||||
|
|
||||||
|
result = g_simple_async_result_new (G_OBJECT (self),
|
||||||
|
callback,
|
||||||
|
user_data,
|
||||||
|
mm_iface_icera_modem_load_current_bands);
|
||||||
|
mm_base_modem_at_command (
|
||||||
|
MM_BASE_MODEM (self),
|
||||||
|
"%IPBM?",
|
||||||
|
3,
|
||||||
|
FALSE,
|
||||||
|
(GAsyncReadyCallback)load_current_bands_ready,
|
||||||
|
result);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*****************************************************************************/
|
||||||
|
/* Set bands (Modem interface) */
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
GSimpleAsyncResult *result;
|
||||||
|
guint bandbits;
|
||||||
|
guint enablebits;
|
||||||
|
guint disablebits;
|
||||||
|
} SetBandsContext;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The modem's band-setting command (%IPBM=) enables or disables one
|
||||||
|
* band at a time, and one band must always be enabled. Here, we first
|
||||||
|
* get the set of enabled bands, compute the difference between that
|
||||||
|
* set and the requested set, enable any added bands, and finally
|
||||||
|
* disable any removed bands.
|
||||||
|
*/
|
||||||
|
gboolean
|
||||||
|
mm_iface_icera_modem_set_bands_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GError **error)
|
||||||
|
{
|
||||||
|
return !g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void set_one_band (MMIfaceModem *self, SetBandsContext *ctx);
|
||||||
|
|
||||||
|
static void
|
||||||
|
set_bands_context_complete_and_free (SetBandsContext *ctx)
|
||||||
|
{
|
||||||
|
g_simple_async_result_complete (ctx->result);
|
||||||
|
g_object_unref (ctx->result);
|
||||||
|
g_free (ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
set_bands_next (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
SetBandsContext *ctx)
|
||||||
|
{
|
||||||
|
GError *error = NULL;
|
||||||
|
|
||||||
|
if (!mm_base_modem_at_command_finish (MM_BASE_MODEM (self), res, &error)) {
|
||||||
|
mm_dbg ("Couldn't set bands: '%s'", error->message);
|
||||||
|
g_simple_async_result_take_error (ctx->result, error);
|
||||||
|
set_bands_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
set_one_band (self, ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
set_one_band (MMIfaceModem *self,
|
||||||
|
SetBandsContext *ctx)
|
||||||
|
{
|
||||||
|
guint enable, band;
|
||||||
|
gchar *command;
|
||||||
|
|
||||||
|
/* Find the next band to enable or disable, always doing enables first */
|
||||||
|
enable = 1;
|
||||||
|
band = ffs (ctx->enablebits);
|
||||||
|
if (band == 0) {
|
||||||
|
enable = 0;
|
||||||
|
band = ffs (ctx->disablebits);
|
||||||
|
}
|
||||||
|
if (band == 0) {
|
||||||
|
/* Both enabling and disabling are done */
|
||||||
|
g_simple_async_result_set_op_res_gboolean (ctx->result, TRUE);
|
||||||
|
set_bands_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Note that ffs() returning 2 corresponds to 1 << 1, not 1 << 2 */
|
||||||
|
band--;
|
||||||
|
mm_dbg("1. enablebits %x disablebits %x band %d enable %d",
|
||||||
|
ctx->enablebits, ctx->disablebits, band, enable);
|
||||||
|
|
||||||
|
if (enable)
|
||||||
|
ctx->enablebits &= ~(1 << band);
|
||||||
|
else
|
||||||
|
ctx->disablebits &= ~(1 << band);
|
||||||
|
mm_dbg("2. enablebits %x disablebits %x",
|
||||||
|
ctx->enablebits, ctx->disablebits);
|
||||||
|
|
||||||
|
command = g_strdup_printf ("%%IPBM=\"%s\",%d",
|
||||||
|
modem_bands[band].name,
|
||||||
|
enable);
|
||||||
|
mm_base_modem_at_command (
|
||||||
|
MM_BASE_MODEM (self),
|
||||||
|
command,
|
||||||
|
10,
|
||||||
|
FALSE,
|
||||||
|
(GAsyncReadyCallback)set_bands_next,
|
||||||
|
ctx);
|
||||||
|
g_free (command);
|
||||||
|
}
|
||||||
|
|
||||||
|
static guint
|
||||||
|
band_array_to_bandbits (GArray *bands)
|
||||||
|
{
|
||||||
|
MMModemBand band;
|
||||||
|
guint i, j, bandbits;
|
||||||
|
|
||||||
|
bandbits = 0;
|
||||||
|
for (i = 0 ; i < bands->len ; i++) {
|
||||||
|
band = g_array_index (bands, MMModemBand, i);
|
||||||
|
for (j = 0 ; j < G_N_ELEMENTS (modem_bands) ; j++) {
|
||||||
|
if (modem_bands[j].band == band) {
|
||||||
|
bandbits |= 1 << j;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
g_assert (j < G_N_ELEMENTS (modem_bands));
|
||||||
|
}
|
||||||
|
|
||||||
|
return bandbits;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
set_bands_got_current_bands (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
SetBandsContext *ctx)
|
||||||
|
{
|
||||||
|
GArray *bands;
|
||||||
|
GError *error = NULL;
|
||||||
|
guint currentbits;
|
||||||
|
|
||||||
|
bands = mm_iface_icera_modem_load_current_bands_finish (self, res, &error);
|
||||||
|
if (!bands) {
|
||||||
|
g_simple_async_result_take_error (ctx->result, error);
|
||||||
|
set_bands_context_complete_and_free (ctx);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
currentbits = band_array_to_bandbits (bands);
|
||||||
|
ctx->enablebits = ctx->bandbits & ~currentbits;
|
||||||
|
ctx->disablebits = currentbits & ~ctx->bandbits;
|
||||||
|
|
||||||
|
set_one_band (self, ctx);
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
mm_iface_icera_modem_set_bands (MMIfaceModem *self,
|
||||||
|
GArray *bands_array,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data)
|
||||||
|
{
|
||||||
|
SetBandsContext *ctx;
|
||||||
|
|
||||||
|
ctx = g_new0 (SetBandsContext, 1);
|
||||||
|
ctx->result = g_simple_async_result_new (G_OBJECT (self),
|
||||||
|
callback,
|
||||||
|
user_data,
|
||||||
|
mm_iface_icera_modem_set_bands);
|
||||||
|
ctx->bandbits = band_array_to_bandbits (bands_array);
|
||||||
|
/*
|
||||||
|
* For the sake of efficiency, convert "ANY" to the actual set of
|
||||||
|
* bands; this matches what we get from load_current_bands and
|
||||||
|
* minimizes the number of changes we need to make.
|
||||||
|
*
|
||||||
|
* This requires that ANY is last in modem_bands and that all the
|
||||||
|
* other bits are valid.
|
||||||
|
*/
|
||||||
|
if (ctx->bandbits == (1 << (G_N_ELEMENTS (modem_bands) - 1)))
|
||||||
|
ctx->bandbits--; /* clear the top bit, set all lower bits */
|
||||||
|
mm_iface_icera_modem_load_current_bands (self,
|
||||||
|
(GAsyncReadyCallback)set_bands_got_current_bands,
|
||||||
|
ctx);
|
||||||
|
}
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
/* Load network timezone (Time interface) */
|
/* Load network timezone (Time interface) */
|
||||||
|
|
||||||
|
|||||||
@@ -99,6 +99,31 @@ MMUnlockRetries *mm_iface_icera_modem_load_unlock_retries_finish (MMIfaceModem *
|
|||||||
GAsyncResult *res,
|
GAsyncResult *res,
|
||||||
GError **error);
|
GError **error);
|
||||||
|
|
||||||
|
void mm_iface_icera_modem_load_supported_bands (MMIfaceModem *self,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data);
|
||||||
|
|
||||||
|
GArray *mm_iface_icera_modem_load_supported_bands_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GError **error);
|
||||||
|
|
||||||
|
void mm_iface_icera_modem_load_current_bands (MMIfaceModem *self,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data);
|
||||||
|
|
||||||
|
GArray *mm_iface_icera_modem_load_current_bands_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GError **error);
|
||||||
|
|
||||||
|
void mm_iface_icera_modem_set_bands (MMIfaceModem *self,
|
||||||
|
GArray *bands_array,
|
||||||
|
GAsyncReadyCallback callback,
|
||||||
|
gpointer user_data);
|
||||||
|
|
||||||
|
gboolean mm_iface_icera_modem_set_bands_finish (MMIfaceModem *self,
|
||||||
|
GAsyncResult *res,
|
||||||
|
GError **error);
|
||||||
|
|
||||||
/*****************************************************************************/
|
/*****************************************************************************/
|
||||||
/* Modem 3GPP interface specific implementations */
|
/* Modem 3GPP interface specific implementations */
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user