4dad94d500
Make port roles more flexible. We have modems that do PPP on interfaces other than the primary interface, and that wasn't possible with the old code. So clean up all that logic and move the port organization code into the core so we can reduce code in the plugins. In the new world order, the plugins say whether the port is a QCDM port, an AT port, or ignored. If it's an AT port the plugins get to tag it as primary, secondary, or PPP, or any combination of the 3. This allows for modems where PPP should really be done on the secondary port (Huawei E220, Sierra devices) so that the primary port stays open for command and status. Modem subclasses no longer get asked to handle port grabbing themselves. Instead, that's now done by the generic classes (MMGenericCdma and MMGenericGsm) and the plugins are notified when a port is grabbed so they can add unsolicited response handlers for it. After all ports are grabbed by the generic classes, they get "organized", which assigns various ports to the roles of PRIMARY, SECONDARY, DATA, and QCDM based on specific rules and hints that the plugin provided (which are expressed as MMAtPortFlags). The plugins then have a chance to perform fixups on the primary port if they choose. The plugin code is responsible for determining the port hints (ie MMAtPortFlags) at probe time, instead of having a combination of the plugin and the modem class do the job. This simplifies things greatly for the plugins at the expense of more complicated logic in the core.
389 lines
13 KiB
C
389 lines
13 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) 2008 - 2009 Novell, Inc.
|
|
* Copyright (C) 2009 - 2010 Red Hat, Inc.
|
|
*/
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <ctype.h>
|
|
|
|
#define G_UDEV_API_IS_SUBJECT_TO_CHANGE
|
|
#include <gudev/gudev.h>
|
|
|
|
#include "mm-modem-anydata-cdma.h"
|
|
#include "mm-errors.h"
|
|
#include "mm-callback-info.h"
|
|
#include "mm-serial-port.h"
|
|
#include "mm-serial-parsers.h"
|
|
#include "mm-log.h"
|
|
|
|
static void modem_init (MMModem *modem_class);
|
|
|
|
G_DEFINE_TYPE_EXTENDED (MMModemAnydataCdma, mm_modem_anydata_cdma, MM_TYPE_GENERIC_CDMA, 0,
|
|
G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM, modem_init))
|
|
|
|
MMModem *
|
|
mm_modem_anydata_cdma_new (const char *device,
|
|
const char *driver,
|
|
const char *plugin,
|
|
gboolean evdo_rev0,
|
|
gboolean evdo_revA,
|
|
guint32 vendor,
|
|
guint32 product)
|
|
{
|
|
g_return_val_if_fail (device != NULL, NULL);
|
|
g_return_val_if_fail (driver != NULL, NULL);
|
|
g_return_val_if_fail (plugin != NULL, NULL);
|
|
|
|
return MM_MODEM (g_object_new (MM_TYPE_MODEM_ANYDATA_CDMA,
|
|
MM_MODEM_MASTER_DEVICE, device,
|
|
MM_MODEM_DRIVER, driver,
|
|
MM_MODEM_PLUGIN, plugin,
|
|
MM_GENERIC_CDMA_EVDO_REV0, evdo_rev0,
|
|
MM_GENERIC_CDMA_EVDO_REVA, evdo_revA,
|
|
MM_GENERIC_CDMA_REGISTRATION_TRY_CSS, FALSE,
|
|
MM_MODEM_HW_VID, vendor,
|
|
MM_MODEM_HW_PID, product,
|
|
NULL));
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static const char *
|
|
strip_response (const char *resp, const char *cmd)
|
|
{
|
|
const char *p = resp;
|
|
|
|
if (p) {
|
|
if (!strncmp (p, cmd, strlen (cmd)))
|
|
p += strlen (cmd);
|
|
while (*p == ' ')
|
|
p++;
|
|
}
|
|
return p;
|
|
}
|
|
|
|
static gboolean
|
|
uint_from_match_item (GMatchInfo *match_info, guint32 num, guint32 *val)
|
|
{
|
|
long int tmp;
|
|
char *str;
|
|
gboolean success = FALSE;
|
|
|
|
str = g_match_info_fetch (match_info, num);
|
|
g_return_val_if_fail (str != NULL, FALSE);
|
|
|
|
errno = 0;
|
|
tmp = strtol (str, NULL, 10);
|
|
if (errno == 0 && tmp >= 0 && tmp <= G_MAXUINT) {
|
|
*val = (guint32) tmp;
|
|
success = TRUE;
|
|
}
|
|
g_free (str);
|
|
return success;
|
|
}
|
|
|
|
static gboolean
|
|
int_from_match_item (GMatchInfo *match_info, guint32 num, gint *val)
|
|
{
|
|
long int tmp;
|
|
char *str;
|
|
gboolean success = FALSE;
|
|
|
|
str = g_match_info_fetch (match_info, num);
|
|
g_return_val_if_fail (str != NULL, FALSE);
|
|
|
|
errno = 0;
|
|
tmp = strtol (str, NULL, 10);
|
|
if (errno == 0 && tmp >= G_MININT && tmp <= G_MAXINT) {
|
|
*val = (gint) tmp;
|
|
success = TRUE;
|
|
}
|
|
g_free (str);
|
|
return success;
|
|
}
|
|
|
|
static void
|
|
evdo_state_done (MMAtSerialPort *port,
|
|
GString *response,
|
|
GError *error,
|
|
gpointer user_data)
|
|
{
|
|
MMCallbackInfo *info = (MMCallbackInfo *) user_data;
|
|
MMModemCdmaRegistrationState reg_state = MM_MODEM_CDMA_REGISTRATION_STATE_UNKNOWN;
|
|
const char *reply;
|
|
GRegex *r;
|
|
GMatchInfo *match_info;
|
|
|
|
/* If the modem has already been removed, return without
|
|
* scheduling callback */
|
|
if (mm_callback_info_check_modem_removed (info))
|
|
return;
|
|
|
|
if (error) {
|
|
/* Leave superclass' reg state alone if AT*HSTATE isn't supported */
|
|
mm_callback_info_schedule (info);
|
|
return;
|
|
}
|
|
|
|
reply = strip_response (response->str, "*HSTATE:");
|
|
|
|
/* Format is "<at state>,<session state>,<channel>,<pn>,<EcIo>,<rssi>,..." */
|
|
r = g_regex_new ("\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*([^,\\)]*)\\s*,\\s*([^,\\)]*)\\s*,.*",
|
|
G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
if (!r) {
|
|
/* Parse error; warn about it and assume EVDO is not available */
|
|
mm_warn ("ANYDATA: *HSTATE parse regex creation failed.");
|
|
goto done;
|
|
}
|
|
|
|
g_regex_match (r, reply, 0, &match_info);
|
|
if (g_match_info_get_match_count (match_info) >= 6) {
|
|
guint32 val = 0;
|
|
gint dbm = 0;
|
|
|
|
/* dBm is between -106 (worst) and -20.7 (best) */
|
|
int_from_match_item (match_info, 6, &dbm);
|
|
|
|
/* Parse the EVDO radio state */
|
|
if (uint_from_match_item (match_info, 1, &val)) {
|
|
switch (val) {
|
|
case 3: /* IDLE */
|
|
/* If IDLE and the EVDO dBm is -105 or lower, assume no service.
|
|
* It may be that IDLE actually means NO SERVICE too; not sure.
|
|
*/
|
|
if (dbm > -105)
|
|
reg_state = MM_MODEM_CDMA_REGISTRATION_STATE_REGISTERED;
|
|
break;
|
|
case 4: /* ACCESS */
|
|
case 5: /* CONNECT */
|
|
reg_state = MM_MODEM_CDMA_REGISTRATION_STATE_REGISTERED;
|
|
break;
|
|
default:
|
|
mm_warn ("ANYDATA: unknown *STATE (%d); assuming no service.", val);
|
|
/* fall through */
|
|
case 0: /* NO SERVICE */
|
|
case 1: /* ACQUISITION */
|
|
case 2: /* SYNC */
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
g_match_info_free (match_info);
|
|
g_regex_unref (r);
|
|
|
|
done:
|
|
mm_generic_cdma_query_reg_state_set_callback_evdo_state (info, reg_state);
|
|
mm_callback_info_schedule (info);
|
|
}
|
|
|
|
static void
|
|
state_done (MMAtSerialPort *port,
|
|
GString *response,
|
|
GError *error,
|
|
gpointer user_data)
|
|
{
|
|
MMCallbackInfo *info = (MMCallbackInfo *) user_data;
|
|
MMModemCdmaRegistrationState reg_state = MM_MODEM_CDMA_REGISTRATION_STATE_UNKNOWN;
|
|
const char *reply;
|
|
GRegex *r;
|
|
GMatchInfo *match_info;
|
|
|
|
/* If the modem has already been removed, return without
|
|
* scheduling callback */
|
|
if (mm_callback_info_check_modem_removed (info))
|
|
return;
|
|
|
|
if (error) {
|
|
/* Leave superclass' reg state alone if AT*STATE isn't supported */
|
|
mm_callback_info_schedule (info);
|
|
return;
|
|
}
|
|
|
|
reply = strip_response (response->str, "*STATE:");
|
|
|
|
/* Format is "<channel>,<pn>,<sid>,<nid>,<state>,<rssi>,..." */
|
|
r = g_regex_new ("\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*(\\d+)\\s*,\\s*([^,\\)]*)\\s*,.*",
|
|
G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
if (!r) {
|
|
mm_warn ("ANYDATA: *STATE parse regex creation failed.");
|
|
mm_callback_info_schedule (info);
|
|
return;
|
|
}
|
|
|
|
g_regex_match (r, reply, 0, &match_info);
|
|
if (g_match_info_get_match_count (match_info) >= 6) {
|
|
guint32 val = 0;
|
|
gint dbm = 0;
|
|
|
|
/* dBm is between -106 (worst) and -20.7 (best) */
|
|
int_from_match_item (match_info, 6, &dbm);
|
|
|
|
/* Parse the 1x radio state */
|
|
if (uint_from_match_item (match_info, 5, &val)) {
|
|
switch (val) {
|
|
case 1: /* IDLE */
|
|
/* If IDLE and the 1X dBm is -105 or lower, assume no service.
|
|
* It may be that IDLE actually means NO SERVICE too; not sure.
|
|
*/
|
|
if (dbm > -105)
|
|
reg_state = MM_MODEM_CDMA_REGISTRATION_STATE_REGISTERED;
|
|
break;
|
|
case 2: /* ACCESS */
|
|
case 3: /* PAGING */
|
|
case 4: /* TRAFFIC */
|
|
reg_state = MM_MODEM_CDMA_REGISTRATION_STATE_REGISTERED;
|
|
break;
|
|
default:
|
|
mm_warn ("ANYDATA: unknown *STATE (%d); assuming no service.", val);
|
|
/* fall through */
|
|
case 0: /* NO SERVICE */
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
g_match_info_free (match_info);
|
|
g_regex_unref (r);
|
|
|
|
mm_generic_cdma_query_reg_state_set_callback_1x_state (info, reg_state);
|
|
|
|
/* Try for EVDO state too */
|
|
mm_at_serial_port_queue_command (port, "*HSTATE?", 3, evdo_state_done, info);
|
|
}
|
|
|
|
static void
|
|
query_registration_state (MMGenericCdma *cdma,
|
|
MMModemCdmaRegistrationState cur_cdma_state,
|
|
MMModemCdmaRegistrationState cur_evdo_state,
|
|
MMModemCdmaRegistrationStateFn callback,
|
|
gpointer user_data)
|
|
{
|
|
MMCallbackInfo *info;
|
|
MMAtSerialPort *port;
|
|
|
|
info = mm_generic_cdma_query_reg_state_callback_info_new (cdma, cur_cdma_state, cur_evdo_state, callback, user_data);
|
|
|
|
port = mm_generic_cdma_get_best_at_port (cdma, &info->error);
|
|
if (!port) {
|
|
mm_callback_info_schedule (info);
|
|
return;
|
|
}
|
|
|
|
mm_at_serial_port_queue_command (port, "*STATE?", 3, state_done, info);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static void
|
|
reset (MMModem *modem,
|
|
MMModemFn callback,
|
|
gpointer user_data)
|
|
{
|
|
MMCallbackInfo *info;
|
|
MMAtSerialPort *port;
|
|
|
|
info = mm_callback_info_new (MM_MODEM (modem), callback, user_data);
|
|
|
|
/* Ensure we have a usable port to use for the command */
|
|
port = mm_generic_cdma_get_best_at_port (MM_GENERIC_CDMA (modem), &info->error);
|
|
if (port)
|
|
mm_at_serial_port_queue_command (port, "*RESET", 3, NULL, NULL);
|
|
|
|
mm_callback_info_schedule (info);
|
|
}
|
|
|
|
static void
|
|
port_grabbed (MMGenericCdma *cdma,
|
|
MMPort *port,
|
|
MMAtPortFlags pflags,
|
|
gpointer user_data)
|
|
{
|
|
GRegex *regex;
|
|
|
|
if (MM_IS_AT_SERIAL_PORT (port)) {
|
|
/* Data state notifications */
|
|
|
|
/* Data call has connected */
|
|
regex = g_regex_new ("\\r\\n\\*ACTIVE:(.*)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL);
|
|
g_regex_unref (regex);
|
|
|
|
/* Data call disconnected */
|
|
regex = g_regex_new ("\\r\\n\\*INACTIVE:(.*)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL);
|
|
g_regex_unref (regex);
|
|
|
|
/* Modem is now dormant */
|
|
regex = g_regex_new ("\\r\\n\\*DORMANT:(.*)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL);
|
|
g_regex_unref (regex);
|
|
|
|
/* Abnormal state notifications
|
|
*
|
|
* FIXME: set 1X/EVDO registration state to UNKNOWN when these
|
|
* notifications are received?
|
|
*/
|
|
|
|
/* Network acquisition fail */
|
|
regex = g_regex_new ("\\r\\n\\*OFFLINE:(.*)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL);
|
|
g_regex_unref (regex);
|
|
|
|
/* Registration fail */
|
|
regex = g_regex_new ("\\r\\n\\*REGREQ:(.*)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL);
|
|
g_regex_unref (regex);
|
|
|
|
/* Authentication fail */
|
|
regex = g_regex_new ("\\r\\n\\*AUTHREQ:(.*)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL);
|
|
mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL);
|
|
g_regex_unref (regex);
|
|
}
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
static void
|
|
modem_init (MMModem *modem_class)
|
|
{
|
|
modem_class->reset = reset;
|
|
}
|
|
|
|
static void
|
|
mm_modem_anydata_cdma_init (MMModemAnydataCdma *self)
|
|
{
|
|
}
|
|
|
|
static void
|
|
mm_modem_anydata_cdma_class_init (MMModemAnydataCdmaClass *klass)
|
|
{
|
|
MMGenericCdmaClass *cdma_class = MM_GENERIC_CDMA_CLASS (klass);
|
|
|
|
mm_modem_anydata_cdma_parent_class = g_type_class_peek_parent (klass);
|
|
|
|
cdma_class->query_registration_state = query_registration_state;
|
|
cdma_class->port_grabbed = port_grabbed;
|
|
|
|
#if 0
|
|
/* FIXME: maybe use AT*SLEEP=0/1 to disable/enable slotted mode for powersave */
|
|
cdma_class->post_enable = post_enable;
|
|
cdma_class->post_enable = post_disable;
|
|
#endif
|
|
}
|
|
|