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