1746949277
Instead of a custom modem_init() step in the 'Modem' interface, just add a sequence of port initialization commands in each port. While enabling for the first time a non-hotplugged modem, we will issue the port initialization commands only after having run the enabling_modem_init() step (i.e. after ATZ usually).
299 lines
9.8 KiB
C
299 lines
9.8 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 - 2011 Red Hat, Inc.
|
|
* Copyright (C) 2011 Google Inc.
|
|
*/
|
|
|
|
#include <config.h>
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <ctype.h>
|
|
|
|
#include "ModemManager.h"
|
|
#include "mm-serial-parsers.h"
|
|
#include "mm-log.h"
|
|
#include "mm-errors-types.h"
|
|
#include "mm-iface-modem.h"
|
|
#include "mm-iface-modem-messaging.h"
|
|
#include "mm-base-modem-at.h"
|
|
#include "mm-broadband-modem-nokia.h"
|
|
#include "mm-sim-nokia.h"
|
|
|
|
static void iface_modem_init (MMIfaceModem *iface);
|
|
static void iface_modem_messaging_init (MMIfaceModemMessaging *iface);
|
|
|
|
G_DEFINE_TYPE_EXTENDED (MMBroadbandModemNokia, mm_broadband_modem_nokia, MM_TYPE_BROADBAND_MODEM, 0,
|
|
G_IMPLEMENT_INTERFACE (MM_TYPE_IFACE_MODEM, iface_modem_init)
|
|
G_IMPLEMENT_INTERFACE (MM_TYPE_IFACE_MODEM_MESSAGING, iface_modem_messaging_init));
|
|
|
|
/*****************************************************************************/
|
|
/* Create SIM (Modem interface) */
|
|
|
|
static MMSim *
|
|
create_sim_finish (MMIfaceModem *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
return mm_sim_nokia_new_finish (res, error);
|
|
}
|
|
|
|
static void
|
|
create_sim (MMIfaceModem *self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
/* New Nokia SIM */
|
|
mm_sim_nokia_new (MM_BASE_MODEM (self),
|
|
NULL, /* cancellable */
|
|
callback,
|
|
user_data);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Load supported modes (Modem interface) */
|
|
|
|
static MMModemMode
|
|
modem_load_supported_modes_finish (MMIfaceModem *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
{
|
|
return (MMModemMode)GPOINTER_TO_UINT (g_simple_async_result_get_op_res_gpointer (
|
|
G_SIMPLE_ASYNC_RESULT (res)));
|
|
}
|
|
|
|
static void
|
|
modem_load_supported_modes (MMIfaceModem *self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
GSimpleAsyncResult *result;
|
|
MMModemMode mode;
|
|
|
|
/* Nokia phones don't seem to like AT+WS46?, they just report 2G even if
|
|
* 3G is supported, so we'll just assume they actually do 3G. */
|
|
mode = (MM_MODEM_MODE_2G | MM_MODEM_MODE_3G);
|
|
|
|
/* Then, if the modem has LTE caps, it does 4G */
|
|
if (mm_iface_modem_is_3gpp_lte (MM_IFACE_MODEM (self)))
|
|
mode |= MM_MODEM_MODE_4G;
|
|
|
|
result = g_simple_async_result_new (G_OBJECT (self),
|
|
callback,
|
|
user_data,
|
|
modem_load_supported_modes);
|
|
g_simple_async_result_set_op_res_gpointer (result,
|
|
GUINT_TO_POINTER (mode),
|
|
NULL);
|
|
g_simple_async_result_complete_in_idle (result);
|
|
g_object_unref (result);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Initializing the modem (during first enabling) */
|
|
|
|
typedef struct {
|
|
GSimpleAsyncResult *result;
|
|
MMBroadbandModemNokia *self;
|
|
guint retries;
|
|
} EnablingModemInitContext;
|
|
|
|
static void
|
|
enabling_modem_init_context_complete_and_free (EnablingModemInitContext *ctx)
|
|
{
|
|
g_simple_async_result_complete (ctx->result);
|
|
g_object_unref (ctx->result);
|
|
g_object_unref (ctx->self);
|
|
g_slice_free (EnablingModemInitContext, ctx);
|
|
}
|
|
|
|
static gboolean
|
|
enabling_modem_init_finish (MMBroadbandModem *self,
|
|
GAsyncResult *res,
|
|
GError **error)
|
|
|
|
{
|
|
return !g_simple_async_result_propagate_error (G_SIMPLE_ASYNC_RESULT (res), error);
|
|
}
|
|
|
|
static void retry_atz (EnablingModemInitContext *ctx);
|
|
|
|
static void
|
|
atz_ready (MMBaseModem *self,
|
|
GAsyncResult *res,
|
|
EnablingModemInitContext *ctx)
|
|
{
|
|
GError *error = NULL;
|
|
|
|
/* One retry less */
|
|
ctx->retries--;
|
|
|
|
if (!mm_base_modem_at_command_full_finish (self, res, &error)) {
|
|
/* Consumed all retries... */
|
|
if (ctx->retries == 0) {
|
|
g_simple_async_result_take_error (ctx->result, error);
|
|
enabling_modem_init_context_complete_and_free (ctx);
|
|
return;
|
|
}
|
|
|
|
/* Retry... */
|
|
g_error_free (error);
|
|
retry_atz (ctx);
|
|
return;
|
|
}
|
|
|
|
/* Good! */
|
|
g_simple_async_result_set_op_res_gboolean (ctx->result, TRUE);
|
|
enabling_modem_init_context_complete_and_free (ctx);
|
|
}
|
|
|
|
static void
|
|
retry_atz (EnablingModemInitContext *ctx)
|
|
{
|
|
mm_base_modem_at_command_full (MM_BASE_MODEM (ctx->self),
|
|
mm_base_modem_peek_port_primary (MM_BASE_MODEM (ctx->self)),
|
|
"Z",
|
|
6,
|
|
FALSE,
|
|
FALSE,
|
|
NULL, /* cancellable */
|
|
(GAsyncReadyCallback)atz_ready,
|
|
ctx);
|
|
}
|
|
|
|
static void
|
|
enabling_modem_init (MMBroadbandModem *self,
|
|
GAsyncReadyCallback callback,
|
|
gpointer user_data)
|
|
{
|
|
EnablingModemInitContext *ctx;
|
|
|
|
ctx = g_slice_new0 (EnablingModemInitContext);
|
|
ctx->result = g_simple_async_result_new (G_OBJECT (self),
|
|
callback,
|
|
user_data,
|
|
enabling_modem_init);
|
|
ctx->self = g_object_ref (self);
|
|
|
|
/* Send the init command twice; some devices (Nokia N900) appear to take a
|
|
* few commands before responding correctly. Instead of penalizing them for
|
|
* being stupid the first time by failing to enable the device, just
|
|
* try again. */
|
|
ctx->retries = 2;
|
|
retry_atz (ctx);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
/* Setup ports (Broadband modem class) */
|
|
|
|
static const gchar *primary_init_sequence[] = {
|
|
/* When initializing a Nokia port, first enable the echo,
|
|
* and then disable it, so that we get it properly disabled. */
|
|
"E1 E0",
|
|
/* Get word responses */
|
|
"V1",
|
|
/* Extended numeric codes */
|
|
"+CMEE=1",
|
|
/* Report all call status */
|
|
"X4",
|
|
/* Assert DCD when carrier detected */
|
|
"&C1",
|
|
NULL
|
|
};
|
|
|
|
static void
|
|
setup_ports (MMBroadbandModem *self)
|
|
{
|
|
MMAtSerialPort *primary;
|
|
|
|
/* Call parent's setup ports first always */
|
|
MM_BROADBAND_MODEM_CLASS (mm_broadband_modem_nokia_parent_class)->setup_ports (self);
|
|
|
|
primary = mm_base_modem_peek_port_primary (MM_BASE_MODEM (self));
|
|
|
|
g_object_set (primary,
|
|
MM_AT_SERIAL_PORT_INIT_SEQUENCE, primary_init_sequence,
|
|
NULL);
|
|
}
|
|
|
|
/*****************************************************************************/
|
|
|
|
MMBroadbandModemNokia *
|
|
mm_broadband_modem_nokia_new (const gchar *device,
|
|
const gchar **drivers,
|
|
const gchar *plugin,
|
|
guint16 vendor_id,
|
|
guint16 product_id)
|
|
{
|
|
return g_object_new (MM_TYPE_BROADBAND_MODEM_NOKIA,
|
|
MM_BASE_MODEM_DEVICE, device,
|
|
MM_BASE_MODEM_DRIVERS, drivers,
|
|
MM_BASE_MODEM_PLUGIN, plugin,
|
|
MM_BASE_MODEM_VENDOR_ID, vendor_id,
|
|
MM_BASE_MODEM_PRODUCT_ID, product_id,
|
|
NULL);
|
|
}
|
|
|
|
static void
|
|
mm_broadband_modem_nokia_init (MMBroadbandModemNokia *self)
|
|
{
|
|
}
|
|
|
|
static void
|
|
iface_modem_messaging_init (MMIfaceModemMessaging *iface)
|
|
{
|
|
/* Don't even try to check messaging support */
|
|
iface->check_support = NULL;
|
|
iface->check_support_finish = NULL;
|
|
}
|
|
|
|
static void
|
|
iface_modem_init (MMIfaceModem *iface)
|
|
{
|
|
/* Create Nokia-specific SIM*/
|
|
iface->create_sim = create_sim;
|
|
iface->create_sim_finish = create_sim_finish;
|
|
|
|
/* Nokia handsets (at least N85) do not support "power on"; they do
|
|
* support "power off" but you proabably do not want to turn off the
|
|
* power on your telephone if something went wrong with connecting
|
|
* process. So, disabling both these operations. The Nokia GSM/UMTS command
|
|
* reference v1.2 also states that only CFUN=0 (turn off but still charge)
|
|
* and CFUN=1 (full functionality) are supported, and since the phone has
|
|
* to be in CFUN=1 before we'll be able to talk to it in the first place,
|
|
* we shouldn't bother with CFUN at all.
|
|
*/
|
|
iface->load_power_state = NULL;
|
|
iface->load_power_state_finish = NULL;
|
|
iface->modem_power_up = NULL;
|
|
iface->modem_power_up_finish = NULL;
|
|
iface->modem_power_down = NULL;
|
|
iface->modem_power_down_finish = NULL;
|
|
|
|
iface->load_supported_modes = modem_load_supported_modes;
|
|
iface->load_supported_modes_finish = modem_load_supported_modes_finish;
|
|
}
|
|
|
|
static void
|
|
mm_broadband_modem_nokia_class_init (MMBroadbandModemNokiaClass *klass)
|
|
{
|
|
MMBroadbandModemClass *broadband_modem_class = MM_BROADBAND_MODEM_CLASS (klass);
|
|
|
|
broadband_modem_class->setup_ports = setup_ports;
|
|
broadband_modem_class->enabling_modem_init = enabling_modem_init;
|
|
broadband_modem_class->enabling_modem_init_finish = enabling_modem_init_finish;
|
|
}
|