6de2d84af1
Vendor specific plugins that support QMI or MBIM based devices need to handle the creation of these modems themselves. https://bugs.freedesktop.org/show_bug.cgi?id=100372 Original patch by Aleksander Morgado.
348 lines
12 KiB
C
348 lines
12 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) 2015 Aleksander Morgado <aleksander@aleksander.es>
|
|
*/
|
|
|
|
#include <string.h>
|
|
|
|
#include "mm-common-telit.h"
|
|
#include "mm-log.h"
|
|
|
|
/*****************************************************************************/
|
|
|
|
#define TAG_GETPORTCFG_SUPPORTED "getportcfg-supported"
|
|
|
|
#define TAG_TELIT_MODEM_PORT "ID_MM_TELIT_PORT_TYPE_MODEM"
|
|
#define TAG_TELIT_AUX_PORT "ID_MM_TELIT_PORT_TYPE_AUX"
|
|
#define TAG_TELIT_NMEA_PORT "ID_MM_TELIT_PORT_TYPE_NMEA"
|
|
|
|
#define TELIT_GE910_FAMILY_PID 0x0022
|
|
|
|
gboolean
|
|
telit_grab_port (MMPlugin *self,
|
|
MMBaseModem *modem,
|
|
MMPortProbe *probe,
|
|
GError **error)
|
|
{
|
|
MMKernelDevice *port;
|
|
MMDevice *device;
|
|
MMPortType ptype;
|
|
MMPortSerialAtFlag pflags = MM_PORT_SERIAL_AT_FLAG_NONE;
|
|
const gchar *subsys;
|
|
|
|
port = mm_port_probe_peek_port (probe);
|
|
ptype = mm_port_probe_get_port_type (probe);
|
|
device = mm_port_probe_peek_device (probe);
|
|
subsys = mm_port_probe_get_port_subsys (probe);
|
|
|
|
/* Just skip custom port identification for subsys different than tty */
|
|
if (!g_str_equal (subsys, "tty"))
|
|
goto out;
|
|
|
|
/* Look for port type hints; just probing can't distinguish which port should
|
|
* be the data/primary port on these devices. We have to tag them based on
|
|
* what the Windows .INF files say the port layout should be.
|
|
*
|
|
* If no udev rules are found, AT#PORTCFG (if supported) can be used for
|
|
* identifying the port layout
|
|
*/
|
|
if (mm_kernel_device_get_property_as_boolean (port, TAG_TELIT_MODEM_PORT)) {
|
|
mm_dbg ("telit: AT port '%s/%s' flagged as primary",
|
|
mm_port_probe_get_port_subsys (probe),
|
|
mm_port_probe_get_port_name (probe));
|
|
pflags = MM_PORT_SERIAL_AT_FLAG_PRIMARY;
|
|
} else if (mm_kernel_device_get_property_as_boolean (port, TAG_TELIT_AUX_PORT)) {
|
|
mm_dbg ("telit: AT port '%s/%s' flagged as secondary",
|
|
mm_port_probe_get_port_subsys (probe),
|
|
mm_port_probe_get_port_name (probe));
|
|
pflags = MM_PORT_SERIAL_AT_FLAG_SECONDARY;
|
|
} else if (mm_kernel_device_get_property_as_boolean (port, TAG_TELIT_NMEA_PORT)) {
|
|
mm_dbg ("telit: port '%s/%s' flagged as NMEA",
|
|
mm_port_probe_get_port_subsys (probe),
|
|
mm_port_probe_get_port_name (probe));
|
|
ptype = MM_PORT_TYPE_GPS;
|
|
} else if (g_object_get_data (G_OBJECT (device), TAG_GETPORTCFG_SUPPORTED) != NULL) {
|
|
if (g_strcmp0 (mm_kernel_device_get_property (port, "ID_USB_INTERFACE_NUM"), g_object_get_data (G_OBJECT (device), TAG_TELIT_MODEM_PORT)) == 0) {
|
|
mm_dbg ("telit: AT port '%s/%s' flagged as primary",
|
|
mm_port_probe_get_port_subsys (probe),
|
|
mm_port_probe_get_port_name (probe));
|
|
pflags = MM_PORT_SERIAL_AT_FLAG_PRIMARY;
|
|
} else if (g_strcmp0 (mm_kernel_device_get_property (port, "ID_USB_INTERFACE_NUM"), g_object_get_data (G_OBJECT (device), TAG_TELIT_AUX_PORT)) == 0) {
|
|
mm_dbg ("telit: AT port '%s/%s' flagged as secondary",
|
|
mm_port_probe_get_port_subsys (probe),
|
|
mm_port_probe_get_port_name (probe));
|
|
pflags = MM_PORT_SERIAL_AT_FLAG_SECONDARY;
|
|
} else if (g_strcmp0 (mm_kernel_device_get_property (port, "ID_USB_INTERFACE_NUM"), g_object_get_data (G_OBJECT (device), TAG_TELIT_NMEA_PORT)) == 0) {
|
|
mm_dbg ("telit: port '%s/%s' flagged as NMEA",
|
|
mm_port_probe_get_port_subsys (probe),
|
|
mm_port_probe_get_port_name (probe));
|
|
ptype = MM_PORT_TYPE_GPS;
|
|
} else
|
|
ptype = MM_PORT_TYPE_IGNORED;
|
|
} else {
|
|
/* If the port isn't explicitly tagged as primary, secondary, or gps
|
|
* port, we will fallback to flagging it as secondary, but only if it
|
|
* probed AT successfully.
|
|
*
|
|
* This is so that we support the case where a single TTY is exposed
|
|
* by the modem and no explicit port type hint is specified.
|
|
*
|
|
* From the modem point of view, only the AT_FLAG_PRIMARY would be
|
|
* important, as that is the port that would end up getting used for PPP
|
|
* in this case, so having multiple secondary ports, if that ever
|
|
* happened, wouldn't be an issue.
|
|
*/
|
|
if (mm_port_probe_is_at (probe))
|
|
pflags = MM_PORT_SERIAL_AT_FLAG_SECONDARY;
|
|
else
|
|
ptype = MM_PORT_TYPE_IGNORED;
|
|
}
|
|
|
|
out:
|
|
return mm_base_modem_grab_port (modem,
|
|
port,
|
|
ptype,
|
|
pflags,
|
|
error);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Custom init */
|
|
|
|
typedef struct {
|
|
MMPortProbe *probe;
|
|
MMPortSerialAt *port;
|
|
GCancellable *cancellable;
|
|
GSimpleAsyncResult *result;
|
|
gboolean getportcfg_done;
|
|
guint getportcfg_retries;
|
|
} TelitCustomInitContext;
|
|
|
|
gboolean
|
|
telit_custom_init_finish (MMPortProbe *probe,
|
|
GAsyncResult *result,
|
|
GError **error)
|
|
{
|
|
return !g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (result), error);
|
|
}
|
|
|
|
static void telit_custom_init_step (TelitCustomInitContext *ctx);
|
|
|
|
static gboolean
|
|
cache_port_mode (MMDevice *device,
|
|
const gchar *reply)
|
|
{
|
|
GRegex *r = NULL;
|
|
GRegexCompileFlags flags = G_REGEX_DOLLAR_ENDONLY | G_REGEX_RAW;
|
|
GMatchInfo *match_info = NULL;
|
|
GError *error = NULL;
|
|
gboolean ret = FALSE;
|
|
guint portcfg_current;
|
|
|
|
/* #PORTCFG: <requested>,<active> */
|
|
r = g_regex_new ("#PORTCFG:\\s*(\\d+),(\\d+)", flags, 0, NULL);
|
|
g_assert (r != NULL);
|
|
|
|
if (!g_regex_match_full (r, reply, strlen (reply), 0, 0, &match_info, &error))
|
|
goto out;
|
|
|
|
if (!mm_get_uint_from_match_info (match_info, 2, &portcfg_current)) {
|
|
mm_dbg ("telit: unrecognized #PORTCFG <active> value");
|
|
goto out;
|
|
}
|
|
|
|
/* Reference for port configurations:
|
|
* HE910/UE910/UL865 Families Ports Arrangements User Guide
|
|
* GE910 Family Ports Arrangements User Guide
|
|
*/
|
|
switch (portcfg_current) {
|
|
case 0:
|
|
case 1:
|
|
case 4:
|
|
case 5:
|
|
case 7:
|
|
case 9:
|
|
case 10:
|
|
case 11:
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_MODEM_PORT, "00");
|
|
|
|
if (mm_device_get_product (device) == TELIT_GE910_FAMILY_PID)
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_AUX_PORT, "02");
|
|
else
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_AUX_PORT, "06");
|
|
break;
|
|
case 2:
|
|
case 3:
|
|
case 6:
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_MODEM_PORT, "00");
|
|
break;
|
|
case 8:
|
|
case 12:
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_MODEM_PORT, "00");
|
|
|
|
if (mm_device_get_product (device) == TELIT_GE910_FAMILY_PID) {
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_AUX_PORT, "02");
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_NMEA_PORT, "04");
|
|
} else {
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_AUX_PORT, "06");
|
|
g_object_set_data (G_OBJECT (device), TAG_TELIT_NMEA_PORT, "0a");
|
|
}
|
|
break;
|
|
default:
|
|
/* portcfg value not supported */
|
|
goto out;
|
|
}
|
|
ret = TRUE;
|
|
|
|
out:
|
|
g_match_info_free (match_info);
|
|
g_regex_unref (r);
|
|
if (error != NULL) {
|
|
mm_dbg ("telit: error while matching: %s", error->message);
|
|
g_error_free (error);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static void
|
|
getportcfg_ready (MMPortSerialAt *port,
|
|
GAsyncResult *res,
|
|
TelitCustomInitContext *ctx)
|
|
{
|
|
const gchar *response;
|
|
GError *error = NULL;
|
|
|
|
response = mm_port_serial_at_command_finish (port, res, &error);
|
|
if (error) {
|
|
mm_dbg ("telit: couldn't get port mode: '%s'",
|
|
error->message);
|
|
|
|
/* If ERROR or COMMAND NOT SUPPORT occur then do not retry the
|
|
* command.
|
|
*/
|
|
if (g_error_matches (error,
|
|
MM_MOBILE_EQUIPMENT_ERROR,
|
|
MM_MOBILE_EQUIPMENT_ERROR_UNKNOWN))
|
|
ctx->getportcfg_done = TRUE;
|
|
} else {
|
|
MMDevice *device;
|
|
|
|
device = mm_port_probe_peek_device (ctx->probe);
|
|
|
|
/* Results are cached in the parent device object */
|
|
if (g_object_get_data (G_OBJECT (device), TAG_GETPORTCFG_SUPPORTED) == NULL) {
|
|
mm_dbg ("telit: retrieving port mode layout");
|
|
if (cache_port_mode (device, response)) {
|
|
g_object_set_data (G_OBJECT (device), TAG_GETPORTCFG_SUPPORTED, GUINT_TO_POINTER (TRUE));
|
|
ctx->getportcfg_done = TRUE;
|
|
}
|
|
}
|
|
|
|
/* Port answered to #PORTCFG, so mark it as being AT already */
|
|
mm_port_probe_set_result_at (ctx->probe, TRUE);
|
|
}
|
|
|
|
if (error)
|
|
g_error_free (error);
|
|
|
|
telit_custom_init_step (ctx);
|
|
}
|
|
|
|
static void
|
|
telit_custom_init_context_complete_and_free (TelitCustomInitContext *ctx)
|
|
{
|
|
g_simple_async_result_complete_in_idle (ctx->result);
|
|
|
|
if (ctx->cancellable)
|
|
g_object_unref (ctx->cancellable);
|
|
g_object_unref (ctx->port);
|
|
g_object_unref (ctx->probe);
|
|
g_object_unref (ctx->result);
|
|
g_slice_free (TelitCustomInitContext, ctx);
|
|
}
|
|
|
|
static void
|
|
telit_custom_init_step (TelitCustomInitContext *ctx)
|
|
{
|
|
MMKernelDevice *port;
|
|
|
|
/* If cancelled, end */
|
|
if (g_cancellable_is_cancelled (ctx->cancellable)) {
|
|
mm_dbg ("telit: no need to keep on running custom init in (%s)",
|
|
mm_port_get_device (MM_PORT (ctx->port)));
|
|
goto out;
|
|
}
|
|
|
|
/* Try to get a port configuration from the modem: usb interface 00
|
|
* is always linked to an AT port
|
|
*/
|
|
port = mm_port_probe_peek_port (ctx->probe);
|
|
if (!ctx->getportcfg_done &&
|
|
g_strcmp0 (mm_kernel_device_get_property (port, "ID_USB_INTERFACE_NUM"), "00") == 0) {
|
|
|
|
if (ctx->getportcfg_retries == 0)
|
|
goto out;
|
|
ctx->getportcfg_retries--;
|
|
|
|
mm_port_serial_at_command (
|
|
ctx->port,
|
|
"AT#PORTCFG?",
|
|
2,
|
|
FALSE, /* raw */
|
|
FALSE, /* allow_cached */
|
|
ctx->cancellable,
|
|
(GAsyncReadyCallback)getportcfg_ready,
|
|
ctx);
|
|
return;
|
|
}
|
|
|
|
out:
|
|
g_simple_async_result_set_op_res_gboolean (ctx->result, TRUE);
|
|
telit_custom_init_context_complete_and_free (ctx);
|
|
}
|
|
|
|
void
|
|
telit_custom_init (MMPortProbe *probe,
|
|
MMPortSerialAt *port,
|
|
GCancellable *cancellable,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
MMDevice *device;
|
|
MMKernelDevice *port_device;
|
|
TelitCustomInitContext *ctx;
|
|
|
|
device = mm_port_probe_peek_device (probe);
|
|
port_device = mm_port_probe_peek_port (probe);
|
|
|
|
ctx = g_slice_new (TelitCustomInitContext);
|
|
ctx->result = g_simple_async_result_new (G_OBJECT (probe),
|
|
callback,
|
|
user_data,
|
|
telit_custom_init);
|
|
ctx->probe = g_object_ref (probe);
|
|
ctx->port = g_object_ref (port);
|
|
ctx->cancellable = cancellable ? g_object_ref (cancellable) : NULL;
|
|
ctx->getportcfg_done = FALSE;
|
|
ctx->getportcfg_retries = 3;
|
|
|
|
/* If the device is tagged for supporting #PORTCFG do the custom init */
|
|
if (mm_kernel_device_get_global_property_as_boolean (port_device, "ID_MM_TELIT_PORTS_TAGGED")) {
|
|
telit_custom_init_step (ctx);
|
|
return;
|
|
}
|
|
|
|
g_simple_async_result_set_op_res_gboolean (ctx->result, TRUE);
|
|
telit_custom_init_context_complete_and_free (ctx);
|
|
}
|