/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */ #include #include #include #include "mm-modem-huawei.h" #include "mm-modem-gsm-network.h" #include "mm-errors.h" #include "mm-callback-info.h" #include "mm-util.h" #include "mm-serial-parsers.h" static gpointer mm_modem_huawei_parent_class = NULL; static void pending_registration_stop (MMModemHuawei *self); #define MM_MODEM_HUAWEI_GET_PRIVATE(o) (G_TYPE_INSTANCE_GET_PRIVATE ((o), MM_TYPE_MODEM_HUAWEI, MMModemHuaweiPrivate)) typedef struct { MMSerial *monitor_device; gpointer std_parser; /* Unsolicited message regexps */ GRegex *signal_quality_regex; GRegex *mode_regex; GRegex *status_regex; GRegex *reg_state_regex; /* Pending operations */ guint pending_registration; /* Cached state */ MMModemGsmNetworkRegStatus reg_status; guint signal_quality; MMModemGsmNetworkMode mode; MMModemGsmNetworkBand band; } MMModemHuaweiPrivate; MMModem * mm_modem_huawei_new (const char *data_device, const char *monitor_device, const char *driver) { g_return_val_if_fail (data_device != NULL, NULL); g_return_val_if_fail (monitor_device != NULL, NULL); g_return_val_if_fail (driver != NULL, NULL); return MM_MODEM (g_object_new (MM_TYPE_MODEM_HUAWEI, MM_SERIAL_DEVICE, monitor_device, MM_MODEM_DATA_DEVICE, data_device, MM_MODEM_DRIVER, driver, NULL)); } static void reg_status_updated (MMModemHuawei *self, int new_status) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (self); switch (new_status) { case 0: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_IDLE; break; case 1: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_HOME; break; case 2: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_SEARCHING; break; case 3: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_DENIED; break; case 4: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_UNKNOWN; break; case 5: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_ROAMING; break; default: priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_UNKNOWN; break; } /* Stop the pending registration in case of success or certain failure */ if (priv->reg_status == MM_MODEM_GSM_NETWORK_REG_STATUS_HOME || priv->reg_status == MM_MODEM_GSM_NETWORK_REG_STATUS_ROAMING || priv->reg_status == MM_MODEM_GSM_NETWORK_REG_STATUS_DENIED) pending_registration_stop (self); g_debug ("Registration state changed: %d\n", priv->reg_status); mm_generic_gsm_set_reg_status (MM_GENERIC_GSM (self), priv->reg_status); } static void got_reg_status (MMSerial *serial, GString *response, GError *error, gpointer user_data) { if (error) g_warning ("Error getting registration status: %s", error->message); else if (g_str_has_prefix (response->str, "+CREG: ")) { /* Got valid reply */ int n, stat; if (sscanf (response->str + 7, "%d,%d", &n, &stat)) reg_status_updated (MM_MODEM_HUAWEI (serial), stat); } } static void parent_enable_done (MMModem *modem, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; if (error) info->error = g_error_copy (error); else { /* Enable unsolicited registration state changes and get the current state */ mm_serial_queue_command (MM_SERIAL (modem), "+CREG=1", 5, NULL, NULL); mm_serial_queue_command (MM_SERIAL (modem), "+CREG?", 5, got_reg_status, NULL); } mm_callback_info_schedule (info); } static void enable (MMModem *modem, gboolean enable, MMModemFn callback, gpointer user_data) { MMModem *parent_modem_iface; parent_modem_iface = g_type_interface_peek_parent (MM_MODEM_GET_INTERFACE (modem)); if (enable) { MMCallbackInfo *info; info = mm_callback_info_new (modem, callback, user_data); parent_modem_iface->enable (modem, enable, parent_enable_done, info); } else { pending_registration_stop (MM_MODEM_HUAWEI (modem)); parent_modem_iface->enable (modem, enable, callback, user_data); } } static void pending_registration_set (MMModemHuawei *self, guint tag) { MM_MODEM_HUAWEI_GET_PRIVATE (self)->pending_registration = tag; } static void pending_registration_stop (MMModemHuawei *self) { guint tag; tag = MM_MODEM_HUAWEI_GET_PRIVATE (self)->pending_registration; if (tag) g_source_remove (tag); } static void pending_registration_cleanup (gpointer data) { MMCallbackInfo *info = (MMCallbackInfo *) data; if (!info->error) { switch (MM_MODEM_HUAWEI_GET_PRIVATE (info->modem)->reg_status) { case MM_MODEM_GSM_NETWORK_REG_STATUS_HOME: case MM_MODEM_GSM_NETWORK_REG_STATUS_ROAMING: /* Successfully registered */ break; case MM_MODEM_GSM_NETWORK_REG_STATUS_DENIED: info->error = mm_mobile_error_for_code (MM_MOBILE_ERROR_NETWORK_NOT_ALLOWED); break; case MM_MODEM_GSM_NETWORK_REG_STATUS_SEARCHING: info->error = mm_mobile_error_for_code (MM_MOBILE_ERROR_NETWORK_TIMEOUT); break; case MM_MODEM_GSM_NETWORK_REG_STATUS_IDLE: info->error = mm_mobile_error_for_code (MM_MOBILE_ERROR_NO_NETWORK); break; default: info->error = mm_mobile_error_for_code (MM_MOBILE_ERROR_UNKNOWN); break; } } pending_registration_set (MM_MODEM_HUAWEI (info->modem), 0); mm_callback_info_schedule (info); } static gboolean pending_registration_timed_out (gpointer data) { return FALSE; } static void register_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; if (error) { info->error = g_error_copy (error); mm_callback_info_schedule (info); } else { /* Add a timeout to wait for the unsolicited "connected" message */ pending_registration_set (MM_MODEM_HUAWEI (serial), g_timeout_add_seconds_full (G_PRIORITY_DEFAULT, 60, pending_registration_timed_out, info, pending_registration_cleanup)); mm_serial_queue_command (serial, "+CREG?", 5, got_reg_status, NULL); } } static void do_register (MMModemGsmNetwork *modem, const char *network_id, MMModemFn callback, gpointer user_data) { MMCallbackInfo *info; char *command; info = mm_callback_info_new (MM_MODEM (modem), callback, user_data); if (network_id) command = g_strdup_printf ("+COPS=1,2,\"%s\"", network_id); else command = g_strdup ("+COPS=0,,"); mm_serial_queue_command (MM_SERIAL (modem), command, 5, register_done, info); g_free (command); } static gboolean parse_syscfg (MMModemHuawei *self, const char *reply, int *mode_a, int *mode_b, guint32 *band, int *unknown1, int *unknown2) { if (reply == NULL || strncmp (reply, "^SYSCFG:", 8)) return FALSE; if (sscanf (reply + 8, "%d,%d,%x,%d,%d", mode_a, mode_b, band, unknown1, unknown2)) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (self); /* Network mode */ if (*mode_a == 2 && *mode_b == 1) priv->mode = MM_MODEM_GSM_NETWORK_MODE_PREFER_2G; else if (*mode_a == 2 && *mode_b == 2) priv->mode = MM_MODEM_GSM_NETWORK_MODE_PREFER_3G; else if (*mode_a == 13 && *mode_b == 1) priv->mode = MM_MODEM_GSM_NETWORK_MODE_GPRS; else if (*mode_a == 14 && *mode_b == 2) priv->mode = MM_MODEM_GSM_NETWORK_MODE_3G; /* Band */ if (*band == 0x3FFFFFFF) priv->band = MM_MODEM_GSM_NETWORK_BAND_ANY; else if (*band == 0x400380) priv->band = MM_MODEM_GSM_NETWORK_BAND_DCS; else if (*band == 0x200000) priv->band = MM_MODEM_GSM_NETWORK_BAND_PCS; return TRUE; } return FALSE; } static void set_network_mode_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; if (error) info->error = g_error_copy (error); else /* Success, cache the value */ MM_MODEM_HUAWEI_GET_PRIVATE (serial)->mode = GPOINTER_TO_UINT (mm_callback_info_get_data (info, "mode")); mm_callback_info_schedule (info); } static void set_network_mode_get_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; if (error) { info->error = g_error_copy (error); mm_callback_info_schedule (info); } else { int a, b, u1, u2; guint32 band; if (parse_syscfg (MM_MODEM_HUAWEI (serial), response->str, &a, &b, &band, &u1, &u2)) { char *command; switch (GPOINTER_TO_UINT (mm_callback_info_get_data (info, "mode"))) { case MM_MODEM_GSM_NETWORK_MODE_GPRS: case MM_MODEM_GSM_NETWORK_MODE_EDGE: a = 13; b = 1; break; case MM_MODEM_GSM_NETWORK_MODE_3G: case MM_MODEM_GSM_NETWORK_MODE_HSDPA: a = 14; b = 2; break; case MM_MODEM_GSM_NETWORK_MODE_PREFER_2G: a = 2; b = 1; break; case MM_MODEM_GSM_NETWORK_MODE_PREFER_3G: a = 2; b = 2; break; default: break; } command = g_strdup_printf ("AT^SYSCFG=%d,%d,%X,%d,%d", a, b, band, u1, u2); mm_serial_queue_command (serial, command, 3, set_network_mode_done, info); g_free (command); } } } static void set_network_mode (MMModemGsmNetwork *modem, MMModemGsmNetworkMode mode, MMModemFn callback, gpointer user_data) { MMCallbackInfo *info; info = mm_callback_info_new (MM_MODEM (modem), callback, user_data); switch (mode) { case MM_MODEM_GSM_NETWORK_MODE_ANY: /* Do nothing */ break; case MM_MODEM_GSM_NETWORK_MODE_GPRS: case MM_MODEM_GSM_NETWORK_MODE_EDGE: case MM_MODEM_GSM_NETWORK_MODE_3G: case MM_MODEM_GSM_NETWORK_MODE_HSDPA: case MM_MODEM_GSM_NETWORK_MODE_PREFER_2G: case MM_MODEM_GSM_NETWORK_MODE_PREFER_3G: /* Allowed values */ mm_callback_info_set_data (info, "mode", GUINT_TO_POINTER (mode), NULL); mm_serial_queue_command (MM_SERIAL (modem), "AT^SYSCFG?", 3, set_network_mode_get_done, info); return; break; default: info->error = g_error_new_literal (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL, "Invalid mode."); break; } mm_callback_info_schedule (info); } static void get_network_mode_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; int mode_a, mode_b, u1, u2; guint32 band; if (error) info->error = g_error_copy (error); else if (parse_syscfg (MM_MODEM_HUAWEI (serial), response->str, &mode_a, &mode_b, &band, &u1, &u2)) mm_callback_info_set_result (info, GUINT_TO_POINTER (MM_MODEM_HUAWEI_GET_PRIVATE (serial)->mode), NULL); mm_callback_info_schedule (info); } static void get_network_mode (MMModemGsmNetwork *modem, MMModemUIntFn callback, gpointer user_data) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (modem); if (priv->mode != MM_MODEM_GSM_NETWORK_MODE_ANY) { /* have cached mode (from an unsolicited message). Use that */ MMCallbackInfo *info; info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data); mm_callback_info_set_result (info, GUINT_TO_POINTER (priv->mode), NULL); mm_callback_info_schedule (info); } else { /* Get it from modem */ MMCallbackInfo *info; info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data); mm_serial_queue_command (MM_SERIAL (modem), "AT^SYSCFG?", 3, get_network_mode_done, info); } } static void set_band_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; if (error) info->error = g_error_copy (error); else /* Success, cache the value */ MM_MODEM_HUAWEI_GET_PRIVATE (serial)->band = GPOINTER_TO_UINT (mm_callback_info_get_data (info, "band")); mm_callback_info_schedule (info); } static void set_band_get_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; if (error) { info->error = g_error_copy (error); mm_callback_info_schedule (info); } else { int a, b, u1, u2; guint32 band; if (parse_syscfg (MM_MODEM_HUAWEI (serial), response->str, &a, &b, &band, &u1, &u2)) { char *command; switch (GPOINTER_TO_UINT (mm_callback_info_get_data (info, "band"))) { case MM_MODEM_GSM_NETWORK_BAND_ANY: band = 0x3FFFFFFF; break; case MM_MODEM_GSM_NETWORK_BAND_EGSM: case MM_MODEM_GSM_NETWORK_BAND_DCS: case MM_MODEM_GSM_NETWORK_BAND_U2100: band = 0x400380; break; case MM_MODEM_GSM_NETWORK_BAND_PCS: band = 0x200000; break; default: break; } command = g_strdup_printf ("AT^SYSCFG=%d,%d,%X,%d,%d", a, b, band, u1, u2); mm_serial_queue_command (serial, command, 3, set_band_done, info); g_free (command); } } } static void set_band (MMModemGsmNetwork *modem, MMModemGsmNetworkBand band, MMModemFn callback, gpointer user_data) { MMCallbackInfo *info; info = mm_callback_info_new (MM_MODEM (modem), callback, user_data); switch (band) { case MM_MODEM_GSM_NETWORK_BAND_ANY: case MM_MODEM_GSM_NETWORK_BAND_EGSM: case MM_MODEM_GSM_NETWORK_BAND_DCS: case MM_MODEM_GSM_NETWORK_BAND_U2100: case MM_MODEM_GSM_NETWORK_BAND_PCS: mm_callback_info_set_data (info, "band", GUINT_TO_POINTER (band), NULL); mm_serial_queue_command (MM_SERIAL (modem), "AT^SYSCFG?", 3, set_band_get_done, info); break; default: info->error = g_error_new_literal (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL, "Invalid band."); mm_callback_info_schedule (info); break; } } static void get_band_done (MMSerial *serial, GString *response, GError *error, gpointer user_data) { MMCallbackInfo *info = (MMCallbackInfo *) user_data; int mode_a, mode_b, u1, u2; guint32 band; if (error) info->error = g_error_copy (error); else if (parse_syscfg (MM_MODEM_HUAWEI (serial), response->str, &mode_a, &mode_b, &band, &u1, &u2)) mm_callback_info_set_result (info, GUINT_TO_POINTER (MM_MODEM_HUAWEI_GET_PRIVATE (serial)->band), NULL); mm_callback_info_schedule (info); } static void get_band (MMModemGsmNetwork *modem, MMModemUIntFn callback, gpointer user_data) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (modem); if (priv->band != MM_MODEM_GSM_NETWORK_BAND_ANY) { /* have cached mode (from an unsolicited message). Use that */ MMCallbackInfo *info; info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data); mm_callback_info_set_result (info, GUINT_TO_POINTER (priv->band), NULL); mm_callback_info_schedule (info); } else { /* Get it from modem */ MMCallbackInfo *info; info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data); mm_serial_queue_command (MM_SERIAL (modem), "AT^SYSCFG?", 3, get_band_done, info); } } static void get_signal_quality (MMModemGsmNetwork *modem, MMModemUIntFn callback, gpointer user_data) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (modem); if (priv->signal_quality) { /* have cached signal quality (from an unsolicited message). Use that */ MMCallbackInfo *info; info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data); mm_callback_info_set_result (info, GUINT_TO_POINTER (priv->signal_quality), NULL); mm_callback_info_schedule (info); } else { /* Use the generic implementation */ MMModemGsmNetwork *parent_gsm_network_iface; parent_gsm_network_iface = g_type_interface_peek_parent (MM_MODEM_GSM_NETWORK_GET_INTERFACE (modem)); parent_gsm_network_iface->get_signal_quality (modem, callback, user_data); } } /* Unsolicited messages */ static void handle_signal_quality_change (const char *str, gpointer data) { int quality = atoi (str); if (quality == 99) /* 99 means unknown */ quality = 0; else /* Normalize the quality */ quality = quality * 100 / 31; g_debug ("Signal quality: %d", quality); MM_MODEM_HUAWEI_GET_PRIVATE (data)->signal_quality = (guint32) quality; mm_modem_gsm_network_signal_quality (MM_MODEM_GSM_NETWORK (data), (guint32) quality); } static void handle_mode_change (const char *str, gpointer data) { int a; int b; if (sscanf (str, "%d,%d", &a, &b)) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (data); if (a == 3 && b == 2) priv->mode = MM_MODEM_GSM_NETWORK_MODE_GPRS; else if (a == 3 && b == 3) priv->mode = MM_MODEM_GSM_NETWORK_MODE_EDGE; else if (a == 5 && b == 4) priv->mode = MM_MODEM_GSM_NETWORK_MODE_3G; else if (a ==5 && b == 5) priv->mode = MM_MODEM_GSM_NETWORK_MODE_HSDPA; else { g_warning ("Couldn't parse mode change value: '%s'", str); return; } g_debug ("Mode: %d", priv->mode); mm_modem_gsm_network_mode (MM_MODEM_GSM_NETWORK (data), priv->mode); } } static void handle_status_change (const char *str, gpointer data) { int n1, n2, n3, n4, n5, n6, n7; if (sscanf (str, "%x,%x,%x,%x,%x,%x,%x", &n1, &n2, &n3, &n4, &n5, &n6, &n7)) { g_debug ("Duration: %d Up: %d Kbps Down: %d Kbps Total: %d Total: %d\n", n1, n2 * 8 / 1000, n3 * 8 / 1000, n4 / 1024, n5 / 1024); } } static void reg_state_changed (const char *str, gpointer data) { reg_status_updated (MM_MODEM_HUAWEI (data), atoi (str)); } static gboolean huawei_parse_response (gpointer data, GString *response, GError **error) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (data); mm_util_strip_string (response, priv->signal_quality_regex, handle_signal_quality_change, data); mm_util_strip_string (response, priv->mode_regex, handle_mode_change, data); mm_util_strip_string (response, priv->status_regex, handle_status_change, data); mm_util_strip_string (response, priv->reg_state_regex, reg_state_changed, data); return mm_serial_parser_v1_parse (priv->std_parser, response, error); } /*****************************************************************************/ static void modem_init (MMModem *modem_class) { modem_class->enable = enable; } static void modem_gsm_network_init (MMModemGsmNetwork *class) { class->do_register = do_register; class->set_network_mode = set_network_mode; class->get_network_mode = get_network_mode; class->set_band = set_band; class->get_band = get_band; class->get_signal_quality = get_signal_quality; } static void mm_modem_huawei_init (MMModemHuawei *self) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (self); priv->reg_status = MM_MODEM_GSM_NETWORK_REG_STATUS_UNKNOWN; priv->signal_quality_regex = g_regex_new ("\\r\\n\\^RSSI:(\\d+)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); priv->mode_regex = g_regex_new ("\\r\\n\\^MODE:(.+)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); priv->status_regex = g_regex_new ("\\r\\n\\^DSFLOWRPT:(.+)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); priv->reg_state_regex = g_regex_new ("\\r\\n\\+CREG: (\\d+)\\r\\n", G_REGEX_RAW | G_REGEX_OPTIMIZE, 0, NULL); priv->std_parser = mm_serial_parser_v1_new (); mm_serial_set_response_parser (MM_SERIAL (self), huawei_parse_response, self, NULL); } static void finalize (GObject *object) { MMModemHuaweiPrivate *priv = MM_MODEM_HUAWEI_GET_PRIVATE (object); pending_registration_stop (MM_MODEM_HUAWEI (object)); mm_serial_parser_v1_destroy (priv->std_parser); g_regex_unref (priv->signal_quality_regex); g_regex_unref (priv->mode_regex); g_regex_unref (priv->status_regex); g_regex_unref (priv->reg_state_regex); G_OBJECT_CLASS (mm_modem_huawei_parent_class)->finalize (object); } static void mm_modem_huawei_class_init (MMModemHuaweiClass *klass) { GObjectClass *object_class = G_OBJECT_CLASS (klass); mm_modem_huawei_parent_class = g_type_class_peek_parent (klass); g_type_class_add_private (object_class, sizeof (MMModemHuaweiPrivate)); /* Virtual methods */ object_class->finalize = finalize; } GType mm_modem_huawei_get_type (void) { static GType modem_huawei_type = 0; if (G_UNLIKELY (modem_huawei_type == 0)) { static const GTypeInfo modem_huawei_type_info = { sizeof (MMModemHuaweiClass), (GBaseInitFunc) NULL, (GBaseFinalizeFunc) NULL, (GClassInitFunc) mm_modem_huawei_class_init, (GClassFinalizeFunc) NULL, NULL, /* class_data */ sizeof (MMModemHuawei), 0, /* n_preallocs */ (GInstanceInitFunc) mm_modem_huawei_init, }; static const GInterfaceInfo modem_iface_info = { (GInterfaceInitFunc) modem_init }; static const GInterfaceInfo modem_gsm_network_info = { (GInterfaceInitFunc) modem_gsm_network_init }; modem_huawei_type = g_type_register_static (MM_TYPE_GENERIC_GSM, "MMModemHuawei", &modem_huawei_type_info, 0); g_type_add_interface_static (modem_huawei_type, MM_TYPE_MODEM, &modem_iface_info); g_type_add_interface_static (modem_huawei_type, MM_TYPE_MODEM_GSM_NETWORK, &modem_gsm_network_info); } return modem_huawei_type; }