Blame view

net/rose/rose_loopback.c 2.73 KB
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1
2
3
4
5
6
7
8
9
  /*
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or
   * (at your option) any later version.
   *
   * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
   */
  #include <linux/types.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
10
  #include <linux/slab.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
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
  #include <linux/socket.h>
  #include <linux/timer.h>
  #include <net/ax25.h>
  #include <linux/skbuff.h>
  #include <net/rose.h>
  #include <linux/init.h>
  
  static struct sk_buff_head loopback_queue;
  static struct timer_list loopback_timer;
  
  static void rose_set_loopback_timer(void);
  
  void rose_loopback_init(void)
  {
  	skb_queue_head_init(&loopback_queue);
  
  	init_timer(&loopback_timer);
  }
  
  static int rose_loopback_running(void)
  {
  	return timer_pending(&loopback_timer);
  }
  
  int rose_loopback_queue(struct sk_buff *skb, struct rose_neigh *neigh)
  {
  	struct sk_buff *skbn;
  
  	skbn = skb_clone(skb, GFP_ATOMIC);
  
  	kfree_skb(skb);
  
  	if (skbn != NULL) {
  		skb_queue_tail(&loopback_queue, skbn);
  
  		if (!rose_loopback_running())
  			rose_set_loopback_timer();
  	}
  
  	return 1;
  }
  
  static void rose_loopback_timer(unsigned long);
  
  static void rose_set_loopback_timer(void)
  {
  	del_timer(&loopback_timer);
  
  	loopback_timer.data     = 0;
  	loopback_timer.function = &rose_loopback_timer;
  	loopback_timer.expires  = jiffies + 10;
  
  	add_timer(&loopback_timer);
  }
  
  static void rose_loopback_timer(unsigned long param)
  {
  	struct sk_buff *skb;
  	struct net_device *dev;
  	rose_address *dest;
  	struct sock *sk;
  	unsigned short frametype;
  	unsigned int lci_i, lci_o;
  
  	while ((skb = skb_dequeue(&loopback_queue)) != NULL) {
e0bccd315   Ben Hutchings   rose: Add length ...
76
77
78
79
  		if (skb->len < ROSE_MIN_LEN) {
  			kfree_skb(skb);
  			continue;
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
80
81
  		lci_i     = ((skb->data[0] << 8) & 0xF00) + ((skb->data[1] << 0) & 0x0FF);
  		frametype = skb->data[2];
e0bccd315   Ben Hutchings   rose: Add length ...
82
83
84
85
86
87
88
89
  		if (frametype == ROSE_CALL_REQUEST &&
  		    (skb->len <= ROSE_CALL_REQ_FACILITIES_OFF ||
  		     skb->data[ROSE_CALL_REQ_ADDR_LEN_OFF] !=
  		     ROSE_CALL_REQ_ADDR_LEN_VAL)) {
  			kfree_skb(skb);
  			continue;
  		}
  		dest      = (rose_address *)(skb->data + ROSE_CALL_REQ_DEST_ADDR_OFF);
1f731b637   Bernard Pidoux F6BVP   rose_loopback_tim...
90
  		lci_o     = ROSE_DEFAULT_MAXVC + 1 - lci_i;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
91

badff6d01   Arnaldo Carvalho de Melo   [SK_BUFF]: Introd...
92
  		skb_reset_transport_header(skb);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
93

891e6a931   Alexey Dobriyan   [ROSE]: Fix rose....
94
  		sk = rose_find_socket(lci_o, rose_loopback_neigh);
a3d384029   Ralf Baechle   [AX.25]: Fix unch...
95
  		if (sk) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
96
97
98
99
100
101
102
  			if (rose_process_rx_frame(sk, skb) == 0)
  				kfree_skb(skb);
  			continue;
  		}
  
  		if (frametype == ROSE_CALL_REQUEST) {
  			if ((dev = rose_dev_get(dest)) != NULL) {
891e6a931   Alexey Dobriyan   [ROSE]: Fix rose....
103
  				if (rose_rx_call_request(skb, dev, rose_loopback_neigh, lci_o) == 0)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
  					kfree_skb(skb);
  			} else {
  				kfree_skb(skb);
  			}
  		} else {
  			kfree_skb(skb);
  		}
  	}
  }
  
  void __exit rose_loopback_clear(void)
  {
  	struct sk_buff *skb;
  
  	del_timer(&loopback_timer);
  
  	while ((skb = skb_dequeue(&loopback_queue)) != NULL) {
  		skb->sk = NULL;
  		kfree_skb(skb);
  	}
  }