[PATCH] x86_64: Make IRDA devices are not really ISA devices not depend on CONFIG_ISA
[linux-2.6] / net / irda / irlap_frame.c
1 /*********************************************************************
2  *
3  * Filename:      irlap_frame.c
4  * Version:       1.0
5  * Description:   Build and transmit IrLAP frames
6  * Status:        Stable
7  * Author:        Dag Brattli <dagb@cs.uit.no>
8  * Created at:    Tue Aug 19 10:27:26 1997
9  * Modified at:   Wed Jan  5 08:59:04 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-2003 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  *     Neither Dag Brattli nor University of Tromsø admit liability nor
22  *     provide warranty for any of this software. This material is
23  *     provided "AS-IS" and at no charge.
24  *
25  ********************************************************************/
26
27 #include <linux/skbuff.h>
28 #include <linux/if.h>
29 #include <linux/if_ether.h>
30 #include <linux/netdevice.h>
31 #include <linux/irda.h>
32
33 #include <net/pkt_sched.h>
34 #include <net/sock.h>
35
36 #include <asm/byteorder.h>
37
38 #include <net/irda/irda.h>
39 #include <net/irda/irda_device.h>
40 #include <net/irda/irlap.h>
41 #include <net/irda/wrapper.h>
42 #include <net/irda/timer.h>
43 #include <net/irda/irlap_frame.h>
44 #include <net/irda/qos.h>
45
46 static void irlap_send_i_frame(struct irlap_cb *self, struct sk_buff *skb,
47                                int command);
48
49 /*
50  * Function irlap_insert_info (self, skb)
51  *
52  *    Insert minimum turnaround time and speed information into the skb. We
53  *    need to do this since it's per packet relevant information. Safe to
54  *    have this function inlined since it's only called from one place
55  */
56 static inline void irlap_insert_info(struct irlap_cb *self,
57                                      struct sk_buff *skb)
58 {
59         struct irda_skb_cb *cb = (struct irda_skb_cb *) skb->cb;
60
61         /*
62          * Insert MTT (min. turn time) and speed into skb, so that the
63          * device driver knows which settings to use
64          */
65         cb->magic = LAP_MAGIC;
66         cb->mtt = self->mtt_required;
67         cb->next_speed = self->speed;
68
69         /* Reset */
70         self->mtt_required = 0;
71
72         /*
73          * Delay equals negotiated BOFs count, plus the number of BOFs to
74          * force the negotiated minimum turnaround time
75          */
76         cb->xbofs = self->bofs_count;
77         cb->next_xbofs = self->next_bofs;
78         cb->xbofs_delay = self->xbofs_delay;
79
80         /* Reset XBOF's delay (used only for getting min turn time) */
81         self->xbofs_delay = 0;
82         /* Put the correct xbofs value for the next packet */
83         self->bofs_count = self->next_bofs;
84 }
85
86 /*
87  * Function irlap_queue_xmit (self, skb)
88  *
89  *    A little wrapper for dev_queue_xmit, so we can insert some common
90  *    code into it.
91  */
92 void irlap_queue_xmit(struct irlap_cb *self, struct sk_buff *skb)
93 {
94         /* Some common init stuff */
95         skb->dev = self->netdev;
96         skb->h.raw = skb->nh.raw = skb->mac.raw = skb->data;
97         skb->protocol = htons(ETH_P_IRDA);
98         skb->priority = TC_PRIO_BESTEFFORT;
99
100         irlap_insert_info(self, skb);
101
102         dev_queue_xmit(skb);
103 }
104
105 /*
106  * Function irlap_send_snrm_cmd (void)
107  *
108  *    Transmits a connect SNRM command frame
109  */
110 void irlap_send_snrm_frame(struct irlap_cb *self, struct qos_info *qos)
111 {
112         struct sk_buff *tx_skb;
113         struct snrm_frame *frame;
114         int ret;
115
116         IRDA_ASSERT(self != NULL, return;);
117         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
118
119         /* Allocate frame */
120         tx_skb = dev_alloc_skb(64);
121         if (!tx_skb)
122                 return;
123
124         frame = (struct snrm_frame *) skb_put(tx_skb, 2);
125
126         /* Insert connection address field */
127         if (qos)
128                 frame->caddr = CMD_FRAME | CBROADCAST;
129         else
130                 frame->caddr = CMD_FRAME | self->caddr;
131
132         /* Insert control field */
133         frame->control = SNRM_CMD | PF_BIT;
134
135         /*
136          *  If we are establishing a connection then insert QoS paramerters
137          */
138         if (qos) {
139                 skb_put(tx_skb, 9); /* 21 left */
140                 frame->saddr = cpu_to_le32(self->saddr);
141                 frame->daddr = cpu_to_le32(self->daddr);
142
143                 frame->ncaddr = self->caddr;
144
145                 ret = irlap_insert_qos_negotiation_params(self, tx_skb);
146                 if (ret < 0) {
147                         dev_kfree_skb(tx_skb);
148                         return;
149                 }
150         }
151         irlap_queue_xmit(self, tx_skb);
152 }
153
154 /*
155  * Function irlap_recv_snrm_cmd (skb, info)
156  *
157  *    Received SNRM (Set Normal Response Mode) command frame
158  *
159  */
160 static void irlap_recv_snrm_cmd(struct irlap_cb *self, struct sk_buff *skb,
161                                 struct irlap_info *info)
162 {
163         struct snrm_frame *frame;
164
165         if (pskb_may_pull(skb,sizeof(struct snrm_frame))) {
166                 frame = (struct snrm_frame *) skb->data;
167
168                 /* Copy the new connection address ignoring the C/R bit */
169                 info->caddr = frame->ncaddr & 0xFE;
170
171                 /* Check if the new connection address is valid */
172                 if ((info->caddr == 0x00) || (info->caddr == 0xfe)) {
173                         IRDA_DEBUG(3, "%s(), invalid connection address!\n",
174                                    __FUNCTION__);
175                         return;
176                 }
177
178                 /* Copy peer device address */
179                 info->daddr = le32_to_cpu(frame->saddr);
180                 info->saddr = le32_to_cpu(frame->daddr);
181
182                 /* Only accept if addressed directly to us */
183                 if (info->saddr != self->saddr) {
184                         IRDA_DEBUG(2, "%s(), not addressed to us!\n",
185                                    __FUNCTION__);
186                         return;
187                 }
188                 irlap_do_event(self, RECV_SNRM_CMD, skb, info);
189         } else {
190                 /* Signal that this SNRM frame does not contain and I-field */
191                 irlap_do_event(self, RECV_SNRM_CMD, skb, NULL);
192         }
193 }
194
195 /*
196  * Function irlap_send_ua_response_frame (qos)
197  *
198  *    Send UA (Unnumbered Acknowledgement) frame
199  *
200  */
201 void irlap_send_ua_response_frame(struct irlap_cb *self, struct qos_info *qos)
202 {
203         struct sk_buff *tx_skb;
204         struct ua_frame *frame;
205         int ret;
206
207         IRDA_DEBUG(2, "%s() <%ld>\n", __FUNCTION__, jiffies);
208
209         IRDA_ASSERT(self != NULL, return;);
210         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
211
212         /* Allocate frame */
213         tx_skb = dev_alloc_skb(64);
214         if (!tx_skb)
215                 return;
216
217         frame = (struct ua_frame *) skb_put(tx_skb, 10);
218
219         /* Build UA response */
220         frame->caddr = self->caddr;
221         frame->control = UA_RSP | PF_BIT;
222
223         frame->saddr = cpu_to_le32(self->saddr);
224         frame->daddr = cpu_to_le32(self->daddr);
225
226         /* Should we send QoS negotiation parameters? */
227         if (qos) {
228                 ret = irlap_insert_qos_negotiation_params(self, tx_skb);
229                 if (ret < 0) {
230                         dev_kfree_skb(tx_skb);
231                         return;
232                 }
233         }
234
235         irlap_queue_xmit(self, tx_skb);
236 }
237
238
239 /*
240  * Function irlap_send_dm_frame (void)
241  *
242  *    Send disconnected mode (DM) frame
243  *
244  */
245 void irlap_send_dm_frame( struct irlap_cb *self)
246 {
247         struct sk_buff *tx_skb = NULL;
248         __u8 *frame;
249
250         IRDA_ASSERT(self != NULL, return;);
251         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
252
253         tx_skb = dev_alloc_skb(32);
254         if (!tx_skb)
255                 return;
256
257         frame = skb_put(tx_skb, 2);
258
259         if (self->state == LAP_NDM)
260                 frame[0] = CBROADCAST;
261         else
262                 frame[0] = self->caddr;
263
264         frame[1] = DM_RSP | PF_BIT;
265
266         irlap_queue_xmit(self, tx_skb);
267 }
268
269 /*
270  * Function irlap_send_disc_frame (void)
271  *
272  *    Send disconnect (DISC) frame
273  *
274  */
275 void irlap_send_disc_frame(struct irlap_cb *self)
276 {
277         struct sk_buff *tx_skb = NULL;
278         __u8 *frame;
279
280         IRDA_DEBUG(3, "%s()\n", __FUNCTION__);
281
282         IRDA_ASSERT(self != NULL, return;);
283         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
284
285         tx_skb = dev_alloc_skb(16);
286         if (!tx_skb)
287                 return;
288
289         frame = skb_put(tx_skb, 2);
290
291         frame[0] = self->caddr | CMD_FRAME;
292         frame[1] = DISC_CMD | PF_BIT;
293
294         irlap_queue_xmit(self, tx_skb);
295 }
296
297 /*
298  * Function irlap_send_discovery_xid_frame (S, s, command)
299  *
300  *    Build and transmit a XID (eXchange station IDentifier) discovery
301  *    frame.
302  */
303 void irlap_send_discovery_xid_frame(struct irlap_cb *self, int S, __u8 s,
304                                     __u8 command, discovery_t *discovery)
305 {
306         struct sk_buff *tx_skb = NULL;
307         struct xid_frame *frame;
308         __u32 bcast = BROADCAST;
309         __u8 *info;
310
311         IRDA_DEBUG(4, "%s(), s=%d, S=%d, command=%d\n", __FUNCTION__,
312                    s, S, command);
313
314         IRDA_ASSERT(self != NULL, return;);
315         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
316         IRDA_ASSERT(discovery != NULL, return;);
317
318         tx_skb = dev_alloc_skb(64);
319         if (!tx_skb)
320                 return;
321
322         skb_put(tx_skb, 14);
323         frame = (struct xid_frame *) tx_skb->data;
324
325         if (command) {
326                 frame->caddr = CBROADCAST | CMD_FRAME;
327                 frame->control =  XID_CMD | PF_BIT;
328         } else {
329                 frame->caddr = CBROADCAST;
330                 frame->control =  XID_RSP | PF_BIT;
331         }
332         frame->ident = XID_FORMAT;
333
334         frame->saddr = cpu_to_le32(self->saddr);
335
336         if (command)
337                 frame->daddr = cpu_to_le32(bcast);
338         else
339                 frame->daddr = cpu_to_le32(discovery->data.daddr);
340
341         switch (S) {
342         case 1:
343                 frame->flags = 0x00;
344                 break;
345         case 6:
346                 frame->flags = 0x01;
347                 break;
348         case 8:
349                 frame->flags = 0x02;
350                 break;
351         case 16:
352                 frame->flags = 0x03;
353                 break;
354         default:
355                 frame->flags = 0x02;
356                 break;
357         }
358
359         frame->slotnr = s;
360         frame->version = 0x00;
361
362         /*
363          *  Provide info for final slot only in commands, and for all
364          *  responses. Send the second byte of the hint only if the
365          *  EXTENSION bit is set in the first byte.
366          */
367         if (!command || (frame->slotnr == 0xff)) {
368                 int len;
369
370                 if (discovery->data.hints[0] & HINT_EXTENSION) {
371                         info = skb_put(tx_skb, 2);
372                         info[0] = discovery->data.hints[0];
373                         info[1] = discovery->data.hints[1];
374                 } else {
375                         info = skb_put(tx_skb, 1);
376                         info[0] = discovery->data.hints[0];
377                 }
378                 info = skb_put(tx_skb, 1);
379                 info[0] = discovery->data.charset;
380
381                 len = IRDA_MIN(discovery->name_len, skb_tailroom(tx_skb));
382                 info = skb_put(tx_skb, len);
383                 memcpy(info, discovery->data.info, len);
384         }
385         irlap_queue_xmit(self, tx_skb);
386 }
387
388 /*
389  * Function irlap_recv_discovery_xid_rsp (skb, info)
390  *
391  *    Received a XID discovery response
392  *
393  */
394 static void irlap_recv_discovery_xid_rsp(struct irlap_cb *self,
395                                          struct sk_buff *skb,
396                                          struct irlap_info *info)
397 {
398         struct xid_frame *xid;
399         discovery_t *discovery = NULL;
400         __u8 *discovery_info;
401         char *text;
402
403         IRDA_DEBUG(4, "%s()\n", __FUNCTION__);
404
405         IRDA_ASSERT(self != NULL, return;);
406         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
407
408         if (!pskb_may_pull(skb, sizeof(struct xid_frame))) {
409                 IRDA_ERROR("%s: frame to short!\n", __FUNCTION__);
410                 return;
411         }
412                 
413         xid = (struct xid_frame *) skb->data;
414
415         info->daddr = le32_to_cpu(xid->saddr);
416         info->saddr = le32_to_cpu(xid->daddr);
417
418         /* Make sure frame is addressed to us */
419         if ((info->saddr != self->saddr) && (info->saddr != BROADCAST)) {
420                 IRDA_DEBUG(0, "%s(), frame is not addressed to us!\n",
421                            __FUNCTION__);
422                 return;
423         }
424
425         if ((discovery = kmalloc(sizeof(discovery_t), GFP_ATOMIC)) == NULL) {
426                 IRDA_WARNING("%s: kmalloc failed!\n", __FUNCTION__);
427                 return;
428         }
429         memset(discovery, 0, sizeof(discovery_t));
430
431         discovery->data.daddr = info->daddr;
432         discovery->data.saddr = self->saddr;
433         discovery->timestamp = jiffies;
434
435         IRDA_DEBUG(4, "%s(), daddr=%08x\n", __FUNCTION__,
436                    discovery->data.daddr);
437
438         discovery_info = skb_pull(skb, sizeof(struct xid_frame));
439
440         /* Get info returned from peer */
441         discovery->data.hints[0] = discovery_info[0];
442         if (discovery_info[0] & HINT_EXTENSION) {
443                 IRDA_DEBUG(4, "EXTENSION\n");
444                 discovery->data.hints[1] = discovery_info[1];
445                 discovery->data.charset = discovery_info[2];
446                 text = (char *) &discovery_info[3];
447         } else {
448                 discovery->data.hints[1] = 0;
449                 discovery->data.charset = discovery_info[1];
450                 text = (char *) &discovery_info[2];
451         }
452         /*
453          *  Terminate info string, should be safe since this is where the
454          *  FCS bytes resides.
455          */
456         skb->data[skb->len] = '\0';
457         strncpy(discovery->data.info, text, NICKNAME_MAX_LEN);
458         discovery->name_len = strlen(discovery->data.info);
459
460         info->discovery = discovery;
461
462         irlap_do_event(self, RECV_DISCOVERY_XID_RSP, skb, info);
463 }
464
465 /*
466  * Function irlap_recv_discovery_xid_cmd (skb, info)
467  *
468  *    Received a XID discovery command
469  *
470  */
471 static void irlap_recv_discovery_xid_cmd(struct irlap_cb *self,
472                                          struct sk_buff *skb,
473                                          struct irlap_info *info)
474 {
475         struct xid_frame *xid;
476         discovery_t *discovery = NULL;
477         __u8 *discovery_info;
478         char *text;
479
480         if (!pskb_may_pull(skb, sizeof(struct xid_frame))) {
481                 IRDA_ERROR("%s: frame to short!\n", __FUNCTION__);
482                 return;
483         }
484         
485         xid = (struct xid_frame *) skb->data;
486
487         info->daddr = le32_to_cpu(xid->saddr);
488         info->saddr = le32_to_cpu(xid->daddr);
489
490         /* Make sure frame is addressed to us */
491         if ((info->saddr != self->saddr) && (info->saddr != BROADCAST)) {
492                 IRDA_DEBUG(0, "%s(), frame is not addressed to us!\n",
493                            __FUNCTION__);
494                 return;
495         }
496
497         switch (xid->flags & 0x03) {
498         case 0x00:
499                 info->S = 1;
500                 break;
501         case 0x01:
502                 info->S = 6;
503                 break;
504         case 0x02:
505                 info->S = 8;
506                 break;
507         case 0x03:
508                 info->S = 16;
509                 break;
510         default:
511                 /* Error!! */
512                 return;
513         }
514         info->s = xid->slotnr;
515
516         discovery_info = skb_pull(skb, sizeof(struct xid_frame));
517
518         /*
519          *  Check if last frame
520          */
521         if (info->s == 0xff) {
522                 /* Check if things are sane at this point... */
523                 if((discovery_info == NULL) || 
524                    !pskb_may_pull(skb, 3)) {
525                         IRDA_ERROR("%s: discovery frame to short!\n",
526                                    __FUNCTION__);
527                         return;
528                 }
529
530                 /*
531                  *  We now have some discovery info to deliver!
532                  */
533                 discovery = kmalloc(sizeof(discovery_t), GFP_ATOMIC);
534                 if (!discovery) {
535                         IRDA_WARNING("%s: unable to malloc!\n", __FUNCTION__);
536                         return;
537                 }
538
539                 discovery->data.daddr = info->daddr;
540                 discovery->data.saddr = self->saddr;
541                 discovery->timestamp = jiffies;
542
543                 discovery->data.hints[0] = discovery_info[0];
544                 if (discovery_info[0] & HINT_EXTENSION) {
545                         discovery->data.hints[1] = discovery_info[1];
546                         discovery->data.charset = discovery_info[2];
547                         text = (char *) &discovery_info[3];
548                 } else {
549                         discovery->data.hints[1] = 0;
550                         discovery->data.charset = discovery_info[1];
551                         text = (char *) &discovery_info[2];
552                 }
553                 /*
554                  *  Terminate string, should be safe since this is where the
555                  *  FCS bytes resides.
556                  */
557                 skb->data[skb->len] = '\0';
558                 strncpy(discovery->data.info, text, NICKNAME_MAX_LEN);
559                 discovery->name_len = strlen(discovery->data.info);
560
561                 info->discovery = discovery;
562         } else
563                 info->discovery = NULL;
564
565         irlap_do_event(self, RECV_DISCOVERY_XID_CMD, skb, info);
566 }
567
568 /*
569  * Function irlap_send_rr_frame (self, command)
570  *
571  *    Build and transmit RR (Receive Ready) frame. Notice that it is currently
572  *    only possible to send RR frames with the poll bit set.
573  */
574 void irlap_send_rr_frame(struct irlap_cb *self, int command)
575 {
576         struct sk_buff *tx_skb;
577         __u8 *frame;
578
579         tx_skb = dev_alloc_skb(16);
580         if (!tx_skb)
581                 return;
582
583         frame = skb_put(tx_skb, 2);
584
585         frame[0] = self->caddr;
586         frame[0] |= (command) ? CMD_FRAME : 0;
587
588         frame[1] = RR | PF_BIT | (self->vr << 5);
589
590         irlap_queue_xmit(self, tx_skb);
591 }
592
593 /*
594  * Function irlap_send_rd_frame (self)
595  *
596  *    Request disconnect. Used by a secondary station to request the
597  *    disconnection of the link.
598  */
599 void irlap_send_rd_frame(struct irlap_cb *self)
600 {
601         struct sk_buff *tx_skb;
602         __u8 *frame;
603
604         tx_skb = dev_alloc_skb(16);
605         if (!tx_skb)
606                 return;
607
608         frame = skb_put(tx_skb, 2);
609
610         frame[0] = self->caddr;
611         frame[1] = RD_RSP | PF_BIT;
612
613         irlap_queue_xmit(self, tx_skb);
614 }
615
616 /*
617  * Function irlap_recv_rr_frame (skb, info)
618  *
619  *    Received RR (Receive Ready) frame from peer station, no harm in
620  *    making it inline since its called only from one single place
621  *    (irlap_driver_rcv).
622  */
623 static inline void irlap_recv_rr_frame(struct irlap_cb *self,
624                                        struct sk_buff *skb,
625                                        struct irlap_info *info, int command)
626 {
627         info->nr = skb->data[1] >> 5;
628
629         /* Check if this is a command or a response frame */
630         if (command)
631                 irlap_do_event(self, RECV_RR_CMD, skb, info);
632         else
633                 irlap_do_event(self, RECV_RR_RSP, skb, info);
634 }
635
636 /*
637  * Function irlap_recv_rnr_frame (self, skb, info)
638  *
639  *    Received RNR (Receive Not Ready) frame from peer station
640  *
641  */
642 static void irlap_recv_rnr_frame(struct irlap_cb *self, struct sk_buff *skb,
643                                  struct irlap_info *info, int command)
644 {
645         info->nr = skb->data[1] >> 5;
646
647         IRDA_DEBUG(4, "%s(), nr=%d, %ld\n", __FUNCTION__, info->nr, jiffies);
648
649         if (command)
650                 irlap_do_event(self, RECV_RNR_CMD, skb, info);
651         else
652                 irlap_do_event(self, RECV_RNR_RSP, skb, info);
653 }
654
655 static void irlap_recv_rej_frame(struct irlap_cb *self, struct sk_buff *skb,
656                                  struct irlap_info *info, int command)
657 {
658         IRDA_DEBUG(0, "%s()\n", __FUNCTION__);
659
660         info->nr = skb->data[1] >> 5;
661
662         /* Check if this is a command or a response frame */
663         if (command)
664                 irlap_do_event(self, RECV_REJ_CMD, skb, info);
665         else
666                 irlap_do_event(self, RECV_REJ_RSP, skb, info);
667 }
668
669 static void irlap_recv_srej_frame(struct irlap_cb *self, struct sk_buff *skb,
670                                   struct irlap_info *info, int command)
671 {
672         IRDA_DEBUG(0, "%s()\n", __FUNCTION__);
673
674         info->nr = skb->data[1] >> 5;
675
676         /* Check if this is a command or a response frame */
677         if (command)
678                 irlap_do_event(self, RECV_SREJ_CMD, skb, info);
679         else
680                 irlap_do_event(self, RECV_SREJ_RSP, skb, info);
681 }
682
683 static void irlap_recv_disc_frame(struct irlap_cb *self, struct sk_buff *skb,
684                                   struct irlap_info *info, int command)
685 {
686         IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
687
688         /* Check if this is a command or a response frame */
689         if (command)
690                 irlap_do_event(self, RECV_DISC_CMD, skb, info);
691         else
692                 irlap_do_event(self, RECV_RD_RSP, skb, info);
693 }
694
695 /*
696  * Function irlap_recv_ua_frame (skb, frame)
697  *
698  *    Received UA (Unnumbered Acknowledgement) frame
699  *
700  */
701 static inline void irlap_recv_ua_frame(struct irlap_cb *self,
702                                        struct sk_buff *skb,
703                                        struct irlap_info *info)
704 {
705         irlap_do_event(self, RECV_UA_RSP, skb, info);
706 }
707
708 /*
709  * Function irlap_send_data_primary(self, skb)
710  *
711  *    Send I-frames as the primary station but without the poll bit set
712  *
713  */
714 void irlap_send_data_primary(struct irlap_cb *self, struct sk_buff *skb)
715 {
716         struct sk_buff *tx_skb;
717
718         if (skb->data[1] == I_FRAME) {
719
720                 /*
721                  *  Insert frame sequence number (Vs) in control field before
722                  *  inserting into transmit window queue.
723                  */
724                 skb->data[1] = I_FRAME | (self->vs << 1);
725
726                 /*
727                  *  Insert frame in store, in case of retransmissions
728                  *  Increase skb reference count, see irlap_do_event()
729                  */
730                 skb_get(skb);
731                 skb_queue_tail(&self->wx_list, skb);
732
733                 /* Copy buffer */
734                 tx_skb = skb_clone(skb, GFP_ATOMIC);
735                 if (tx_skb == NULL) {
736                         return;
737                 }
738
739                 self->vs = (self->vs + 1) % 8;
740                 self->ack_required = FALSE;
741                 self->window -= 1;
742
743                 irlap_send_i_frame( self, tx_skb, CMD_FRAME);
744         } else {
745                 IRDA_DEBUG(4, "%s(), sending unreliable frame\n", __FUNCTION__);
746                 irlap_send_ui_frame(self, skb_get(skb), self->caddr, CMD_FRAME);
747                 self->window -= 1;
748         }
749 }
750 /*
751  * Function irlap_send_data_primary_poll (self, skb)
752  *
753  *    Send I(nformation) frame as primary with poll bit set
754  */
755 void irlap_send_data_primary_poll(struct irlap_cb *self, struct sk_buff *skb)
756 {
757         struct sk_buff *tx_skb;
758         int transmission_time;
759
760         /* Stop P timer */
761         del_timer(&self->poll_timer);
762
763         /* Is this reliable or unreliable data? */
764         if (skb->data[1] == I_FRAME) {
765
766                 /*
767                  *  Insert frame sequence number (Vs) in control field before
768                  *  inserting into transmit window queue.
769                  */
770                 skb->data[1] = I_FRAME | (self->vs << 1);
771
772                 /*
773                  *  Insert frame in store, in case of retransmissions
774                  *  Increase skb reference count, see irlap_do_event()
775                  */
776                 skb_get(skb);
777                 skb_queue_tail(&self->wx_list, skb);
778
779                 /* Copy buffer */
780                 tx_skb = skb_clone(skb, GFP_ATOMIC);
781                 if (tx_skb == NULL) {
782                         return;
783                 }
784
785                 /*
786                  *  Set poll bit if necessary. We do this to the copied
787                  *  skb, since retransmitted need to set or clear the poll
788                  *  bit depending on when they are sent.
789                  */
790                 tx_skb->data[1] |= PF_BIT;
791
792                 self->vs = (self->vs + 1) % 8;
793                 self->ack_required = FALSE;
794
795                 irlap_send_i_frame(self, tx_skb, CMD_FRAME);
796         } else {
797                 IRDA_DEBUG(4, "%s(), sending unreliable frame\n", __FUNCTION__);
798
799                 if (self->ack_required) {
800                         irlap_send_ui_frame(self, skb_get(skb), self->caddr, CMD_FRAME);
801                         irlap_send_rr_frame(self, CMD_FRAME);
802                         self->ack_required = FALSE;
803                 } else {
804                         skb->data[1] |= PF_BIT;
805                         irlap_send_ui_frame(self, skb_get(skb), self->caddr, CMD_FRAME);
806                 }
807         }
808
809         /* How much time we took for transmission of all frames.
810          * We don't know, so let assume we used the full window. Jean II */
811         transmission_time = self->final_timeout;
812
813         /* Reset parameter so that we can fill next window */
814         self->window = self->window_size;
815
816 #ifdef CONFIG_IRDA_DYNAMIC_WINDOW
817         /* Remove what we have not used. Just do a prorata of the
818          * bytes left in window to window capacity.
819          * See max_line_capacities[][] in qos.c for details. Jean II */
820         transmission_time -= (self->final_timeout * self->bytes_left
821                               / self->line_capacity);
822         IRDA_DEBUG(4, "%s() adjusting transmission_time : ft=%d, bl=%d, lc=%d -> tt=%d\n", __FUNCTION__, self->final_timeout, self->bytes_left, self->line_capacity, transmission_time);
823
824         /* We are allowed to transmit a maximum number of bytes again. */
825         self->bytes_left = self->line_capacity;
826 #endif /* CONFIG_IRDA_DYNAMIC_WINDOW */
827
828         /*
829          * The network layer has a intermediate buffer between IrLAP
830          * and the IrDA driver which can contain 8 frames. So, even
831          * though IrLAP is currently sending the *last* frame of the
832          * tx-window, the driver most likely has only just started
833          * sending the *first* frame of the same tx-window.
834          * I.e. we are always at the very begining of or Tx window.
835          * Now, we are supposed to set the final timer from the end
836          * of our tx-window to let the other peer reply. So, we need
837          * to add extra time to compensate for the fact that we
838          * are really at the start of tx-window, otherwise the final timer
839          * might expire before he can answer...
840          * Jean II
841          */
842         irlap_start_final_timer(self, self->final_timeout + transmission_time);
843
844         /*
845          * The clever amongst you might ask why we do this adjustement
846          * only here, and not in all the other cases in irlap_event.c.
847          * In all those other case, we only send a very short management
848          * frame (few bytes), so the adjustement would be lost in the
849          * noise...
850          * The exception of course is irlap_resend_rejected_frame().
851          * Jean II */
852 }
853
854 /*
855  * Function irlap_send_data_secondary_final (self, skb)
856  *
857  *    Send I(nformation) frame as secondary with final bit set
858  *
859  */
860 void irlap_send_data_secondary_final(struct irlap_cb *self,
861                                      struct sk_buff *skb)
862 {
863         struct sk_buff *tx_skb = NULL;
864
865         IRDA_ASSERT(self != NULL, return;);
866         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
867         IRDA_ASSERT(skb != NULL, return;);
868
869         /* Is this reliable or unreliable data? */
870         if (skb->data[1] == I_FRAME) {
871
872                 /*
873                  *  Insert frame sequence number (Vs) in control field before
874                  *  inserting into transmit window queue.
875                  */
876                 skb->data[1] = I_FRAME | (self->vs << 1);
877
878                 /*
879                  *  Insert frame in store, in case of retransmissions
880                  *  Increase skb reference count, see irlap_do_event()
881                  */
882                 skb_get(skb);
883                 skb_queue_tail(&self->wx_list, skb);
884
885                 tx_skb = skb_clone(skb, GFP_ATOMIC);
886                 if (tx_skb == NULL) {
887                         return;
888                 }
889
890                 tx_skb->data[1] |= PF_BIT;
891
892                 self->vs = (self->vs + 1) % 8;
893                 self->ack_required = FALSE;
894
895                 irlap_send_i_frame(self, tx_skb, RSP_FRAME);
896         } else {
897                 if (self->ack_required) {
898                         irlap_send_ui_frame(self, skb_get(skb), self->caddr, RSP_FRAME);
899                         irlap_send_rr_frame(self, RSP_FRAME);
900                         self->ack_required = FALSE;
901                 } else {
902                         skb->data[1] |= PF_BIT;
903                         irlap_send_ui_frame(self, skb_get(skb), self->caddr, RSP_FRAME);
904                 }
905         }
906
907         self->window = self->window_size;
908 #ifdef CONFIG_IRDA_DYNAMIC_WINDOW
909         /* We are allowed to transmit a maximum number of bytes again. */
910         self->bytes_left = self->line_capacity;
911 #endif /* CONFIG_IRDA_DYNAMIC_WINDOW */
912
913         irlap_start_wd_timer(self, self->wd_timeout);
914 }
915
916 /*
917  * Function irlap_send_data_secondary (self, skb)
918  *
919  *    Send I(nformation) frame as secondary without final bit set
920  *
921  */
922 void irlap_send_data_secondary(struct irlap_cb *self, struct sk_buff *skb)
923 {
924         struct sk_buff *tx_skb = NULL;
925
926         /* Is this reliable or unreliable data? */
927         if (skb->data[1] == I_FRAME) {
928
929                 /*
930                  *  Insert frame sequence number (Vs) in control field before
931                  *  inserting into transmit window queue.
932                  */
933                 skb->data[1] = I_FRAME | (self->vs << 1);
934
935                 /*
936                  *  Insert frame in store, in case of retransmissions
937                  *  Increase skb reference count, see irlap_do_event()
938                  */
939                 skb_get(skb);
940                 skb_queue_tail(&self->wx_list, skb);
941
942                 tx_skb = skb_clone(skb, GFP_ATOMIC);
943                 if (tx_skb == NULL) {
944                         return;
945                 }
946
947                 self->vs = (self->vs + 1) % 8;
948                 self->ack_required = FALSE;
949                 self->window -= 1;
950
951                 irlap_send_i_frame(self, tx_skb, RSP_FRAME);
952         } else {
953                 irlap_send_ui_frame(self, skb_get(skb), self->caddr, RSP_FRAME);
954                 self->window -= 1;
955         }
956 }
957
958 /*
959  * Function irlap_resend_rejected_frames (nr)
960  *
961  *    Resend frames which has not been acknowledged. Should be safe to
962  *    traverse the list without locking it since this function will only be
963  *    called from interrupt context (BH)
964  */
965 void irlap_resend_rejected_frames(struct irlap_cb *self, int command)
966 {
967         struct sk_buff *tx_skb;
968         struct sk_buff *skb;
969         int count;
970
971         IRDA_ASSERT(self != NULL, return;);
972         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
973
974         /* Initialize variables */
975         count = skb_queue_len(&self->wx_list);
976
977         /*  Resend unacknowledged frame(s) */
978         skb = skb_peek(&self->wx_list);
979         while (skb != NULL) {
980                 irlap_wait_min_turn_around(self, &self->qos_tx);
981
982                 /* We copy the skb to be retransmitted since we will have to
983                  * modify it. Cloning will confuse packet sniffers
984                  */
985                 /* tx_skb = skb_clone( skb, GFP_ATOMIC); */
986                 tx_skb = skb_copy(skb, GFP_ATOMIC);
987                 if (!tx_skb) {
988                         IRDA_DEBUG(0, "%s(), unable to copy\n", __FUNCTION__);
989                         return;
990                 }
991                 /* Unlink tx_skb from list */
992                 tx_skb->next = tx_skb->prev = NULL;
993                 tx_skb->list = NULL;
994
995                 /* Clear old Nr field + poll bit */
996                 tx_skb->data[1] &= 0x0f;
997
998                 /*
999                  *  Set poll bit on the last frame retransmitted
1000                  */
1001                 if (count-- == 1)
1002                         tx_skb->data[1] |= PF_BIT; /* Set p/f bit */
1003                 else
1004                         tx_skb->data[1] &= ~PF_BIT; /* Clear p/f bit */
1005
1006                 irlap_send_i_frame(self, tx_skb, command);
1007
1008                 /*
1009                  *  If our skb is the last buffer in the list, then
1010                  *  we are finished, if not, move to the next sk-buffer
1011                  */
1012                 if (skb == skb_peek_tail(&self->wx_list))
1013                         skb = NULL;
1014                 else
1015                         skb = skb->next;
1016         }
1017 #if 0 /* Not yet */
1018         /*
1019          *  We can now fill the window with additional data frames
1020          */
1021         while (skb_queue_len( &self->txq) > 0) {
1022
1023                 IRDA_DEBUG(0, "%s(), sending additional frames!\n", __FUNCTION__);
1024                 if ((skb_queue_len( &self->txq) > 0) &&
1025                     (self->window > 0)) {
1026                         skb = skb_dequeue( &self->txq);
1027                         IRDA_ASSERT(skb != NULL, return;);
1028
1029                         /*
1030                          *  If send window > 1 then send frame with pf
1031                          *  bit cleared
1032                          */
1033                         if ((self->window > 1) &&
1034                             skb_queue_len(&self->txq) > 0)
1035                         {
1036                                 irlap_send_data_primary(self, skb);
1037                         } else {
1038                                 irlap_send_data_primary_poll(self, skb);
1039                         }
1040                         kfree_skb(skb);
1041                 }
1042         }
1043 #endif
1044 }
1045
1046 void irlap_resend_rejected_frame(struct irlap_cb *self, int command)
1047 {
1048         struct sk_buff *tx_skb;
1049         struct sk_buff *skb;
1050
1051         IRDA_ASSERT(self != NULL, return;);
1052         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
1053
1054         /*  Resend unacknowledged frame(s) */
1055         skb = skb_peek(&self->wx_list);
1056         if (skb != NULL) {
1057                 irlap_wait_min_turn_around(self, &self->qos_tx);
1058
1059                 /* We copy the skb to be retransmitted since we will have to
1060                  * modify it. Cloning will confuse packet sniffers
1061                  */
1062                 /* tx_skb = skb_clone( skb, GFP_ATOMIC); */
1063                 tx_skb = skb_copy(skb, GFP_ATOMIC);
1064                 if (!tx_skb) {
1065                         IRDA_DEBUG(0, "%s(), unable to copy\n", __FUNCTION__);
1066                         return;
1067                 }
1068                 /* Unlink tx_skb from list */
1069                 tx_skb->next = tx_skb->prev = NULL;
1070                 tx_skb->list = NULL;
1071
1072                 /* Clear old Nr field + poll bit */
1073                 tx_skb->data[1] &= 0x0f;
1074
1075                 /*  Set poll/final bit */
1076                 tx_skb->data[1] |= PF_BIT; /* Set p/f bit */
1077
1078                 irlap_send_i_frame(self, tx_skb, command);
1079         }
1080 }
1081
1082 /*
1083  * Function irlap_send_ui_frame (self, skb, command)
1084  *
1085  *    Contruct and transmit an Unnumbered Information (UI) frame
1086  *
1087  */
1088 void irlap_send_ui_frame(struct irlap_cb *self, struct sk_buff *skb,
1089                          __u8 caddr, int command)
1090 {
1091         IRDA_DEBUG(4, "%s()\n", __FUNCTION__);
1092
1093         IRDA_ASSERT(self != NULL, return;);
1094         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
1095         IRDA_ASSERT(skb != NULL, return;);
1096
1097         /* Insert connection address */
1098         skb->data[0] = caddr | ((command) ? CMD_FRAME : 0);
1099
1100         irlap_queue_xmit(self, skb);
1101 }
1102
1103 /*
1104  * Function irlap_send_i_frame (skb)
1105  *
1106  *    Contruct and transmit Information (I) frame
1107  */
1108 static void irlap_send_i_frame(struct irlap_cb *self, struct sk_buff *skb,
1109                                int command)
1110 {
1111         /* Insert connection address */
1112         skb->data[0] = self->caddr;
1113         skb->data[0] |= (command) ? CMD_FRAME : 0;
1114
1115         /* Insert next to receive (Vr) */
1116         skb->data[1] |= (self->vr << 5);  /* insert nr */
1117
1118         irlap_queue_xmit(self, skb);
1119 }
1120
1121 /*
1122  * Function irlap_recv_i_frame (skb, frame)
1123  *
1124  *    Receive and parse an I (Information) frame, no harm in making it inline
1125  *    since it's called only from one single place (irlap_driver_rcv).
1126  */
1127 static inline void irlap_recv_i_frame(struct irlap_cb *self,
1128                                       struct sk_buff *skb,
1129                                       struct irlap_info *info, int command)
1130 {
1131         info->nr = skb->data[1] >> 5;          /* Next to receive */
1132         info->pf = skb->data[1] & PF_BIT;      /* Final bit */
1133         info->ns = (skb->data[1] >> 1) & 0x07; /* Next to send */
1134
1135         /* Check if this is a command or a response frame */
1136         if (command)
1137                 irlap_do_event(self, RECV_I_CMD, skb, info);
1138         else
1139                 irlap_do_event(self, RECV_I_RSP, skb, info);
1140 }
1141
1142 /*
1143  * Function irlap_recv_ui_frame (self, skb, info)
1144  *
1145  *    Receive and parse an Unnumbered Information (UI) frame
1146  *
1147  */
1148 static void irlap_recv_ui_frame(struct irlap_cb *self, struct sk_buff *skb,
1149                                 struct irlap_info *info)
1150 {
1151         IRDA_DEBUG( 4, "%s()\n", __FUNCTION__);
1152
1153         info->pf = skb->data[1] & PF_BIT;      /* Final bit */
1154
1155         irlap_do_event(self, RECV_UI_FRAME, skb, info);
1156 }
1157
1158 /*
1159  * Function irlap_recv_frmr_frame (skb, frame)
1160  *
1161  *    Received Frame Reject response.
1162  *
1163  */
1164 static void irlap_recv_frmr_frame(struct irlap_cb *self, struct sk_buff *skb,
1165                                   struct irlap_info *info)
1166 {
1167         __u8 *frame;
1168         int w, x, y, z;
1169
1170         IRDA_DEBUG(0, "%s()\n", __FUNCTION__);
1171
1172         IRDA_ASSERT(self != NULL, return;);
1173         IRDA_ASSERT(self->magic == LAP_MAGIC, return;);
1174         IRDA_ASSERT(skb != NULL, return;);
1175         IRDA_ASSERT(info != NULL, return;);
1176
1177         if (!pskb_may_pull(skb, 4)) {
1178                 IRDA_ERROR("%s: frame to short!\n", __FUNCTION__);
1179                 return;
1180         }
1181
1182         frame = skb->data;
1183
1184         info->nr = frame[2] >> 5;          /* Next to receive */
1185         info->pf = frame[2] & PF_BIT;      /* Final bit */
1186         info->ns = (frame[2] >> 1) & 0x07; /* Next to send */
1187
1188         w = frame[3] & 0x01;
1189         x = frame[3] & 0x02;
1190         y = frame[3] & 0x04;
1191         z = frame[3] & 0x08;
1192
1193         if (w) {
1194                 IRDA_DEBUG(0, "Rejected control field is undefined or not "
1195                       "implemented.\n");
1196         }
1197         if (x) {
1198                 IRDA_DEBUG(0, "Rejected control field was invalid because it "
1199                       "contained a non permitted I field.\n");
1200         }
1201         if (y) {
1202                 IRDA_DEBUG(0, "Received I field exceeded the maximum negotiated "
1203                       "for the existing connection or exceeded the maximum "
1204                       "this station supports if no connection exists.\n");
1205         }
1206         if (z) {
1207                 IRDA_DEBUG(0, "Rejected control field control field contained an "
1208                       "invalid Nr count.\n");
1209         }
1210         irlap_do_event(self, RECV_FRMR_RSP, skb, info);
1211 }
1212
1213 /*
1214  * Function irlap_send_test_frame (self, daddr)
1215  *
1216  *    Send a test frame response
1217  *
1218  */
1219 void irlap_send_test_frame(struct irlap_cb *self, __u8 caddr, __u32 daddr,
1220                            struct sk_buff *cmd)
1221 {
1222         struct sk_buff *tx_skb;
1223         struct test_frame *frame;
1224         __u8 *info;
1225
1226         tx_skb = dev_alloc_skb(cmd->len+sizeof(struct test_frame));
1227         if (!tx_skb)
1228                 return;
1229
1230         /* Broadcast frames must include saddr and daddr fields */
1231         if (caddr == CBROADCAST) {
1232                 frame = (struct test_frame *)
1233                         skb_put(tx_skb, sizeof(struct test_frame));
1234
1235                 /* Insert the swapped addresses */
1236                 frame->saddr = cpu_to_le32(self->saddr);
1237                 frame->daddr = cpu_to_le32(daddr);
1238         } else
1239                 frame = (struct test_frame *) skb_put(tx_skb, LAP_ADDR_HEADER + LAP_CTRL_HEADER);
1240
1241         frame->caddr = caddr;
1242         frame->control = TEST_RSP | PF_BIT;
1243
1244         /* Copy info */
1245         info = skb_put(tx_skb, cmd->len);
1246         memcpy(info, cmd->data, cmd->len);
1247
1248         /* Return to sender */
1249         irlap_wait_min_turn_around(self, &self->qos_tx);
1250         irlap_queue_xmit(self, tx_skb);
1251 }
1252
1253 /*
1254  * Function irlap_recv_test_frame (self, skb)
1255  *
1256  *    Receive a test frame
1257  *
1258  */
1259 static void irlap_recv_test_frame(struct irlap_cb *self, struct sk_buff *skb,
1260                                   struct irlap_info *info, int command)
1261 {
1262         struct test_frame *frame;
1263
1264         IRDA_DEBUG(2, "%s()\n", __FUNCTION__);
1265
1266         if (!pskb_may_pull(skb, sizeof(*frame))) {
1267                 IRDA_ERROR("%s: frame to short!\n", __FUNCTION__);
1268                 return;
1269         }
1270         frame = (struct test_frame *) skb->data;
1271
1272         /* Broadcast frames must carry saddr and daddr fields */
1273         if (info->caddr == CBROADCAST) {
1274                 if (skb->len < sizeof(struct test_frame)) {
1275                         IRDA_DEBUG(0, "%s() test frame to short!\n",
1276                                    __FUNCTION__);
1277                         return;
1278                 }
1279
1280                 /* Read and swap addresses */
1281                 info->daddr = le32_to_cpu(frame->saddr);
1282                 info->saddr = le32_to_cpu(frame->daddr);
1283
1284                 /* Make sure frame is addressed to us */
1285                 if ((info->saddr != self->saddr) &&
1286                     (info->saddr != BROADCAST)) {
1287                         return;
1288                 }
1289         }
1290
1291         if (command)
1292                 irlap_do_event(self, RECV_TEST_CMD, skb, info);
1293         else
1294                 irlap_do_event(self, RECV_TEST_RSP, skb, info);
1295 }
1296
1297 /*
1298  * Function irlap_driver_rcv (skb, netdev, ptype)
1299  *
1300  *    Called when a frame is received. Dispatches the right receive function
1301  *    for processing of the frame.
1302  *
1303  * Note on skb management :
1304  * After calling the higher layers of the IrDA stack, we always
1305  * kfree() the skb, which drop the reference count (and potentially
1306  * destroy it).
1307  * If a higher layer of the stack want to keep the skb around (to put
1308  * in a queue or pass it to the higher layer), it will need to use
1309  * skb_get() to keep a reference on it. This is usually done at the
1310  * LMP level in irlmp.c.
1311  * Jean II
1312  */
1313 int irlap_driver_rcv(struct sk_buff *skb, struct net_device *dev,
1314                      struct packet_type *ptype)
1315 {
1316         struct irlap_info info;
1317         struct irlap_cb *self;
1318         int command;
1319         __u8 control;
1320
1321         /* FIXME: should we get our own field? */
1322         self = (struct irlap_cb *) dev->atalk_ptr;
1323
1324         /* If the net device is down, then IrLAP is gone! */
1325         if (!self || self->magic != LAP_MAGIC) {
1326                 dev_kfree_skb(skb);
1327                 return -1;
1328         }
1329
1330         /* We are no longer an "old" protocol, so we need to handle
1331          * share and non linear skbs. This should never happen, so
1332          * we don't need to be clever about it. Jean II */
1333         if ((skb = skb_share_check(skb, GFP_ATOMIC)) == NULL) {
1334                 IRDA_ERROR("%s: can't clone shared skb!\n", __FUNCTION__);
1335                 dev_kfree_skb(skb);
1336                 return -1;
1337         }
1338
1339         /* Check if frame is large enough for parsing */
1340         if (!pskb_may_pull(skb, 2)) {
1341                 IRDA_ERROR("%s: frame to short!\n", __FUNCTION__);
1342                 dev_kfree_skb(skb);
1343                 return -1;
1344         }
1345
1346         command    = skb->data[0] & CMD_FRAME;
1347         info.caddr = skb->data[0] & CBROADCAST;
1348
1349         info.pf      = skb->data[1] &  PF_BIT;
1350         info.control = skb->data[1] & ~PF_BIT; /* Mask away poll/final bit */
1351
1352         control = info.control;
1353
1354         /*  First we check if this frame has a valid connection address */
1355         if ((info.caddr != self->caddr) && (info.caddr != CBROADCAST)) {
1356                 IRDA_DEBUG(0, "%s(), wrong connection address!\n",
1357                            __FUNCTION__);
1358                 goto out;
1359         }
1360         /*
1361          *  Optimize for the common case and check if the frame is an
1362          *  I(nformation) frame. Only I-frames have bit 0 set to 0
1363          */
1364         if (~control & 0x01) {
1365                 irlap_recv_i_frame(self, skb, &info, command);
1366                 goto out;
1367         }
1368         /*
1369          *  We now check is the frame is an S(upervisory) frame. Only
1370          *  S-frames have bit 0 set to 1 and bit 1 set to 0
1371          */
1372         if (~control & 0x02) {
1373                 /*
1374                  *  Received S(upervisory) frame, check which frame type it is
1375                  *  only the first nibble is of interest
1376                  */
1377                 switch (control & 0x0f) {
1378                 case RR:
1379                         irlap_recv_rr_frame(self, skb, &info, command);
1380                         break;
1381                 case RNR:
1382                         irlap_recv_rnr_frame(self, skb, &info, command);
1383                         break;
1384                 case REJ:
1385                         irlap_recv_rej_frame(self, skb, &info, command);
1386                         break;
1387                 case SREJ:
1388                         irlap_recv_srej_frame(self, skb, &info, command);
1389                         break;
1390                 default:
1391                         IRDA_WARNING("%s: Unknown S-frame %02x received!\n",
1392                                 __FUNCTION__, info.control);
1393                         break;
1394                 }
1395                 goto out;
1396         }
1397         /*
1398          *  This must be a C(ontrol) frame
1399          */
1400         switch (control) {
1401         case XID_RSP:
1402                 irlap_recv_discovery_xid_rsp(self, skb, &info);
1403                 break;
1404         case XID_CMD:
1405                 irlap_recv_discovery_xid_cmd(self, skb, &info);
1406                 break;
1407         case SNRM_CMD:
1408                 irlap_recv_snrm_cmd(self, skb, &info);
1409                 break;
1410         case DM_RSP:
1411                 irlap_do_event(self, RECV_DM_RSP, skb, &info);
1412                 break;
1413         case DISC_CMD: /* And RD_RSP since they have the same value */
1414                 irlap_recv_disc_frame(self, skb, &info, command);
1415                 break;
1416         case TEST_CMD:
1417                 irlap_recv_test_frame(self, skb, &info, command);
1418                 break;
1419         case UA_RSP:
1420                 irlap_recv_ua_frame(self, skb, &info);
1421                 break;
1422         case FRMR_RSP:
1423                 irlap_recv_frmr_frame(self, skb, &info);
1424                 break;
1425         case UI_FRAME:
1426                 irlap_recv_ui_frame(self, skb, &info);
1427                 break;
1428         default:
1429                 IRDA_WARNING("%s: Unknown frame %02x received!\n",
1430                                 __FUNCTION__, info.control);
1431                 break;
1432         }
1433 out:
1434         /* Always drop our reference on the skb */
1435         dev_kfree_skb(skb);
1436         return 0;
1437 }