git.oblomov.eu Git - linux-2.6/blob - 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);