1/*
2 *	ROSE release 003
3 *
4 *	This code REQUIRES 2.1.15 or higher/ NET3.038
5 *
6 *	This module:
7 *		This module is free software; you can redistribute it and/or
8 *		modify it under the terms of the GNU General Public License
9 *		as published by the Free Software Foundation; either version
10 *		2 of the License, or (at your option) any later version.
11 *
12 *	History
13 *	ROSE 003	Jonathan(G4KLX)	Created this file from nr_loopback.c.
14 *
15 */
16
17#include <linux/types.h>
18#include <linux/socket.h>
19#include <linux/timer.h>
20#include <net/ax25.h>
21#include <linux/skbuff.h>
22#include <net/rose.h>
23#include <linux/init.h>
24
25static struct sk_buff_head loopback_queue;
26static struct timer_list loopback_timer;
27
28static void rose_set_loopback_timer(void);
29
30void rose_loopback_init(void)
31{
32	skb_queue_head_init(&loopback_queue);
33
34	init_timer(&loopback_timer);
35}
36
37static int rose_loopback_running(void)
38{
39	return timer_pending(&loopback_timer);
40}
41
42int rose_loopback_queue(struct sk_buff *skb, struct rose_neigh *neigh)
43{
44	struct sk_buff *skbn;
45
46	skbn = skb_clone(skb, GFP_ATOMIC);
47
48	kfree_skb(skb);
49
50	if (skbn != NULL) {
51		skb_queue_tail(&loopback_queue, skbn);
52
53		if (!rose_loopback_running())
54			rose_set_loopback_timer();
55	}
56
57	return 1;
58}
59
60static void rose_loopback_timer(unsigned long);
61
62static void rose_set_loopback_timer(void)
63{
64	del_timer(&loopback_timer);
65
66	loopback_timer.data     = 0;
67	loopback_timer.function = &rose_loopback_timer;
68	loopback_timer.expires  = jiffies + 10;
69
70	add_timer(&loopback_timer);
71}
72
73static void rose_loopback_timer(unsigned long param)
74{
75	struct sk_buff *skb;
76	struct net_device *dev;
77	rose_address *dest;
78	struct sock *sk;
79	unsigned short frametype;
80	unsigned int lci_i, lci_o;
81
82	while ((skb = skb_dequeue(&loopback_queue)) != NULL) {
83		lci_i     = ((skb->data[0] << 8) & 0xF00) + ((skb->data[1] << 0) & 0x0FF);
84		frametype = skb->data[2];
85		dest      = (rose_address *)(skb->data + 4);
86		lci_o     = 0xFFF - lci_i;
87
88		skb->h.raw = skb->data;
89
90		if ((sk = rose_find_socket(lci_o, rose_loopback_neigh)) != NULL) {
91			if (rose_process_rx_frame(sk, skb) == 0)
92				kfree_skb(skb);
93			continue;
94		}
95
96		if (frametype == ROSE_CALL_REQUEST) {
97			if ((dev = rose_dev_get(dest)) != NULL) {
98				if (rose_rx_call_request(skb, dev, rose_loopback_neigh, lci_o) == 0)
99					kfree_skb(skb);
100			} else {
101				kfree_skb(skb);
102			}
103		} else {
104			kfree_skb(skb);
105		}
106	}
107}
108
109void __exit rose_loopback_clear(void)
110{
111	struct sk_buff *skb;
112
113	del_timer(&loopback_timer);
114
115	while ((skb = skb_dequeue(&loopback_queue)) != NULL) {
116		skb->sk = NULL;
117		kfree_skb(skb);
118	}
119}
120