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