qos.c

sparc硬件平台上的红外协议

/*********************************************************************
*
* Filename:      qos.c
* Version:       1.0
* Description:   IrLAP QoS parameter negotiation
* Status:        Stable
* Author:        Dag Brattli <[e-mail]>
* Created at:    Tue Sep  9 00:00:26 1997
* Modified at:   Sun Jan 30 14:29:16 2000
* Modified by:   Dag Brattli <[e-mail]>
*
*     Copyright (c) 1998-2000 Dag Brattli <[e-mail]>,
*     All Rights Reserved.
*     Copyright (c) 2000-2001 Jean Tourrilhes <[e-mail]>
*
*     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.
*
*     You should have received a copy of the GNU General Public License
*     along with this program; if not, write to the Free Software
*     Foundation, Inc., 59 Temple Place, Suite 330, Boston,
*     MA 02111-1307 USA
*
********************************************************************/



#include "irda.h"
#include "parameters.h"
#include "qos.h"
#include "irlap.h"
#include "irlap_frame.h"

/*
* Maximum values of the baud rate we negociate with the other end.
* Most often, you don't have to change that, because Linux-IrDA will
* use the maximum offered by the link layer, which usually works fine.
* In some very rare cases, you may want to limit it to lower speeds...
*/
//modify by xugan
//	int sysctl_max_baud_rate = 16000000;
int sysctl_max_baud_rate = 9600;
/*
* Maximum value of the lap disconnect timer we negociate with the other end.
* Most often, the value below represent the best compromise, but some user
* may want to keep the LAP alive longuer or shorter in case of link failure.
* Remember that the threshold time (early warning) is fixed to 3s...
*/
int sysctl_max_noreply_time = 12;

/*
* Minimum turn time to be applied before transmitting to the peer.
* Nonzero values (usec) are used as lower limit to the per-connection
* mtt value which was announced by the other end during negotiation.
* Might be helpful if the peer device provides too short mtt.
* Default is 10us which means using the unmodified value given by the
* peer except if it's 0 (0 is likely a bug in the other stack).
*/
unsigned sysctl_min_tx_turn_time = 10;
/*
* Maximum data size to be used in transmission in payload of LAP frame.
* There is a bit of confusion in the IrDA spec :
* The LAP spec defines the payload of a LAP frame (I field) to be
* 2048 bytes max (IrLAP 1.1, chapt 6.6.5, p40).
* On the other hand, the PHY mention frames of 2048 bytes max (IrPHY
* 1.2, chapt 5.3.2.1, p41). But, this number includes the LAP header
* (2 bytes), and CRC (32 bits at 4 Mb/s). So, for the I field (LAP
* payload), that's only 2042 bytes. Oups !
* My nsc-ircc hardware has troubles receiving 2048 bytes frames at 4 Mb/s,
* so adjust to 2042... I don't know if this bug applies only for 2048
* bytes frames or all negotiated frame sizes, but you can use the sysctl
* to play with this value anyway.
* Jean II */
unsigned sysctl_max_tx_data_size = 2042;
/*
* Maximum transmit window, i.e. number of LAP frames between turn-around.
* This allow to override what the peer told us. Some peers are buggy and
* don't always support what they tell us.
* Jean II */
unsigned sysctl_max_tx_window = 7;

static int irlap_param_baud_rate(void *instance, irda_param_t *param, int get);
static int irlap_param_link_disconnect(void *instance, irda_param_t *parm,
									   int get);
static int irlap_param_max_turn_time(void *instance, irda_param_t *param,
									 int get);
static int irlap_param_data_size(void *instance, irda_param_t *param, int get);
static int irlap_param_window_size(void *instance, irda_param_t *param,
								   int get);
static int irlap_param_additional_bofs(void *instance, irda_param_t *parm,
									   int get);
static int irlap_param_min_turn_time(void *instance, irda_param_t *param,
									 int get);

#ifndef CONFIG_IRDA_DYNAMIC_WINDOW
static __u32 irlap_requested_line_capacity(struct qos_info *qos);
#endif

static __u32 min_turn_times[]  = { 10000, 5000, 1000, 500, 100, 50, 10, 0 }; /* us */
static __u32 baud_rates[]      = { 2400, 9600, 19200, 38400, 57600, 115200, 576000,
1152000, 4000000, 16000000 };           /* bps */
static __u32 data_sizes[]      = { 64, 128, 256, 512, 1024, 2048 };        /* bytes */
static __u32 add_bofs[]        = { 48, 24, 12, 5, 3, 2, 1, 0 };            /* bytes */
static __u32 max_turn_times[]  = { 500, 250, 100, 50 };                    /* ms */
static __u32 link_disc_times[] = { 3, 8, 12, 16, 20, 25, 30, 40 };         /* secs */

