Blame view

kernel/linux-imx6_3.14.28/net/atm/raw.c 1.84 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
  /* net/atm/raw.c - Raw AAL0 and AAL5 transports */
  
  /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
  
  #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
  
  #include <linux/module.h>
  #include <linux/atmdev.h>
  #include <linux/capability.h>
  #include <linux/kernel.h>
  #include <linux/skbuff.h>
  #include <linux/mm.h>
  #include <linux/slab.h>
  
  #include "common.h"
  #include "protocols.h"
  
  /*
   * SKB == NULL indicates that the link is being closed
   */
  
  static void atm_push_raw(struct atm_vcc *vcc, struct sk_buff *skb)
  {
  	if (skb) {
  		struct sock *sk = sk_atm(vcc);
  
  		skb_queue_tail(&sk->sk_receive_queue, skb);
  		sk->sk_data_ready(sk, skb->len);
  	}
  }
  
  static void atm_pop_raw(struct atm_vcc *vcc, struct sk_buff *skb)
  {
  	struct sock *sk = sk_atm(vcc);
  
  	pr_debug("(%d) %d -= %d
  ",
  		 vcc->vci, sk_wmem_alloc_get(sk), skb->truesize);
  	atomic_sub(skb->truesize, &sk->sk_wmem_alloc);
  	dev_kfree_skb_any(skb);
  	sk->sk_write_space(sk);
  }
  
  static int atm_send_aal0(struct atm_vcc *vcc, struct sk_buff *skb)
  {
  	/*
  	 * Note that if vpi/vci are _ANY or _UNSPEC the below will
  	 * still work
  	 */
  	if (!capable(CAP_NET_ADMIN) &&
  	    (((u32 *)skb->data)[0] & (ATM_HDR_VPI_MASK | ATM_HDR_VCI_MASK)) !=
  	    ((vcc->vpi << ATM_HDR_VPI_SHIFT) |
  	     (vcc->vci << ATM_HDR_VCI_SHIFT))) {
  		kfree_skb(skb);
  		return -EADDRNOTAVAIL;
  	}
  	return vcc->dev->ops->send(vcc, skb);
  }
  
  int atm_init_aal0(struct atm_vcc *vcc)
  {
  	vcc->push = atm_push_raw;
  	vcc->pop = atm_pop_raw;
  	vcc->push_oam = NULL;
  	vcc->send = atm_send_aal0;
  	return 0;
  }
  
  int atm_init_aal34(struct atm_vcc *vcc)
  {
  	vcc->push = atm_push_raw;
  	vcc->pop = atm_pop_raw;
  	vcc->push_oam = NULL;
  	vcc->send = vcc->dev->ops->send;
  	return 0;
  }
  
  int atm_init_aal5(struct atm_vcc *vcc)
  {
  	vcc->push = atm_push_raw;
  	vcc->pop = atm_pop_raw;
  	vcc->push_oam = NULL;
  	vcc->send = vcc->dev->ops->send;
  	return 0;
  }
  EXPORT_SYMBOL(atm_init_aal5);