Merge master.kernel.org:/pub/scm/linux/kernel/git/gregkh/driver-2.6
[linux-2.6] / net / irda / qos.c
1 /*********************************************************************
2  *                                
3  * Filename:      qos.c
4  * Version:       1.0
5  * Description:   IrLAP QoS parameter negotiation
6  * Status:        Stable
7  * Author:        Dag Brattli <dagb@cs.uit.no>
8  * Created at:    Tue Sep  9 00:00:26 1997
9  * Modified at:   Sun Jan 30 14:29:16 2000
10  * Modified by:   Dag Brattli <dagb@cs.uit.no>
11  * 
12  *     Copyright (c) 1998-2000 Dag Brattli <dagb@cs.uit.no>, 
13  *     All Rights Reserved.
14  *     Copyright (c) 2000-2001 Jean Tourrilhes <jt@hpl.hp.com>
15  *     
16  *     This program is free software; you can redistribute it and/or 
17  *     modify it under the terms of the GNU General Public License as 
18  *     published by the Free Software Foundation; either version 2 of 
19  *     the License, or (at your option) any later version.
20  * 
21  *     This program is distributed in the hope that it will be useful,
22  *     but WITHOUT ANY WARRANTY; without even the implied warranty of
23  *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
24  *     GNU General Public License for more details.
25  * 
26  *     You should have received a copy of the GNU General Public License 
27  *     along with this program; if not, write to the Free Software 
28  *     Foundation, Inc., 59 Temple Place, Suite 330, Boston, 
29  *     MA 02111-1307 USA
30  *     
31  ********************************************************************/
32
33 #include <linux/config.h>
34 #include <asm/byteorder.h>
35
36 #include <net/irda/irda.h>
37 #include <net/irda/parameters.h>
38 #include <net/irda/qos.h>
39 #include <net/irda/irlap.h>
40 #include <net/irda/irlap_frame.h>
41
42 /*
43  * Maximum values of the baud rate we negociate with the other end.
44  * Most often, you don't have to change that, because Linux-IrDA will
45  * use the maximum offered by the link layer, which usually works fine.
46  * In some very rare cases, you may want to limit it to lower speeds...
47  */
48 int sysctl_max_baud_rate = 16000000;
49 /*
50  * Maximum value of the lap disconnect timer we negociate with the other end.
51  * Most often, the value below represent the best compromise, but some user
52  * may want to keep the LAP alive longuer or shorter in case of link failure.
53  * Remember that the threshold time (early warning) is fixed to 3s...
54  */
55 int sysctl_max_noreply_time = 12;
56 /*
57  * Minimum turn time to be applied before transmitting to the peer.
58  * Nonzero values (usec) are used as lower limit to the per-connection
59  * mtt value which was announced by the other end during negotiation.
60  * Might be helpful if the peer device provides too short mtt.
61  * Default is 10us which means using the unmodified value given by the
62  * peer except if it's 0 (0 is likely a bug in the other stack).
63  */
64 unsigned sysctl_min_tx_turn_time = 10;
65 /*
66  * Maximum data size to be used in transmission in payload of LAP frame.
67  * There is a bit of confusion in the IrDA spec :
68  * The LAP spec defines the payload of a LAP frame (I field) to be
69  * 2048 bytes max (IrLAP 1.1, chapt 6.6.5, p40).
70  * On the other hand, the PHY mention frames of 2048 bytes max (IrPHY
71  * 1.2, chapt 5.3.2.1, p41). But, this number includes the LAP header
72  * (2 bytes), and CRC (32 bits at 4 Mb/s). So, for the I field (LAP
73  * payload), that's only 2042 bytes. Oups !
74  * My nsc-ircc hardware has troubles receiving 2048 bytes frames at 4 Mb/s,
75  * so adjust to 2042... I don't know if this bug applies only for 2048
76  * bytes frames or all negotiated frame sizes, but you can use the sysctl
77  * to play with this value anyway.
78  * Jean II */
79 unsigned sysctl_max_tx_data_size = 2042;
80 /*
81  * Maximum transmit window, i.e. number of LAP frames between turn-around.
82  * This allow to override what the peer told us. Some peers are buggy and
83  * don't always support what they tell us.
84  * Jean II */
85 unsigned sysctl_max_tx_window = 7;
86
87 static int irlap_param_baud_rate(void *instance, irda_param_t *param, int get);
88 static int irlap_param_link_disconnect(void *instance, irda_param_t *parm, 
89                                        int get);
90 static int irlap_param_max_turn_time(void *instance, irda_param_t *param, 
91                                      int get);
92 static int irlap_param_data_size(void *instance, irda_param_t *param, int get);
93 static int irlap_param_window_size(void *instance, irda_param_t *param, 
94                                    int get);
95 static int irlap_param_additional_bofs(void *instance, irda_param_t *parm, 
96                                        int get);
97 static int irlap_param_min_turn_time(void *instance, irda_param_t *param, 
98                                      int get);
99
100 #ifndef CONFIG_IRDA_DYNAMIC_WINDOW
101 static __u32 irlap_requested_line_capacity(struct qos_info *qos);
102 #endif
103
104 static __u32 min_turn_times[]  = { 10000, 5000, 1000, 500, 100, 50, 10, 0 }; /* us */
105 static __u32 baud_rates[]      = { 2400, 9600, 19200, 38400, 57600, 115200, 576000, 
106                                    1152000, 4000000, 16000000 };           /* bps */
107 static __u32 data_sizes[]      = { 64, 128, 256, 512, 1024, 2048 };        /* bytes */
108 static __u32 add_bofs[]        = { 48, 24, 12, 5, 3, 2, 1, 0 };            /* bytes */
109 static __u32 max_turn_times[]  = { 500, 250, 100, 50 };                    /* ms */
110 static __u32 link_disc_times[] = { 3, 8, 12, 16, 20, 25, 30, 40 };         /* secs */
111
112 static __u32 max_line_capacities[10][4] = {
113        /* 500 ms     250 ms  100 ms  50 ms (max turn time) */
114         {    100,      0,      0,     0 }, /*     2400 bps */
115         {    400,      0,      0,     0 }, /*     9600 bps */
116         {    800,      0,      0,     0 }, /*    19200 bps */
117         {   1600,      0,      0,     0 }, /*    38400 bps */
118         {   2360,      0,      0,     0 }, /*    57600 bps */
119         {   4800,   2400,    960,   480 }, /*   115200 bps */
120         {  28800,  11520,   5760,  2880 }, /*   576000 bps */
121         {  57600,  28800,  11520,  5760 }, /*  1152000 bps */
122         { 200000, 100000,  40000, 20000 }, /*  4000000 bps */
123         { 800000, 400000, 160000, 80000 }, /* 16000000 bps */
124 };
125
126 static pi_minor_info_t pi_minor_call_table_type_0[] = {
127         { NULL, 0 },
128 /* 01 */{ irlap_param_baud_rate,       PV_INTEGER | PV_LITTLE_ENDIAN },
129         { NULL, 0 },
130         { NULL, 0 },
131         { NULL, 0 },
132         { NULL, 0 },
133         { NULL, 0 },
134         { NULL, 0 },
135 /* 08 */{ irlap_param_link_disconnect, PV_INT_8_BITS }
136 };
137
138 static pi_minor_info_t pi_minor_call_table_type_1[] = {
139         { NULL, 0 },
140         { NULL, 0 },
141 /* 82 */{ irlap_param_max_turn_time,   PV_INT_8_BITS },
142 /* 83 */{ irlap_param_data_size,       PV_INT_8_BITS },
143 /* 84 */{ irlap_param_window_size,     PV_INT_8_BITS },
144 /* 85 */{ irlap_param_additional_bofs, PV_INT_8_BITS },
145 /* 86 */{ irlap_param_min_turn_time,   PV_INT_8_BITS },
146 };
147
148 static pi_major_info_t pi_major_call_table[] = {
149         { pi_minor_call_table_type_0, 9 },
150         { pi_minor_call_table_type_1, 7 },
151 };
152
153 static pi_param_info_t irlap_param_info = { pi_major_call_table, 2, 0x7f, 7 };
154
155 /* ---------------------- LOCAL SUBROUTINES ---------------------- */
156 /* Note : we start with a bunch of local subroutines.
157  * As the compiler is "one pass", this is the only way to get them to
158  * inline properly...
159  * Jean II
160  */
161 /*
162  * Function value_index (value, array, size)
163  *
164  *    Returns the index to the value in the specified array
165  */
166 static inline int value_index(__u32 value, __u32 *array, int size)
167 {
168         int i;
169         
170         for (i=0; i < size; i++)
171                 if (array[i] == value)
172                         break;
173         return i;
174 }
175
176 /*
177  * Function index_value (index, array)
178  *
179  *    Returns value to index in array, easy!
180  *
181  */
182 static inline __u32 index_value(int index, __u32 *array) 
183 {
184         return array[index];
185 }
186
187 /*
188  * Function msb_index (word)
189  *
190  *    Returns index to most significant bit (MSB) in word
191  *
192  */
193 static int msb_index (__u16 word) 
194 {
195         __u16 msb = 0x8000;
196         int index = 15;   /* Current MSB */
197
198         /* Check for buggy peers.
199          * Note : there is a small probability that it could be us, but I
200          * would expect driver authors to catch that pretty early and be
201          * able to check precisely what's going on. If a end user sees this,
202          * it's very likely the peer. - Jean II */
203         if (word == 0) {
204                 IRDA_WARNING("%s(), Detected buggy peer, adjust null PV to 0x1!\n",
205                          __FUNCTION__);
206                 /* The only safe choice (we don't know the array size) */
207                 word = 0x1;
208         }
209
210         while (msb) {
211                 if (word & msb)
212                         break;   /* Found it! */
213                 msb >>=1;
214                 index--;
215         }
216         return index;
217 }
218
219 /*
220  * Function value_lower_bits (value, array)
221  *
222  *    Returns a bit field marking all possibility lower than value.
223  */
224 static inline int value_lower_bits(__u32 value, __u32 *array, int size, __u16 *field)
225 {
226         int     i;
227         __u16   mask = 0x1;
228         __u16   result = 0x0;
229
230         for (i=0; i < size; i++) {
231                 /* Add the current value to the bit field, shift mask */
232                 result |= mask;
233                 mask <<= 1;
234                 /* Finished ? */
235                 if (array[i] >= value)
236                         break;
237         }
238         /* Send back a valid index */
239         if(i >= size)
240           i = size - 1; /* Last item */
241         *field = result;
242         return i;
243 }
244
245 /*
246  * Function value_highest_bit (value, array)
247  *
248  *    Returns a bit field marking the highest possibility lower than value.
249  */
250 static inline int value_highest_bit(__u32 value, __u32 *array, int size, __u16 *field)
251 {
252         int     i;
253         __u16   mask = 0x1;
254         __u16   result = 0x0;
255
256         for (i=0; i < size; i++) {
257                 /* Finished ? */
258                 if (array[i] <= value)
259                         break;
260                 /* Shift mask */
261                 mask <<= 1;
262         }
263         /* Set the current value to the bit field */
264         result |= mask;
265         /* Send back a valid index */
266         if(i >= size)
267           i = size - 1; /* Last item */
268         *field = result;
269         return i;
270 }
271
272 /* -------------------------- MAIN CALLS -------------------------- */
273
274 /*
275  * Function irda_qos_compute_intersection (qos, new)
276  *
277  *    Compute the intersection of the old QoS capabilities with new ones
278  *
279  */
280 void irda_qos_compute_intersection(struct qos_info *qos, struct qos_info *new)
281 {
282         IRDA_ASSERT(qos != NULL, return;);
283         IRDA_ASSERT(new != NULL, return;);
284
285         /* Apply */
286         qos->baud_rate.bits       &= new->baud_rate.bits;
287         qos->window_size.bits     &= new->window_size.bits;
288         qos->min_turn_time.bits   &= new->min_turn_time.bits;
289         qos->max_turn_time.bits   &= new->max_turn_time.bits;
290         qos->data_size.bits       &= new->data_size.bits;
291         qos->link_disc_time.bits  &= new->link_disc_time.bits;
292         qos->additional_bofs.bits &= new->additional_bofs.bits;
293
294         irda_qos_bits_to_value(qos);
295 }
296
297 /*
298  * Function irda_init_max_qos_capabilies (qos)
299  *
300  *    The purpose of this function is for layers and drivers to be able to
301  *    set the maximum QoS possible and then "and in" their own limitations
302  * 
303  */
304 void irda_init_max_qos_capabilies(struct qos_info *qos)
305 {
306         int i;
307         /* 
308          *  These are the maximum supported values as specified on pages
309          *  39-43 in IrLAP
310          */
311
312         /* Use sysctl to set some configurable values... */
313         /* Set configured max speed */
314         i = value_lower_bits(sysctl_max_baud_rate, baud_rates, 10,
315                              &qos->baud_rate.bits);
316         sysctl_max_baud_rate = index_value(i, baud_rates);
317
318         /* Set configured max disc time */
319         i = value_lower_bits(sysctl_max_noreply_time, link_disc_times, 8,
320                              &qos->link_disc_time.bits);
321         sysctl_max_noreply_time = index_value(i, link_disc_times);
322
323         /* LSB is first byte, MSB is second byte */
324         qos->baud_rate.bits    &= 0x03ff;
325
326         qos->window_size.bits     = 0x7f;
327         qos->min_turn_time.bits   = 0xff;
328         qos->max_turn_time.bits   = 0x0f;
329         qos->data_size.bits       = 0x3f;
330         qos->link_disc_time.bits &= 0xff;
331         qos->additional_bofs.bits = 0xff;
332 }
333 EXPORT_SYMBOL(irda_init_max_qos_capabilies);
334
335 /*
336  * Function irlap_adjust_qos_settings (qos)
337  *
338  *     Adjust QoS settings in case some values are not possible to use because
339  *     of other settings
340  */
341 static void irlap_adjust_qos_settings(struct qos_info *qos)
342 {
343         __u32 line_capacity;
344         int index;
345
346         IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
347
348         /*
349          * Make sure the mintt is sensible.
350          * Main culprit : Ericsson T39. - Jean II
351          */
352         if (sysctl_min_tx_turn_time > qos->min_turn_time.value) {
353                 int i;
354
355                 IRDA_WARNING("%s(), Detected buggy peer, adjust mtt to %dus!\n",
356                          __FUNCTION__, sysctl_min_tx_turn_time);
357
358                 /* We don't really need bits, but easier this way */
359                 i = value_highest_bit(sysctl_min_tx_turn_time, min_turn_times,
360                                       8, &qos->min_turn_time.bits);
361                 sysctl_min_tx_turn_time = index_value(i, min_turn_times);
362                 qos->min_turn_time.value = sysctl_min_tx_turn_time;
363         }
364
365         /* 
366          * Not allowed to use a max turn time less than 500 ms if the baudrate
367          * is less than 115200
368          */
369         if ((qos->baud_rate.value < 115200) && 
370             (qos->max_turn_time.value < 500))
371         {
372                 IRDA_DEBUG(0, 
373                            "%s(), adjusting max turn time from %d to 500 ms\n",
374                            __FUNCTION__, qos->max_turn_time.value);
375                 qos->max_turn_time.value = 500;
376         }
377         
378         /*
379          * The data size must be adjusted according to the baud rate and max 
380          * turn time
381          */
382         index = value_index(qos->data_size.value, data_sizes, 6);
383         line_capacity = irlap_max_line_capacity(qos->baud_rate.value, 
384                                                 qos->max_turn_time.value);
385
386 #ifdef CONFIG_IRDA_DYNAMIC_WINDOW
387         while ((qos->data_size.value > line_capacity) && (index > 0)) {
388                 qos->data_size.value = data_sizes[index--];
389                 IRDA_DEBUG(2, "%s(), reducing data size to %d\n",
390                            __FUNCTION__, qos->data_size.value);
391         }
392 #else /* Use method described in section 6.6.11 of IrLAP */
393         while (irlap_requested_line_capacity(qos) > line_capacity) {
394                 IRDA_ASSERT(index != 0, return;);
395
396                 /* Must be able to send at least one frame */
397                 if (qos->window_size.value > 1) {
398                         qos->window_size.value--;
399                         IRDA_DEBUG(2, "%s(), reducing window size to %d\n",
400                                    __FUNCTION__, qos->window_size.value);
401                 } else if (index > 1) {
402                         qos->data_size.value = data_sizes[index--];
403                         IRDA_DEBUG(2, "%s(), reducing data size to %d\n",
404                                    __FUNCTION__, qos->data_size.value);
405                 } else {
406                         IRDA_WARNING("%s(), nothing more we can do!\n",
407                                      __FUNCTION__);
408                 }
409         }
410 #endif /* CONFIG_IRDA_DYNAMIC_WINDOW */
411         /*
412          * Fix tx data size according to user limits - Jean II
413          */
414         if (qos->data_size.value > sysctl_max_tx_data_size)
415                 /* Allow non discrete adjustement to avoid loosing capacity */
416                 qos->data_size.value = sysctl_max_tx_data_size;
417         /*
418          * Override Tx window if user request it. - Jean II
419          */
420         if (qos->window_size.value > sysctl_max_tx_window)
421                 qos->window_size.value = sysctl_max_tx_window;
422 }
423
424 /*
425  * Function irlap_negotiate (qos_device, qos_session, skb)
426  *
427  *    Negotiate QoS values, not really that much negotiation :-)
428  *    We just set the QoS capabilities for the peer station
429  *
430  */
431 int irlap_qos_negotiate(struct irlap_cb *self, struct sk_buff *skb) 
432 {
433         int ret;
434         
435         ret = irda_param_extract_all(self, skb->data, skb->len, 
436                                      &irlap_param_info);
437         
438         /* Convert the negotiated bits to values */
439         irda_qos_bits_to_value(&self->qos_tx);
440         irda_qos_bits_to_value(&self->qos_rx);
441
442         irlap_adjust_qos_settings(&self->qos_tx);
443
444         IRDA_DEBUG(2, "Setting BAUD_RATE to %d bps.\n", 
445                    self->qos_tx.baud_rate.value);
446         IRDA_DEBUG(2, "Setting DATA_SIZE to %d bytes\n",
447                    self->qos_tx.data_size.value);
448         IRDA_DEBUG(2, "Setting WINDOW_SIZE to %d\n", 
449                    self->qos_tx.window_size.value);
450         IRDA_DEBUG(2, "Setting XBOFS to %d\n", 
451                    self->qos_tx.additional_bofs.value);
452         IRDA_DEBUG(2, "Setting MAX_TURN_TIME to %d ms.\n",
453                    self->qos_tx.max_turn_time.value);
454         IRDA_DEBUG(2, "Setting MIN_TURN_TIME to %d usecs.\n",
455                    self->qos_tx.min_turn_time.value);
456         IRDA_DEBUG(2, "Setting LINK_DISC to %d secs.\n", 
457                    self->qos_tx.link_disc_time.value);
458         return ret;
459 }
460
461 /*
462  * Function irlap_insert_negotiation_params (qos, fp)
463  *
464  *    Insert QoS negotiaion pararameters into frame
465  *
466  */
467 int irlap_insert_qos_negotiation_params(struct irlap_cb *self, 
468                                         struct sk_buff *skb)
469 {
470         int ret;
471
472         /* Insert data rate */
473         ret = irda_param_insert(self, PI_BAUD_RATE, skb->tail, 
474                                 skb_tailroom(skb), &irlap_param_info);
475         if (ret < 0)
476                 return ret;
477         skb_put(skb, ret);
478
479         /* Insert max turnaround time */
480         ret = irda_param_insert(self, PI_MAX_TURN_TIME, skb->tail, 
481                                 skb_tailroom(skb), &irlap_param_info);
482         if (ret < 0)
483                 return ret;
484         skb_put(skb, ret);
485
486         /* Insert data size */
487         ret = irda_param_insert(self, PI_DATA_SIZE, skb->tail, 
488                                 skb_tailroom(skb), &irlap_param_info);
489         if (ret < 0)
490                 return ret;
491         skb_put(skb, ret);
492
493         /* Insert window size */
494         ret = irda_param_insert(self, PI_WINDOW_SIZE, skb->tail, 
495                                 skb_tailroom(skb), &irlap_param_info);
496         if (ret < 0)
497                 return ret;
498         skb_put(skb, ret);
499
500         /* Insert additional BOFs */
501         ret = irda_param_insert(self, PI_ADD_BOFS, skb->tail, 
502                                 skb_tailroom(skb), &irlap_param_info);
503         if (ret < 0)
504                 return ret;
505         skb_put(skb, ret);
506
507         /* Insert minimum turnaround time */
508         ret = irda_param_insert(self, PI_MIN_TURN_TIME, skb->tail, 
509                                 skb_tailroom(skb), &irlap_param_info);
510         if (ret < 0)
511                 return ret;
512         skb_put(skb, ret);
513
514         /* Insert link disconnect/threshold time */
515         ret = irda_param_insert(self, PI_LINK_DISC, skb->tail, 
516                                 skb_tailroom(skb), &irlap_param_info);
517         if (ret < 0)
518                 return ret;
519         skb_put(skb, ret);
520
521         return 0;
522 }
523
524 /*
525  * Function irlap_param_baud_rate (instance, param, get)
526  *
527  *    Negotiate data-rate
528  *
529  */
530 static int irlap_param_baud_rate(void *instance, irda_param_t *param, int get)
531 {
532         __u16 final;
533
534         struct irlap_cb *self = (struct irlap_cb *) instance;
535
536         IRDA_ASSERT(self != NULL, return -1;);
537         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
538
539         if (get) {
540                 param->pv.i = self->qos_rx.baud_rate.bits;
541                 IRDA_DEBUG(2, "%s(), baud rate = 0x%02x\n", 
542                            __FUNCTION__, param->pv.i);          
543         } else {
544                 /* 
545                  *  Stations must agree on baud rate, so calculate
546                  *  intersection 
547                  */
548                 IRDA_DEBUG(2, "Requested BAUD_RATE: 0x%04x\n", (__u16) param->pv.i);
549                 final = (__u16) param->pv.i & self->qos_rx.baud_rate.bits;
550
551                 IRDA_DEBUG(2, "Final BAUD_RATE: 0x%04x\n", final);
552                 self->qos_tx.baud_rate.bits = final;
553                 self->qos_rx.baud_rate.bits = final;
554         }
555
556         return 0;
557 }
558
559 /*
560  * Function irlap_param_link_disconnect (instance, param, get)
561  *
562  *    Negotiate link disconnect/threshold time. 
563  *
564  */
565 static int irlap_param_link_disconnect(void *instance, irda_param_t *param, 
566                                        int get)
567 {
568         __u16 final;
569         
570         struct irlap_cb *self = (struct irlap_cb *) instance;
571         
572         IRDA_ASSERT(self != NULL, return -1;);
573         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
574         
575         if (get)
576                 param->pv.i = self->qos_rx.link_disc_time.bits;
577         else {
578                 /*  
579                  *  Stations must agree on link disconnect/threshold 
580                  *  time.
581                  */
582                 IRDA_DEBUG(2, "LINK_DISC: %02x\n", (__u8) param->pv.i);
583                 final = (__u8) param->pv.i & self->qos_rx.link_disc_time.bits;
584
585                 IRDA_DEBUG(2, "Final LINK_DISC: %02x\n", final);
586                 self->qos_tx.link_disc_time.bits = final;
587                 self->qos_rx.link_disc_time.bits = final;
588         }
589         return 0;
590 }
591
592 /*
593  * Function irlap_param_max_turn_time (instance, param, get)
594  *
595  *    Negotiate the maximum turnaround time. This is a type 1 parameter and
596  *    will be negotiated independently for each station
597  *
598  */
599 static int irlap_param_max_turn_time(void *instance, irda_param_t *param, 
600                                      int get)
601 {
602         struct irlap_cb *self = (struct irlap_cb *) instance;
603         
604         IRDA_ASSERT(self != NULL, return -1;);
605         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
606         
607         if (get)
608                 param->pv.i = self->qos_rx.max_turn_time.bits;
609         else
610                 self->qos_tx.max_turn_time.bits = (__u8) param->pv.i;
611
612         return 0;
613 }
614
615 /*
616  * Function irlap_param_data_size (instance, param, get)
617  *
618  *    Negotiate the data size. This is a type 1 parameter and
619  *    will be negotiated independently for each station
620  *
621  */
622 static int irlap_param_data_size(void *instance, irda_param_t *param, int get)
623 {
624         struct irlap_cb *self = (struct irlap_cb *) instance;
625         
626         IRDA_ASSERT(self != NULL, return -1;);
627         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
628         
629         if (get)
630                 param->pv.i = self->qos_rx.data_size.bits;
631         else
632                 self->qos_tx.data_size.bits = (__u8) param->pv.i;
633
634         return 0;
635 }
636
637 /*
638  * Function irlap_param_window_size (instance, param, get)
639  *
640  *    Negotiate the window size. This is a type 1 parameter and
641  *    will be negotiated independently for each station
642  *
643  */
644 static int irlap_param_window_size(void *instance, irda_param_t *param, 
645                                    int get)
646 {
647         struct irlap_cb *self = (struct irlap_cb *) instance;
648         
649         IRDA_ASSERT(self != NULL, return -1;);
650         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
651         
652         if (get)
653                 param->pv.i = self->qos_rx.window_size.bits;
654         else
655                 self->qos_tx.window_size.bits = (__u8) param->pv.i;
656
657         return 0;
658 }
659
660 /*
661  * Function irlap_param_additional_bofs (instance, param, get)
662  *
663  *    Negotiate additional BOF characters. This is a type 1 parameter and
664  *    will be negotiated independently for each station.
665  */
666 static int irlap_param_additional_bofs(void *instance, irda_param_t *param, int get)
667 {
668         struct irlap_cb *self = (struct irlap_cb *) instance;
669         
670         IRDA_ASSERT(self != NULL, return -1;);
671         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
672         
673         if (get)
674                 param->pv.i = self->qos_rx.additional_bofs.bits;
675         else
676                 self->qos_tx.additional_bofs.bits = (__u8) param->pv.i;
677
678         return 0;
679 }
680
681 /*
682  * Function irlap_param_min_turn_time (instance, param, get)
683  *
684  *    Negotiate the minimum turn around time. This is a type 1 parameter and
685  *    will be negotiated independently for each station
686  */
687 static int irlap_param_min_turn_time(void *instance, irda_param_t *param, 
688                                      int get)
689 {
690         struct irlap_cb *self = (struct irlap_cb *) instance;
691         
692         IRDA_ASSERT(self != NULL, return -1;);
693         IRDA_ASSERT(self->magic == LAP_MAGIC, return -1;);
694         
695         if (get)
696                 param->pv.i = self->qos_rx.min_turn_time.bits;
697         else
698                 self->qos_tx.min_turn_time.bits = (__u8) param->pv.i;
699
700         return 0;
701 }
702
703 /*
704  * Function irlap_max_line_capacity (speed, max_turn_time, min_turn_time)
705  *
706  *    Calculate the maximum line capacity
707  *
708  */
709 __u32 irlap_max_line_capacity(__u32 speed, __u32 max_turn_time)
710 {
711         __u32 line_capacity;
712         int i,j;
713
714         IRDA_DEBUG(2, "%s(), speed=%d, max_turn_time=%d\n",
715                    __FUNCTION__, speed, max_turn_time);
716
717         i = value_index(speed, baud_rates, 10);
718         j = value_index(max_turn_time, max_turn_times, 4);
719
720         IRDA_ASSERT(((i >=0) && (i <10)), return 0;);
721         IRDA_ASSERT(((j >=0) && (j <4)), return 0;);
722
723         line_capacity = max_line_capacities[i][j];
724
725         IRDA_DEBUG(2, "%s(), line capacity=%d bytes\n", 
726                    __FUNCTION__, line_capacity);
727         
728         return line_capacity;
729 }
730
731 #ifndef CONFIG_IRDA_DYNAMIC_WINDOW
732 static __u32 irlap_requested_line_capacity(struct qos_info *qos)
733 {
734         __u32 line_capacity;
735
736         line_capacity = qos->window_size.value *
737                 (qos->data_size.value + 6 + qos->additional_bofs.value) +
738                 irlap_min_turn_time_in_bytes(qos->baud_rate.value,
739                                              qos->min_turn_time.value);
740
741         IRDA_DEBUG(2, "%s(), requested line capacity=%d\n",
742                    __FUNCTION__, line_capacity);
743
744         return line_capacity;
745 }
746 #endif
747
748 void irda_qos_bits_to_value(struct qos_info *qos)
749 {
750         int index;
751
752         IRDA_ASSERT(qos != NULL, return;);
753         
754         index = msb_index(qos->baud_rate.bits);
755         qos->baud_rate.value = baud_rates[index];
756
757         index = msb_index(qos->data_size.bits);
758         qos->data_size.value = data_sizes[index];
759
760         index = msb_index(qos->window_size.bits);
761         qos->window_size.value = index+1;
762
763         index = msb_index(qos->min_turn_time.bits);
764         qos->min_turn_time.value = min_turn_times[index];
765         
766         index = msb_index(qos->max_turn_time.bits);
767         qos->max_turn_time.value = max_turn_times[index];
768
769         index = msb_index(qos->link_disc_time.bits);
770         qos->link_disc_time.value = link_disc_times[index];
771         
772         index = msb_index(qos->additional_bofs.bits);
773         qos->additional_bofs.value = add_bofs[index];
774 }
775 EXPORT_SYMBOL(irda_qos_bits_to_value);