diff options
author | Aleksander Morgado <aleksander@lanedo.com> | 2012-08-23 18:53:51 +0200 |
---|---|---|
committer | Aleksander Morgado <aleksander@lanedo.com> | 2012-08-23 18:56:24 +0200 |
commit | e1aa7d376f27ab46a3f7711a2a0c0b0c4be913bd (patch) | |
tree | 4cf68aaaf50d18f915fc07042a9191d7be540299 /plugins/mm-modem-mbm.c | |
parent | 2d0cb24af86610032e4f797ccc407ec0722623bd (diff) |
mbm: plugin fully ported
Diffstat (limited to 'plugins/mm-modem-mbm.c')
-rw-r--r-- | plugins/mm-modem-mbm.c | 1068 |
1 files changed, 0 insertions, 1068 deletions
diff --git a/plugins/mm-modem-mbm.c b/plugins/mm-modem-mbm.c deleted file mode 100644 index 07fd389a..00000000 --- a/plugins/mm-modem-mbm.c +++ /dev/null @@ -1,1068 +0,0 @@ -/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */ -/* - * Copyright (C) 2008 - 2010 Ericsson AB - * Copyright (C) 2009 - 2011 Red Hat, Inc. - * - * Author: Per Hallsmark <per.hallsmark@ericsson.com> - * Bjorn Runaker <bjorn.runaker@ericsson.com> - * Torgny Johansson <torgny.johansson@ericsson.com> - * Jonas Sjöquist <jonas.sjoquist@ericsson.com> - * Dan Williams <dcbw@redhat.com> - * - * 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. - * - */ - -#include <stdlib.h> -#include <stdio.h> -#include <string.h> -#include <unistd.h> - -#include "mm-modem-mbm.h" -#include "mm-modem-simple.h" -#include "mm-modem-gsm-card.h" -#include "mm-errors.h" -#include "mm-callback-info.h" -#include "mm-log.h" - -static void modem_init (MMModem *modem_class); -static void modem_gsm_network_init (MMModemGsmNetwork *gsm_network_class); -static void modem_simple_init (MMModemSimple *class); -static void modem_gsm_card_init (MMModemGsmCard *class); - -G_DEFINE_TYPE_EXTENDED (MMModemMbm, mm_modem_mbm, MM_TYPE_GENERIC_GSM, 0, - G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM, modem_init) - G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM_GSM_NETWORK, modem_gsm_network_init) - G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM_SIMPLE, modem_simple_init) - G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM_GSM_CARD, modem_gsm_card_init)) - -#define MM_MODEM_MBM_GET_PRIVATE(o) (G_TYPE_INSTANCE_GET_PRIVATE ((o), MM_TYPE_MODEM_MBM, MMModemMbmPrivate)) - -#define MBM_E2NAP_DISCONNECTED 0 -#define MBM_E2NAP_CONNECTED 1 -#define MBM_E2NAP_CONNECTING 2 - -#define MBM_NETWORK_MODE_ANY 1 -#define MBM_NETWORK_MODE_2G 5 -#define MBM_NETWORK_MODE_3G 6 - -typedef struct { - guint reg_id; - gboolean have_emrdy; - char *network_device; - MMCallbackInfo *pending_connect_info; - int account_index; - int network_mode; - const char *username; - const char *password; -} MMModemMbmPrivate; - -enum { - PROP_0, - PROP_NETWORK_DEVICE, - - LAST_PROP -}; - -static void -mbm_modem_authenticate (MMModemMbm *self, - const char *username, - const char *password, - gpointer user_data); - -MMModem * -mm_modem_mbm_new (const char *device, - const char *driver, - const char *plugin, - 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_MBM, - MM_MODEM_MASTER_DEVICE, device, - MM_MODEM_DRIVER, driver, - MM_MODEM_PLUGIN, plugin, - MM_MODEM_IP_METHOD, MM_MODEM_IP_METHOD_DHCP, - MM_MODEM_HW_VID, vendor, - MM_MODEM_HW_PID, product, - NULL)); -} - -/*****************************************************************************/ -/* Gsm network class override functions */ -/*****************************************************************************/ - -typedef struct { - MMModemGsmNetwork *modem; - const char *network_id; - MMModemFn callback; - gpointer user_data; -} RegisterData; - -static gboolean -register_done (gpointer user_data) -{ - RegisterData *reg_data = user_data; - MMModemMbm *self = MM_MODEM_MBM (reg_data->modem); - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (self); - MMModemGsmNetwork *parent_modem_iface; - - priv->reg_id = 0; - - parent_modem_iface = g_type_interface_peek_parent (MM_MODEM_GSM_NETWORK_GET_INTERFACE (self)); - parent_modem_iface->do_register (MM_MODEM_GSM_NETWORK (self), - reg_data->network_id, - reg_data->callback, - reg_data->user_data); - return FALSE; -} - -static void -do_register (MMModemGsmNetwork *modem, - const char *network_id, - MMModemFn callback, - gpointer user_data) -{ - MMModemMbm *self = MM_MODEM_MBM (modem); - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (self); - RegisterData *reg_data; - - reg_data = g_malloc0 (sizeof(RegisterData)); - reg_data->modem = modem; - reg_data->network_id = network_id; - reg_data->callback = callback; - reg_data->user_data = user_data; - - /* wait so sim pin is done */ - if (priv->reg_id) - g_source_remove (priv->reg_id); - priv->reg_id = g_timeout_add_full (G_PRIORITY_DEFAULT, 500, - register_done, reg_data, - g_free); -} - -static int -mbm_parse_allowed_mode (MMModemGsmAllowedMode network_mode) -{ - switch (network_mode) { - case MM_MODEM_GSM_ALLOWED_MODE_ANY: - case MM_MODEM_GSM_ALLOWED_MODE_3G_PREFERRED: - case MM_MODEM_GSM_ALLOWED_MODE_2G_PREFERRED: - return MBM_NETWORK_MODE_ANY; - case MM_MODEM_GSM_ALLOWED_MODE_2G_ONLY: - return MBM_NETWORK_MODE_2G; - case MM_MODEM_GSM_ALLOWED_MODE_3G_ONLY: - return MBM_NETWORK_MODE_3G; - default: - return MBM_NETWORK_MODE_ANY; - } -} - -static void -mbm_set_allowed_mode_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - if (error) - info->error = g_error_copy (error); - - mm_callback_info_schedule (info); -} - -static void -set_allowed_mode (MMGenericGsm *gsm, - MMModemGsmAllowedMode mode, - MMModemFn callback, - gpointer user_data) -{ - MMCallbackInfo *info; - char *command; - MMAtSerialPort *port; - - info = mm_callback_info_new (MM_MODEM (gsm), callback, user_data); - - port = mm_generic_gsm_get_best_at_port (gsm, &info->error); - if (!port) { - mm_callback_info_schedule (info); - return; - } - - command = g_strdup_printf ("+CFUN=%d", mbm_parse_allowed_mode (mode)); - mm_at_serial_port_queue_command (port, command, 3, mbm_set_allowed_mode_done, info); - g_free (command); -} - -static void -mbm_erinfo_received (MMAtSerialPort *port, - GMatchInfo *info, - gpointer user_data) -{ - MMModemGsmAccessTech act = MM_MODEM_GSM_ACCESS_TECH_UNKNOWN; - char *str; - - str = g_match_info_fetch (info, 2); - if (str) { - switch (atoi (str)) { - case 1: - act = MM_MODEM_GSM_ACCESS_TECH_GPRS; - break; - case 2: - act = MM_MODEM_GSM_ACCESS_TECH_EDGE; - break; - default: - break; - } - } - g_free (str); - - /* 3G modes take precedence */ - str = g_match_info_fetch (info, 3); - if (str) { - switch (atoi (str)) { - case 1: - act = MM_MODEM_GSM_ACCESS_TECH_UMTS; - break; - case 2: - act = MM_MODEM_GSM_ACCESS_TECH_HSDPA; - break; - default: - break; - } - } - g_free (str); - - mm_generic_gsm_update_access_technology (MM_GENERIC_GSM (user_data), act); -} - -static void -get_allowed_mode_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - gboolean parsed = FALSE; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - if (error) - info->error = g_error_copy (error); - else if (!g_str_has_prefix (response->str, "CFUN: ")) { - MMModemGsmAllowedMode mode = MM_MODEM_GSM_ALLOWED_MODE_ANY; - int a; - - a = atoi (response->str + 6); - if (a == MBM_NETWORK_MODE_2G) - mode = MM_MODEM_GSM_ALLOWED_MODE_2G_ONLY; - else if (a == MBM_NETWORK_MODE_3G) - mode = MM_MODEM_GSM_ALLOWED_MODE_3G_ONLY; - - mm_callback_info_set_result (info, GUINT_TO_POINTER (mode), NULL); - parsed = TRUE; - } - - if (!error && !parsed) - info->error = g_error_new_literal (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL, - "Could not parse allowed mode results"); - - mm_callback_info_schedule (info); -} - -static void -get_allowed_mode (MMGenericGsm *gsm, - MMModemUIntFn callback, - gpointer user_data) -{ - MMCallbackInfo *info; - MMAtSerialPort *port; - - info = mm_callback_info_uint_new (MM_MODEM (gsm), callback, user_data); - - port = mm_generic_gsm_get_best_at_port (gsm, &info->error); - if (!port) { - mm_callback_info_schedule (info); - return; - } - - mm_at_serial_port_queue_command (port, "+CFUN?", 3, get_allowed_mode_done, info); -} - -/*****************************************************************************/ -/* Simple Modem class override functions */ -/*****************************************************************************/ - -static const char * -mbm_simple_get_string_property (GHashTable *properties, const char *name, GError **error) -{ - GValue *value; - - value = (GValue *) g_hash_table_lookup (properties, name); - if (!value) - return NULL; - - if (G_VALUE_HOLDS_STRING (value)) - return g_value_get_string (value); - - g_set_error (error, MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL, - "Invalid property type for '%s': %s (string expected)", - name, G_VALUE_TYPE_NAME (value)); - - return NULL; -} - -static void -simple_connect (MMModemSimple *simple, - GHashTable *properties, - MMModemFn callback, - gpointer user_data) -{ - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (simple); - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - MMModemSimple *parent_iface; - - priv->username = mbm_simple_get_string_property (properties, "username", &info->error); - priv->password = mbm_simple_get_string_property (properties, "password", &info->error); - - parent_iface = g_type_interface_peek_parent (MM_MODEM_SIMPLE_GET_INTERFACE (simple)); - parent_iface->connect (MM_MODEM_SIMPLE (simple), properties, callback, info); -} - -/*****************************************************************************/ -/* Modem class override functions */ -/*****************************************************************************/ - -static void -mbm_enable_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - /* Start unsolicited signal strength and access technology responses */ - mm_at_serial_port_queue_command (port, "*ERINFO=1", 3, NULL, NULL); - - mm_generic_gsm_enable_complete (MM_GENERIC_GSM (info->modem), error, info); -} - -static void -mbm_enap0_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = user_data; - MMModemMbmPrivate *priv; - char *command; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - priv = MM_MODEM_MBM_GET_PRIVATE (info->modem); - - if (!priv->network_mode) - priv->network_mode = MBM_NETWORK_MODE_ANY; - - command = g_strdup_printf ("+CFUN=%d", priv->network_mode); - mm_at_serial_port_queue_command (port, command, 3, mbm_enable_done, info); - g_free (command); -} - -static void -mbm_init_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = user_data; - MMModemMbmPrivate *priv; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - priv = MM_MODEM_MBM_GET_PRIVATE (info->modem); - - if (error) { - mm_generic_gsm_enable_complete (MM_GENERIC_GSM (info->modem), error, info); - return; - } - - if (!priv->network_mode) - priv->network_mode = MBM_NETWORK_MODE_ANY; - - mm_at_serial_port_queue_command (port, "*ENAP=0", 3, mbm_enap0_done, info); -} - -static void -do_init (MMAtSerialPort *port, MMCallbackInfo *info) -{ - mm_at_serial_port_queue_command (port, "&F E0 V1 X4 &C1 +CMEE=1", 3, mbm_init_done, info); -} - -static void -mbm_emrdy_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = user_data; - MMModemMbmPrivate *priv; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - /* EMRDY unsolicited response might have happened between the command - * submission and the response. This was seen once: - * - * (ttyACM0): --> 'AT*EMRDY?<CR>' - * (ttyACM0): <-- 'T*EMRD<CR><LF>*EMRDY: 1<CR><LF>Y?' - * - * So suppress the warning if the unsolicited handler handled the response - * before we get here. - */ - priv = MM_MODEM_MBM_GET_PRIVATE (info->modem); - if (!priv->have_emrdy) { - if (g_error_matches (error, MM_SERIAL_ERROR, MM_SERIAL_ERROR_RESPONSE_TIMEOUT)) - mm_warn ("timed out waiting for EMRDY response."); - else - priv->have_emrdy = TRUE; - } - - do_init (port, info); -} - -static void -do_enable (MMGenericGsm *self, MMModemFn callback, gpointer user_data) -{ - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (self); - MMCallbackInfo *info; - MMAtSerialPort *primary; - - info = mm_callback_info_new (MM_MODEM (self), callback, user_data); - - primary = mm_generic_gsm_get_at_port (self, MM_AT_PORT_FLAG_PRIMARY); - g_assert (primary); - - if (priv->have_emrdy) { - /* Modem is ready, no need to check EMRDY */ - do_init (primary, info); - } else - mm_at_serial_port_queue_command (primary, "*EMRDY?", 5, mbm_emrdy_done, info); -} - -/*****************************************************************************/ - -static void -disable_unsolicited_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) - -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - /* Ignore all errors */ - mm_callback_info_schedule (info); -} - -static void -invoke_call_parent_disable_fn (MMCallbackInfo *info) -{ - /* Note: we won't call the parent disable if info->modem is no longer - * valid. The invoke is called always once the info gets scheduled, which - * may happen during removed modem detection. */ - if (info->modem) { - MMModem *parent_modem_iface; - - parent_modem_iface = g_type_interface_peek_parent (MM_MODEM_GET_INTERFACE (info->modem)); - parent_modem_iface->disable (info->modem, (MMModemFn)info->callback, info->user_data); - } -} - -static void -disable (MMModem *modem, - MMModemFn callback, - gpointer user_data) -{ - MMAtSerialPort *primary; - MMCallbackInfo *info; - - info = mm_callback_info_new_full (modem, - invoke_call_parent_disable_fn, - (GCallback)callback, - user_data); - - primary = mm_generic_gsm_get_at_port (MM_GENERIC_GSM (modem), MM_AT_PORT_FLAG_PRIMARY); - g_assert (primary); - - /* Turn off unsolicited responses */ - mm_at_serial_port_queue_command (primary, "*ERINFO=0", 5, disable_unsolicited_done, info); -} - -static void -do_connect (MMModem *modem, - const char *number, - MMModemFn callback, - gpointer user_data) -{ - MMCallbackInfo *info; - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (modem); - - mm_modem_set_state (modem, MM_MODEM_STATE_CONNECTING, MM_MODEM_STATE_REASON_NONE); - - info = mm_callback_info_new (modem, callback, user_data); - priv->pending_connect_info = info; - - mbm_modem_authenticate (MM_MODEM_MBM (modem), priv->username, priv->password, info); -} - -static void -do_disconnect (MMGenericGsm *gsm, - gint cid, - MMModemFn callback, - gpointer user_data) -{ - MMAtSerialPort *primary; - - primary = mm_generic_gsm_get_at_port (gsm, MM_AT_PORT_FLAG_PRIMARY); - g_assert (primary); - mm_at_serial_port_queue_command (primary, "*ENAP=0", 3, NULL, NULL); - - MM_GENERIC_GSM_CLASS (mm_modem_mbm_parent_class)->do_disconnect (gsm, cid, callback, user_data); -} - -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_gsm_get_best_at_port (MM_GENERIC_GSM (modem), &info->error); - if (port) - mm_at_serial_port_queue_command (port, "*E2RESET", 3, NULL, NULL); - - mm_callback_info_schedule (info); -} - -static void -factory_reset_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - mm_serial_port_close (MM_SERIAL_PORT (port)); - mm_callback_info_schedule (info); -} - -static void -factory_reset (MMModem *self, - const char *code, - MMModemFn callback, - gpointer user_data) -{ - MMAtSerialPort *port; - MMCallbackInfo *info; - - info = mm_callback_info_new (self, callback, user_data); - - /* Ensure we have a usable port to use for the command */ - port = mm_generic_gsm_get_best_at_port (MM_GENERIC_GSM (self), &info->error); - if (!port) { - mm_callback_info_schedule (info); - return; - } - - /* Modem may not be enabled yet, which sometimes can't be done until - * the device has been unlocked. In this case we have to open the port - * ourselves. - */ - if (!mm_serial_port_open (MM_SERIAL_PORT (port), &info->error)) { - mm_callback_info_schedule (info); - return; - } - - mm_at_serial_port_queue_command (port, "&F +CMEE=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+COPS=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CR=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CRC=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CREG=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CMER=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "*EPEE=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CNMI=2, 0, 0, 0, 0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CGREG=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "*EIAD=0", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CGSMS=3", 3, NULL, NULL); - mm_at_serial_port_queue_command (port, "+CSCA=\"\",129", 3, factory_reset_done, info); -} - -/*****************************************************************************/ - -static void -mbm_emrdy_received (MMAtSerialPort *port, - GMatchInfo *info, - gpointer user_data) -{ - MM_MODEM_MBM_GET_PRIVATE (user_data)->have_emrdy = TRUE; -} - -static void -mbm_pacsp_received (MMAtSerialPort *port, - GMatchInfo *info, - gpointer user_data) -{ - return; -} - -static void -mbm_do_connect_done (MMModemMbm *self, gboolean success) -{ - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (self); - - if (!priv->pending_connect_info) - return; - - if (success) - mm_generic_gsm_connect_complete (MM_GENERIC_GSM (self), NULL, priv->pending_connect_info); - else { - GError *connect_error; - - connect_error = mm_modem_connect_error_for_code (MM_MODEM_CONNECT_ERROR_BUSY); - mm_generic_gsm_connect_complete (MM_GENERIC_GSM (self), connect_error, priv->pending_connect_info); - g_error_free (connect_error); - } - priv->pending_connect_info = NULL; -} - -static void -mbm_e2nap_received (MMAtSerialPort *port, - GMatchInfo *info, - gpointer user_data) -{ - int state = 0; - char *str; - - str = g_match_info_fetch (info, 1); - if (str) - state = atoi (str); - g_free (str); - - if (MBM_E2NAP_DISCONNECTED == state) { - mm_dbg ("disconnected"); - mbm_do_connect_done (MM_MODEM_MBM (user_data), FALSE); - } else if (MBM_E2NAP_CONNECTED == state) { - mm_dbg ("connected"); - mbm_do_connect_done (MM_MODEM_MBM (user_data), TRUE); - } else if (MBM_E2NAP_CONNECTING == state) - mm_dbg ("connecting"); - else { - /* Should not happen */ - mm_dbg ("unhandled E2NAP state %d", state); - mbm_do_connect_done (MM_MODEM_MBM (user_data), FALSE); - } -} - -static void -enap_poll_response (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - guint state; - guint count; - - g_assert (info); - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - count = GPOINTER_TO_UINT (mm_callback_info_get_data (info, "mbm-enap-poll-count")); - - if ( response - && sscanf (response->str, "*ENAP: %d", &state) == 1 - && state == 1) { - /* Success! Connected... */ - mm_generic_gsm_connect_complete (MM_GENERIC_GSM (info->modem), NULL, info); - return; - } - - mm_callback_info_set_data (info, "mbm-enap-poll-count", GUINT_TO_POINTER (++count), NULL); - - /* lets give it about 50 seconds */ - if (count > 50) { - GError *poll_error; - - poll_error = mm_modem_connect_error_for_code (MM_MODEM_CONNECT_ERROR_BUSY); - mm_generic_gsm_connect_complete (MM_GENERIC_GSM (info->modem), poll_error, info); - g_error_free (poll_error); - } -} - -static gboolean -enap_poll (gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - MMAtSerialPort *port; - - port = mm_generic_gsm_get_at_port (MM_GENERIC_GSM (info->modem), MM_AT_PORT_FLAG_PRIMARY); - g_assert (port); - - mm_at_serial_port_queue_command (port, "AT*ENAP?", 3, enap_poll_response, user_data); - /* we cancel this in the _done function if all is fine */ - return TRUE; -} - -static void -enap_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - guint tid; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - if (error) { - mm_generic_gsm_connect_complete (MM_GENERIC_GSM (info->modem), error, info); - return; - } - - tid = g_timeout_add_seconds (1, enap_poll, user_data); - /* remember poll id as callback info object, with source_remove as free func */ - mm_callback_info_set_data (info, "mbm-enap-poll-id", GUINT_TO_POINTER (tid), (GFreeFunc) g_source_remove); -} - -static void -mbm_auth_done (MMSerialPort *port, - GByteArray *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - MMGenericGsm *modem = MM_GENERIC_GSM (info->modem); - char *command; - - if (error) { - mm_generic_gsm_connect_complete (modem, error, info); - return; - } - - mm_at_serial_port_queue_command (MM_AT_SERIAL_PORT (port), "AT*E2NAP=1", 3, NULL, NULL); - - command = g_strdup_printf ("AT*ENAP=1,%d", mm_generic_gsm_get_cid (modem)); - mm_at_serial_port_queue_command (MM_AT_SERIAL_PORT (port), command, 3, enap_done, user_data); - g_free (command); -} - -static void -mbm_modem_authenticate (MMModemMbm *self, - const char *username, - const char *password, - gpointer user_data) -{ - MMAtSerialPort *primary; - - primary = mm_generic_gsm_get_at_port (MM_GENERIC_GSM (self), MM_AT_PORT_FLAG_PRIMARY); - g_assert (primary); - - if (username || password) { - GByteArray *command; - MMModemCharset cur_set; - char *tmp; - - /* F3507g at least wants the username and password to be sent in the - * modem's current character set. - */ - cur_set = mm_generic_gsm_get_charset (MM_GENERIC_GSM (self)); - - command = g_byte_array_sized_new (75); - tmp = g_strdup_printf ("AT*EIAAUW=%d,1,", mm_generic_gsm_get_cid (MM_GENERIC_GSM (self))); - g_byte_array_append (command, (const guint8 *) tmp, strlen (tmp)); - g_free (tmp); - - if (username) - mm_modem_charset_byte_array_append (command, username, TRUE, cur_set); - else - g_byte_array_append (command, (const guint8 *) "\"\"", 2); - - g_byte_array_append (command, (const guint8 *) ",", 1); - - if (password) - mm_modem_charset_byte_array_append (command, password, TRUE, cur_set); - else - g_byte_array_append (command, (const guint8 *) "\"\"", 2); - - g_byte_array_append (command, (const guint8 *) "\r", 1); - - mm_serial_port_queue_command (MM_SERIAL_PORT (primary), - command, - TRUE, - 3, - mbm_auth_done, - user_data); - } else - mbm_auth_done (MM_SERIAL_PORT (primary), NULL, NULL, user_data); -} - -/*****************************************************************************/ - -static void -send_epin_done (MMAtSerialPort *port, - GString *response, - GError *error, - gpointer user_data) -{ - MMCallbackInfo *info = (MMCallbackInfo *) user_data; - int matched; - GArray *retry_counts; - PinRetryCount ur[4] = { - {"sim-pin", 0}, {"sim-puk", 0}, {"sim-pin2", 0}, {"sim-puk2", 0} - }; - - /* If the modem has already been removed, return without - * scheduling callback */ - if (mm_callback_info_check_modem_removed (info)) - return; - - if (error) { - info->error = g_error_copy (error); - goto done; - } - - matched = sscanf (response->str, "*EPIN: %d, %d, %d, %d", - &ur[0].count, &ur[1].count, &ur[2].count, &ur[3].count); - if (matched == 4) { - if (ur[0].count > 998) { - info->error = g_error_new (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL, - "Invalid PIN attempts left %d", ur[0].count); - ur[0].count = 0; - } - - retry_counts = g_array_sized_new (FALSE, TRUE, sizeof (PinRetryCount), 4); - g_array_append_vals (retry_counts, &ur, 4); - mm_callback_info_set_result (info, retry_counts, NULL); - } else { - info->error = g_error_new_literal (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL, - "Could not parse PIN retries results"); - } - -done: - mm_serial_port_close (MM_SERIAL_PORT (port)); - mm_callback_info_schedule (info); -} - -static void -mbm_get_unlock_retries (MMModemGsmCard *modem, - MMModemArrayFn callback, - gpointer user_data) -{ - MMAtSerialPort *port; - char *command; - MMCallbackInfo *info = mm_callback_info_array_new (MM_MODEM (modem), callback, user_data); - - /* Ensure we have a usable port to use for the command */ - port = mm_generic_gsm_get_best_at_port (MM_GENERIC_GSM (modem), &info->error); - if (!port) { - mm_callback_info_schedule (info); - return; - } - - /* Modem may not be enabled yet, which sometimes can't be done until - * the device has been unlocked. In this case we have to open the port - * ourselves. - */ - if (!mm_serial_port_open (MM_SERIAL_PORT (port), &info->error)) { - mm_callback_info_schedule (info); - return; - } - - /* if the modem have not yet been enabled we need to make sure echoing is turned off */ - command = g_strdup_printf ("E0"); - mm_at_serial_port_queue_command (port, command, 3, NULL, NULL); - g_free (command); - - command = g_strdup_printf ("*EPIN?"); - mm_at_serial_port_queue_command (port, command, 3, send_epin_done, info); - g_free (command); -} - -/*****************************************************************************/ - -static void -port_grabbed (MMGenericGsm *gsm, - MMPort *port, - MMAtPortFlags pflags, - gpointer user_data) -{ - GRegex *regex; - - if (MM_IS_AT_SERIAL_PORT (port)) { - /* The Ericsson modems always have a free AT command port, so we - * don't need to flash the ports when disconnecting to get back to - * command mode. F5521gw R2A07 resets port properties like echo when - * flashed, leading to confusion. bgo #650740 - */ - g_object_set (G_OBJECT (port), MM_SERIAL_PORT_FLASH_OK, FALSE, NULL); - - regex = g_regex_new ("\\r\\n\\*EMRDY: \\d\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); - mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, mbm_emrdy_received, gsm, NULL); - g_regex_unref (regex); - - regex = g_regex_new ("\\r\\n\\+PACSP(\\d)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); - mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, mbm_pacsp_received, gsm, NULL); - g_regex_unref (regex); - - /* also consume unsolicited mbm messages we are not interested in them - see LP: #416418 */ - regex = g_regex_new ("\\R\\*ESTKSMENU:.*\\R", G_REGEX_RAW | G_REGEX_OPTIMIZE | G_REGEX_MULTILINE | G_REGEX_NEWLINE_CRLF, G_REGEX_MATCH_NEWLINE_CRLF, NULL); - mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, NULL, NULL, NULL); - g_regex_unref (regex); - - regex = g_regex_new ("\\r\\n\\*EMWI: (\\d),(\\d).*\\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); - - regex = g_regex_new ("\\r\\n\\*ERINFO:\\s*(\\d),(\\d),(\\d).*\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); - mm_at_serial_port_add_unsolicited_msg_handler (MM_AT_SERIAL_PORT (port), regex, mbm_erinfo_received, gsm, NULL); - g_regex_unref (regex); - } -} - -static void -ports_organized (MMGenericGsm *gsm, MMAtSerialPort *primary) -{ - GRegex *regex; - - /* Only listen on the primary port for connect status responses */ - regex = g_regex_new ("\\r\\n\\*E2NAP: (\\d)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); - mm_at_serial_port_add_unsolicited_msg_handler (primary, regex, mbm_e2nap_received, gsm, NULL); - g_regex_unref (regex); - - /* Catch the extended error status bit of the command too */ - regex = g_regex_new ("\\r\\n\\*E2NAP: (\\d),.*\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); - mm_at_serial_port_add_unsolicited_msg_handler (primary, regex, mbm_e2nap_received, gsm, NULL); - g_regex_unref (regex); -} - -/*****************************************************************************/ - -static void -modem_gsm_card_init (MMModemGsmCard *class) -{ - class->get_unlock_retries = mbm_get_unlock_retries; -} - -static void -modem_gsm_network_init (MMModemGsmNetwork *class) -{ - class->do_register = do_register; -} - -static void -modem_simple_init (MMModemSimple *class) -{ - class->connect = simple_connect; -} - -static void -modem_init (MMModem *modem_class) -{ - modem_class->disable = disable; - modem_class->connect = do_connect; - modem_class->reset = reset; - modem_class->factory_reset = factory_reset; -} - -static void -mm_modem_mbm_init (MMModemMbm *self) -{ -} - -static void -finalize (GObject *object) -{ - MMModemMbmPrivate *priv = MM_MODEM_MBM_GET_PRIVATE (object); - - if (priv->reg_id) - g_source_remove (priv->reg_id); - - g_free (priv->network_device); - - G_OBJECT_CLASS (mm_modem_mbm_parent_class)->finalize (object); -} - -static void -mm_modem_mbm_class_init (MMModemMbmClass *klass) -{ - GObjectClass *object_class = G_OBJECT_CLASS (klass); - MMGenericGsmClass *gsm_class = MM_GENERIC_GSM_CLASS (klass); - - mm_modem_mbm_parent_class = g_type_class_peek_parent (klass); - g_type_class_add_private (object_class, sizeof (MMModemMbmPrivate)); - - /* Virtual methods */ - object_class->finalize = finalize; - - gsm_class->port_grabbed = port_grabbed; - gsm_class->ports_organized = ports_organized; - gsm_class->do_enable = do_enable; - gsm_class->do_disconnect = do_disconnect; - gsm_class->get_allowed_mode = get_allowed_mode; - gsm_class->set_allowed_mode = set_allowed_mode; -} - |