diff options
| -rw-r--r-- | plugins/ublox/mm-broadband-bearer-ublox.c | 394 |
1 files changed, 394 insertions, 0 deletions
diff --git a/plugins/ublox/mm-broadband-bearer-ublox.c b/plugins/ublox/mm-broadband-bearer-ublox.c index 310af714..0621780c 100644 --- a/plugins/ublox/mm-broadband-bearer-ublox.c +++ b/plugins/ublox/mm-broadband-bearer-ublox.c @@ -30,6 +30,7 @@ #include "mm-base-modem-at.h" #include "mm-log.h" #include "mm-ublox-enums-types.h" +#include "mm-modem-helpers.h" #include "mm-modem-helpers-ublox.h" G_DEFINE_TYPE (MMBroadbandBearerUblox, mm_broadband_bearer_ublox, MM_TYPE_BROADBAND_BEARER) @@ -49,6 +50,388 @@ struct _MMBroadbandBearerUbloxPrivate { }; /*****************************************************************************/ +/* Common connection context and task */ + +typedef struct { + MMBroadbandBearerUblox *self; + MMBroadbandModem *modem; + MMPortSerialAt *primary; + MMPort *data; + guint cid; + /* For IPv4 settings */ + MMBearerIpConfig *ip_config; +} CommonConnectContext; + +static void +common_connect_context_free (CommonConnectContext *ctx) +{ + if (ctx->ip_config) + g_object_unref (ctx->ip_config); + if (ctx->data) + g_object_unref (ctx->data); + g_object_unref (ctx->self); + g_object_unref (ctx->modem); + g_object_unref (ctx->primary); + g_slice_free (CommonConnectContext, ctx); +} + +static GTask * +common_connect_task_new (MMBroadbandBearerUblox *self, + MMBroadbandModem *modem, + MMPortSerialAt *primary, + guint cid, + MMPort *data, + GCancellable *cancellable, + GAsyncReadyCallback callback, + gpointer user_data) +{ + CommonConnectContext *ctx; + GTask *task; + + ctx = g_slice_new0 (CommonConnectContext); + ctx->self = g_object_ref (self); + ctx->modem = g_object_ref (modem); + ctx->primary = g_object_ref (primary); + ctx->cid = cid; + + task = g_task_new (self, cancellable, callback, user_data); + g_task_set_task_data (task, ctx, (GDestroyNotify) common_connect_context_free); + + /* We need a net data port */ + if (data) + ctx->data = g_object_ref (data); + else { + ctx->data = mm_base_modem_get_best_data_port (MM_BASE_MODEM (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 NULL; + } + } + + return task; +} + +/*****************************************************************************/ +/* 3GPP IP config (sub-step of the 3GPP Connection sequence) */ + +static gboolean +get_ip_config_3gpp_finish (MMBroadbandBearer *self, + GAsyncResult *res, + MMBearerIpConfig **ipv4_config, + MMBearerIpConfig **ipv6_config, + GError **error) +{ + MMBearerConnectResult *configs; + MMBearerIpConfig *ipv4; + + configs = g_task_propagate_pointer (G_TASK (res), error); + if (!configs) + return FALSE; + + /* Just IPv4 for now */ + ipv4 = mm_bearer_connect_result_peek_ipv4_config (configs); + g_assert (ipv4); + if (ipv4_config) + *ipv4_config = g_object_ref (ipv4); + if (ipv6_config) + *ipv6_config = NULL; + mm_bearer_connect_result_unref (configs); + return TRUE; +} + +static void +complete_get_ip_config_3gpp (GTask *task) +{ + CommonConnectContext *ctx; + + ctx = (CommonConnectContext *) g_task_get_task_data (task); + g_assert (mm_bearer_ip_config_get_method (ctx->ip_config) != MM_BEARER_IP_METHOD_UNKNOWN); + g_task_return_pointer (task, + mm_bearer_connect_result_new (ctx->data, ctx->ip_config, NULL), + (GDestroyNotify) mm_bearer_connect_result_unref); + g_object_unref (task); +} + +static void +cgcontrdp_ready (MMBaseModem *modem, + GAsyncResult *res, + GTask *task) +{ + const gchar *response; + GError *error = NULL; + CommonConnectContext *ctx; + gchar *local_address = NULL; + gchar *subnet = NULL; + gchar *dns_addresses[3] = { NULL, NULL, NULL }; + + ctx = (CommonConnectContext *) g_task_get_task_data (task); + + response = mm_base_modem_at_command_finish (modem, res, &error); + if (!response || !mm_3gpp_parse_cgcontrdp_response (response, + NULL, /* cid */ + NULL, /* bearer id */ + NULL, /* apn */ + &local_address, + &subnet, + NULL, /* gateway_address */ + &dns_addresses[0], + &dns_addresses[1], + &error)) { + g_task_return_error (task, error); + g_object_unref (task); + return; + } + + mm_dbg ("IPv4 address retrieved: %s", local_address); + mm_bearer_ip_config_set_address (ctx->ip_config, local_address); + mm_dbg ("IPv4 subnet retrieved: %s", subnet); + mm_bearer_ip_config_set_prefix (ctx->ip_config, mm_netmask_to_cidr (subnet)); + if (dns_addresses[0]) + mm_dbg ("Primary DNS retrieved: %s", dns_addresses[0]); + if (dns_addresses[1]) + mm_dbg ("Secondary DNS retrieved: %s", dns_addresses[1]); + mm_bearer_ip_config_set_dns (ctx->ip_config, (const gchar **) dns_addresses); + + g_free (local_address); + g_free (subnet); + g_free (dns_addresses[0]); + g_free (dns_addresses[1]); + + mm_dbg ("finished IP settings retrieval for PDP context #%u...", ctx->cid); + + complete_get_ip_config_3gpp (task); +} + +static void +uipaddr_ready (MMBaseModem *modem, + GAsyncResult *res, + GTask *task) +{ + const gchar *response; + gchar *cmd; + GError *error = NULL; + CommonConnectContext *ctx; + gchar *gw_ipv4_address = NULL; + + ctx = (CommonConnectContext *) g_task_get_task_data (task); + + response = mm_base_modem_at_command_finish (modem, res, &error); + if (!response || !mm_ublox_parse_uipaddr_response (response, + NULL, /* cid */ + NULL, /* if_name */ + &gw_ipv4_address, + NULL, /* ipv4_subnet */ + NULL, /* ipv6_global_address */ + NULL, /* ipv6_link_local_address */ + &error)) { + g_task_return_error (task, error); + g_object_unref (task); + return; + } + + mm_dbg ("IPv4 gateway address retrieved: %s", gw_ipv4_address); + mm_bearer_ip_config_set_gateway (ctx->ip_config, gw_ipv4_address); + g_free (gw_ipv4_address); + + cmd = g_strdup_printf ("+CGCONTRDP=%u", ctx->cid); + mm_dbg ("gathering IP and DNS information for PDP context #%u...", ctx->cid); + mm_base_modem_at_command (MM_BASE_MODEM (modem), + cmd, + 10, + FALSE, + (GAsyncReadyCallback) cgcontrdp_ready, + task); + g_free (cmd); +} + +static void +get_ip_config_3gpp (MMBroadbandBearer *self, + MMBroadbandModem *modem, + MMPortSerialAt *primary, + MMPortSerialAt *secondary, + MMPort *data, + guint cid, + MMBearerIpFamily ip_family, + GAsyncReadyCallback callback, + gpointer user_data) +{ + GTask *task; + CommonConnectContext *ctx; + + if (!(task = common_connect_task_new (MM_BROADBAND_BEARER_UBLOX (self), + MM_BROADBAND_MODEM (modem), + primary, + cid, + data, + NULL, + callback, + user_data))) + return; + + ctx = (CommonConnectContext *) g_task_get_task_data (task); + ctx->ip_config = mm_bearer_ip_config_new (); + + /* If we're in BRIDGE mode, we need to ask for static IP addressing details: + * - AT+UIPADDR=[CID] will give us the default gateway address. + * - +CGCONTRDP?[CID] will give us the IP address, subnet and DNS addresses. + */ + if (ctx->self->priv->mode == MM_UBLOX_NETWORKING_MODE_BRIDGE) { + gchar *cmd; + + mm_bearer_ip_config_set_method (ctx->ip_config, MM_BEARER_IP_METHOD_STATIC); + + cmd = g_strdup_printf ("+UIPADDR=%u", cid); + mm_dbg ("gathering gateway information for PDP context #%u...", cid); + mm_base_modem_at_command (MM_BASE_MODEM (modem), + cmd, + 10, + FALSE, + (GAsyncReadyCallback) uipaddr_ready, + task); + g_free (cmd); + return; + } + + /* If we're in ROUTER networking mode, we just need to request DHCP on the + * network interface. Early return with that result. */ + if (ctx->self->priv->mode == MM_UBLOX_NETWORKING_MODE_ROUTER) { + mm_bearer_ip_config_set_method (ctx->ip_config, MM_BEARER_IP_METHOD_DHCP); + complete_get_ip_config_3gpp (task); + return; + } + + g_assert_not_reached (); +} + +/*****************************************************************************/ +/* 3GPP Dialing (sub-step of the 3GPP Connection sequence) */ + +static MMPort * +dial_3gpp_finish (MMBroadbandBearer *self, + GAsyncResult *res, + GError **error) +{ + return MM_PORT (g_task_propagate_pointer (G_TASK (res), error)); +} + +static void +cgact_activate_ready (MMBaseModem *modem, + GAsyncResult *res, + GTask *task) +{ + const gchar *response; + GError *error = NULL; + CommonConnectContext *ctx; + + ctx = (CommonConnectContext *) g_task_get_task_data (task); + + response = mm_base_modem_at_command_finish (modem, res, &error); + if (!response) + g_task_return_error (task, error); + else + g_task_return_pointer (task, g_object_ref (ctx->data), (GDestroyNotify) g_object_unref); + g_object_unref (task); +} + +static void +dial_3gpp (MMBroadbandBearer *self, + MMBaseModem *modem, + MMPortSerialAt *primary, + guint cid, + GCancellable *cancellable, + GAsyncReadyCallback callback, + gpointer user_data) +{ + GTask *task; + gchar *cmd; + + if (!(task = common_connect_task_new (MM_BROADBAND_BEARER_UBLOX (self), + MM_BROADBAND_MODEM (modem), + primary, + cid, + NULL, /* data, unused */ + cancellable, + callback, + user_data))) + return; + + cmd = g_strdup_printf ("+CGACT=1,%u", cid); + mm_dbg ("activating PDP context #%u...", cid); + mm_base_modem_at_command (MM_BASE_MODEM (modem), + cmd, + 120, + FALSE, + (GAsyncReadyCallback) cgact_activate_ready, + task); + g_free (cmd); +} + +/*****************************************************************************/ +/* 3GPP disconnection */ + +static gboolean +disconnect_3gpp_finish (MMBroadbandBearer *self, + GAsyncResult *res, + GError **error) +{ + return g_task_propagate_boolean (G_TASK (res), error); +} + +static void +cgact_deactivate_ready (MMBaseModem *modem, + GAsyncResult *res, + GTask *task) +{ + const gchar *response; + GError *error = NULL; + + response = mm_base_modem_at_command_finish (modem, res, &error); + if (!response) + g_task_return_error (task, error); + else + g_task_return_boolean (task, TRUE); + g_object_unref (task); +} + +static void +disconnect_3gpp (MMBroadbandBearer *self, + MMBroadbandModem *modem, + MMPortSerialAt *primary, + MMPortSerialAt *secondary, + MMPort *data, + guint cid, + GAsyncReadyCallback callback, + gpointer user_data) +{ + GTask *task; + gchar *cmd; + + if (!(task = common_connect_task_new (MM_BROADBAND_BEARER_UBLOX (self), + MM_BROADBAND_MODEM (modem), + primary, + cid, + data, + NULL, + callback, + user_data))) + return; + + cmd = g_strdup_printf ("+CGACT=0,%u", cid); + mm_dbg ("deactivating PDP context #%u...", cid); + mm_base_modem_at_command (MM_BASE_MODEM (modem), + cmd, + 120, + FALSE, + (GAsyncReadyCallback) cgact_deactivate_ready, + task); + g_free (cmd); +} + +/*****************************************************************************/ MMBaseBearer * mm_broadband_bearer_ublox_new_finish (GAsyncResult *res, @@ -79,6 +462,9 @@ mm_broadband_bearer_ublox_new (MMBroadbandModem *modem, GAsyncReadyCallback callback, gpointer user_data) { + g_assert (profile == MM_UBLOX_USB_PROFILE_ECM || profile == MM_UBLOX_USB_PROFILE_RNDIS); + g_assert (mode == MM_UBLOX_NETWORKING_MODE_ROUTER || mode == MM_UBLOX_NETWORKING_MODE_BRIDGE); + g_async_initable_new_async ( MM_TYPE_BROADBAND_BEARER_UBLOX, G_PRIORITY_DEFAULT, @@ -151,12 +537,20 @@ static void mm_broadband_bearer_ublox_class_init (MMBroadbandBearerUbloxClass *klass) { GObjectClass *object_class = G_OBJECT_CLASS (klass); + MMBroadbandBearerClass *broadband_bearer_class = MM_BROADBAND_BEARER_CLASS (klass); g_type_class_add_private (object_class, sizeof (MMBroadbandBearerUbloxPrivate)); object_class->get_property = get_property; object_class->set_property = set_property; + broadband_bearer_class->disconnect_3gpp = disconnect_3gpp; + broadband_bearer_class->disconnect_3gpp_finish = disconnect_3gpp_finish; + broadband_bearer_class->dial_3gpp = dial_3gpp; + broadband_bearer_class->dial_3gpp_finish = dial_3gpp_finish; + broadband_bearer_class->get_ip_config_3gpp = get_ip_config_3gpp; + broadband_bearer_class->get_ip_config_3gpp_finish = get_ip_config_3gpp_finish; + properties[PROP_USB_PROFILE] = g_param_spec_enum (MM_BROADBAND_BEARER_UBLOX_USB_PROFILE, "USB profile", |