Aleksander Morgado
74fc5baca2
The behavior of GRegex changed in 2.73.2 once it was ported from pcre1 to pcre2. In some cases it was made more strict, which is fine, in other cases it exposed some change in how it behaves on certain matches that is not extremely clear whether it's ok or not. See https://gitlab.gnome.org/GNOME/glib/-/issues/2729 See https://gitlab.freedesktop.org/mobile-broadband/ModemManager/-/issues/601 See https://gitlab.freedesktop.org/mobile-broadband/ModemManager/-/issues/621 Either way, one thing that was assumed was that initializing all GRegex/GMatchInfo variables to NULL and making sure they're NULL before they're initialized by glib (especially the GMatchInfo) was a good and safer approach. So, whenever possible, g_autoptr() is used to cleanup the allocated GMatchInfo/GRegex variables, and otherwise, g_clear_pointer() is used to ensure that no free/unref is attempted unless the given variable is not NULL, and also so that the variable is reseted to NULL after being disposed.
338 lines
11 KiB
C
338 lines
11 KiB
C
/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
|
|
/*
|
|
* 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:
|
|
*
|
|
* Copyright (C) 2012 Google, Inc.
|
|
* Copyright (C) 2012 - 2013 Aleksander Morgado <aleksander@gnu.org>
|
|
* Copyright (C) 2014 Dan Williams <dcbw@redhat.com>
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <arpa/inet.h>
|
|
#include <netinet/in.h>
|
|
|
|
#include <ModemManager.h>
|
|
#define _LIBMM_INSIDE_MM
|
|
#include <libmm-glib.h>
|
|
|
|
#include "mm-log.h"
|
|
#include "mm-modem-helpers.h"
|
|
#include "mm-modem-helpers-mbm.h"
|
|
|
|
/*****************************************************************************/
|
|
/* *E2IPCFG response parser */
|
|
|
|
static gboolean
|
|
validate_address (int family, const char *addr)
|
|
{
|
|
struct in6_addr tmp6 = IN6ADDR_ANY_INIT;
|
|
|
|
if (inet_pton (family, addr, (void *) &tmp6) != 1)
|
|
{
|
|
g_message ("%s: famil '%s'", __func__, addr);
|
|
return FALSE;
|
|
}
|
|
if ((family == AF_INET6) && IN6_IS_ADDR_UNSPECIFIED (&tmp6))
|
|
return FALSE;
|
|
return TRUE;
|
|
}
|
|
|
|
#define E2IPCFG_TAG "*E2IPCFG"
|
|
|
|
gboolean
|
|
mm_mbm_parse_e2ipcfg_response (const gchar *response,
|
|
MMBearerIpConfig **out_ip4_config,
|
|
MMBearerIpConfig **out_ip6_config,
|
|
GError **error)
|
|
{
|
|
MMBearerIpConfig **ip_config = NULL;
|
|
gboolean got_address = FALSE;
|
|
gboolean got_gw = FALSE;
|
|
gboolean got_dns = FALSE;
|
|
g_autoptr(GRegex) r = NULL;
|
|
g_autoptr(GMatchInfo) match_info = NULL;
|
|
GError *match_error = NULL;
|
|
gchar *dns[3] = { 0 };
|
|
guint dns_idx = 0;
|
|
int family = AF_INET;
|
|
MMBearerIpMethod method = MM_BEARER_IP_METHOD_STATIC;
|
|
|
|
g_return_val_if_fail (out_ip4_config, FALSE);
|
|
g_return_val_if_fail (out_ip6_config, FALSE);
|
|
|
|
if (!response || !g_str_has_prefix (response, E2IPCFG_TAG)) {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED, "Missing " E2IPCFG_TAG " prefix");
|
|
return FALSE;
|
|
}
|
|
|
|
response = mm_strip_tag (response, "*E2IPCFG: ");
|
|
|
|
if (strchr (response, ':')) {
|
|
family = AF_INET6;
|
|
ip_config = out_ip6_config;
|
|
method = MM_BEARER_IP_METHOD_DHCP;
|
|
} else if (strchr (response, '.')) {
|
|
family = AF_INET;
|
|
ip_config = out_ip4_config;
|
|
method = MM_BEARER_IP_METHOD_STATIC;
|
|
} else {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED,
|
|
"Failed to detect " E2IPCFG_TAG " address family");
|
|
return FALSE;
|
|
}
|
|
|
|
/* *E2IPCFG: (1,<IP>)(2,<gateway>)(3,<DNS>)(3,<DNS>)
|
|
*
|
|
* *E2IPCFG: (1,"46.157.32.246")(2,"46.157.32.243")(3,"193.213.112.4")(3,"130.67.15.198")
|
|
* *E2IPCFG: (1,"fe80:0000:0000:0000:0000:0000:e537:1801")(3,"2001:4600:0004:0fff:0000:0000:0000:0054")(3,"2001:4600:0004:1fff:0000:0000:0000:0054")
|
|
* *E2IPCFG: (1,"fe80:0000:0000:0000:0000:0027:b7fe:9401")(3,"fd00:976a:0000:0000:0000:0000:0000:0009")
|
|
*/
|
|
r = g_regex_new ("\\((\\d),\"([0-9a-fA-F.:]+)\"\\)", 0, 0, NULL);
|
|
g_assert (r != NULL);
|
|
|
|
if (!g_regex_match_full (r, response, -1, 0, 0, &match_info, &match_error)) {
|
|
if (match_error) {
|
|
g_propagate_error (error, match_error);
|
|
g_prefix_error (error, "Could not parse " E2IPCFG_TAG " results: ");
|
|
} else {
|
|
g_set_error_literal (error,
|
|
MM_CORE_ERROR,
|
|
MM_CORE_ERROR_FAILED,
|
|
"Couldn't match " E2IPCFG_TAG " reply");
|
|
}
|
|
return FALSE;
|
|
}
|
|
|
|
*ip_config = mm_bearer_ip_config_new ();
|
|
mm_bearer_ip_config_set_method (*ip_config, method);
|
|
while (g_match_info_matches (match_info)) {
|
|
g_autofree gchar *id = NULL;
|
|
g_autofree gchar *str = NULL;
|
|
|
|
id = g_match_info_fetch (match_info, 1);
|
|
str = g_match_info_fetch (match_info, 2);
|
|
|
|
switch (atoi (id)) {
|
|
case 1:
|
|
if (validate_address (family, str)) {
|
|
mm_bearer_ip_config_set_address (*ip_config, str);
|
|
mm_bearer_ip_config_set_prefix (*ip_config, (family == AF_INET6) ? 64 : 28);
|
|
got_address = TRUE;
|
|
}
|
|
break;
|
|
case 2:
|
|
if ((family == AF_INET) && validate_address (family, str)) {
|
|
mm_bearer_ip_config_set_gateway (*ip_config, str);
|
|
got_gw = TRUE;
|
|
}
|
|
break;
|
|
case 3:
|
|
if (validate_address (family, str)) {
|
|
dns[dns_idx++] = g_strdup (str);
|
|
got_dns = TRUE;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
g_match_info_next (match_info, NULL);
|
|
}
|
|
|
|
if (got_dns) {
|
|
mm_bearer_ip_config_set_dns (*ip_config, (const gchar **) dns);
|
|
g_free (dns[0]);
|
|
g_free (dns[1]);
|
|
}
|
|
|
|
if (!got_address || (family == AF_INET && !got_gw)) {
|
|
g_object_unref (*ip_config);
|
|
*ip_config = NULL;
|
|
g_set_error_literal (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED,
|
|
"Got incomplete IP configuration from " E2IPCFG_TAG);
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
#define CFUN_TAG "+CFUN:"
|
|
|
|
static void
|
|
add_supported_mode (guint mode,
|
|
gpointer log_object,
|
|
guint32 *mask)
|
|
{
|
|
g_assert (mask);
|
|
if (mode >= 32)
|
|
mm_obj_warn (log_object, "ignored unexpected mode in +CFUN match: %d", mode);
|
|
else
|
|
*mask |= (1 << mode);
|
|
}
|
|
|
|
gboolean
|
|
mm_mbm_parse_cfun_test (const gchar *response,
|
|
gpointer log_object,
|
|
guint32 *supported_mask,
|
|
GError **error)
|
|
{
|
|
gchar **groups;
|
|
guint32 mask = 0;
|
|
|
|
g_assert (supported_mask);
|
|
|
|
if (!response || !g_str_has_prefix (response, CFUN_TAG)) {
|
|
g_set_error_literal (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED,
|
|
"Missing " CFUN_TAG " prefix");
|
|
return FALSE;
|
|
}
|
|
|
|
/*
|
|
* AT+CFUN=?
|
|
* +CFUN: (0,1,4-6),(0,1)
|
|
* OK
|
|
*/
|
|
|
|
/* Strip tag from response */
|
|
response = mm_strip_tag (response, CFUN_TAG);
|
|
|
|
/* Split response in (groups) */
|
|
groups = mm_split_string_groups (response);
|
|
|
|
/* First group is the one listing supported modes */
|
|
if (groups && groups[0]) {
|
|
gchar **supported_modes;
|
|
|
|
supported_modes = g_strsplit_set (groups[0], ", ", -1);
|
|
if (supported_modes) {
|
|
guint i;
|
|
|
|
for (i = 0; supported_modes[i]; i++) {
|
|
gchar *separator;
|
|
guint mode;
|
|
|
|
if (!supported_modes[i][0])
|
|
continue;
|
|
|
|
/* Check if this is a range that's being given to us */
|
|
separator = strchr (supported_modes[i], '-');
|
|
if (separator) {
|
|
gchar *first_str;
|
|
gchar *last_str;
|
|
guint first;
|
|
guint last;
|
|
|
|
*separator = '\0';
|
|
first_str = supported_modes[i];
|
|
last_str = separator + 1;
|
|
|
|
if (!mm_get_uint_from_str (first_str, &first))
|
|
mm_obj_warn (log_object, "couldn't match range start: '%s'", first_str);
|
|
else if (!mm_get_uint_from_str (last_str, &last))
|
|
mm_obj_warn (log_object, "couldn't match range stop: '%s'", last_str);
|
|
else if (first >= last)
|
|
mm_obj_warn (log_object, "couldn't match range: wrong first '%s' and last '%s' items", first_str, last_str);
|
|
else {
|
|
for (mode = first; mode <= last; mode++)
|
|
add_supported_mode (mode, log_object, &mask);
|
|
}
|
|
} else {
|
|
if (!mm_get_uint_from_str (supported_modes[i], &mode))
|
|
mm_obj_warn (log_object, "couldn't match mode: '%s'", supported_modes[i]);
|
|
else
|
|
add_supported_mode (mode, log_object, &mask);
|
|
}
|
|
}
|
|
|
|
g_strfreev (supported_modes);
|
|
}
|
|
}
|
|
g_strfreev (groups);
|
|
|
|
if (mask)
|
|
*supported_mask = mask;
|
|
return !!mask;
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* AT+CFUN? response parsers */
|
|
|
|
gboolean
|
|
mm_mbm_parse_cfun_query_power_state (const gchar *response,
|
|
MMModemPowerState *out_state,
|
|
GError **error)
|
|
{
|
|
guint state;
|
|
|
|
if (!mm_3gpp_parse_cfun_query_response (response, &state, error))
|
|
return FALSE;
|
|
|
|
switch (state) {
|
|
case MBM_NETWORK_MODE_OFFLINE:
|
|
*out_state = MM_MODEM_POWER_STATE_OFF;
|
|
return TRUE;
|
|
case MBM_NETWORK_MODE_LOW_POWER:
|
|
*out_state = MM_MODEM_POWER_STATE_LOW;
|
|
return TRUE;
|
|
case MBM_NETWORK_MODE_ANY:
|
|
case MBM_NETWORK_MODE_2G:
|
|
case MBM_NETWORK_MODE_3G:
|
|
*out_state = MM_MODEM_POWER_STATE_ON;
|
|
return TRUE;
|
|
default:
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED,
|
|
"Unknown +CFUN pòwer state: '%u'", state);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
gboolean
|
|
mm_mbm_parse_cfun_query_current_modes (const gchar *response,
|
|
MMModemMode *allowed,
|
|
gint *mbm_mode,
|
|
GError **error)
|
|
{
|
|
guint state;
|
|
|
|
g_assert (mbm_mode);
|
|
g_assert (allowed);
|
|
|
|
if (!mm_3gpp_parse_cfun_query_response (response, &state, error))
|
|
return FALSE;
|
|
|
|
switch (state) {
|
|
case MBM_NETWORK_MODE_OFFLINE:
|
|
case MBM_NETWORK_MODE_LOW_POWER:
|
|
/* Do not update mbm_mode */
|
|
*allowed = MM_MODEM_MODE_NONE;
|
|
return TRUE;
|
|
case MBM_NETWORK_MODE_2G:
|
|
*mbm_mode = MBM_NETWORK_MODE_2G;
|
|
*allowed = MM_MODEM_MODE_2G;
|
|
return TRUE;
|
|
case MBM_NETWORK_MODE_3G:
|
|
*mbm_mode = MBM_NETWORK_MODE_3G;
|
|
*allowed = MM_MODEM_MODE_3G;
|
|
return TRUE;
|
|
case MBM_NETWORK_MODE_ANY:
|
|
/* Do not update mbm_mode */
|
|
*allowed = (MM_MODEM_MODE_2G | MM_MODEM_MODE_3G);
|
|
return TRUE;
|
|
default:
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_FAILED,
|
|
"Unknown +CFUN current mode: '%u'", state);
|
|
return FALSE;
|
|
}
|
|
}
|