static __u32 max_line_capacities[10][4] = {
	/* 500 ms     250 ms  100 ms  50 ms (max turn time) */
	{    100,      0,      0,     0 }, /*     2400 bps */
	{    400,      0,      0,     0 }, /*     9600 bps */
	{    800,      0,      0,     0 }, /*    19200 bps */
	{   1600,      0,      0,     0 }, /*    38400 bps */
	{   2360,      0,      0,     0 }, /*    57600 bps */
	{   4800,   2400,    960,   480 }, /*   115200 bps */
	{  28800,  11520,   5760,  2880 }, /*   576000 bps */
	{  57600,  28800,  11520,  5760 }, /*  1152000 bps */
	{ 200000, 100000,  40000, 20000 }, /*  4000000 bps */
	{ 800000, 400000, 160000, 80000 }, /* 16000000 bps */
};

static pi_minor_info_t pi_minor_call_table_type_0[] = {
	{ NULL, 0 },
		/* 01 */{ irlap_param_baud_rate,       PV_INTEGER | PV_LITTLE_ENDIAN },
	{ NULL, 0 },
	{ NULL, 0 },
	{ NULL, 0 },
	{ NULL, 0 },
	{ NULL, 0 },
	{ NULL, 0 },
	/* 08 */{ irlap_param_link_disconnect, PV_INT_8_BITS }
};

static pi_minor_info_t pi_minor_call_table_type_1[] = {
	{ NULL, 0 },
	{ NULL, 0 },
	/* 82 */{ irlap_param_max_turn_time,   PV_INT_8_BITS },
	/* 83 */{ irlap_param_data_size,       PV_INT_8_BITS },
	/* 84 */{ irlap_param_window_size,     PV_INT_8_BITS },
	/* 85 */{ irlap_param_additional_bofs, PV_INT_8_BITS },
	/* 86 */{ irlap_param_min_turn_time,   PV_INT_8_BITS },
};

static pi_major_info_t pi_major_call_table[] = {
	{ pi_minor_call_table_type_0, 9 },
	{ pi_minor_call_table_type_1, 7 },
};

static pi_param_info_t irlap_param_info = { pi_major_call_table, 2, 0x7f, 7 };

/* ---------------------- LOCAL SUBROUTINES ---------------------- */
/* Note : we start with a bunch of local subroutines.
* As the compiler is "one pass", this is the only way to get them to
* inline properly...
* Jean II
*/
/*
* Function value_index (value, array, size)
*
*    Returns the index to the value in the specified array
*/
static inline int value_index(__u32 value, __u32 *array, int size)
{
	int i;
	
	for (i=0; i < size; i++)
		if (array[i] == value)
			break;
		return i;
}

/*
* Function index_value (index, array)
*
*    Returns value to index in array, easy!
*
*/
static inline __u32 index_value(int index, __u32 *array)
{
	return array[index];
}

/*
* Function msb_index (word)
*
*    Returns index to most significant bit (MSB) in word
*
*/
static int msb_index (__u16 word)
{
	__u16 msb = 0x8000;
	int index = 15;   /* Current MSB */
	
					  /* Check for buggy peers.
					  * Note : there is a small probability that it could be us, but I
					  * would expect driver authors to catch that pretty early and be
					  * able to check precisely what's going on. If a end user sees this,
	* it's very likely the peer. - Jean II */
	if (word == 0) {
		IRDA_WARNING("%s(), Detected buggy peer, adjust null PV to 0x1!\n",
			__FUNCTION__);
		/* The only safe choice (we don't know the array size) */
		word = 0x1;
	}
	
	while (msb) {
		if (word & msb)
			break;   /* Found it! */
		msb >>=1;
		index--;
	}
	return index;
}

/*
* Function value_lower_bits (value, array)
*
*    Returns a bit field marking all possibility lower than value.
*/
static inline int value_lower_bits(__u32 value, __u32 *array, int size, __u16 *field)
{
	int	i;
	__u16	mask = 0x1;
	__u16	result = 0x0;
	
	for (i=0; i < size; i++) {
		/* Add the current value to the bit field, shift mask */
		result |= mask;
		mask <<= 1;
		/* Finished ? */
		if (array[i] >= value)
			break;
	}
	/* Send back a valid index */
	if(i >= size)
		i = size - 1;	/* Last item */
	*field = result;
	return i;
}

