Allow counting more kinds of bearers than just multiplexed ones. Signed-off-by: Dan Williams <dan@ioncontrol.co>
3020 lines
112 KiB
C
3020 lines
112 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) 2015 Azimut Electronics
|
|
* Copyright (c) 2022 Qualcomm Innovation Center, Inc.
|
|
*/
|
|
|
|
#include <config.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <ctype.h>
|
|
#include <netinet/in.h>
|
|
#include <arpa/inet.h>
|
|
|
|
#include <ModemManager.h>
|
|
#define _LIBMM_INSIDE_MM
|
|
#include <libmm-glib.h>
|
|
|
|
#include "mm-iface-modem-3gpp.h"
|
|
#include "mm-iface-modem.h"
|
|
#include "mm-iface-modem-3gpp-profile-manager.h"
|
|
#include "mm-bearer-qmi.h"
|
|
#include "mm-modem-helpers-qmi.h"
|
|
#include "mm-port-enums-types.h"
|
|
#include "mm-log-object.h"
|
|
#include "mm-modem-helpers.h"
|
|
#include "mm-context.h"
|
|
#include "mm-bind.h"
|
|
|
|
G_DEFINE_TYPE (MMBearerQmi, mm_bearer_qmi, MM_TYPE_BASE_BEARER)
|
|
|
|
#define GLOBAL_PACKET_DATA_HANDLE 0xFFFFFFFF
|
|
|
|
struct _MMBearerQmiPrivate {
|
|
/* Cancellables available during a connection attempt */
|
|
GCancellable *ongoing_connect_user_cancellable;
|
|
GCancellable *ongoing_connect_network_cancellable;
|
|
|
|
/* State kept while connected */
|
|
MMPortQmi *qmi;
|
|
gboolean explicit_qmi_open;
|
|
|
|
QmiClientWds *client_ipv4;
|
|
guint packet_service_status_ipv4_indication_id;
|
|
guint event_report_ipv4_indication_id;
|
|
guint extended_ipv4_config_change_id;
|
|
|
|
QmiClientWds *client_ipv6;
|
|
guint packet_service_status_ipv6_indication_id;
|
|
guint event_report_ipv6_indication_id;
|
|
guint extended_ipv6_config_change_id;
|
|
|
|
MMPort *data;
|
|
MMPort *link;
|
|
guint mux_id;
|
|
guint32 packet_data_handle_ipv4;
|
|
guint32 packet_data_handle_ipv6;
|
|
|
|
GList *pco_list;
|
|
};
|
|
|
|
/*****************************************************************************/
|
|
/* Stats */
|
|
|
|
typedef enum {
|
|
RELOAD_STATS_CONTEXT_STEP_FIRST,
|
|
RELOAD_STATS_CONTEXT_STEP_IPV4,
|
|
RELOAD_STATS_CONTEXT_STEP_IPV6,
|
|
RELOAD_STATS_CONTEXT_STEP_LAST,
|
|
} ReloadStatsContextStep;
|
|
|
|
typedef struct {
|
|
guint64 rx_bytes;
|
|
guint64 tx_bytes;
|
|
} ReloadStatsResult;
|
|
|
|
typedef struct {
|
|
QmiMessageWdsGetPacketStatisticsInput *input;
|
|
ReloadStatsContextStep step;
|
|
ReloadStatsResult stats;
|
|
} ReloadStatsContext;
|
|
|
|
static gboolean
|
|
reload_stats_finish (MMBaseBearer *bearer,
|
|
guint64 *rx_bytes,
|
|
guint64 *tx_bytes,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
ReloadStatsResult *stats;
|
|
|
|
stats = g_task_propagate_pointer (G_TASK (res), error);
|
|
if (!stats)
|
|
return FALSE;
|
|
|
|
if (rx_bytes)
|
|
*rx_bytes = stats->rx_bytes;
|
|
if (tx_bytes)
|
|
*tx_bytes = stats->tx_bytes;
|
|
|
|
g_free (stats);
|
|
return TRUE;
|
|
}
|
|
|
|
static void
|
|
reload_stats_context_free (ReloadStatsContext *ctx)
|
|
{
|
|
qmi_message_wds_get_packet_statistics_input_unref (ctx->input);
|
|
g_slice_free (ReloadStatsContext, ctx);
|
|
}
|
|
|
|
static void reload_stats_context_step (GTask *task);
|
|
|
|
static void
|
|
get_packet_statistics_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ReloadStatsContext *ctx;
|
|
GError *error = NULL;
|
|
QmiMessageWdsGetPacketStatisticsOutput *output;
|
|
guint64 tx_bytes_ok = 0;
|
|
guint64 rx_bytes_ok = 0;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
output = qmi_client_wds_get_packet_statistics_finish (client, res, &error);
|
|
if (!output) {
|
|
g_prefix_error (&error, "QMI operation failed: ");
|
|
g_task_return_error (task, error);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
if (!qmi_message_wds_get_packet_statistics_output_get_result (output, &error)) {
|
|
g_prefix_error (&error, "Couldn't get packet statistics: ");
|
|
g_task_return_error (task, error);
|
|
g_object_unref (task);
|
|
qmi_message_wds_get_packet_statistics_output_unref (output);
|
|
return;
|
|
}
|
|
|
|
qmi_message_wds_get_packet_statistics_output_get_tx_bytes_ok (output, &tx_bytes_ok, NULL);
|
|
qmi_message_wds_get_packet_statistics_output_get_rx_bytes_ok (output, &rx_bytes_ok, NULL);
|
|
ctx->stats.rx_bytes += rx_bytes_ok;
|
|
ctx->stats.tx_bytes += tx_bytes_ok;
|
|
|
|
qmi_message_wds_get_packet_statistics_output_unref (output);
|
|
|
|
/* Go on */
|
|
ctx->step++;
|
|
reload_stats_context_step (task);
|
|
}
|
|
|
|
static void
|
|
reload_stats_context_step (GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ReloadStatsContext *ctx;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
switch (ctx->step) {
|
|
case RELOAD_STATS_CONTEXT_STEP_FIRST:
|
|
ctx->step++;
|
|
/* fall through */
|
|
case RELOAD_STATS_CONTEXT_STEP_IPV4:
|
|
if (self->priv->client_ipv4) {
|
|
qmi_client_wds_get_packet_statistics (QMI_CLIENT_WDS (self->priv->client_ipv4),
|
|
ctx->input,
|
|
10,
|
|
NULL,
|
|
(GAsyncReadyCallback)get_packet_statistics_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
case RELOAD_STATS_CONTEXT_STEP_IPV6:
|
|
if (self->priv->client_ipv6) {
|
|
qmi_client_wds_get_packet_statistics (QMI_CLIENT_WDS (self->priv->client_ipv6),
|
|
ctx->input,
|
|
10,
|
|
NULL,
|
|
(GAsyncReadyCallback)get_packet_statistics_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
case RELOAD_STATS_CONTEXT_STEP_LAST:
|
|
g_task_return_pointer (task,
|
|
g_memdup (&ctx->stats, sizeof (ctx->stats)),
|
|
g_free);
|
|
g_object_unref (task);
|
|
return;
|
|
|
|
default:
|
|
g_assert_not_reached ();
|
|
}
|
|
}
|
|
|
|
static void
|
|
reload_stats (MMBaseBearer *self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
ReloadStatsContext *ctx;
|
|
GTask *task;
|
|
|
|
ctx = g_slice_new0 (ReloadStatsContext);
|
|
ctx->input = qmi_message_wds_get_packet_statistics_input_new ();
|
|
qmi_message_wds_get_packet_statistics_input_set_mask (
|
|
ctx->input,
|
|
(QMI_WDS_PACKET_STATISTICS_MASK_FLAG_TX_BYTES_OK |
|
|
QMI_WDS_PACKET_STATISTICS_MASK_FLAG_RX_BYTES_OK),
|
|
NULL);
|
|
ctx->step = RELOAD_STATS_CONTEXT_STEP_FIRST;
|
|
|
|
task = g_task_new (self, NULL, callback, user_data);
|
|
g_task_set_task_data (task, ctx, (GDestroyNotify)reload_stats_context_free);
|
|
|
|
reload_stats_context_step (task);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Connection status check */
|
|
|
|
typedef enum {
|
|
CONNECTION_STATUS_CONTEXT_STEP_FIRST,
|
|
CONNECTION_STATUS_CONTEXT_STEP_IPV4,
|
|
CONNECTION_STATUS_CONTEXT_STEP_IPV6,
|
|
CONNECTION_STATUS_CONTEXT_STEP_LAST,
|
|
} ConnectionStatusContextStep;
|
|
|
|
typedef struct {
|
|
ConnectionStatusContextStep step;
|
|
} ConnectionStatusContext;
|
|
|
|
static MMBearerConnectionStatus
|
|
reload_connection_status_finish (MMBaseBearer *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
gint val;
|
|
|
|
val = g_task_propagate_int (G_TASK (res), error);
|
|
if (val < 0)
|
|
return MM_BEARER_CONNECTION_STATUS_UNKNOWN;
|
|
|
|
return (MMBearerConnectionStatus) val;
|
|
}
|
|
|
|
static void connection_status_context_step (GTask *task);
|
|
|
|
static void
|
|
get_packet_service_status_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
GError *error = NULL;
|
|
QmiMessageWdsGetPacketServiceStatusOutput *output;
|
|
QmiWdsConnectionStatus status = QMI_WDS_CONNECTION_STATUS_UNKNOWN;
|
|
ConnectionStatusContext *ctx;
|
|
|
|
output = qmi_client_wds_get_packet_service_status_finish (client, res, &error);
|
|
if (!output)
|
|
goto out;
|
|
|
|
if (!qmi_message_wds_get_packet_service_status_output_get_result (output, &error))
|
|
goto out;
|
|
|
|
qmi_message_wds_get_packet_service_status_output_get_connection_status (
|
|
output,
|
|
&status,
|
|
NULL);
|
|
|
|
out:
|
|
if (output)
|
|
qmi_message_wds_get_packet_service_status_output_unref (output);
|
|
|
|
/* An error checking status is reported right away */
|
|
if (error) {
|
|
g_task_return_error (task, error);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
/* Report disconnection right away */
|
|
if (status != QMI_WDS_CONNECTION_STATUS_CONNECTED) {
|
|
g_task_return_int (task, MM_BEARER_CONNECTION_STATUS_DISCONNECTED);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
/* we're reported as connected, go on to next check if any */
|
|
ctx = g_task_get_task_data (task);
|
|
ctx->step++;
|
|
connection_status_context_step (task);
|
|
}
|
|
|
|
static void
|
|
connection_status_context_step (GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectionStatusContext *ctx;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
switch (ctx->step) {
|
|
case CONNECTION_STATUS_CONTEXT_STEP_FIRST:
|
|
/* If no clients ready on start, assume disconnected */
|
|
if (!self->priv->client_ipv4 && !self->priv->client_ipv6) {
|
|
g_task_return_int (task, MM_BEARER_CONNECTION_STATUS_DISCONNECTED);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECTION_STATUS_CONTEXT_STEP_IPV4:
|
|
if (self->priv->client_ipv4) {
|
|
qmi_client_wds_get_packet_service_status (self->priv->client_ipv4,
|
|
NULL,
|
|
10,
|
|
NULL,
|
|
(GAsyncReadyCallback)get_packet_service_status_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECTION_STATUS_CONTEXT_STEP_IPV6:
|
|
if (self->priv->client_ipv6) {
|
|
qmi_client_wds_get_packet_service_status (self->priv->client_ipv6,
|
|
NULL,
|
|
10,
|
|
NULL,
|
|
(GAsyncReadyCallback)get_packet_service_status_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECTION_STATUS_CONTEXT_STEP_LAST:
|
|
/* All available clients are connected */
|
|
g_task_return_int (task, MM_BEARER_CONNECTION_STATUS_CONNECTED);
|
|
g_object_unref (task);
|
|
return;
|
|
|
|
default:
|
|
g_assert_not_reached ();
|
|
}
|
|
}
|
|
|
|
static void
|
|
reload_connection_status (MMBaseBearer *self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
GTask *task;
|
|
ConnectionStatusContext *ctx;
|
|
|
|
ctx = g_new (ConnectionStatusContext, 1);
|
|
ctx->step = CONNECTION_STATUS_CONTEXT_STEP_FIRST;
|
|
|
|
task = g_task_new (self, NULL, callback, user_data);
|
|
g_task_set_task_data (task, ctx, g_free);
|
|
|
|
connection_status_context_step (task);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Connection status polling */
|
|
|
|
static MMBearerConnectionStatus
|
|
load_connection_status_finish (MMBaseBearer *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
gint val;
|
|
|
|
val = g_task_propagate_int (G_TASK (res), error);
|
|
if (val < 0)
|
|
return MM_BEARER_CONNECTION_STATUS_UNKNOWN;
|
|
|
|
return (MMBearerConnectionStatus) val;
|
|
}
|
|
|
|
static void
|
|
reload_connection_status_ready (MMBaseBearer *self,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
MMBearerConnectionStatus status;
|
|
GError *error = NULL;
|
|
|
|
status = reload_connection_status_finish (self, res, &error);
|
|
if (status == MM_BEARER_CONNECTION_STATUS_UNKNOWN)
|
|
g_task_return_error (task, error);
|
|
else
|
|
g_task_return_int (task, MM_BEARER_CONNECTION_STATUS_CONNECTED);
|
|
g_object_unref (task);
|
|
}
|
|
|
|
static void
|
|
load_connection_status (MMBaseBearer *_self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
MMBearerQmi *self = MM_BEARER_QMI (_self);
|
|
GTask *task;
|
|
|
|
task = g_task_new (self, NULL, callback, user_data);
|
|
|
|
/* Connection status polling is an optional feature that must be
|
|
* enabled explicitly via udev tags. If not set, out as unsupported. */
|
|
if (self->priv->qmi &&
|
|
!mm_kernel_device_get_global_property_as_boolean (mm_port_peek_kernel_device (MM_PORT (self->priv->qmi)),
|
|
"ID_MM_QMI_CONNECTION_STATUS_POLLING_ENABLE")) {
|
|
g_task_return_new_error (task, MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED,
|
|
"Connection status polling not required");
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
reload_connection_status (_self, (GAsyncReadyCallback)reload_connection_status_ready, task);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Connect */
|
|
|
|
#define WAIT_LINK_PORT_TIMEOUT_MS 2500
|
|
|
|
static void common_setup_cleanup_packet_service_status_unsolicited_events (MMBearerQmi *self,
|
|
QmiClientWds *client,
|
|
gboolean enable,
|
|
guint *indication_id);
|
|
|
|
static void setup_event_report_unsolicited_events (MMBearerQmi *self,
|
|
QmiClientWds *client,
|
|
GCancellable *cancellable,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data);
|
|
|
|
static void cleanup_event_report_unsolicited_events (MMBearerQmi *self,
|
|
QmiClientWds *client,
|
|
guint *indication_id);
|
|
|
|
typedef enum {
|
|
CONNECT_STEP_FIRST,
|
|
CONNECT_STEP_LOAD_PROFILE_SETTINGS,
|
|
CONNECT_STEP_OPEN_QMI_PORT,
|
|
CONNECT_STEP_SETUP_DATA_FORMAT,
|
|
CONNECT_STEP_SETUP_LINK,
|
|
CONNECT_STEP_SETUP_LINK_MAIN_UP,
|
|
CONNECT_STEP_IP_METHOD,
|
|
CONNECT_STEP_IPV4,
|
|
CONNECT_STEP_WDS_CLIENT_IPV4,
|
|
CONNECT_STEP_BIND_DATA_PORT_IPV4,
|
|
CONNECT_STEP_IP_FAMILY_IPV4,
|
|
CONNECT_STEP_ENABLE_INDICATIONS_IPV4,
|
|
CONNECT_STEP_START_NETWORK_IPV4,
|
|
CONNECT_STEP_ENABLE_WDS_INDICATIONS_IPV4,
|
|
CONNECT_STEP_GET_CURRENT_SETTINGS_IPV4,
|
|
CONNECT_STEP_IPV6,
|
|
CONNECT_STEP_WDS_CLIENT_IPV6,
|
|
CONNECT_STEP_BIND_DATA_PORT_IPV6,
|
|
CONNECT_STEP_IP_FAMILY_IPV6,
|
|
CONNECT_STEP_ENABLE_INDICATIONS_IPV6,
|
|
CONNECT_STEP_START_NETWORK_IPV6,
|
|
CONNECT_STEP_ENABLE_WDS_INDICATIONS_IPV6,
|
|
CONNECT_STEP_GET_CURRENT_SETTINGS_IPV6,
|
|
CONNECT_STEP_LAST
|
|
} ConnectStep;
|
|
|
|
typedef struct {
|
|
MMBearerQmi *self;
|
|
MMBaseModem *modem;
|
|
ConnectStep step;
|
|
MMPort *data;
|
|
MMPortQmi *qmi;
|
|
|
|
MMQmiDataEndpoint endpoint;
|
|
gboolean sio_port_failed;
|
|
|
|
gint profile_id;
|
|
MMBearerIpMethod ip_method;
|
|
gboolean explicit_qmi_open;
|
|
gchar *user;
|
|
gchar *password;
|
|
gchar *apn;
|
|
QmiWdsAuthentication auth;
|
|
gboolean no_ip_family_preference;
|
|
|
|
MMBearerMultiplexSupport multiplex;
|
|
QmiWdaDataAggregationProtocol dap;
|
|
guint mux_id;
|
|
gchar *link_prefix_hint;
|
|
gchar *link_name;
|
|
MMPort *link;
|
|
|
|
gboolean ipv4;
|
|
gboolean running_ipv4;
|
|
QmiClientWds *client_ipv4;
|
|
guint packet_service_status_ipv4_indication_id;
|
|
guint event_report_ipv4_indication_id;
|
|
guint32 packet_data_handle_ipv4;
|
|
MMBearerIpConfig *ipv4_config;
|
|
GError *error_ipv4;
|
|
|
|
gboolean ipv6;
|
|
gboolean running_ipv6;
|
|
QmiClientWds *client_ipv6;
|
|
guint packet_service_status_ipv6_indication_id;
|
|
guint event_report_ipv6_indication_id;
|
|
guint32 packet_data_handle_ipv6;
|
|
MMBearerIpConfig *ipv6_config;
|
|
GError *error_ipv6;
|
|
guint extended_ipv4_config_change_id;
|
|
guint extended_ipv6_config_change_id;
|
|
} ConnectContext;
|
|
|
|
/* When using the WDS service, we may not only want to have explicit different
|
|
* clients for IPv4 or IPv6, but also for different mux ids/endpoints as well,
|
|
* so that different bearer objects never attempt to use the same WDS clients. */
|
|
#define MM_BEARER_QMI_PORT_FLAG(flag, ctx) \
|
|
(((ctx->endpoint.interface_number & 0xFF) << 24) | \
|
|
((ctx->endpoint.type & 0xFF) << 16) | \
|
|
((ctx->mux_id & 0xFF) << 8) | (flag & 0xFF))
|
|
|
|
/*****************************************************************************/
|
|
static void
|
|
process_operator_reserved_pco (MMBearerQmi *self,
|
|
QmiMessageWdsGetCurrentSettingsOutput *output)
|
|
{
|
|
MMBaseModem *modem = NULL;
|
|
MMPco *pco;
|
|
g_autofree gchar *app_specific_info_str = NULL;
|
|
GArray *array = NULL;
|
|
g_autoptr(GByteArray) pco_raw = NULL;
|
|
guint16 container_id;
|
|
guint16 tmp_mcc;
|
|
guint16 tmp_mnc;
|
|
gboolean mnc_includes_pcs_digit;
|
|
guint8 pco_prefix[9];
|
|
gsize pco_raw_len;
|
|
|
|
if (!qmi_message_wds_get_current_settings_output_get_operator_reserved_pco (
|
|
output,
|
|
&tmp_mcc,
|
|
&tmp_mnc,
|
|
&mnc_includes_pcs_digit,
|
|
&array,
|
|
&container_id,
|
|
NULL))
|
|
return;
|
|
|
|
/* Ignore PCOs with undefined contents */
|
|
if (!tmp_mcc && !tmp_mnc && !container_id && !array->len)
|
|
return;
|
|
|
|
app_specific_info_str = ((array->len > 0) ?
|
|
mm_utils_bin2hexstr ((guint8*) (array->data), array->len) :
|
|
NULL);
|
|
|
|
mm_obj_dbg (self, "container ID: %d", container_id);
|
|
mm_obj_dbg (self, "app specific info: %s", app_specific_info_str ? app_specific_info_str : "n/a");
|
|
|
|
pco_raw_len = sizeof (pco_prefix) + array->len;
|
|
pco_prefix[0] = 0x27;
|
|
pco_prefix[1] = pco_raw_len - 2;
|
|
pco_prefix[2] = 0x80;
|
|
pco_prefix[3] = (container_id >> 8) & 0xFF;
|
|
pco_prefix[4] = container_id & 0xFF;
|
|
pco_prefix[5] = 3 * sizeof (guint8) + array->len;
|
|
|
|
/* if MNC consist of 3 digits
|
|
* pco_prefix[7] = 0x<MNC digit 3><MCC digit 3>
|
|
* if MNC consist of 2 digits
|
|
* pco_prefix[7] = 0xF<MCC digit 3>
|
|
* pco_prefix[6] = 0x<MCC digit 2><MCC digit 1>
|
|
* pco_prefix[8] = 0x<MNC digit 2><MNC digit 1>
|
|
*
|
|
* e.g. from MCCMNC 311480 (MCC=311, MNC=480 with PCS digit), logic would do
|
|
* pco_prefix[7] = 0x01 | (0x00 << 4) = 0x01
|
|
* pco_prefix[6] = 0x03 | (0x01 << 4) = 0x13
|
|
* pco_prefix[6] = 0x04 | (0x08 << 4) = 0x84
|
|
* And so the `pco_prefix` includes bytes `13:01:84` when the operator is 311480 (Verizon)
|
|
*
|
|
* See 3GPP TS 24.008, subclause 10.5.6.3.1 (Protocol Configuration Options) and
|
|
* 10.5.1.3 for more details on the coding of MCC and MNC.
|
|
*/
|
|
if (mnc_includes_pcs_digit) {
|
|
pco_prefix[7] = (guint8)(tmp_mcc%10) | ((guint8)(tmp_mnc%10) << 4);
|
|
tmp_mnc /= 10;
|
|
}
|
|
else
|
|
pco_prefix[7] = (guint8)(tmp_mcc%10) | 0xF0;
|
|
tmp_mcc /= 10;
|
|
pco_prefix[6] = (guint8)(tmp_mcc/10) | ((guint8)(tmp_mcc%10) << 4);
|
|
pco_prefix[8] = (guint8)(tmp_mnc/10) | ((guint8)(tmp_mnc%10) << 4);
|
|
|
|
pco_raw = g_byte_array_sized_new (pco_raw_len);
|
|
g_byte_array_append (pco_raw, pco_prefix, sizeof (pco_prefix));
|
|
if (array->len > 0)
|
|
g_byte_array_append (pco_raw, (const guint8 *)array->data, array->len);
|
|
|
|
pco = mm_pco_new ();
|
|
/* set session ID to 0 (default) */
|
|
mm_pco_set_session_id (pco, 0);
|
|
mm_pco_set_complete (pco, TRUE);
|
|
mm_pco_set_data (pco, pco_raw->data, pco_raw->len);
|
|
|
|
/* mm_pco_list_add API takes care of duplicate entry */
|
|
self->priv->pco_list = mm_pco_list_add (self->priv->pco_list, pco);
|
|
g_object_get (self,
|
|
MM_BASE_BEARER_MODEM, &modem,
|
|
NULL);
|
|
mm_iface_modem_3gpp_update_pco_list (MM_IFACE_MODEM_3GPP (modem), self->priv->pco_list);
|
|
mm_obj_dbg (self, "pco info sent successfully");
|
|
|
|
g_object_unref (modem);
|
|
}
|
|
|
|
static void
|
|
get_pco_settings_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
MMBearerQmi *self)
|
|
{
|
|
g_autoptr(QmiMessageWdsGetCurrentSettingsOutput) output = NULL;
|
|
GError *error = NULL;
|
|
|
|
output = qmi_client_wds_get_current_settings_finish (client, res, &error);
|
|
if (!output) {
|
|
mm_obj_warn (self, "error: operation failed: %s", error->message);
|
|
g_error_free (error);
|
|
g_object_unref (self);
|
|
return;
|
|
}
|
|
if (!qmi_message_wds_get_current_settings_output_get_result (output, &error)) {
|
|
mm_obj_warn (self, "error: couldn't get current settings: %s", error->message);
|
|
g_error_free (error);
|
|
g_object_unref (self);
|
|
return;
|
|
}
|
|
|
|
process_operator_reserved_pco (self, output);
|
|
g_object_unref (self);
|
|
}
|
|
|
|
static void
|
|
fetch_pco_data_from_modem (QmiClientWds *client,
|
|
MMBearerQmi *self)
|
|
{
|
|
QmiMessageWdsGetCurrentSettingsInput *input;
|
|
|
|
input = qmi_message_wds_get_current_settings_input_new ();
|
|
qmi_message_wds_get_current_settings_input_set_requested_settings (
|
|
input, QMI_WDS_REQUESTED_SETTINGS_OPERATOR_RESERVED_PCO, NULL);
|
|
mm_obj_dbg (self, "Getting PCO Information from Modem");
|
|
qmi_client_wds_get_current_settings (client,
|
|
input,
|
|
10,
|
|
NULL,
|
|
(GAsyncReadyCallback) get_pco_settings_ready,
|
|
g_object_ref (self));
|
|
qmi_message_wds_get_current_settings_input_unref (input);
|
|
}
|
|
|
|
static void
|
|
extended_ip_config_indication_received (QmiClientWds *client,
|
|
QmiIndicationWdsExtendedIpConfigOutput *output,
|
|
MMBearerQmi *self)
|
|
{
|
|
QmiWdsRequestedSettings mask;
|
|
g_autofree gchar *mask_str = NULL;
|
|
|
|
if (!qmi_indication_wds_extended_ip_config_output_get_changed_ip_configuration (output, &mask, NULL))
|
|
return;
|
|
|
|
mask_str = qmi_wds_requested_settings_build_string_from_mask (mask);
|
|
mm_obj_dbg (self, "received extended ip type mask %s", mask_str);
|
|
if (mask & QMI_WDS_REQUESTED_SETTINGS_OPERATOR_RESERVED_PCO)
|
|
fetch_pco_data_from_modem (client, self);
|
|
}
|
|
/*****************************************************************************/
|
|
|
|
static void
|
|
connect_context_free (ConnectContext *ctx)
|
|
{
|
|
g_free (ctx->apn);
|
|
g_free (ctx->user);
|
|
g_free (ctx->password);
|
|
|
|
if (ctx->client_ipv4) {
|
|
if (ctx->packet_service_status_ipv4_indication_id) {
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (ctx->self,
|
|
ctx->client_ipv4,
|
|
FALSE,
|
|
&ctx->packet_service_status_ipv4_indication_id);
|
|
}
|
|
if (ctx->event_report_ipv4_indication_id) {
|
|
cleanup_event_report_unsolicited_events (ctx->self,
|
|
ctx->client_ipv4,
|
|
&ctx->event_report_ipv4_indication_id);
|
|
}
|
|
if (ctx->extended_ipv4_config_change_id) {
|
|
g_signal_handler_disconnect (ctx->client_ipv4, ctx->extended_ipv4_config_change_id);
|
|
ctx->extended_ipv4_config_change_id = 0;
|
|
}
|
|
if (ctx->packet_data_handle_ipv4) {
|
|
g_autoptr(QmiMessageWdsStopNetworkInput) input = NULL;
|
|
|
|
input = qmi_message_wds_stop_network_input_new ();
|
|
qmi_message_wds_stop_network_input_set_packet_data_handle (input, ctx->packet_data_handle_ipv4, NULL);
|
|
qmi_client_wds_stop_network (ctx->client_ipv4, input, MM_BASE_BEARER_DEFAULT_DISCONNECTION_TIMEOUT, NULL, NULL, NULL);
|
|
}
|
|
g_clear_object (&ctx->client_ipv4);
|
|
}
|
|
|
|
if (ctx->client_ipv6) {
|
|
if (ctx->packet_service_status_ipv6_indication_id) {
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (ctx->self,
|
|
ctx->client_ipv6,
|
|
FALSE,
|
|
&ctx->packet_service_status_ipv6_indication_id);
|
|
}
|
|
if (ctx->event_report_ipv6_indication_id) {
|
|
cleanup_event_report_unsolicited_events (ctx->self,
|
|
ctx->client_ipv6,
|
|
&ctx->event_report_ipv6_indication_id);
|
|
}
|
|
if (ctx->extended_ipv6_config_change_id) {
|
|
g_signal_handler_disconnect (ctx->client_ipv6, ctx->extended_ipv6_config_change_id);
|
|
ctx->extended_ipv6_config_change_id = 0;
|
|
}
|
|
if (ctx->packet_data_handle_ipv6) {
|
|
g_autoptr(QmiMessageWdsStopNetworkInput) input = NULL;
|
|
|
|
input = qmi_message_wds_stop_network_input_new ();
|
|
qmi_message_wds_stop_network_input_set_packet_data_handle (input, ctx->packet_data_handle_ipv6, NULL);
|
|
qmi_client_wds_stop_network (ctx->client_ipv6, input, MM_BASE_BEARER_DEFAULT_DISCONNECTION_TIMEOUT, NULL, NULL, NULL);
|
|
}
|
|
g_clear_object (&ctx->client_ipv6);
|
|
}
|
|
|
|
if (ctx->link_name) {
|
|
mm_port_qmi_cleanup_link (ctx->qmi, ctx->link_name, ctx->mux_id, NULL, NULL);
|
|
g_free (ctx->link_name);
|
|
}
|
|
g_clear_object (&ctx->link);
|
|
g_free (ctx->link_prefix_hint);
|
|
|
|
if (ctx->explicit_qmi_open)
|
|
mm_port_qmi_close (ctx->qmi, NULL, NULL);
|
|
|
|
g_clear_error (&ctx->error_ipv4);
|
|
g_clear_error (&ctx->error_ipv6);
|
|
g_clear_object (&ctx->ipv4_config);
|
|
g_clear_object (&ctx->ipv6_config);
|
|
|
|
g_clear_object (&ctx->data);
|
|
g_clear_object (&ctx->qmi);
|
|
g_clear_object (&ctx->modem);
|
|
g_clear_object (&ctx->self);
|
|
g_slice_free (ConnectContext, ctx);
|
|
}
|
|
|
|
static MMBearerConnectResult *
|
|
connect_finish (MMBaseBearer *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
return g_task_propagate_pointer (G_TASK (res), error);
|
|
}
|
|
|
|
static void
|
|
complete_connect (GTask *task,
|
|
MMBearerConnectResult *result,
|
|
GError *error)
|
|
{
|
|
ConnectContext *ctx;
|
|
|
|
g_assert (result || error);
|
|
g_assert (!(result && error));
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
g_clear_object (&ctx->self->priv->ongoing_connect_user_cancellable);
|
|
g_clear_object (&ctx->self->priv->ongoing_connect_network_cancellable);
|
|
|
|
if (error)
|
|
g_task_return_error (task, error);
|
|
else
|
|
g_task_return_pointer (task, result, (GDestroyNotify)mm_bearer_connect_result_unref);
|
|
g_object_unref (task);
|
|
}
|
|
|
|
static void connect_context_step (GTask *task);
|
|
|
|
static void
|
|
qmi_inet4_ntop (guint32 address, char *buf, const gsize buflen)
|
|
{
|
|
struct in_addr a = { .s_addr = GUINT32_TO_BE (address) };
|
|
|
|
g_assert (buflen >= INET_ADDRSTRLEN);
|
|
|
|
/* We can ignore inet_ntop() return value if 'buf' is
|
|
* at least INET_ADDRSTRLEN in size. */
|
|
memset (buf, 0, buflen);
|
|
g_assert (inet_ntop (AF_INET, &a, buf, buflen));
|
|
}
|
|
|
|
static MMBearerIpConfig *
|
|
get_ipv4_config (MMBearerQmi *self,
|
|
MMBearerIpMethod ip_method,
|
|
QmiMessageWdsGetCurrentSettingsOutput *output,
|
|
guint32 mtu)
|
|
{
|
|
MMBearerIpConfig *config;
|
|
char buf[INET_ADDRSTRLEN];
|
|
char buf2[INET_ADDRSTRLEN];
|
|
const gchar *dns[3] = { 0 };
|
|
guint dns_idx = 0;
|
|
guint32 addr = 0;
|
|
GError *error = NULL;
|
|
guint32 prefix = 0;
|
|
|
|
/* IPv4 subnet mask */
|
|
if (!qmi_message_wds_get_current_settings_output_get_ipv4_gateway_subnet_mask (output, &addr, &error)) {
|
|
mm_obj_warn (self, "failed to read IPv4 netmask: %s", error->message);
|
|
g_clear_error (&error);
|
|
return NULL;
|
|
}
|
|
qmi_inet4_ntop (addr, buf, sizeof (buf));
|
|
prefix = mm_netmask_to_cidr (buf);
|
|
|
|
/* IPv4 address */
|
|
if (!qmi_message_wds_get_current_settings_output_get_ipv4_address (output, &addr, &error)) {
|
|
mm_obj_warn (self, "IPv4 family but no IPv4 address: %s", error->message);
|
|
g_clear_error (&error);
|
|
return NULL;
|
|
}
|
|
|
|
mm_obj_msg (self, "QMI IPv4 Settings:");
|
|
|
|
config = mm_bearer_ip_config_new ();
|
|
mm_bearer_ip_config_set_method (config, ip_method);
|
|
|
|
/* IPv4 address */
|
|
qmi_inet4_ntop (addr, buf, sizeof (buf));
|
|
mm_bearer_ip_config_set_address (config, buf);
|
|
mm_bearer_ip_config_set_prefix (config, prefix);
|
|
mm_obj_msg (self, " address: %s/%d", buf, prefix);
|
|
|
|
/* IPv4 gateway address */
|
|
if (qmi_message_wds_get_current_settings_output_get_ipv4_gateway_address (output, &addr, &error)) {
|
|
qmi_inet4_ntop (addr, buf, sizeof (buf));
|
|
mm_bearer_ip_config_set_gateway (config, buf);
|
|
mm_obj_msg (self, " gateway: %s", buf);
|
|
} else {
|
|
mm_obj_msg (self, " gateway: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
/* IPv4 DNS #1 */
|
|
if (qmi_message_wds_get_current_settings_output_get_primary_ipv4_dns_address (output, &addr, &error)) {
|
|
qmi_inet4_ntop (addr, buf, sizeof (buf));
|
|
dns[dns_idx++] = buf;
|
|
mm_obj_msg (self, " DNS #1: %s", buf);
|
|
} else {
|
|
mm_obj_msg (self, " DNS #1: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
/* IPv4 DNS #2 */
|
|
if (qmi_message_wds_get_current_settings_output_get_secondary_ipv4_dns_address (output, &addr, &error)) {
|
|
qmi_inet4_ntop (addr, buf2, sizeof (buf2));
|
|
dns[dns_idx++] = buf2;
|
|
mm_obj_msg (self, " DNS #2: %s", buf2);
|
|
} else {
|
|
mm_obj_msg (self, " DNS #2: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
if (dns_idx > 0)
|
|
mm_bearer_ip_config_set_dns (config, (const gchar **) &dns);
|
|
|
|
if (mtu) {
|
|
mm_bearer_ip_config_set_mtu (config, mtu);
|
|
mm_obj_msg (self, " MTU: %d", mtu);
|
|
}
|
|
|
|
return config;
|
|
}
|
|
|
|
static void
|
|
qmi_inet6_ntop (GArray *array, char *buf, const gsize buflen)
|
|
{
|
|
struct in6_addr a;
|
|
guint32 i;
|
|
|
|
g_assert (array);
|
|
g_assert (array->len == 8);
|
|
g_assert (buflen >= INET6_ADDRSTRLEN);
|
|
|
|
for (i = 0; i < array->len; i++)
|
|
a.s6_addr16[i] = GUINT16_TO_BE (g_array_index (array, guint16, i));
|
|
|
|
/* We can ignore inet_ntop() return value if 'buf' is
|
|
* at least INET6_ADDRSTRLEN in size. */
|
|
memset (buf, 0, buflen);
|
|
g_assert (inet_ntop (AF_INET6, &a, buf, buflen));
|
|
}
|
|
|
|
static MMBearerIpConfig *
|
|
get_ipv6_config (MMBearerQmi *self,
|
|
MMBearerIpMethod ip_method,
|
|
QmiMessageWdsGetCurrentSettingsOutput *output,
|
|
guint32 mtu)
|
|
{
|
|
MMBearerIpConfig *config;
|
|
char buf[INET6_ADDRSTRLEN];
|
|
char buf2[INET6_ADDRSTRLEN];
|
|
const gchar *dns[3] = { 0 };
|
|
guint dns_idx = 0;
|
|
GArray *array;
|
|
GError *error = NULL;
|
|
guint8 prefix = 0;
|
|
|
|
/* If the message has an IPv6 address, create an IPv6 bearer config */
|
|
if (!qmi_message_wds_get_current_settings_output_get_ipv6_address (output, &array, &prefix, &error)) {
|
|
mm_obj_warn (self, "IPv6 family but no IPv6 address: %s", error->message);
|
|
g_clear_error (&error);
|
|
return NULL;
|
|
}
|
|
|
|
mm_obj_msg (self, "QMI IPv6 Settings:");
|
|
|
|
config = mm_bearer_ip_config_new ();
|
|
mm_bearer_ip_config_set_method (config, ip_method);
|
|
|
|
/* IPv6 address */
|
|
qmi_inet6_ntop (array, buf, sizeof (buf));
|
|
|
|
mm_bearer_ip_config_set_address (config, buf);
|
|
mm_bearer_ip_config_set_prefix (config, prefix);
|
|
mm_obj_msg (self, " address: %s/%d", buf, prefix);
|
|
|
|
/* IPv6 gateway address */
|
|
if (qmi_message_wds_get_current_settings_output_get_ipv6_gateway_address (output, &array, &prefix, &error)) {
|
|
qmi_inet6_ntop (array, buf, sizeof (buf));
|
|
mm_bearer_ip_config_set_gateway (config, buf);
|
|
mm_obj_msg (self, " gateway: %s/%d", buf, prefix);
|
|
} else {
|
|
mm_obj_msg (self, " gateway: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
/* IPv6 DNS #1 */
|
|
if (qmi_message_wds_get_current_settings_output_get_ipv6_primary_dns_address (output, &array, &error)) {
|
|
qmi_inet6_ntop (array, buf, sizeof (buf));
|
|
dns[dns_idx++] = buf;
|
|
mm_obj_msg (self, " DNS #1: %s", buf);
|
|
} else {
|
|
mm_obj_msg (self, " DNS #1: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
/* IPv6 DNS #2 */
|
|
if (qmi_message_wds_get_current_settings_output_get_ipv6_secondary_dns_address (output, &array, &error)) {
|
|
qmi_inet6_ntop (array, buf2, sizeof (buf2));
|
|
dns[dns_idx++] = buf2;
|
|
mm_obj_msg (self, " DNS #2: %s", buf2);
|
|
} else {
|
|
mm_obj_msg (self, " DNS #2: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
if (dns_idx > 0)
|
|
mm_bearer_ip_config_set_dns (config, (const gchar **) &dns);
|
|
|
|
if (mtu) {
|
|
mm_bearer_ip_config_set_mtu (config, mtu);
|
|
mm_obj_msg (self, " MTU: %d", mtu);
|
|
}
|
|
|
|
return config;
|
|
}
|
|
|
|
static void
|
|
get_current_settings_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
QmiMessageWdsGetCurrentSettingsOutput *output;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
|
|
output = qmi_client_wds_get_current_settings_finish (client, res, &error);
|
|
if (!output || !qmi_message_wds_get_current_settings_output_get_result (output, &error)) {
|
|
MMBearerIpConfig *config;
|
|
|
|
/* When we're using static IP address, the current settings are mandatory */
|
|
if (ctx->ip_method == MM_BEARER_IP_METHOD_STATIC) {
|
|
mm_obj_warn (self, "failed to retrieve mandatory IP settings: %s", error->message);
|
|
if (output)
|
|
qmi_message_wds_get_current_settings_output_unref (output);
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Otherwise, just go on as we're asking for DHCP */
|
|
mm_obj_dbg (self, "couldn't get current settings: %s", error->message);
|
|
g_error_free (error);
|
|
|
|
config = mm_bearer_ip_config_new ();
|
|
mm_bearer_ip_config_set_method (config, ctx->ip_method);
|
|
|
|
if (ctx->running_ipv4)
|
|
ctx->ipv4_config = config;
|
|
else if (ctx->running_ipv6)
|
|
ctx->ipv6_config = config;
|
|
else
|
|
g_assert_not_reached ();
|
|
} else {
|
|
QmiWdsIpFamily ip_family = QMI_WDS_IP_FAMILY_UNSPECIFIED;
|
|
guint32 mtu = 0;
|
|
GArray *array;
|
|
|
|
if (!qmi_message_wds_get_current_settings_output_get_ip_family (output, &ip_family, &error)) {
|
|
mm_obj_dbg (self, " IP Family: failed (%s); assuming IPv4", error->message);
|
|
g_clear_error (&error);
|
|
ip_family = QMI_WDS_IP_FAMILY_IPV4;
|
|
}
|
|
mm_obj_dbg (self, " IP Family: %s",
|
|
(ip_family == QMI_WDS_IP_FAMILY_IPV4) ? "IPv4" :
|
|
(ip_family == QMI_WDS_IP_FAMILY_IPV6) ? "IPv6" : "unknown");
|
|
|
|
if (!qmi_message_wds_get_current_settings_output_get_mtu (output, &mtu, &error)) {
|
|
mm_obj_dbg (self, " MTU: failed (%s)", error->message);
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
if (ip_family == QMI_WDS_IP_FAMILY_IPV4)
|
|
ctx->ipv4_config = get_ipv4_config (ctx->self, ctx->ip_method, output, mtu);
|
|
else if (ip_family == QMI_WDS_IP_FAMILY_IPV6)
|
|
ctx->ipv6_config = get_ipv6_config (ctx->self, ctx->ip_method, output, mtu);
|
|
|
|
/* Domain names */
|
|
if (qmi_message_wds_get_current_settings_output_get_domain_name_list (output, &array, &error)) {
|
|
GString *s = g_string_sized_new (array ? (array->len * 20) : 1);
|
|
guint i;
|
|
|
|
for (i = 0; array && (i < array->len); i++) {
|
|
if (s->len)
|
|
g_string_append (s, ", ");
|
|
g_string_append (s, g_array_index (array, const char *, i));
|
|
}
|
|
mm_obj_dbg (self, " domains: %s", s->str);
|
|
g_string_free (s, TRUE);
|
|
} else {
|
|
mm_obj_dbg (self, " domains: failed (%s)", error ? error->message : "unknown");
|
|
g_clear_error (&error);
|
|
}
|
|
|
|
process_operator_reserved_pco (self, output);
|
|
}
|
|
|
|
if (output)
|
|
qmi_message_wds_get_current_settings_output_unref (output);
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
get_current_settings (GTask *task, QmiClientWds *client)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectContext *ctx;
|
|
QmiMessageWdsGetCurrentSettingsInput *input;
|
|
QmiWdsRequestedSettings requested;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
|
|
requested = QMI_WDS_REQUESTED_SETTINGS_DNS_ADDRESS |
|
|
QMI_WDS_REQUESTED_SETTINGS_GRANTED_QOS |
|
|
QMI_WDS_REQUESTED_SETTINGS_IP_ADDRESS |
|
|
QMI_WDS_REQUESTED_SETTINGS_GATEWAY_INFO |
|
|
QMI_WDS_REQUESTED_SETTINGS_MTU |
|
|
QMI_WDS_REQUESTED_SETTINGS_DOMAIN_NAME_LIST |
|
|
QMI_WDS_REQUESTED_SETTINGS_IP_FAMILY;
|
|
|
|
/* Modems like Qualcomm MPL200 and SimTech SIM7100E eventually crash when enabling PCO.
|
|
* Avoid crashing by skip registering for PCO */
|
|
if (!mm_kernel_device_get_global_property_as_boolean (mm_port_peek_kernel_device (MM_PORT (ctx->qmi)),
|
|
"ID_MM_QMI_PCO_DISABLED")) {
|
|
mm_obj_dbg (self, "Requesting QMI WDS Operator Reserved PCO");
|
|
requested |= QMI_WDS_REQUESTED_SETTINGS_OPERATOR_RESERVED_PCO;
|
|
}
|
|
|
|
input = qmi_message_wds_get_current_settings_input_new ();
|
|
qmi_message_wds_get_current_settings_input_set_requested_settings (input, requested, NULL);
|
|
qmi_client_wds_get_current_settings (client,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)get_current_settings_ready,
|
|
task);
|
|
qmi_message_wds_get_current_settings_input_unref (input);
|
|
}
|
|
|
|
static void
|
|
wds_indication_register_response_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectContext *ctx;
|
|
QmiMessageWdsIndicationRegisterOutput *output;
|
|
GError *error = NULL;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
output = qmi_client_wds_indication_register_finish (client, res, &error);
|
|
|
|
if (!output) {
|
|
mm_obj_warn (self, "error: operation failed: %s", error->message);
|
|
g_error_free (error);
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
return;
|
|
}
|
|
|
|
if (!qmi_message_wds_indication_register_output_get_result (output, &error)) {
|
|
mm_obj_warn (self, "error: could not register for indication: %s", error->message);
|
|
qmi_message_wds_indication_register_output_unref (output);
|
|
g_error_free (error);
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
return;
|
|
}
|
|
qmi_message_wds_indication_register_output_unref (output);
|
|
if (ctx->running_ipv4) {
|
|
mm_obj_dbg (self, "v4 extended ip config indication registered successfully");
|
|
g_assert (ctx->extended_ipv4_config_change_id == 0);
|
|
ctx->extended_ipv4_config_change_id =
|
|
g_signal_connect (client,
|
|
"extended-ip-config",
|
|
G_CALLBACK (extended_ip_config_indication_received),
|
|
self);
|
|
} else {
|
|
mm_obj_dbg (self, "v6 extended ip Config indication registered successfully");
|
|
g_assert (ctx->extended_ipv6_config_change_id == 0);
|
|
ctx->extended_ipv6_config_change_id =
|
|
g_signal_connect (client,
|
|
"extended-ip-config",
|
|
G_CALLBACK (extended_ip_config_indication_received),
|
|
self);
|
|
}
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
register_for_wds_indication (ConnectContext *ctx,
|
|
GTask *task)
|
|
{
|
|
QmiMessageWdsIndicationRegisterInput *input;
|
|
QmiClientWds *client;
|
|
MMBearerQmi *self;
|
|
|
|
input = qmi_message_wds_indication_register_input_new ();
|
|
self = g_task_get_source_object (task);
|
|
|
|
if (ctx->running_ipv4) {
|
|
client = ctx->client_ipv4;
|
|
mm_obj_dbg (self, "registering for wds extended ip V4 info indication");
|
|
} else {
|
|
client = ctx->client_ipv6;
|
|
mm_obj_dbg (self, "registering for wds extended ip V6 info indication");
|
|
}
|
|
qmi_message_wds_indication_register_input_set_report_extended_ip_configuration_change (input, TRUE, NULL);
|
|
qmi_client_wds_indication_register (
|
|
client,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback) wds_indication_register_response_ready,
|
|
task);
|
|
qmi_message_wds_indication_register_input_unref (input);
|
|
}
|
|
|
|
static GError *
|
|
error_from_start_network_output (MMBearerQmi *self,
|
|
gboolean running_ipv4,
|
|
QmiMessageWdsStartNetworkOutput *output)
|
|
{
|
|
QmiWdsCallEndReason cer;
|
|
QmiWdsVerboseCallEndReasonType verbose_cer_type;
|
|
gint16 verbose_cer_reason;
|
|
|
|
if (qmi_message_wds_start_network_output_get_verbose_call_end_reason (
|
|
output,
|
|
&verbose_cer_type,
|
|
&verbose_cer_reason,
|
|
NULL)) {
|
|
return mm_error_from_wds_verbose_call_end_reason (verbose_cer_type, verbose_cer_reason,
|
|
running_ipv4 ? MM_BEARER_IP_FAMILY_IPV4 : MM_BEARER_IP_FAMILY_IPV6,
|
|
self);
|
|
}
|
|
|
|
if (qmi_message_wds_start_network_output_get_call_end_reason (
|
|
output,
|
|
&cer,
|
|
NULL)) {
|
|
const gchar *cer_str;
|
|
|
|
cer_str = qmi_wds_call_end_reason_get_string (cer);
|
|
mm_obj_msg (self, " call end reason (%u): %s", cer, cer_str);
|
|
|
|
return g_error_new (MM_MOBILE_EQUIPMENT_ERROR, MM_MOBILE_EQUIPMENT_ERROR_UNKNOWN,
|
|
"Call failed: %s", cer_str);
|
|
}
|
|
|
|
return g_error_new_literal (MM_MOBILE_EQUIPMENT_ERROR, MM_MOBILE_EQUIPMENT_ERROR_UNKNOWN, "Call failed");
|
|
}
|
|
|
|
static void
|
|
start_network_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
QmiMessageWdsStartNetworkOutput *output;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
g_assert (!(ctx->running_ipv4 && ctx->running_ipv6));
|
|
|
|
output = qmi_client_wds_start_network_finish (client, res, &error);
|
|
if (output && !qmi_message_wds_start_network_output_get_result (output, &error)) {
|
|
/* No-effect errors should be ignored. The modem will keep the
|
|
* connection active as long as there is a WDS client which requested
|
|
* to start the network. If ModemManager crashed while a connection was
|
|
* active, we would be leaving an unreleased WDS client around and the
|
|
* modem would just keep connected. */
|
|
if (g_error_matches (error, QMI_PROTOCOL_ERROR, QMI_PROTOCOL_ERROR_NO_EFFECT)) {
|
|
g_clear_error (&error);
|
|
if (ctx->running_ipv4)
|
|
ctx->packet_data_handle_ipv4 = GLOBAL_PACKET_DATA_HANDLE;
|
|
else
|
|
ctx->packet_data_handle_ipv6 = GLOBAL_PACKET_DATA_HANDLE;
|
|
/* Fall down to a successful connection */
|
|
} else {
|
|
mm_obj_msg (self, "couldn't start %s network: %s", ctx->running_ipv4 ? "IPv4" : "IPv6", error->message);
|
|
if (g_error_matches (error, QMI_PROTOCOL_ERROR, QMI_PROTOCOL_ERROR_CALL_FAILED)) {
|
|
g_clear_error (&error);
|
|
error = error_from_start_network_output (self, ctx->running_ipv4, output);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (error) {
|
|
if (ctx->running_ipv4)
|
|
ctx->error_ipv4 = error;
|
|
else
|
|
ctx->error_ipv6 = error;
|
|
} else {
|
|
if (ctx->running_ipv4)
|
|
qmi_message_wds_start_network_output_get_packet_data_handle (output, &ctx->packet_data_handle_ipv4, NULL);
|
|
else
|
|
qmi_message_wds_start_network_output_get_packet_data_handle (output, &ctx->packet_data_handle_ipv6, NULL);
|
|
}
|
|
|
|
if (output)
|
|
qmi_message_wds_start_network_output_unref (output);
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static QmiMessageWdsStartNetworkInput *
|
|
build_start_network_input (ConnectContext *ctx)
|
|
{
|
|
QmiMessageWdsStartNetworkInput *input;
|
|
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
g_assert (!(ctx->running_ipv4 && ctx->running_ipv6));
|
|
|
|
input = qmi_message_wds_start_network_input_new ();
|
|
|
|
/* When requesting to connect through a profile, add the profile-id setting */
|
|
if (ctx->profile_id != MM_3GPP_PROFILE_ID_UNKNOWN) {
|
|
g_assert (ctx->profile_id <= (gint)G_MAXUINT8);
|
|
qmi_message_wds_start_network_input_set_profile_index_3gpp (input, (guint8)ctx->profile_id, NULL);
|
|
} else {
|
|
/* If user gives empty string as APN, we also skip setting it in the
|
|
* request. */
|
|
if (ctx->apn && ctx->apn[0])
|
|
qmi_message_wds_start_network_input_set_apn (input, ctx->apn, NULL);
|
|
|
|
/* Auth info */
|
|
qmi_message_wds_start_network_input_set_authentication_preference (input, ctx->auth, NULL);
|
|
if (ctx->auth != QMI_WDS_AUTHENTICATION_NONE) {
|
|
if (ctx->user)
|
|
qmi_message_wds_start_network_input_set_username (input, ctx->user, NULL);
|
|
if (ctx->password)
|
|
qmi_message_wds_start_network_input_set_password (input, ctx->password, NULL);
|
|
}
|
|
}
|
|
|
|
/* Only add the IP family preference TLV if explicitly requested a given
|
|
* family. This TLV may be newer than the Start Network command itself, so
|
|
* we'll just allow the case where none is specified. */
|
|
if (!ctx->no_ip_family_preference) {
|
|
qmi_message_wds_start_network_input_set_ip_family_preference (
|
|
input,
|
|
(ctx->running_ipv6 ? QMI_WDS_IP_FAMILY_IPV6 : QMI_WDS_IP_FAMILY_IPV4),
|
|
NULL);
|
|
}
|
|
|
|
return input;
|
|
}
|
|
|
|
static void
|
|
packet_service_status_indication_cb (QmiClientWds *client,
|
|
QmiIndicationWdsPacketServiceStatusOutput *output,
|
|
MMBearerQmi *self)
|
|
{
|
|
QmiWdsConnectionStatus connection_status;
|
|
MMBearerStatus bearer_status;
|
|
|
|
if (!qmi_indication_wds_packet_service_status_output_get_connection_status (
|
|
output,
|
|
&connection_status,
|
|
NULL,
|
|
NULL))
|
|
return;
|
|
|
|
bearer_status = mm_base_bearer_get_status (MM_BASE_BEARER (self));
|
|
if (connection_status == QMI_WDS_CONNECTION_STATUS_DISCONNECTED &&
|
|
bearer_status != MM_BEARER_STATUS_DISCONNECTED &&
|
|
bearer_status != MM_BEARER_STATUS_DISCONNECTING) {
|
|
QmiWdsCallEndReason cer;
|
|
QmiWdsVerboseCallEndReasonType verbose_cer_type;
|
|
gint16 verbose_cer_reason;
|
|
g_autoptr(GError) connection_error = NULL;
|
|
|
|
if (qmi_indication_wds_packet_service_status_output_get_verbose_call_end_reason (
|
|
output,
|
|
&verbose_cer_type,
|
|
&verbose_cer_reason,
|
|
NULL)) {
|
|
/* Create MM error based on the verbose call end reason details. There is no real
|
|
* need for now to provide the correct IP type associated to the QMI WDS client
|
|
* that received the indication, because the type of errors that need this info
|
|
* would happen upon a Start Network operation, not after the modem has been
|
|
* connected. */
|
|
connection_error = mm_error_from_wds_verbose_call_end_reason (verbose_cer_type, verbose_cer_reason,
|
|
MM_BEARER_IP_FAMILY_NONE,
|
|
self);
|
|
} else if (qmi_indication_wds_packet_service_status_output_get_call_end_reason (
|
|
output,
|
|
&cer,
|
|
NULL)) {
|
|
const gchar *cer_str;
|
|
|
|
cer_str = qmi_wds_call_end_reason_get_string (cer);
|
|
mm_obj_msg (self, "call end reason (%u): %s", cer, cer_str);
|
|
|
|
connection_error = g_error_new (MM_MOBILE_EQUIPMENT_ERROR, MM_MOBILE_EQUIPMENT_ERROR_UNKNOWN,
|
|
"Call failed: %s", cer_str);
|
|
} else
|
|
connection_error = g_error_new_literal (MM_MOBILE_EQUIPMENT_ERROR, MM_MOBILE_EQUIPMENT_ERROR_UNKNOWN, "Call failed");
|
|
|
|
mm_base_bearer_report_connection_status_detailed (MM_BASE_BEARER (self), MM_BEARER_CONNECTION_STATUS_DISCONNECTED, connection_error);
|
|
}
|
|
}
|
|
|
|
static void
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (MMBearerQmi *self,
|
|
QmiClientWds *client,
|
|
gboolean enable,
|
|
guint *indication_id)
|
|
{
|
|
if (!client)
|
|
return;
|
|
|
|
/* Connect/Disconnect "Packet Service Status" indications */
|
|
if (enable) {
|
|
g_assert (*indication_id == 0);
|
|
*indication_id =
|
|
g_signal_connect (client,
|
|
"packet-service-status",
|
|
G_CALLBACK (packet_service_status_indication_cb),
|
|
self);
|
|
} else if (*indication_id != 0) {
|
|
g_signal_handler_disconnect (client, *indication_id);
|
|
*indication_id = 0;
|
|
}
|
|
}
|
|
|
|
static void
|
|
event_report_indication_cb (QmiClientWds *client,
|
|
QmiIndicationWdsEventReportOutput *output,
|
|
MMBearerQmi *self)
|
|
{
|
|
mm_obj_dbg (self, "got QMI WDS event report");
|
|
}
|
|
|
|
static guint
|
|
connect_enable_indications_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
MMBearerQmi *self,
|
|
GError **error)
|
|
{
|
|
QmiMessageWdsSetEventReportOutput *output;
|
|
|
|
/* Don't care about the result */
|
|
output = qmi_client_wds_set_event_report_finish (client, res, error);
|
|
if (!output || !qmi_message_wds_set_event_report_output_get_result (output, error)) {
|
|
if (output)
|
|
qmi_message_wds_set_event_report_output_unref (output);
|
|
return 0;
|
|
}
|
|
qmi_message_wds_set_event_report_output_unref (output);
|
|
|
|
return g_signal_connect (client,
|
|
"event-report",
|
|
G_CALLBACK (event_report_indication_cb),
|
|
self);
|
|
}
|
|
|
|
static void
|
|
connect_enable_indications_ipv4_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
g_assert (ctx->event_report_ipv4_indication_id == 0);
|
|
|
|
ctx->event_report_ipv4_indication_id =
|
|
connect_enable_indications_ready (client, res, ctx->self, &ctx->error_ipv4);
|
|
|
|
if (!ctx->event_report_ipv4_indication_id)
|
|
ctx->step = CONNECT_STEP_LAST;
|
|
else
|
|
ctx->step++;
|
|
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
connect_enable_indications_ipv6_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
g_assert (ctx->event_report_ipv6_indication_id == 0);
|
|
|
|
ctx->event_report_ipv6_indication_id =
|
|
connect_enable_indications_ready (client, res, ctx->self, &ctx->error_ipv6);
|
|
|
|
if (!ctx->event_report_ipv6_indication_id)
|
|
ctx->step = CONNECT_STEP_LAST;
|
|
else
|
|
ctx->step++;
|
|
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static QmiMessageWdsSetEventReportInput *
|
|
event_report_input_new (gboolean enable)
|
|
{
|
|
QmiMessageWdsSetEventReportInput *input;
|
|
|
|
input = qmi_message_wds_set_event_report_input_new ();
|
|
qmi_message_wds_set_event_report_input_set_extended_data_bearer_technology (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_limited_data_system_status (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_uplink_flow_control (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_data_systems (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_evdo_pm_change (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_preferred_data_system (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_data_call_status (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_current_data_bearer_technology (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_mip_status (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_dormancy_status (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_data_bearer_technology (input, enable, NULL);
|
|
qmi_message_wds_set_event_report_input_set_channel_rate (input, enable, NULL);
|
|
|
|
return input;
|
|
}
|
|
|
|
static void
|
|
setup_event_report_unsolicited_events (MMBearerQmi *self,
|
|
QmiClientWds *client,
|
|
GCancellable *cancellable,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
QmiMessageWdsSetEventReportInput *input = event_report_input_new (TRUE);
|
|
|
|
qmi_client_wds_set_event_report (client,
|
|
input,
|
|
5,
|
|
cancellable,
|
|
callback,
|
|
user_data);
|
|
qmi_message_wds_set_event_report_input_unref (input);
|
|
}
|
|
|
|
static void
|
|
cleanup_event_report_unsolicited_events (MMBearerQmi *self,
|
|
QmiClientWds *client,
|
|
guint *indication_id)
|
|
{
|
|
QmiMessageWdsSetEventReportInput *input;
|
|
|
|
g_assert (*indication_id != 0);
|
|
g_signal_handler_disconnect (client, *indication_id);
|
|
*indication_id = 0;
|
|
|
|
input = event_report_input_new (FALSE);
|
|
qmi_client_wds_set_event_report (client,
|
|
input,
|
|
5,
|
|
NULL,
|
|
NULL,
|
|
NULL);
|
|
qmi_message_wds_set_event_report_input_unref (input);
|
|
}
|
|
|
|
static void
|
|
set_ip_family_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
QmiMessageWdsSetIpFamilyOutput *output;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
g_assert (!(ctx->running_ipv4 && ctx->running_ipv6));
|
|
|
|
output = qmi_client_wds_set_ip_family_finish (client, res, &error);
|
|
if (output) {
|
|
qmi_message_wds_set_ip_family_output_get_result (output, &error);
|
|
qmi_message_wds_set_ip_family_output_unref (output);
|
|
}
|
|
|
|
if (error) {
|
|
mm_obj_dbg (self, "couldn't set IP family preference: %s", error->message);
|
|
g_error_free (error);
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
bind_data_port_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
g_autoptr(QmiMessageWdsBindDataPortOutput) output = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
g_assert (!(ctx->running_ipv4 && ctx->running_ipv6));
|
|
|
|
output = qmi_client_wds_bind_data_port_finish (client, res, &error);
|
|
if (!output || !qmi_message_wds_bind_data_port_output_get_result (output, &error)) {
|
|
if (g_error_matches (error, QMI_PROTOCOL_ERROR, QMI_PROTOCOL_ERROR_DEVICE_UNSUPPORTED)) {
|
|
/* Some firmwares only support this through "Bind Mux Data Port",
|
|
* even if multiplexing is disabled. Try again with that. */
|
|
g_error_free (error);
|
|
ctx->sio_port_failed = TRUE;
|
|
connect_context_step (task);
|
|
return;
|
|
}
|
|
|
|
g_prefix_error (&error, "Couldn't bind data port: ");
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
bind_mux_data_port_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
g_autoptr(QmiMessageWdsBindMuxDataPortOutput) output = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
g_assert (!(ctx->running_ipv4 && ctx->running_ipv6));
|
|
|
|
output = qmi_client_wds_bind_mux_data_port_finish (client, res, &error);
|
|
if (!output || !qmi_message_wds_bind_mux_data_port_output_get_result (output, &error)) {
|
|
g_prefix_error (&error, "Couldn't bind mux data port: ");
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
qmi_port_allocate_client_ready (MMPortQmi *qmi,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
g_assert (ctx->running_ipv4 || ctx->running_ipv6);
|
|
g_assert (!(ctx->running_ipv4 && ctx->running_ipv6));
|
|
|
|
if (!mm_port_qmi_allocate_client_finish (qmi, res, &error)) {
|
|
g_prefix_error (&error, "Couldn't allocate %s client in QMI port %s: ",
|
|
ctx->running_ipv4 ? "IPv4" : "IPv6",
|
|
mm_port_get_device (MM_PORT (qmi)));
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
if (ctx->running_ipv4)
|
|
ctx->client_ipv4 = QMI_CLIENT_WDS (mm_port_qmi_get_client (
|
|
qmi,
|
|
QMI_SERVICE_WDS,
|
|
MM_BEARER_QMI_PORT_FLAG (MM_PORT_QMI_FLAG_WDS_IPV4, ctx)));
|
|
else
|
|
ctx->client_ipv6 = QMI_CLIENT_WDS (mm_port_qmi_get_client (
|
|
qmi,
|
|
QMI_SERVICE_WDS,
|
|
MM_BEARER_QMI_PORT_FLAG (MM_PORT_QMI_FLAG_WDS_IPV6, ctx)));
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
main_interface_up_ready (MMPortNet *link,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
if (!mm_port_net_link_setup_finish (link, res, &error)) {
|
|
g_prefix_error (&error, "Couldn't bring main interface up: ");
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
wait_link_port_ready (MMBaseModem *modem,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
ctx->link = mm_base_modem_wait_link_port_finish (modem, res, &error);
|
|
if (!ctx->link) {
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
setup_link_ready (MMPortQmi *qmi,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
g_autoptr(MMBaseModem) modem = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
ctx->link_name = mm_port_qmi_setup_link_finish (qmi, res, &ctx->mux_id, &error);
|
|
if (!ctx->link_name) {
|
|
g_prefix_error (&error, "failed to create net link for device: ");
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* From now on link_name will be set, and we'll use that to know
|
|
* whether we should cleanup the link upon a connection failure */
|
|
mm_obj_msg (ctx->self, "net link %s created (mux id %u)", ctx->link_name, ctx->mux_id);
|
|
|
|
/* Wait for the data port with the given interface name, which will be
|
|
* added asynchronously */
|
|
g_object_get (ctx->self,
|
|
MM_BASE_BEARER_MODEM, &modem,
|
|
NULL);
|
|
g_assert (modem);
|
|
|
|
mm_base_modem_wait_link_port (modem,
|
|
"net",
|
|
ctx->link_name,
|
|
WAIT_LINK_PORT_TIMEOUT_MS,
|
|
(GAsyncReadyCallback) wait_link_port_ready,
|
|
task);
|
|
}
|
|
|
|
static void
|
|
setup_data_format_ready (MMPortQmi *qmi,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
g_autoptr(GError) error = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
if (!mm_port_qmi_setup_data_format_finish (qmi, res, &error)) {
|
|
/* a failure here could indicate no support for WDA Set Data Format,
|
|
* if so, just go on with the plain CTL based support (and data aggregation
|
|
* protocol disabled) */
|
|
if (!g_error_matches (error, MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED)) {
|
|
complete_connect (task, NULL, g_steal_pointer (&error));
|
|
return;
|
|
}
|
|
ctx->dap = QMI_WDA_DATA_AGGREGATION_PROTOCOL_DISABLED;
|
|
} else
|
|
ctx->dap = mm_port_qmi_get_data_aggregation_protocol (ctx->qmi);
|
|
|
|
if ((ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_REQUIRED) &&
|
|
(ctx->dap == QMI_WDA_DATA_AGGREGATION_PROTOCOL_DISABLED)) {
|
|
complete_connect (task, NULL,
|
|
g_error_new (MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED,
|
|
"Cannot enable multiplex support"));
|
|
return;
|
|
}
|
|
|
|
if ((ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_NONE) &&
|
|
(ctx->dap != QMI_WDA_DATA_AGGREGATION_PROTOCOL_DISABLED)) {
|
|
complete_connect (task, NULL,
|
|
g_error_new (MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED,
|
|
"Cannot disable multiplex support"));
|
|
return;
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
qmi_port_open_ready (MMPortQmi *qmi,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
|
|
if (!mm_port_qmi_open_finish (qmi, res, &error)) {
|
|
g_prefix_error (&error, "Couldn't open QMI port %s: ",
|
|
mm_port_get_device (MM_PORT (qmi)));
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
ctx->explicit_qmi_open = TRUE;
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static gboolean
|
|
load_ip_type_settings_from_profile (ConnectContext *ctx,
|
|
MM3gppProfile *profile,
|
|
GError **error)
|
|
{
|
|
MMBearerIpFamily ip_family;
|
|
|
|
ip_family = mm_3gpp_profile_get_ip_type (profile);
|
|
if (mm_3gpp_normalize_ip_family (&ip_family, TRUE))
|
|
ctx->no_ip_family_preference = TRUE;
|
|
if (ip_family & MM_BEARER_IP_FAMILY_IPV4)
|
|
ctx->ipv4 = TRUE;
|
|
if (ip_family & MM_BEARER_IP_FAMILY_IPV6)
|
|
ctx->ipv6 = TRUE;
|
|
if (ip_family & MM_BEARER_IP_FAMILY_IPV4V6) {
|
|
ctx->ipv4 = TRUE;
|
|
ctx->ipv6 = TRUE;
|
|
}
|
|
if (!ctx->ipv4 && !ctx->ipv6) {
|
|
g_autofree gchar *str = NULL;
|
|
|
|
str = mm_bearer_ip_family_build_string_from_mask (ip_family);
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED,
|
|
"Unsupported IP type requested: '%s'", str);
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static void
|
|
get_profile_ready (MMIfaceModem3gppProfileManager *modem,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
g_autoptr(MM3gppProfile) profile = NULL;
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
profile = mm_iface_modem_3gpp_profile_manager_get_profile_finish (modem, res, &error);
|
|
if (!profile) {
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
if (!load_ip_type_settings_from_profile (ctx, profile, &error)) {
|
|
g_prefix_error (&error, "Couldn't load ip type settings from profile: ");
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
connect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
connect_context_step (GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
ConnectContext *ctx;
|
|
|
|
self = g_task_get_source_object (task);
|
|
|
|
g_assert (self->priv->ongoing_connect_user_cancellable);
|
|
if (g_cancellable_is_cancelled (self->priv->ongoing_connect_user_cancellable)) {
|
|
complete_connect (task,
|
|
NULL,
|
|
g_error_new (G_IO_ERROR,
|
|
G_IO_ERROR_CANCELLED,
|
|
"operation cancelled"));
|
|
return;
|
|
}
|
|
|
|
g_assert (self->priv->ongoing_connect_network_cancellable);
|
|
if (g_cancellable_is_cancelled (self->priv->ongoing_connect_network_cancellable)) {
|
|
complete_connect (task,
|
|
NULL,
|
|
g_error_new (MM_CORE_ERROR,
|
|
MM_CORE_ERROR_ABORTED,
|
|
"aborted by the network"));
|
|
return;
|
|
}
|
|
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
switch (ctx->step) {
|
|
case CONNECT_STEP_FIRST:
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_LOAD_PROFILE_SETTINGS:
|
|
if (ctx->profile_id != MM_3GPP_PROFILE_ID_UNKNOWN) {
|
|
mm_obj_dbg (self, "loading connection settings from profile '%d'...", ctx->profile_id);
|
|
mm_iface_modem_3gpp_profile_manager_get_profile (
|
|
MM_IFACE_MODEM_3GPP_PROFILE_MANAGER (ctx->modem),
|
|
ctx->profile_id,
|
|
(GAsyncReadyCallback)get_profile_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_OPEN_QMI_PORT:
|
|
g_assert (ctx->ipv4 || ctx->ipv6);
|
|
/* If we're explicitly opening the port (e.g. using a different cdc-wdm
|
|
* port because the primary one is already connected by a different
|
|
* bearer), then make sure we also close it if anything goes wrong and
|
|
* during disconnect */
|
|
if (!mm_port_qmi_is_open (ctx->qmi)) {
|
|
mm_port_qmi_open (ctx->qmi,
|
|
TRUE,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)qmi_port_open_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_SETUP_DATA_FORMAT: {
|
|
MMPortQmiSetupDataFormatAction action;
|
|
|
|
switch (ctx->multiplex) {
|
|
case MM_BEARER_MULTIPLEX_SUPPORT_NONE:
|
|
action = MM_PORT_QMI_SETUP_DATA_FORMAT_ACTION_SET_DEFAULT;
|
|
break;
|
|
case MM_BEARER_MULTIPLEX_SUPPORT_REQUESTED:
|
|
case MM_BEARER_MULTIPLEX_SUPPORT_REQUIRED:
|
|
action = MM_PORT_QMI_SETUP_DATA_FORMAT_ACTION_SET_MULTIPLEX;
|
|
break;
|
|
case MM_BEARER_MULTIPLEX_SUPPORT_UNKNOWN:
|
|
default:
|
|
g_assert_not_reached ();
|
|
}
|
|
mm_port_qmi_setup_data_format (ctx->qmi,
|
|
ctx->data,
|
|
action,
|
|
(GAsyncReadyCallback) setup_data_format_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
case CONNECT_STEP_SETUP_LINK:
|
|
/* if muxing has been enabled in the port, we need to create a new link
|
|
* interface. */
|
|
if (MM_PORT_QMI_DAP_IS_SUPPORTED_QMAP (ctx->dap)) {
|
|
mm_port_qmi_setup_link (ctx->qmi,
|
|
ctx->data,
|
|
ctx->link_prefix_hint,
|
|
(GAsyncReadyCallback) setup_link_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_SETUP_LINK_MAIN_UP:
|
|
/* if the connection is done through a new link, we need to ifup the main interface */
|
|
if (ctx->link) {
|
|
mm_obj_dbg (self, "bringing main interface %s up...", mm_port_get_device (ctx->data));
|
|
mm_port_net_link_setup (MM_PORT_NET (ctx->data),
|
|
TRUE,
|
|
0, /* ignore */
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback) main_interface_up_ready,
|
|
task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_IP_METHOD:
|
|
/* Once the QMI port is open, we decide the IP method we're going
|
|
* to request. If the LLP is raw-ip, we force Static IP, because not
|
|
* all DHCP clients support the raw-ip interfaces; otherwise default
|
|
* to DHCP as always. */
|
|
if (mm_port_qmi_get_link_layer_protocol (ctx->qmi) == QMI_WDA_LINK_LAYER_PROTOCOL_RAW_IP)
|
|
ctx->ip_method = MM_BEARER_IP_METHOD_STATIC;
|
|
else
|
|
ctx->ip_method = MM_BEARER_IP_METHOD_DHCP;
|
|
|
|
mm_obj_dbg (self, "defaulting to use %s IP method", mm_bearer_ip_method_get_string (ctx->ip_method));
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_IPV4:
|
|
/* If no IPv4 setup needed, jump to IPv6 */
|
|
if (!ctx->ipv4) {
|
|
ctx->step = CONNECT_STEP_IPV6;
|
|
connect_context_step (task);
|
|
return;
|
|
}
|
|
|
|
/* Start IPv4 setup */
|
|
mm_obj_dbg (self, "running IPv4 connection setup");
|
|
ctx->running_ipv4 = TRUE;
|
|
ctx->running_ipv6 = FALSE;
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_WDS_CLIENT_IPV4: {
|
|
QmiClient *client;
|
|
|
|
client = mm_port_qmi_get_client (ctx->qmi,
|
|
QMI_SERVICE_WDS,
|
|
MM_BEARER_QMI_PORT_FLAG (MM_PORT_QMI_FLAG_WDS_IPV4, ctx));
|
|
if (!client) {
|
|
mm_obj_dbg (self, "allocating IPv4-specific WDS client (mux id %u)", ctx->mux_id);
|
|
mm_port_qmi_allocate_client (ctx->qmi,
|
|
QMI_SERVICE_WDS,
|
|
MM_BEARER_QMI_PORT_FLAG (MM_PORT_QMI_FLAG_WDS_IPV4, ctx),
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)qmi_port_allocate_client_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
ctx->client_ipv4 = QMI_CLIENT_WDS (client);
|
|
ctx->step++;
|
|
} /* fall through */
|
|
|
|
case CONNECT_STEP_BIND_DATA_PORT_IPV4:
|
|
/* If SIO port given, bind client to it */
|
|
if (!ctx->sio_port_failed && ctx->endpoint.sio_port != QMI_SIO_PORT_NONE) {
|
|
g_autoptr(QmiMessageWdsBindDataPortInput) input = NULL;
|
|
|
|
mm_obj_dbg (self, "binding to data port: %s", qmi_sio_port_get_string (ctx->endpoint.sio_port));
|
|
input = qmi_message_wds_bind_data_port_input_new ();
|
|
qmi_message_wds_bind_data_port_input_set_data_port (input, ctx->endpoint.sio_port, NULL);
|
|
qmi_client_wds_bind_data_port (ctx->client_ipv4,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)bind_data_port_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
/* If mux id given, bind mux data port */
|
|
if (ctx->sio_port_failed || ctx->mux_id != QMI_DEVICE_MUX_ID_UNBOUND) {
|
|
g_autoptr(QmiMessageWdsBindMuxDataPortInput) input = NULL;
|
|
|
|
mm_obj_dbg (self, "binding to mux id %d", ctx->mux_id);
|
|
input = qmi_message_wds_bind_mux_data_port_input_new ();
|
|
qmi_message_wds_bind_mux_data_port_input_set_endpoint_info (
|
|
input,
|
|
ctx->endpoint.type,
|
|
ctx->endpoint.interface_number,
|
|
NULL);
|
|
qmi_message_wds_bind_mux_data_port_input_set_mux_id (input, ctx->mux_id, NULL);
|
|
|
|
qmi_client_wds_bind_mux_data_port (ctx->client_ipv4,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)bind_mux_data_port_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_IP_FAMILY_IPV4:
|
|
/* If client is new enough, select IP family */
|
|
if (!ctx->no_ip_family_preference) {
|
|
QmiMessageWdsSetIpFamilyInput *input;
|
|
|
|
mm_obj_dbg (self, "setting default IP family to: IPv4");
|
|
input = qmi_message_wds_set_ip_family_input_new ();
|
|
qmi_message_wds_set_ip_family_input_set_preference (input, QMI_WDS_IP_FAMILY_IPV4, NULL);
|
|
qmi_client_wds_set_ip_family (ctx->client_ipv4,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)set_ip_family_ready,
|
|
task);
|
|
qmi_message_wds_set_ip_family_input_unref (input);
|
|
return;
|
|
}
|
|
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_ENABLE_INDICATIONS_IPV4:
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (ctx->self,
|
|
ctx->client_ipv4,
|
|
TRUE,
|
|
&ctx->packet_service_status_ipv4_indication_id);
|
|
setup_event_report_unsolicited_events (ctx->self,
|
|
ctx->client_ipv4,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback) connect_enable_indications_ipv4_ready,
|
|
task);
|
|
return;
|
|
|
|
case CONNECT_STEP_START_NETWORK_IPV4: {
|
|
QmiMessageWdsStartNetworkInput *input;
|
|
|
|
mm_obj_dbg (self, "starting IPv4 connection...");
|
|
input = build_start_network_input (ctx);
|
|
qmi_client_wds_start_network (ctx->client_ipv4,
|
|
input,
|
|
MM_BASE_BEARER_DEFAULT_CONNECTION_TIMEOUT,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)start_network_ready,
|
|
task);
|
|
qmi_message_wds_start_network_input_unref (input);
|
|
return;
|
|
}
|
|
|
|
case CONNECT_STEP_ENABLE_WDS_INDICATIONS_IPV4:
|
|
/* If call is connected enable wds indications */
|
|
if (ctx->packet_data_handle_ipv4) {
|
|
register_for_wds_indication (ctx, task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_GET_CURRENT_SETTINGS_IPV4:
|
|
/* Retrieve and print IP configuration */
|
|
if (ctx->packet_data_handle_ipv4) {
|
|
mm_obj_dbg (self, "getting IPv4 configuration...");
|
|
get_current_settings (task, ctx->client_ipv4);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_IPV6:
|
|
/* If no IPv6 setup needed, jump to last */
|
|
if (!ctx->ipv6) {
|
|
ctx->step = CONNECT_STEP_LAST;
|
|
connect_context_step (task);
|
|
return;
|
|
}
|
|
|
|
/* Start IPv6 setup */
|
|
mm_obj_dbg (self, "running IPv6 connection setup");
|
|
ctx->running_ipv4 = FALSE;
|
|
ctx->running_ipv6 = TRUE;
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_WDS_CLIENT_IPV6: {
|
|
QmiClient *client;
|
|
|
|
client = mm_port_qmi_get_client (ctx->qmi,
|
|
QMI_SERVICE_WDS,
|
|
MM_BEARER_QMI_PORT_FLAG (MM_PORT_QMI_FLAG_WDS_IPV6, ctx));
|
|
if (!client) {
|
|
mm_obj_dbg (self, "allocating IPv6-specific WDS client (mux id %u)", ctx->mux_id);
|
|
mm_port_qmi_allocate_client (ctx->qmi,
|
|
QMI_SERVICE_WDS,
|
|
MM_BEARER_QMI_PORT_FLAG (MM_PORT_QMI_FLAG_WDS_IPV6, ctx),
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)qmi_port_allocate_client_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
ctx->client_ipv6 = QMI_CLIENT_WDS (client);
|
|
ctx->step++;
|
|
} /* fall through */
|
|
|
|
case CONNECT_STEP_BIND_DATA_PORT_IPV6:
|
|
/* If SIO port given, bind client to it */
|
|
if (!ctx->sio_port_failed && ctx->endpoint.sio_port != QMI_SIO_PORT_NONE) {
|
|
g_autoptr(QmiMessageWdsBindDataPortInput) input = NULL;
|
|
|
|
mm_obj_dbg (self, "binding to data port: %s", qmi_sio_port_get_string (ctx->endpoint.sio_port));
|
|
input = qmi_message_wds_bind_data_port_input_new ();
|
|
qmi_message_wds_bind_data_port_input_set_data_port (input, ctx->endpoint.sio_port, NULL);
|
|
qmi_client_wds_bind_data_port (ctx->client_ipv6,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)bind_data_port_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
/* If mux id given, bind mux data port */
|
|
if (ctx->sio_port_failed || ctx->mux_id != QMI_DEVICE_MUX_ID_UNBOUND) {
|
|
g_autoptr(QmiMessageWdsBindMuxDataPortInput) input = NULL;
|
|
|
|
mm_obj_dbg (self, "binding to mux id %d", ctx->mux_id);
|
|
input = qmi_message_wds_bind_mux_data_port_input_new ();
|
|
qmi_message_wds_bind_mux_data_port_input_set_endpoint_info (
|
|
input,
|
|
ctx->endpoint.type,
|
|
ctx->endpoint.interface_number,
|
|
NULL);
|
|
qmi_message_wds_bind_mux_data_port_input_set_mux_id (input, ctx->mux_id, NULL);
|
|
|
|
qmi_client_wds_bind_mux_data_port (ctx->client_ipv6,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)bind_mux_data_port_ready,
|
|
task);
|
|
return;
|
|
}
|
|
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_IP_FAMILY_IPV6: {
|
|
QmiMessageWdsSetIpFamilyInput *input;
|
|
|
|
g_assert (ctx->no_ip_family_preference == FALSE);
|
|
|
|
mm_obj_dbg (self, "setting default IP family to: IPv6");
|
|
input = qmi_message_wds_set_ip_family_input_new ();
|
|
qmi_message_wds_set_ip_family_input_set_preference (input, QMI_WDS_IP_FAMILY_IPV6, NULL);
|
|
qmi_client_wds_set_ip_family (ctx->client_ipv6,
|
|
input,
|
|
10,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)set_ip_family_ready,
|
|
task);
|
|
qmi_message_wds_set_ip_family_input_unref (input);
|
|
return;
|
|
}
|
|
|
|
case CONNECT_STEP_ENABLE_INDICATIONS_IPV6:
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (ctx->self,
|
|
ctx->client_ipv6,
|
|
TRUE,
|
|
&ctx->packet_service_status_ipv6_indication_id);
|
|
setup_event_report_unsolicited_events (ctx->self,
|
|
ctx->client_ipv6,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback) connect_enable_indications_ipv6_ready,
|
|
task);
|
|
return;
|
|
|
|
case CONNECT_STEP_START_NETWORK_IPV6: {
|
|
QmiMessageWdsStartNetworkInput *input;
|
|
|
|
mm_obj_dbg (self, "starting IPv6 connection...");
|
|
input = build_start_network_input (ctx);
|
|
qmi_client_wds_start_network (ctx->client_ipv6,
|
|
input,
|
|
MM_BASE_BEARER_DEFAULT_CONNECTION_TIMEOUT,
|
|
g_task_get_cancellable (task),
|
|
(GAsyncReadyCallback)start_network_ready,
|
|
task);
|
|
qmi_message_wds_start_network_input_unref (input);
|
|
return;
|
|
}
|
|
|
|
case CONNECT_STEP_ENABLE_WDS_INDICATIONS_IPV6:
|
|
/* If call is connected enable wds indications */
|
|
if (ctx->packet_data_handle_ipv6) {
|
|
register_for_wds_indication (ctx, task);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_GET_CURRENT_SETTINGS_IPV6:
|
|
/* Retrieve and print IP configuration */
|
|
if (ctx->packet_data_handle_ipv6) {
|
|
mm_obj_dbg (self, "getting IPv6 configuration...");
|
|
get_current_settings (task, ctx->client_ipv6);
|
|
return;
|
|
}
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case CONNECT_STEP_LAST: {
|
|
MMBearerConnectResult *connect_result;
|
|
|
|
/* If one of IPv4 or IPv6 succeeds, we're connected */
|
|
if (!ctx->packet_data_handle_ipv4 && !ctx->packet_data_handle_ipv6) {
|
|
GError *error;
|
|
|
|
/* No connection, set error. If both set, IPv4 error preferred */
|
|
if (ctx->error_ipv4) {
|
|
error = ctx->error_ipv4;
|
|
ctx->error_ipv4 = NULL;
|
|
} else {
|
|
error = ctx->error_ipv6;
|
|
ctx->error_ipv6 = NULL;
|
|
}
|
|
|
|
complete_connect (task, NULL, error);
|
|
return;
|
|
}
|
|
|
|
/* Port is connected; update the state */
|
|
mm_port_set_connected (ctx->link ? ctx->link : ctx->data, TRUE);
|
|
|
|
/* Keep connection related data */
|
|
|
|
g_assert (ctx->self->priv->qmi == NULL);
|
|
ctx->self->priv->qmi = g_object_ref (ctx->qmi);
|
|
if (ctx->explicit_qmi_open) {
|
|
ctx->self->priv->explicit_qmi_open = TRUE;
|
|
ctx->explicit_qmi_open = FALSE;
|
|
}
|
|
|
|
g_assert (ctx->self->priv->data == NULL);
|
|
ctx->self->priv->data = ctx->data ? g_object_ref (ctx->data) : NULL;
|
|
g_assert (ctx->self->priv->link == NULL);
|
|
ctx->self->priv->link = ctx->link ? g_object_ref (ctx->link) : NULL;
|
|
g_assert (ctx->self->priv->mux_id == QMI_DEVICE_MUX_ID_UNBOUND);
|
|
ctx->self->priv->mux_id = ctx->mux_id;
|
|
|
|
/* reset the link name to avoid cleaning up the link on context free */
|
|
g_clear_pointer (&ctx->link_name, g_free);
|
|
|
|
g_assert (ctx->self->priv->packet_data_handle_ipv4 == 0);
|
|
g_assert (ctx->self->priv->client_ipv4 == NULL);
|
|
if (ctx->packet_data_handle_ipv4) {
|
|
ctx->self->priv->packet_data_handle_ipv4 = ctx->packet_data_handle_ipv4;
|
|
ctx->packet_data_handle_ipv4 = 0;
|
|
ctx->self->priv->packet_service_status_ipv4_indication_id = ctx->packet_service_status_ipv4_indication_id;
|
|
ctx->packet_service_status_ipv4_indication_id = 0;
|
|
ctx->self->priv->event_report_ipv4_indication_id = ctx->event_report_ipv4_indication_id;
|
|
ctx->event_report_ipv4_indication_id = 0;
|
|
ctx->self->priv->extended_ipv4_config_change_id = ctx->extended_ipv4_config_change_id;
|
|
ctx->extended_ipv4_config_change_id = 0;
|
|
ctx->self->priv->client_ipv4 = g_object_ref (ctx->client_ipv4);
|
|
}
|
|
|
|
g_assert (ctx->self->priv->packet_data_handle_ipv6 == 0);
|
|
g_assert (ctx->self->priv->client_ipv6 == NULL);
|
|
if (ctx->packet_data_handle_ipv6) {
|
|
ctx->self->priv->packet_data_handle_ipv6 = ctx->packet_data_handle_ipv6;
|
|
ctx->packet_data_handle_ipv6 = 0;
|
|
ctx->self->priv->packet_service_status_ipv6_indication_id = ctx->packet_service_status_ipv6_indication_id;
|
|
ctx->packet_service_status_ipv6_indication_id = 0;
|
|
ctx->self->priv->event_report_ipv6_indication_id = ctx->event_report_ipv6_indication_id;
|
|
ctx->event_report_ipv6_indication_id = 0;
|
|
ctx->self->priv->extended_ipv6_config_change_id = ctx->extended_ipv6_config_change_id;
|
|
ctx->extended_ipv6_config_change_id = 0;
|
|
ctx->self->priv->client_ipv6 = g_object_ref (ctx->client_ipv6);
|
|
}
|
|
|
|
connect_result = mm_bearer_connect_result_new (ctx->link ? ctx->link : ctx->data,
|
|
ctx->ipv4_config,
|
|
ctx->ipv6_config);
|
|
mm_bearer_connect_result_set_multiplexed (connect_result, !!ctx->link);
|
|
|
|
if (ctx->profile_id != MM_3GPP_PROFILE_ID_UNKNOWN)
|
|
mm_bearer_connect_result_set_profile_id (connect_result, ctx->profile_id);
|
|
|
|
complete_connect (task, connect_result, NULL);
|
|
return;
|
|
}
|
|
|
|
default:
|
|
g_assert_not_reached ();
|
|
}
|
|
}
|
|
|
|
static void
|
|
cancel_operation_cancellable (GCancellable *cancellable,
|
|
GCancellable *operation_cancellable)
|
|
{
|
|
g_cancellable_cancel (operation_cancellable);
|
|
}
|
|
|
|
static gboolean
|
|
load_settings_from_bearer (MMBearerQmi *self,
|
|
MMBaseModem *modem,
|
|
ConnectContext *ctx,
|
|
MMBearerProperties *properties,
|
|
GError **error)
|
|
{
|
|
MMBearerAllowedAuth bearer_auth;
|
|
GError *inner_error = NULL;
|
|
const gchar *str;
|
|
const gchar *data_port_driver;
|
|
guint current_multiplexed_bearers;
|
|
guint max_multiplexed_bearers;
|
|
gboolean multiplex_supported = TRUE;
|
|
|
|
if (!mm_iface_modem_count_bearers (MM_IFACE_MODEM (ctx->modem),
|
|
MM_IFACE_MODEM_COUNT_BEARERS_FLAG_MULTIPLEXED,
|
|
¤t_multiplexed_bearers,
|
|
&max_multiplexed_bearers,
|
|
error))
|
|
return FALSE;
|
|
|
|
/* Check multiplex support in the kernel and the device */
|
|
data_port_driver = mm_kernel_device_get_driver (mm_port_peek_kernel_device (ctx->data));
|
|
/* All drivers should support multiplexing */
|
|
if (!max_multiplexed_bearers)
|
|
multiplex_supported = FALSE;
|
|
|
|
/* If no multiplex setting given by the user, assume none; unless in IPA */
|
|
ctx->multiplex = mm_bearer_properties_get_multiplex (properties);
|
|
if (ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_UNKNOWN) {
|
|
if (mm_context_get_test_multiplex_requested ())
|
|
ctx->multiplex = MM_BEARER_MULTIPLEX_SUPPORT_REQUESTED;
|
|
else if (!g_strcmp0 (data_port_driver, "ipa"))
|
|
ctx->multiplex = MM_BEARER_MULTIPLEX_SUPPORT_REQUIRED;
|
|
else
|
|
ctx->multiplex = MM_BEARER_MULTIPLEX_SUPPORT_NONE;
|
|
}
|
|
|
|
/* If multiplex unsupported, either abort or default to none */
|
|
if (!multiplex_supported) {
|
|
if (ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_REQUIRED) {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED,
|
|
"Multiplexing required but not supported");
|
|
return FALSE;
|
|
}
|
|
if (ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_REQUESTED) {
|
|
mm_obj_dbg (self, "Multiplexing unsupported");
|
|
ctx->multiplex = MM_BEARER_MULTIPLEX_SUPPORT_NONE;
|
|
}
|
|
}
|
|
|
|
/* Go on with multiplexing enabled */
|
|
if (ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_REQUESTED ||
|
|
ctx->multiplex == MM_BEARER_MULTIPLEX_SUPPORT_REQUIRED) {
|
|
g_assert (multiplex_supported);
|
|
|
|
if (current_multiplexed_bearers == max_multiplexed_bearers) {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_UNSUPPORTED,
|
|
"Maximum number of multiplexed bearers reached");
|
|
return FALSE;
|
|
}
|
|
|
|
/* The link prefix hint given must be modem-specific */
|
|
ctx->link_prefix_hint = g_strdup_printf ("qmapmux%u.", mm_base_modem_get_dbus_id (MM_BASE_MODEM (modem)));
|
|
}
|
|
|
|
/* If profile id is given, we'll launch the connection specifying the profile id in use
|
|
* exclusively, so we ignore any additional user provided setting */
|
|
ctx->profile_id = mm_bearer_properties_get_profile_id (properties);
|
|
if (ctx->profile_id != MM_3GPP_PROFILE_ID_UNKNOWN) {
|
|
/* Is this a 3GPP2 only modem and profile id was given? If so, error, as we don't support
|
|
* 3GPP2 profiles in ModemManager */
|
|
if (mm_iface_modem_is_cdma_only (MM_IFACE_MODEM (modem))) {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_INVALID_ARGS,
|
|
"3GPP2 doesn't support profile id setting");
|
|
return FALSE;
|
|
}
|
|
/* All done now, we'll need to load IP type settings later on once
|
|
* we load the real profile to use */
|
|
return TRUE;
|
|
}
|
|
|
|
/* APN settings */
|
|
ctx->apn = g_strdup (mm_bearer_properties_get_apn (properties));
|
|
/* Is this a 3GPP only modem and no APN was given? If so, error */
|
|
if (mm_iface_modem_is_3gpp_only (MM_IFACE_MODEM (modem)) && !ctx->apn) {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_INVALID_ARGS,
|
|
"3GPP connection logic requires APN setting");
|
|
return FALSE;
|
|
}
|
|
/* Is this a 3GPP2 only modem and APN was given? If so, error */
|
|
if (mm_iface_modem_is_cdma_only (MM_IFACE_MODEM (modem)) && ctx->apn) {
|
|
g_set_error (error, MM_CORE_ERROR, MM_CORE_ERROR_INVALID_ARGS,
|
|
"3GPP2 doesn't support APN setting");
|
|
return FALSE;
|
|
}
|
|
|
|
/* IP type settings */
|
|
if (!load_ip_type_settings_from_profile (ctx, mm_bearer_properties_peek_3gpp_profile (properties), error))
|
|
return FALSE;
|
|
|
|
/* Auth settings; in we treat user/password empty strings as no strings */
|
|
str = mm_bearer_properties_get_user (properties);
|
|
if (str && str[0])
|
|
ctx->user = g_strdup (str);
|
|
str = mm_bearer_properties_get_password (properties);
|
|
if (str && str[0])
|
|
ctx->password = g_strdup (str);
|
|
|
|
if (!ctx->user && !ctx->password)
|
|
ctx->auth = QMI_WDS_AUTHENTICATION_NONE;
|
|
else {
|
|
bearer_auth = mm_bearer_properties_get_allowed_auth (properties);
|
|
ctx->auth = mm_bearer_allowed_auth_to_qmi_authentication (bearer_auth, self, &inner_error);
|
|
if (inner_error) {
|
|
g_propagate_error (error, inner_error);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static void
|
|
_connect (MMBaseBearer *_self,
|
|
GCancellable *cancellable,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
MMBearerQmi *self = MM_BEARER_QMI (_self);
|
|
ConnectContext *ctx;
|
|
GError *error = NULL;
|
|
GTask *task;
|
|
g_autoptr(GCancellable) operation_cancellable = NULL;
|
|
g_autoptr(MMBaseModem) modem = NULL;
|
|
g_autoptr(MMBearerProperties) properties = NULL;
|
|
|
|
operation_cancellable = g_cancellable_new ();
|
|
task = g_task_new (self, operation_cancellable, callback, user_data);
|
|
g_task_set_check_cancellable (task, FALSE);
|
|
|
|
g_object_get (self,
|
|
MM_BASE_BEARER_MODEM, &modem,
|
|
MM_BASE_BEARER_CONFIG, &properties,
|
|
NULL);
|
|
g_assert (modem);
|
|
|
|
ctx = g_slice_new0 (ConnectContext);
|
|
ctx->self = g_object_ref (self);
|
|
ctx->modem = g_object_ref (modem);
|
|
ctx->mux_id = QMI_DEVICE_MUX_ID_UNBOUND;
|
|
ctx->step = CONNECT_STEP_FIRST;
|
|
ctx->ip_method = MM_BEARER_IP_METHOD_UNKNOWN;
|
|
g_task_set_task_data (task, ctx, (GDestroyNotify)connect_context_free);
|
|
|
|
/* Grab a data port */
|
|
ctx->data = mm_base_modem_get_best_data_port (modem, MM_PORT_TYPE_NET);
|
|
if (!ctx->data) {
|
|
g_task_return_new_error (task, MM_CORE_ERROR, MM_CORE_ERROR_NOT_FOUND,
|
|
"No valid data port found to launch connection");
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
/* Each data port has a single QMI port associated */
|
|
ctx->qmi = mm_broadband_modem_qmi_get_port_qmi_for_data (MM_BROADBAND_MODEM_QMI (modem), ctx->data, &ctx->endpoint, &error);
|
|
if (!ctx->qmi) {
|
|
g_task_return_error (task, error);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
ctx->dap = mm_port_qmi_get_data_aggregation_protocol (ctx->qmi);
|
|
|
|
/* load all settings from bearer */
|
|
if (!load_settings_from_bearer (self, modem, ctx, properties, &error)) {
|
|
g_prefix_error (&error, "Invalid bearer properties: ");
|
|
g_task_return_error (task, error);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
/* setup network cancellable */
|
|
g_assert (!self->priv->ongoing_connect_network_cancellable);
|
|
self->priv->ongoing_connect_network_cancellable = g_cancellable_new ();
|
|
g_cancellable_connect (self->priv->ongoing_connect_network_cancellable,
|
|
G_CALLBACK (cancel_operation_cancellable),
|
|
g_object_ref (operation_cancellable),
|
|
g_object_unref);
|
|
|
|
/* setup user cancellable */
|
|
g_assert (!self->priv->ongoing_connect_user_cancellable);
|
|
self->priv->ongoing_connect_user_cancellable = g_object_ref (cancellable);
|
|
g_cancellable_connect (self->priv->ongoing_connect_user_cancellable,
|
|
G_CALLBACK (cancel_operation_cancellable),
|
|
g_object_ref (operation_cancellable),
|
|
g_object_unref);
|
|
|
|
/* Run! */
|
|
mm_obj_dbg (self, "launching connection with QMI port (%s) and data port (%s) (multiplex %s)",
|
|
mm_port_get_device (MM_PORT (ctx->qmi)),
|
|
mm_port_get_device (ctx->data),
|
|
mm_bearer_multiplex_support_get_string (ctx->multiplex));
|
|
connect_context_step (task);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Disconnect */
|
|
|
|
typedef enum {
|
|
DISCONNECT_STEP_FIRST,
|
|
DISCONNECT_STEP_STOP_NETWORK_IPV4,
|
|
DISCONNECT_STEP_STOP_NETWORK_IPV6,
|
|
DISCONNECT_STEP_LAST
|
|
} DisconnectStep;
|
|
|
|
typedef struct {
|
|
DisconnectStep step;
|
|
|
|
gboolean running_ipv4;
|
|
QmiClientWds *client_ipv4;
|
|
guint32 packet_data_handle_ipv4;
|
|
GError *error_ipv4;
|
|
|
|
gboolean running_ipv6;
|
|
QmiClientWds *client_ipv6;
|
|
guint32 packet_data_handle_ipv6;
|
|
GError *error_ipv6;
|
|
} DisconnectContext;
|
|
|
|
static void
|
|
disconnect_context_free (DisconnectContext *ctx)
|
|
{
|
|
if (ctx->error_ipv4)
|
|
g_error_free (ctx->error_ipv4);
|
|
if (ctx->error_ipv6)
|
|
g_error_free (ctx->error_ipv6);
|
|
if (ctx->client_ipv4)
|
|
g_object_unref (ctx->client_ipv4);
|
|
if (ctx->client_ipv6)
|
|
g_object_unref (ctx->client_ipv6);
|
|
g_slice_free (DisconnectContext, ctx);
|
|
}
|
|
|
|
static gboolean
|
|
disconnect_finish (MMBaseBearer *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
return g_task_propagate_boolean (G_TASK (res), error);
|
|
}
|
|
|
|
static void
|
|
reset_bearer_connection (MMBearerQmi *self,
|
|
gboolean reset_ipv4,
|
|
gboolean reset_ipv6)
|
|
{
|
|
if (reset_ipv4) {
|
|
if (self->priv->client_ipv4) {
|
|
if (self->priv->packet_service_status_ipv4_indication_id)
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (self,
|
|
self->priv->client_ipv4,
|
|
FALSE,
|
|
&self->priv->packet_service_status_ipv4_indication_id);
|
|
if (self->priv->event_report_ipv4_indication_id)
|
|
cleanup_event_report_unsolicited_events (self,
|
|
self->priv->client_ipv4,
|
|
&self->priv->event_report_ipv4_indication_id);
|
|
if (self->priv->extended_ipv4_config_change_id) {
|
|
g_signal_handler_disconnect (self->priv->client_ipv4, self->priv->extended_ipv4_config_change_id);
|
|
self->priv->extended_ipv4_config_change_id = 0;
|
|
}
|
|
}
|
|
self->priv->packet_data_handle_ipv4 = 0;
|
|
g_clear_object (&self->priv->client_ipv4);
|
|
}
|
|
|
|
if (reset_ipv6) {
|
|
if (self->priv->client_ipv6) {
|
|
if (self->priv->packet_service_status_ipv6_indication_id)
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (self,
|
|
self->priv->client_ipv6,
|
|
FALSE,
|
|
&self->priv->packet_service_status_ipv6_indication_id);
|
|
if (self->priv->event_report_ipv6_indication_id)
|
|
cleanup_event_report_unsolicited_events (self,
|
|
self->priv->client_ipv6,
|
|
&self->priv->event_report_ipv6_indication_id);
|
|
if (self->priv->extended_ipv6_config_change_id) {
|
|
g_signal_handler_disconnect (self->priv->client_ipv6, self->priv->extended_ipv6_config_change_id);
|
|
self->priv->extended_ipv6_config_change_id = 0;
|
|
}
|
|
}
|
|
self->priv->packet_data_handle_ipv6 = 0;
|
|
g_clear_object (&self->priv->client_ipv6);
|
|
}
|
|
|
|
if (!self->priv->packet_data_handle_ipv4 && !self->priv->packet_data_handle_ipv6) {
|
|
if (self->priv->data) {
|
|
/* Port is disconnected; update the state */
|
|
mm_port_set_connected (self->priv->data, FALSE);
|
|
g_clear_object (&self->priv->data);
|
|
}
|
|
if (self->priv->link) {
|
|
g_assert (self->priv->qmi);
|
|
/* Link is disconnected; update the state */
|
|
mm_port_set_connected (self->priv->link, FALSE);
|
|
mm_port_qmi_cleanup_link (self->priv->qmi,
|
|
mm_port_get_device (self->priv->link),
|
|
self->priv->mux_id,
|
|
NULL,
|
|
NULL);
|
|
g_clear_object (&self->priv->link);
|
|
}
|
|
self->priv->mux_id = QMI_DEVICE_MUX_ID_UNBOUND;
|
|
|
|
/* Close port if we had it explicitly open for this connection */
|
|
if (self->priv->qmi) {
|
|
if (self->priv->explicit_qmi_open) {
|
|
self->priv->explicit_qmi_open = FALSE;
|
|
mm_port_qmi_close (self->priv->qmi, NULL, NULL);
|
|
}
|
|
g_clear_object (&self->priv->qmi);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void disconnect_context_step (GTask *task);
|
|
|
|
static void
|
|
stop_network_ready (QmiClientWds *client,
|
|
GAsyncResult *res,
|
|
GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
DisconnectContext *ctx;
|
|
GError *error = NULL;
|
|
QmiMessageWdsStopNetworkOutput *output;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
output = qmi_client_wds_stop_network_finish (client, res, &error);
|
|
if (output &&
|
|
!qmi_message_wds_stop_network_output_get_result (output, &error)) {
|
|
/* No effect error, we're already disconnected */
|
|
if (g_error_matches (error,
|
|
QMI_PROTOCOL_ERROR,
|
|
QMI_PROTOCOL_ERROR_NO_EFFECT)) {
|
|
g_error_free (error);
|
|
error = NULL;
|
|
}
|
|
}
|
|
|
|
if (error) {
|
|
if (ctx->running_ipv4)
|
|
ctx->error_ipv4 = error;
|
|
else
|
|
ctx->error_ipv6 = error;
|
|
} else {
|
|
/* Clear internal status */
|
|
reset_bearer_connection (self,
|
|
ctx->running_ipv4,
|
|
ctx->running_ipv6);
|
|
}
|
|
|
|
if (output)
|
|
qmi_message_wds_stop_network_output_unref (output);
|
|
|
|
/* Keep on */
|
|
ctx->step++;
|
|
disconnect_context_step (task);
|
|
}
|
|
|
|
static void
|
|
disconnect_context_step (GTask *task)
|
|
{
|
|
MMBearerQmi *self;
|
|
DisconnectContext *ctx;
|
|
|
|
self = g_task_get_source_object (task);
|
|
ctx = g_task_get_task_data (task);
|
|
|
|
switch (ctx->step) {
|
|
case DISCONNECT_STEP_FIRST:
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case DISCONNECT_STEP_STOP_NETWORK_IPV4:
|
|
if (ctx->packet_data_handle_ipv4) {
|
|
QmiMessageWdsStopNetworkInput *input;
|
|
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (self,
|
|
ctx->client_ipv4,
|
|
FALSE,
|
|
&self->priv->packet_service_status_ipv4_indication_id);
|
|
if (self->priv->event_report_ipv4_indication_id)
|
|
cleanup_event_report_unsolicited_events (self,
|
|
ctx->client_ipv4,
|
|
&self->priv->event_report_ipv4_indication_id);
|
|
|
|
if (self->priv->extended_ipv4_config_change_id) {
|
|
g_signal_handler_disconnect (ctx->client_ipv4, self->priv->extended_ipv4_config_change_id);
|
|
self->priv->extended_ipv4_config_change_id = 0;
|
|
}
|
|
input = qmi_message_wds_stop_network_input_new ();
|
|
qmi_message_wds_stop_network_input_set_packet_data_handle (input, ctx->packet_data_handle_ipv4, NULL);
|
|
|
|
ctx->running_ipv4 = TRUE;
|
|
ctx->running_ipv6 = FALSE;
|
|
qmi_client_wds_stop_network (ctx->client_ipv4,
|
|
input,
|
|
MM_BASE_BEARER_DEFAULT_DISCONNECTION_TIMEOUT,
|
|
NULL,
|
|
(GAsyncReadyCallback)stop_network_ready,
|
|
task);
|
|
qmi_message_wds_stop_network_input_unref (input);
|
|
return;
|
|
}
|
|
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case DISCONNECT_STEP_STOP_NETWORK_IPV6:
|
|
if (ctx->packet_data_handle_ipv6) {
|
|
QmiMessageWdsStopNetworkInput *input;
|
|
|
|
common_setup_cleanup_packet_service_status_unsolicited_events (self,
|
|
ctx->client_ipv6,
|
|
FALSE,
|
|
&self->priv->packet_service_status_ipv6_indication_id);
|
|
if (self->priv->event_report_ipv6_indication_id)
|
|
cleanup_event_report_unsolicited_events (self,
|
|
ctx->client_ipv6,
|
|
&self->priv->event_report_ipv6_indication_id);
|
|
|
|
if (self->priv->extended_ipv6_config_change_id) {
|
|
g_signal_handler_disconnect (ctx->client_ipv6, self->priv->extended_ipv6_config_change_id);
|
|
self->priv->extended_ipv6_config_change_id = 0;
|
|
}
|
|
input = qmi_message_wds_stop_network_input_new ();
|
|
qmi_message_wds_stop_network_input_set_packet_data_handle (input, ctx->packet_data_handle_ipv6, NULL);
|
|
|
|
ctx->running_ipv4 = FALSE;
|
|
ctx->running_ipv6 = TRUE;
|
|
qmi_client_wds_stop_network (ctx->client_ipv6,
|
|
input,
|
|
MM_BASE_BEARER_DEFAULT_DISCONNECTION_TIMEOUT,
|
|
NULL,
|
|
(GAsyncReadyCallback)stop_network_ready,
|
|
task);
|
|
qmi_message_wds_stop_network_input_unref (input);
|
|
return;
|
|
}
|
|
|
|
ctx->step++;
|
|
/* fall through */
|
|
|
|
case DISCONNECT_STEP_LAST:
|
|
if (!ctx->error_ipv4 && !ctx->error_ipv6)
|
|
g_task_return_boolean (task, TRUE);
|
|
else {
|
|
GError *error;
|
|
|
|
/* If both set, IPv4 error preferred */
|
|
if (ctx->error_ipv4) {
|
|
error = ctx->error_ipv4;
|
|
ctx->error_ipv4 = NULL;
|
|
} else {
|
|
error = ctx->error_ipv6;
|
|
ctx->error_ipv6 = NULL;
|
|
}
|
|
|
|
g_task_return_error (task, error);
|
|
}
|
|
|
|
g_object_unref (task);
|
|
return;
|
|
|
|
default:
|
|
g_assert_not_reached ();
|
|
}
|
|
}
|
|
|
|
static void
|
|
disconnect (MMBaseBearer *_self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
MMBearerQmi *self = MM_BEARER_QMI (_self);
|
|
DisconnectContext *ctx;
|
|
GTask *task;
|
|
|
|
task = g_task_new (self, NULL, callback, user_data);
|
|
|
|
if ((!self->priv->packet_data_handle_ipv4 && !self->priv->packet_data_handle_ipv6) ||
|
|
(!self->priv->client_ipv4 && !self->priv->client_ipv6) ||
|
|
(!self->priv->data && !self->priv->link) ||
|
|
!self->priv->qmi) {
|
|
mm_obj_dbg (self, "no need to disconnect: QMI bearer is already disconnected");
|
|
g_task_return_boolean (task, TRUE);
|
|
g_object_unref (task);
|
|
return;
|
|
}
|
|
|
|
ctx = g_slice_new0 (DisconnectContext);
|
|
ctx->client_ipv4 = self->priv->client_ipv4 ? g_object_ref (self->priv->client_ipv4) : NULL;
|
|
ctx->packet_data_handle_ipv4 = self->priv->packet_data_handle_ipv4;
|
|
ctx->client_ipv6 = self->priv->client_ipv6 ? g_object_ref (self->priv->client_ipv6) : NULL;
|
|
ctx->packet_data_handle_ipv6 = self->priv->packet_data_handle_ipv6;
|
|
ctx->step = DISCONNECT_STEP_FIRST;
|
|
|
|
g_task_set_task_data (task, ctx, (GDestroyNotify)disconnect_context_free);
|
|
|
|
/* Run! */
|
|
disconnect_context_step (task);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static void
|
|
report_connection_status (MMBaseBearer *_self,
|
|
MMBearerConnectionStatus status,
|
|
const GError *connection_error)
|
|
{
|
|
MMBearerQmi *self = MM_BEARER_QMI (_self);
|
|
|
|
if (status == MM_BEARER_CONNECTION_STATUS_DISCONNECTED) {
|
|
/* Cancel any ongoing connection attempt */
|
|
g_cancellable_cancel (self->priv->ongoing_connect_network_cancellable);
|
|
/* Cleanup all connection related data */
|
|
reset_bearer_connection (self, TRUE, TRUE);
|
|
}
|
|
|
|
/* Chain up parent's report_connection_status() */
|
|
MM_BASE_BEARER_CLASS (mm_bearer_qmi_parent_class)->report_connection_status (_self, status, connection_error);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
MMBaseBearer *
|
|
mm_bearer_qmi_new (MMBroadbandModemQmi *modem,
|
|
MMBearerProperties *config)
|
|
{
|
|
MMBaseBearer *bearer;
|
|
|
|
/* The Qmi bearer inherits from MMBaseBearer (so it's not a MMBroadbandBearer)
|
|
* and that means that the object is not async-initable, so we just use
|
|
* g_object_new() here */
|
|
bearer = g_object_new (MM_TYPE_BEARER_QMI,
|
|
MM_BASE_BEARER_MODEM, modem,
|
|
MM_BIND_TO, G_OBJECT (modem),
|
|
MM_BASE_BEARER_CONFIG, config,
|
|
NULL);
|
|
|
|
/* Only export valid bearers */
|
|
mm_base_bearer_export (bearer);
|
|
|
|
return bearer;
|
|
}
|
|
|
|
static void
|
|
mm_bearer_qmi_init (MMBearerQmi *self)
|
|
{
|
|
/* Initialize private data */
|
|
self->priv = G_TYPE_INSTANCE_GET_PRIVATE (self, MM_TYPE_BEARER_QMI, MMBearerQmiPrivate);
|
|
self->priv->mux_id = QMI_DEVICE_MUX_ID_UNBOUND;
|
|
}
|
|
|
|
static void
|
|
dispose (GObject *object)
|
|
{
|
|
MMBearerQmi *self = MM_BEARER_QMI (object);
|
|
|
|
g_assert (!self->priv->ongoing_connect_user_cancellable);
|
|
g_assert (!self->priv->ongoing_connect_network_cancellable);
|
|
reset_bearer_connection (self, TRUE, TRUE);
|
|
g_list_free_full (self->priv->pco_list, g_object_unref);
|
|
self->priv->pco_list = NULL;
|
|
G_OBJECT_CLASS (mm_bearer_qmi_parent_class)->dispose (object);
|
|
}
|
|
|
|
static void
|
|
mm_bearer_qmi_class_init (MMBearerQmiClass *klass)
|
|
{
|
|
GObjectClass *object_class = G_OBJECT_CLASS (klass);
|
|
MMBaseBearerClass *base_bearer_class = MM_BASE_BEARER_CLASS (klass);
|
|
|
|
g_type_class_add_private (object_class, sizeof (MMBearerQmiPrivate));
|
|
|
|
/* Virtual methods */
|
|
object_class->dispose = dispose;
|
|
|
|
base_bearer_class->connect = _connect;
|
|
base_bearer_class->connect_finish = connect_finish;
|
|
base_bearer_class->disconnect = disconnect;
|
|
base_bearer_class->disconnect_finish = disconnect_finish;
|
|
base_bearer_class->report_connection_status = report_connection_status;
|
|
base_bearer_class->reload_stats = reload_stats;
|
|
base_bearer_class->reload_stats_finish = reload_stats_finish;
|
|
base_bearer_class->load_connection_status = load_connection_status;
|
|
base_bearer_class->load_connection_status_finish = load_connection_status_finish;
|
|
#if defined WITH_SUSPEND_RESUME
|
|
base_bearer_class->reload_connection_status = reload_connection_status;
|
|
base_bearer_class->reload_connection_status_finish = reload_connection_status_finish;
|
|
#endif
|
|
}
|