plugins/mm-modem-novatel-cdma.c - chromiumos/third_party/modemmanager-next - Git at Google

 /* -*- 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>

 #include "mm-modem-novatel-cdma.h"
 #include "mm-modem-helpers.h"
 #include "libqcdm/src/commands.h"
 #include "mm-errors.h"
 #include "mm-callback-info.h"

 static void modem_cdma_init (MMModemCdma *cdma_class);

 G_DEFINE_TYPE_EXTENDED (MMModemNovatelCdma, mm_modem_novatel_cdma, MM_TYPE_GENERIC_CDMA, 0,
                         G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM_CDMA, modem_cdma_init))


 MMModem *
 mm_modem_novatel_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_NOVATEL_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,
                                    NULL));
 }

 /*****************************************************************************/

 static void
 parent_csq_done (MMModem *modem,
                  guint32 result,
                  GError *error,
                  gpointer user_data)
 {
     MMCallbackInfo *info = user_data;

     if (error)
         info->error = g_error_copy (error);
     else
         mm_callback_info_set_result (info, GUINT_TO_POINTER (result), NULL);
     mm_callback_info_schedule (info);
 }

 static int
 get_one_qual (const char *reply, const char *tag)
 {
     int qual = -1;
     const char *p;
     long int dbm;
     gboolean success = FALSE;

     p = strstr (reply, tag);
     if (!p)
         return -1;

     /* Skip the tag */
     p += strlen (tag);

     /* Skip spaces */
     while (isspace (*p))
         p++;

     errno = 0;
     dbm = strtol (p, NULL, 10);
     if (errno == 0) {
         if (*p == '-') {
             /* Some cards appear to use RX0/RX1 and output RSSI in negative dBm */
             if (dbm < 0)
                 success = TRUE;
         } else if (isdigit (*p) && (dbm > 0) && (dbm < 115)) {
             /* S720 appears to use "1x RSSI" and print RSSI in dBm without '-' */
             dbm *= -1;
             success = TRUE;
         }
     }

     if (success) {
         dbm = CLAMP (dbm, -113, -51);
         qual = 100 - ((dbm + 51) * 100 / (-113 + 51));
     }

     return qual;
 }

 static void
 get_rssi_done (MMAtSerialPort *port,
                GString *response,
                GError *error,
                gpointer user_data)
 {
     MMCallbackInfo *info = (MMCallbackInfo *) user_data;
     MMModemCdma *parent_iface;
     int qual;

     /* If the modem has already been removed, return without
      * scheduling callback */
     if (mm_callback_info_check_modem_removed (info))
         return;

     if (error) {
         /* Fallback to parent's method */
         parent_iface = g_type_interface_peek_parent (MM_MODEM_CDMA_GET_INTERFACE (info->modem));
         parent_iface->get_signal_quality (MM_MODEM_CDMA (info->modem), parent_csq_done, info);
         return;
     }

     /* Parse the signal quality */
     qual = get_one_qual (response->str, "RX0=");
     if (qual < 0)
         qual = get_one_qual (response->str, "1x RSSI=");
     if (qual < 0)
         qual = get_one_qual (response->str, "RX1=");

     if (qual >= 0) {
         mm_callback_info_set_result (info, GUINT_TO_POINTER ((guint32) qual), NULL);
         mm_generic_cdma_update_cdma1x_quality (MM_GENERIC_CDMA (info->modem), (guint32) qual);
     } else {
         info->error = g_error_new (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL,
                                     "%s", "Could not parse signal quality results");
     }

     mm_callback_info_schedule (info);
 }

 static void
 get_signal_quality (MMModemCdma *modem,
                     MMModemUIntFn callback,
                     gpointer user_data)
 {
     MMCallbackInfo *info;
     MMAtSerialPort *port;
     MMModemCdma *parent_iface;

     port = mm_generic_cdma_get_best_at_port (MM_GENERIC_CDMA (modem), NULL);
     if (!port) {
         /* Let the superclass handle it */
         parent_iface = g_type_interface_peek_parent (MM_MODEM_CDMA_GET_INTERFACE (modem));
         parent_iface->get_signal_quality (MM_MODEM_CDMA (modem), callback, user_data);
         return;
     }

     info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data);

     /* Many Novatel CDMA cards don't report CSQ in standard 0 - 31 and the CSQ
      * reply doesn't appear to be in positive dBm either; instead try the custom
      * Novatel command for it.
      */
     mm_at_serial_port_queue_command (port, "$NWRSSI", 3, get_rssi_done, info);
 }

 /*****************************************************************************/

 static void
 parse_modem_snapshot (MMCallbackInfo *info, QcdmResult *result)
 {
     MMModemCdmaRegistrationState evdo_state, cdma1x_state, new_state;
     guint8 eri = 0;

     g_return_if_fail (info != NULL);
     g_return_if_fail (result != NULL);

     evdo_state = mm_generic_cdma_query_reg_state_get_callback_evdo_state (info);
     cdma1x_state = mm_generic_cdma_query_reg_state_get_callback_1x_state (info);

     /* Roaming? */
     if (qcdm_result_get_u8 (result, QCDM_CMD_NW_SUBSYS_MODEM_SNAPSHOT_CDMA_ITEM_ERI, &eri)) {
         char *str;
         gboolean roaming = FALSE;

         str = g_strdup_printf ("%u", eri);
         if (mm_cdma_parse_eri (str, &roaming, NULL, NULL)) {
             new_state = roaming ? MM_MODEM_CDMA_REGISTRATION_STATE_HOME : MM_MODEM_CDMA_REGISTRATION_STATE_ROAMING;
             if (cdma1x_state != MM_MODEM_CDMA_REGISTRATION_STATE_UNKNOWN)
                 mm_generic_cdma_query_reg_state_set_callback_1x_state (info, new_state);
             if (evdo_state != MM_MODEM_CDMA_REGISTRATION_STATE_UNKNOWN)
                 mm_generic_cdma_query_reg_state_set_callback_evdo_state (info, new_state);
         }
         g_free (str);
     }
 }

 static void
 reg_nwsnap_6500_cb (MMQcdmSerialPort *port,
                     GByteArray *response,
                     GError *error,
                     gpointer user_data)
 {
     MMCallbackInfo *info = user_data;
     QcdmResult *result;

     if (!error) {
         result = qcdm_cmd_nw_subsys_modem_snapshot_cdma_result ((const char *) response->data, response->len, NULL);
         if (result) {
             parse_modem_snapshot (info, result);
             qcdm_result_unref (result);
         }
     }
     mm_callback_info_schedule (info);
 }

 static void
 reg_nwsnap_6800_cb (MMQcdmSerialPort *port,
                     GByteArray *response,
                     GError *error,
                     gpointer user_data)
 {
     MMCallbackInfo *info = user_data;
     QcdmResult *result;
     GByteArray *nwsnap;

     if (error)
         goto done;

     /* Parse the response */
     result = qcdm_cmd_nw_subsys_modem_snapshot_cdma_result ((const char *) response->data, response->len, NULL);
     if (!result) {
         /* Try for MSM6500 */
         nwsnap = g_byte_array_sized_new (25);
         nwsnap->len = qcdm_cmd_nw_subsys_modem_snapshot_cdma_new ((char *) nwsnap->data, 25, QCDM_NW_CHIPSET_6500);
         g_assert (nwsnap->len);
         mm_qcdm_serial_port_queue_command (port, nwsnap, 3, reg_nwsnap_6500_cb, info);
         return;
     }

     parse_modem_snapshot (info, result);
     qcdm_result_unref (result);

 done:
     mm_callback_info_schedule (info);
 }

 static void
 query_registration_state (MMGenericCdma *cdma,
                           MMModemCdmaRegistrationState cur_cdma_state,
                           MMModemCdmaRegistrationState cur_evdo_state,
                           MMModemCdmaRegistrationStateFn callback,
                           gpointer user_data)
 {
     MMCallbackInfo *info;
     MMQcdmSerialPort *port;
     GByteArray *nwsnap;

     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_qcdm_port (cdma, &info->error);
     if (!port) {
         mm_callback_info_schedule (info);
         return;
     }

     /* Try MSM6800 first since newer cards use that */
     nwsnap = g_byte_array_sized_new (25);
     nwsnap->len = qcdm_cmd_nw_subsys_modem_snapshot_cdma_new ((char *) nwsnap->data, 25, QCDM_NW_CHIPSET_6800);
     g_assert (nwsnap->len);
     mm_qcdm_serial_port_queue_command (port, nwsnap, 3, reg_nwsnap_6800_cb, info);
 }

 /*****************************************************************************/

 static void
 modem_cdma_init (MMModemCdma *cdma_class)
 {
     cdma_class->get_signal_quality = get_signal_quality;
 }

 static void
 mm_modem_novatel_cdma_init (MMModemNovatelCdma *self)
 {
 }

 static void
 mm_modem_novatel_cdma_class_init (MMModemNovatelCdmaClass *klass)
 {
     MMGenericCdmaClass *generic_class = MM_GENERIC_CDMA_CLASS (klass);

     mm_modem_novatel_cdma_parent_class = g_type_class_peek_parent (klass);

     generic_class->query_registration_state = query_registration_state;
 }
	/* -- 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>

	#include "mm-modem-novatel-cdma.h"
	#include "mm-modem-helpers.h"
	#include "libqcdm/src/commands.h"
	#include "mm-errors.h"
	#include "mm-callback-info.h"

	static void modem_cdma_init (MMModemCdma *cdma_class);

	G_DEFINE_TYPE_EXTENDED (MMModemNovatelCdma, mm_modem_novatel_cdma, MM_TYPE_GENERIC_CDMA, 0,
	G_IMPLEMENT_INTERFACE (MM_TYPE_MODEM_CDMA, modem_cdma_init))


	MMModem *
	mm_modem_novatel_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_NOVATEL_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,
	NULL));
	}

	/*****************************************************************************/

	static void
	parent_csq_done (MMModem *modem,
	guint32 result,
	GError *error,
	gpointer user_data)
	{
	MMCallbackInfo *info = user_data;

	if (error)
	info->error = g_error_copy (error);
	else
	mm_callback_info_set_result (info, GUINT_TO_POINTER (result), NULL);
	mm_callback_info_schedule (info);
	}

	static int
	get_one_qual (const char reply, const char tag)
	{
	int qual = -1;
	const char *p;
	long int dbm;
	gboolean success = FALSE;

	p = strstr (reply, tag);
	if (!p)
	return -1;

	/* Skip the tag */
	p += strlen (tag);

	/* Skip spaces */
	while (isspace (*p))
	p++;

	errno = 0;
	dbm = strtol (p, NULL, 10);
	if (errno == 0) {
	if (*p == '-') {
	/* Some cards appear to use RX0/RX1 and output RSSI in negative dBm */
	if (dbm < 0)
	success = TRUE;
	} else if (isdigit (*p) && (dbm > 0) && (dbm < 115)) {
	/* S720 appears to use "1x RSSI" and print RSSI in dBm without '-' */
	dbm *= -1;
	success = TRUE;
	}
	}

	if (success) {
	dbm = CLAMP (dbm, -113, -51);
	qual = 100 - ((dbm + 51) * 100 / (-113 + 51));
	}

	return qual;
	}

	static void
	get_rssi_done (MMAtSerialPort *port,
	GString *response,
	GError *error,
	gpointer user_data)
	{
	MMCallbackInfo info = (MMCallbackInfo ) user_data;
	MMModemCdma *parent_iface;
	int qual;

	/* If the modem has already been removed, return without
	* scheduling callback */
	if (mm_callback_info_check_modem_removed (info))
	return;

	if (error) {
	/* Fallback to parent's method */
	parent_iface = g_type_interface_peek_parent (MM_MODEM_CDMA_GET_INTERFACE (info->modem));
	parent_iface->get_signal_quality (MM_MODEM_CDMA (info->modem), parent_csq_done, info);
	return;
	}

	/* Parse the signal quality */
	qual = get_one_qual (response->str, "RX0=");
	if (qual < 0)
	qual = get_one_qual (response->str, "1x RSSI=");
	if (qual < 0)
	qual = get_one_qual (response->str, "RX1=");

	if (qual >= 0) {
	mm_callback_info_set_result (info, GUINT_TO_POINTER ((guint32) qual), NULL);
	mm_generic_cdma_update_cdma1x_quality (MM_GENERIC_CDMA (info->modem), (guint32) qual);
	} else {
	info->error = g_error_new (MM_MODEM_ERROR, MM_MODEM_ERROR_GENERAL,
	"%s", "Could not parse signal quality results");
	}

	mm_callback_info_schedule (info);
	}

	static void
	get_signal_quality (MMModemCdma *modem,
	MMModemUIntFn callback,
	gpointer user_data)
	{
	MMCallbackInfo *info;
	MMAtSerialPort *port;
	MMModemCdma *parent_iface;

	port = mm_generic_cdma_get_best_at_port (MM_GENERIC_CDMA (modem), NULL);
	if (!port) {
	/* Let the superclass handle it */
	parent_iface = g_type_interface_peek_parent (MM_MODEM_CDMA_GET_INTERFACE (modem));
	parent_iface->get_signal_quality (MM_MODEM_CDMA (modem), callback, user_data);
	return;
	}

	info = mm_callback_info_uint_new (MM_MODEM (modem), callback, user_data);

	/* Many Novatel CDMA cards don't report CSQ in standard 0 - 31 and the CSQ
	* reply doesn't appear to be in positive dBm either; instead try the custom
	* Novatel command for it.
	*/
	mm_at_serial_port_queue_command (port, "$NWRSSI", 3, get_rssi_done, info);
	}

	/*****************************************************************************/

	static void
	parse_modem_snapshot (MMCallbackInfo info, QcdmResult result)
	{
	MMModemCdmaRegistrationState evdo_state, cdma1x_state, new_state;
	guint8 eri = 0;

	g_return_if_fail (info != NULL);
	g_return_if_fail (result != NULL);

	evdo_state = mm_generic_cdma_query_reg_state_get_callback_evdo_state (info);
	cdma1x_state = mm_generic_cdma_query_reg_state_get_callback_1x_state (info);

	/* Roaming? */
	if (qcdm_result_get_u8 (result, QCDM_CMD_NW_SUBSYS_MODEM_SNAPSHOT_CDMA_ITEM_ERI, &eri)) {
	char *str;
	gboolean roaming = FALSE;

	str = g_strdup_printf ("%u", eri);
	if (mm_cdma_parse_eri (str, &roaming, NULL, NULL)) {
	new_state = roaming ? MM_MODEM_CDMA_REGISTRATION_STATE_HOME : MM_MODEM_CDMA_REGISTRATION_STATE_ROAMING;
	if (cdma1x_state != MM_MODEM_CDMA_REGISTRATION_STATE_UNKNOWN)
	mm_generic_cdma_query_reg_state_set_callback_1x_state (info, new_state);
	if (evdo_state != MM_MODEM_CDMA_REGISTRATION_STATE_UNKNOWN)
	mm_generic_cdma_query_reg_state_set_callback_evdo_state (info, new_state);
	}
	g_free (str);
	}
	}

	static void
	reg_nwsnap_6500_cb (MMQcdmSerialPort *port,
	GByteArray *response,
	GError *error,
	gpointer user_data)
	{
	MMCallbackInfo *info = user_data;
	QcdmResult *result;

	if (!error) {
	result = qcdm_cmd_nw_subsys_modem_snapshot_cdma_result ((const char *) response->data, response->len, NULL);
	if (result) {
	parse_modem_snapshot (info, result);
	qcdm_result_unref (result);
	}
	}
	mm_callback_info_schedule (info);
	}

	static void
	reg_nwsnap_6800_cb (MMQcdmSerialPort *port,
	GByteArray *response,
	GError *error,
	gpointer user_data)
	{
	MMCallbackInfo *info = user_data;
	QcdmResult *result;
	GByteArray *nwsnap;

	if (error)
	goto done;

	/* Parse the response */
	result = qcdm_cmd_nw_subsys_modem_snapshot_cdma_result ((const char *) response->data, response->len, NULL);
	if (!result) {
	/* Try for MSM6500 */
	nwsnap = g_byte_array_sized_new (25);
	nwsnap->len = qcdm_cmd_nw_subsys_modem_snapshot_cdma_new ((char *) nwsnap->data, 25, QCDM_NW_CHIPSET_6500);
	g_assert (nwsnap->len);
	mm_qcdm_serial_port_queue_command (port, nwsnap, 3, reg_nwsnap_6500_cb, info);
	return;
	}

	parse_modem_snapshot (info, result);
	qcdm_result_unref (result);

	done:
	mm_callback_info_schedule (info);
	}

	static void
	query_registration_state (MMGenericCdma *cdma,
	MMModemCdmaRegistrationState cur_cdma_state,
	MMModemCdmaRegistrationState cur_evdo_state,
	MMModemCdmaRegistrationStateFn callback,
	gpointer user_data)
	{
	MMCallbackInfo *info;
	MMQcdmSerialPort *port;
	GByteArray *nwsnap;

	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_qcdm_port (cdma, &info->error);
	if (!port) {
	mm_callback_info_schedule (info);
	return;
	}

	/* Try MSM6800 first since newer cards use that */
	nwsnap = g_byte_array_sized_new (25);
	nwsnap->len = qcdm_cmd_nw_subsys_modem_snapshot_cdma_new ((char *) nwsnap->data, 25, QCDM_NW_CHIPSET_6800);
	g_assert (nwsnap->len);
	mm_qcdm_serial_port_queue_command (port, nwsnap, 3, reg_nwsnap_6800_cb, info);
	}

	/*****************************************************************************/

	static void
	modem_cdma_init (MMModemCdma *cdma_class)
	{
	cdma_class->get_signal_quality = get_signal_quality;
	}

	static void
	mm_modem_novatel_cdma_init (MMModemNovatelCdma *self)
	{
	}

	static void
	mm_modem_novatel_cdma_class_init (MMModemNovatelCdmaClass *klass)
	{
	MMGenericCdmaClass *generic_class = MM_GENERIC_CDMA_CLASS (klass);

	mm_modem_novatel_cdma_parent_class = g_type_class_peek_parent (klass);

	generic_class->query_registration_state = query_registration_state;
	}