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