/*
* Function value_highest_bit (value, array)
*
*    Returns a bit field marking the highest possibility lower than value.
*/
static inline int value_highest_bit(__u32 value, __u32 *array, int size, __u16 *field)
{
	int	i;
	__u16	mask = 0x1;
	__u16	result = 0x0;
	
	for (i=0; i < size; i++) {
		/* Finished ? */
		if (array[i] <= value)
			break;
		/* Shift mask */
		mask <<= 1;
	}
	/* Set the current value to the bit field */
	result |= mask;
	/* Send back a valid index */
	if(i >= size)
		i = size - 1;	/* Last item */
	*field = result;
	return i;
}

/* -------------------------- MAIN CALLS -------------------------- */

/*
* Function irda_qos_compute_intersection (qos, new)
*
*    Compute the intersection of the old QoS capabilities with new ones
*
*/
void irda_qos_compute_intersection(struct qos_info *qos, struct qos_info *new)
{
	IRDA_ASSERT(qos != NULL, return;);
	IRDA_ASSERT(new != NULL, return;);
	
	/* Apply */
	qos->baud_rate.bits       &= new->baud_rate.bits;
	qos->window_size.bits     &= new->window_size.bits;
	qos->min_turn_time.bits   &= new->min_turn_time.bits;
	qos->max_turn_time.bits   &= new->max_turn_time.bits;
	qos->data_size.bits       &= new->data_size.bits;
	qos->link_disc_time.bits  &= new->link_disc_time.bits;
	qos->additional_bofs.bits &= new->additional_bofs.bits;
	
	irda_qos_bits_to_value(qos);
}

/*
* Function irda_init_max_qos_capabilies (qos)
*
*    The purpose of this function is for layers and drivers to be able to
*    set the maximum QoS possible and then "and in" their own limitations
*
*/
void irda_init_max_qos_capabilies(struct qos_info *qos)
{
	int i;
	/*
	*  These are the maximum supported values as specified on pages
	*  39-43 in IrLAP
	*/
	
	/* Use sysctl to set some configurable values... */
	/* Set configured max speed */
	
	i = value_lower_bits(sysctl_max_baud_rate, baud_rates, 10,
			     &qos->baud_rate.bits);
	sysctl_max_baud_rate = index_value(i, baud_rates);
	
	/* Set configured max disc time */
	i = value_lower_bits(sysctl_max_noreply_time, link_disc_times, 8,
			     &qos->link_disc_time.bits);
	sysctl_max_noreply_time = index_value(i, link_disc_times);
	
	/* LSB is first byte, MSB is second byte */
	
	qos->baud_rate.bits    &= 0x03ff;
	//modify by xugangan
	//		qos->window_size.bits     = 0x7f;
	qos->window_size.bits     = 0x01;
	qos->min_turn_time.bits   = 0xff;
	qos->max_turn_time.bits   = 0x0f;
	qos->data_size.bits       = 0x3f;
	qos->link_disc_time.bits &= 0xff;
	qos->additional_bofs.bits = 0xff;
}

/*
* Function irlap_adjust_qos_settings (qos)
*
*     Adjust QoS settings in case some values are not possible to use because
*     of other settings
*/
static void irlap_adjust_qos_settings(struct qos_info *qos)
{
	__u32 line_capacity;
	int index;
	
	IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
	
	/*
	* Make sure the mintt is sensible.
	* Main culprit : Ericsson T39. - Jean II
	*/
	if (sysctl_min_tx_turn_time > qos->min_turn_time.value) {
		int i;
		
		IRDA_WARNING("%s(), Detected buggy peer, adjust mtt to %dus!\n",
			__FUNCTION__, sysctl_min_tx_turn_time);
		
		/* We don't really need bits, but easier this way */
		i = value_highest_bit(sysctl_min_tx_turn_time, min_turn_times,
			8, &qos->min_turn_time.bits);
		sysctl_min_tx_turn_time = index_value(i, min_turn_times);
		qos->min_turn_time.value = sysctl_min_tx_turn_time;
	}
	
	/*
	* Not allowed to use a max turn time less than 500 ms if the baudrate
	* is less than 115200
	*/
	if ((qos->baud_rate.value < 115200) &&
		(qos->max_turn_time.value < 500))
	{
		IRDA_DEBUG(4,
			"%s(), adjusting max turn time from %d to 500 ms\n",
			__FUNCTION__, qos->max_turn_time.value);
		qos->max_turn_time.value = 500;
	}
	
	/*
	* The data size must be adjusted according to the baud rate and max
	* turn time
	*/
	index = value_index(qos->data_size.value, data_sizes, 6);
	line_capacity = irlap_max_line_capacity(qos->baud_rate.value,
		qos->max_turn_time.value);