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#include <linux/errno.h>
28#include <linux/types.h>
29#include <linux/socket.h>
30#include <linux/in.h>
31#include <linux/kernel.h>
32#include <linux/sched.h>
33#include <linux/timer.h>
34#include <linux/string.h>
35#include <linux/sockios.h>
36#include <linux/net.h>
37#include <net/ax25.h>
38#include <linux/inet.h>
39#include <linux/netdevice.h>
40#include <linux/skbuff.h>
41#include <net/sock.h>
42#include <net/ip.h>
43#include <asm/uaccess.h>
44#include <asm/system.h>
45#include <linux/fcntl.h>
46#include <linux/mm.h>
47#include <linux/interrupt.h>
48#include <net/netrom.h>
49
50static int nr_queue_rx_frame(struct sock *sk, struct sk_buff *skb, int more)
51{
52 struct sk_buff *skbo, *skbn = skb;
53
54 skb_pull(skb, NR_NETWORK_LEN + NR_TRANSPORT_LEN);
55
56 nr_start_idletimer(sk);
57
58 if (more) {
59 sk->protinfo.nr->fraglen += skb->len;
60 skb_queue_tail(&sk->protinfo.nr->frag_queue, skb);
61 return 0;
62 }
63
64 if (!more && sk->protinfo.nr->fraglen > 0) {
65 sk->protinfo.nr->fraglen += skb->len;
66 skb_queue_tail(&sk->protinfo.nr->frag_queue, skb);
67
68 if ((skbn = alloc_skb(sk->protinfo.nr->fraglen, GFP_ATOMIC)) == NULL)
69 return 1;
70
71 skbn->h.raw = skbn->data;
72
73 while ((skbo = skb_dequeue(&sk->protinfo.nr->frag_queue)) != NULL) {
74 memcpy(skb_put(skbn, skbo->len), skbo->data, skbo->len);
75 kfree_skb(skbo);
76 }
77
78 sk->protinfo.nr->fraglen = 0;
79 }
80
81 return sock_queue_rcv_skb(sk, skbn);
82}
83
84
85
86
87
88
89static int nr_state1_machine(struct sock *sk, struct sk_buff *skb, int frametype)
90{
91 switch (frametype) {
92
93 case NR_CONNACK:
94 nr_stop_t1timer(sk);
95 nr_start_idletimer(sk);
96 sk->protinfo.nr->your_index = skb->data[17];
97 sk->protinfo.nr->your_id = skb->data[18];
98 sk->protinfo.nr->vs = 0;
99 sk->protinfo.nr->va = 0;
100 sk->protinfo.nr->vr = 0;
101 sk->protinfo.nr->vl = 0;
102 sk->protinfo.nr->state = NR_STATE_3;
103 sk->protinfo.nr->n2count = 0;
104 sk->protinfo.nr->window = skb->data[20];
105 sk->state = TCP_ESTABLISHED;
106 if (!sk->dead)
107 sk->state_change(sk);
108 break;
109
110 case NR_CONNACK | NR_CHOKE_FLAG:
111 nr_disconnect(sk, ECONNREFUSED);
112 break;
113
114 default:
115 break;
116 }
117
118 return 0;
119}
120
121
122
123
124
125
126static int nr_state2_machine(struct sock *sk, struct sk_buff *skb, int frametype)
127{
128 switch (frametype) {
129
130 case NR_CONNACK | NR_CHOKE_FLAG:
131 nr_disconnect(sk, ECONNRESET);
132 break;
133
134 case NR_DISCREQ:
135 nr_write_internal(sk, NR_DISCACK);
136
137 case NR_DISCACK:
138 nr_disconnect(sk, 0);
139 break;
140
141 default:
142 break;
143 }
144
145 return 0;
146}
147
148
149
150
151
152
153static int nr_state3_machine(struct sock *sk, struct sk_buff *skb, int frametype)
154{
155 struct sk_buff_head temp_queue;
156 struct sk_buff *skbn;
157 unsigned short save_vr;
158 unsigned short nr, ns;
159 int queued = 0;
160
161 nr = skb->data[18];
162 ns = skb->data[17];
163
164 switch (frametype) {
165
166 case NR_CONNREQ:
167 nr_write_internal(sk, NR_CONNACK);
168 break;
169
170 case NR_DISCREQ:
171 nr_write_internal(sk, NR_DISCACK);
172 nr_disconnect(sk, 0);
173 break;
174
175 case NR_CONNACK | NR_CHOKE_FLAG:
176 case NR_DISCACK:
177 nr_disconnect(sk, ECONNRESET);
178 break;
179
180 case NR_INFOACK:
181 case NR_INFOACK | NR_CHOKE_FLAG:
182 case NR_INFOACK | NR_NAK_FLAG:
183 case NR_INFOACK | NR_NAK_FLAG | NR_CHOKE_FLAG:
184 if (frametype & NR_CHOKE_FLAG) {
185 sk->protinfo.nr->condition |= NR_COND_PEER_RX_BUSY;
186 nr_start_t4timer(sk);
187 } else {
188 sk->protinfo.nr->condition &= ~NR_COND_PEER_RX_BUSY;
189 nr_stop_t4timer(sk);
190 }
191 if (!nr_validate_nr(sk, nr)) {
192 break;
193 }
194 if (frametype & NR_NAK_FLAG) {
195 nr_frames_acked(sk, nr);
196 nr_send_nak_frame(sk);
197 } else {
198 if (sk->protinfo.nr->condition & NR_COND_PEER_RX_BUSY) {
199 nr_frames_acked(sk, nr);
200 } else {
201 nr_check_iframes_acked(sk, nr);
202 }
203 }
204 break;
205
206 case NR_INFO:
207 case NR_INFO | NR_NAK_FLAG:
208 case NR_INFO | NR_CHOKE_FLAG:
209 case NR_INFO | NR_MORE_FLAG:
210 case NR_INFO | NR_NAK_FLAG | NR_CHOKE_FLAG:
211 case NR_INFO | NR_CHOKE_FLAG | NR_MORE_FLAG:
212 case NR_INFO | NR_NAK_FLAG | NR_MORE_FLAG:
213 case NR_INFO | NR_NAK_FLAG | NR_CHOKE_FLAG | NR_MORE_FLAG:
214 if (frametype & NR_CHOKE_FLAG) {
215 sk->protinfo.nr->condition |= NR_COND_PEER_RX_BUSY;
216 nr_start_t4timer(sk);
217 } else {
218 sk->protinfo.nr->condition &= ~NR_COND_PEER_RX_BUSY;
219 nr_stop_t4timer(sk);
220 }
221 if (nr_validate_nr(sk, nr)) {
222 if (frametype & NR_NAK_FLAG) {
223 nr_frames_acked(sk, nr);
224 nr_send_nak_frame(sk);
225 } else {
226 if (sk->protinfo.nr->condition & NR_COND_PEER_RX_BUSY) {
227 nr_frames_acked(sk, nr);
228 } else {
229 nr_check_iframes_acked(sk, nr);
230 }
231 }
232 }
233 queued = 1;
234 skb_queue_head(&sk->protinfo.nr->reseq_queue, skb);
235 if (sk->protinfo.nr->condition & NR_COND_OWN_RX_BUSY)
236 break;
237 skb_queue_head_init(&temp_queue);
238 do {
239 save_vr = sk->protinfo.nr->vr;
240 while ((skbn = skb_dequeue(&sk->protinfo.nr->reseq_queue)) != NULL) {
241 ns = skbn->data[17];
242 if (ns == sk->protinfo.nr->vr) {
243 if (nr_queue_rx_frame(sk, skbn, frametype & NR_MORE_FLAG) == 0) {
244 sk->protinfo.nr->vr = (sk->protinfo.nr->vr + 1) % NR_MODULUS;
245 } else {
246 sk->protinfo.nr->condition |= NR_COND_OWN_RX_BUSY;
247 skb_queue_tail(&temp_queue, skbn);
248 }
249 } else if (nr_in_rx_window(sk, ns)) {
250 skb_queue_tail(&temp_queue, skbn);
251 } else {
252 kfree_skb(skbn);
253 }
254 }
255 while ((skbn = skb_dequeue(&temp_queue)) != NULL) {
256 skb_queue_tail(&sk->protinfo.nr->reseq_queue, skbn);
257 }
258 } while (save_vr != sk->protinfo.nr->vr);
259
260
261
262 if (((sk->protinfo.nr->vl + sk->protinfo.nr->window) % NR_MODULUS) == sk->protinfo.nr->vr) {
263 nr_enquiry_response(sk);
264 } else {
265 if (!(sk->protinfo.nr->condition & NR_COND_ACK_PENDING)) {
266 sk->protinfo.nr->condition |= NR_COND_ACK_PENDING;
267 nr_start_t2timer(sk);
268 }
269 }
270 break;
271
272 default:
273 break;
274 }
275
276 return queued;
277}
278
279
280int nr_process_rx_frame(struct sock *sk, struct sk_buff *skb)
281{
282 int queued = 0, frametype;
283
284 if (sk->protinfo.nr->state == NR_STATE_0)
285 return 0;
286
287 frametype = skb->data[19];
288
289 switch (sk->protinfo.nr->state) {
290 case NR_STATE_1:
291 queued = nr_state1_machine(sk, skb, frametype);
292 break;
293 case NR_STATE_2:
294 queued = nr_state2_machine(sk, skb, frametype);
295 break;
296 case NR_STATE_3:
297 queued = nr_state3_machine(sk, skb, frametype);
298 break;
299 }
300
301 nr_kick(sk);
302
303 return queued;
304}
305