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