[PATCH] USB: fix bug in ohci-hcd.c ohci_restart()
[linux-2.6] / net / atm / raw.c
1 /* net/atm/raw.c - Raw AAL0 and AAL5 transports */
2
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
4
5
6 #include <linux/module.h>
7 #include <linux/sched.h>
8 #include <linux/atmdev.h>
9 #include <linux/capability.h>
10 #include <linux/kernel.h>
11 #include <linux/skbuff.h>
12 #include <linux/mm.h>
13
14 #include "common.h"
15 #include "protocols.h"
16
17
18 #if 0
19 #define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
20 #else
21 #define DPRINTK(format,args...)
22 #endif
23
24
25 /*
26  * SKB == NULL indicates that the link is being closed
27  */
28
29 static void atm_push_raw(struct atm_vcc *vcc,struct sk_buff *skb)
30 {
31         if (skb) {
32                 struct sock *sk = sk_atm(vcc);
33
34                 skb_queue_tail(&sk->sk_receive_queue, skb);
35                 sk->sk_data_ready(sk, skb->len);
36         }
37 }
38
39
40 static void atm_pop_raw(struct atm_vcc *vcc,struct sk_buff *skb)
41 {
42         struct sock *sk = sk_atm(vcc);
43
44         DPRINTK("APopR (%d) %d -= %d\n", vcc->vci, sk->sk_wmem_alloc,
45                 skb->truesize);
46         atomic_sub(skb->truesize, &sk->sk_wmem_alloc);
47         dev_kfree_skb_any(skb);
48         sk->sk_write_space(sk);
49 }
50
51
52 static int atm_send_aal0(struct atm_vcc *vcc,struct sk_buff *skb)
53 {
54         /*
55          * Note that if vpi/vci are _ANY or _UNSPEC the below will
56          * still work
57          */
58         if (!capable(CAP_NET_ADMIN) &&
59             (((u32 *) skb->data)[0] & (ATM_HDR_VPI_MASK | ATM_HDR_VCI_MASK)) !=
60             ((vcc->vpi << ATM_HDR_VPI_SHIFT) | (vcc->vci << ATM_HDR_VCI_SHIFT)))
61             {
62                 kfree_skb(skb);
63                 return -EADDRNOTAVAIL;
64         }
65         return vcc->dev->ops->send(vcc,skb);
66 }
67
68
69 int atm_init_aal0(struct atm_vcc *vcc)
70 {
71         vcc->push = atm_push_raw;
72         vcc->pop = atm_pop_raw;
73         vcc->push_oam = NULL;
74         vcc->send = atm_send_aal0;
75         return 0;
76 }
77
78
79 int atm_init_aal34(struct atm_vcc *vcc)
80 {
81         vcc->push = atm_push_raw;
82         vcc->pop = atm_pop_raw;
83         vcc->push_oam = NULL;
84         vcc->send = vcc->dev->ops->send;
85         return 0;
86 }
87
88
89 int atm_init_aal5(struct atm_vcc *vcc)
90 {
91         vcc->push = atm_push_raw;
92         vcc->pop = atm_pop_raw;
93         vcc->push_oam = NULL;
94         vcc->send = vcc->dev->ops->send;
95         return 0;
96 }
97
98
99 EXPORT_SYMBOL(atm_init_aal5);