~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/net/irda/qos.c

Version: ~ [ linux-5.12-rc5 ] ~ [ linux-5.11.11 ] ~ [ linux-5.10.27 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.109 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.184 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.228 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.264 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.264 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.18.140 ] ~ [ linux-3.16.85 ] ~ [ linux-3.14.79 ] ~ [ linux-3.12.74 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  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  */
 49 int 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  */
 56 int 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  */
 65 unsigned 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 */
 80 unsigned 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 */
 86 unsigned int sysctl_max_tx_window = 7;
 87 
 88 static int irlap_param_baud_rate(void *instance, irda_param_t *param, int get);
 89 static int irlap_param_link_disconnect(void *instance, irda_param_t *parm,
 90                                        int get);
 91 static int irlap_param_max_turn_time(void *instance, irda_param_t *param,
 92                                      int get);
 93 static int irlap_param_data_size(void *instance, irda_param_t *param, int get);
 94 static int irlap_param_window_size(void *instance, irda_param_t *param,
 95                                    int get);
 96 static int irlap_param_additional_bofs(void *instance, irda_param_t *parm,
 97                                        int get);
 98 static int irlap_param_min_turn_time(void *instance, irda_param_t *param,
 99                                      int get);
100 
101 #ifndef CONFIG_IRDA_DYNAMIC_WINDOW
102 static __u32 irlap_requested_line_capacity(struct qos_info *qos);
103 #endif
104 
105 static __u32 min_turn_times[]  = { 10000, 5000, 1000, 500, 100, 50, 10, 0 }; /* us */
106 static __u32 baud_rates[]      = { 2400, 9600, 19200, 38400, 57600, 115200, 576000,
107                                    1152000, 4000000, 16000000 };           /* bps */
108 static __u32 data_sizes[]      = { 64, 128, 256, 512, 1024, 2048 };        /* bytes */
109 static __u32 add_bofs[]        = { 48, 24, 12, 5, 3, 2, 1, 0 };            /* bytes */
110 static __u32 max_turn_times[]  = { 500, 250, 100, 50 };                    /* ms */
111 static __u32 link_disc_times[] = { 3, 8, 12, 16, 20, 25, 30, 40 };         /* secs */
112 
113 static __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 
127 static 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 
139 static 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 
149 static 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 
154 static 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  */
167 static 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  */
183 static 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  */
194 static 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  */
225 static 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  */
251 static 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  */
281 void 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  */
305 void 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 }
334 EXPORT_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  */
342 static 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  */
432 int 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  */
468 int 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  */
531 static 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  */
566 static 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  */
600 static 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  */
623 static 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  */
645 static 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  */
667 static 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  */
688 static 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
733 static __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 
749 void 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 }
776 EXPORT_SYMBOL(irda_qos_bits_to_value);
777 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp