83a33387c061feefdacc605f990314e4a261729b
[linux-2.6.git] / net / ax25 / ax25_std_in.c
1 /*
2  * This program is free software; you can redistribute it and/or modify
3  * it under the terms of the GNU General Public License as published by
4  * the Free Software Foundation; either version 2 of the License, or
5  * (at your option) any later version.
6  *
7  * Copyright (C) Alan Cox GW4PTS (alan@lxorguk.ukuu.org.uk)
8  * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
9  * Copyright (C) Joerg Reuter DL1BKE (jreuter@yaina.de)
10  * Copyright (C) Hans-Joachim Hetscher DD8NE (dd8ne@bnv-bamberg.de)
11  *
12  * Most of this code is based on the SDL diagrams published in the 7th ARRL
13  * Computer Networking Conference papers. The diagrams have mistakes in them,
14  * but are mostly correct. Before you modify the code could you read the SDL
15  * diagrams as the code is not obvious and probably very easy to break.
16  */
17 #include <linux/errno.h>
18 #include <linux/types.h>
19 #include <linux/socket.h>
20 #include <linux/in.h>
21 #include <linux/kernel.h>
22 #include <linux/sched.h>
23 #include <linux/timer.h>
24 #include <linux/string.h>
25 #include <linux/sockios.h>
26 #include <linux/net.h>
27 #include <net/ax25.h>
28 #include <linux/inet.h>
29 #include <linux/netdevice.h>
30 #include <linux/skbuff.h>
31 #include <net/sock.h>
32 #include <net/ip.h>                     /* For ip_rcv */
33 #include <net/tcp_states.h>
34 #include <asm/uaccess.h>
35 #include <asm/system.h>
36 #include <linux/fcntl.h>
37 #include <linux/mm.h>
38 #include <linux/interrupt.h>
39
40 /*
41  *      State machine for state 1, Awaiting Connection State.
42  *      The handling of the timer(s) is in file ax25_std_timer.c.
43  *      Handling of state 0 and connection release is in ax25.c.
44  */
45 static int ax25_std_state1_machine(ax25_cb *ax25, struct sk_buff *skb, int frametype, int pf, int type)
46 {
47         switch (frametype) {
48         case AX25_SABM:
49                 ax25->modulus = AX25_MODULUS;
50                 ax25->window  = ax25->ax25_dev->values[AX25_VALUES_WINDOW];
51                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
52                 break;
53
54         case AX25_SABME:
55                 ax25->modulus = AX25_EMODULUS;
56                 ax25->window  = ax25->ax25_dev->values[AX25_VALUES_EWINDOW];
57                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
58                 break;
59
60         case AX25_DISC:
61                 ax25_send_control(ax25, AX25_DM, pf, AX25_RESPONSE);
62                 break;
63
64         case AX25_UA:
65                 if (pf) {
66                         ax25_calculate_rtt(ax25);
67                         ax25_stop_t1timer(ax25);
68                         ax25_start_t3timer(ax25);
69                         ax25_start_idletimer(ax25);
70                         ax25->vs      = 0;
71                         ax25->va      = 0;
72                         ax25->vr      = 0;
73                         ax25->state   = AX25_STATE_3;
74                         ax25->n2count = 0;
75                         if (ax25->sk != NULL) {
76                                 bh_lock_sock(ax25->sk);
77                                 ax25->sk->sk_state = TCP_ESTABLISHED;
78                                 /* For WAIT_SABM connections we will produce an accept ready socket here */
79                                 if (!sock_flag(ax25->sk, SOCK_DEAD))
80                                         ax25->sk->sk_state_change(ax25->sk);
81                                 bh_unlock_sock(ax25->sk);
82                         }
83                 }
84                 break;
85
86         case AX25_DM:
87                 if (pf) {
88                         if (ax25->modulus == AX25_MODULUS) {
89                                 ax25_disconnect(ax25, ECONNREFUSED);
90                         } else {
91                                 ax25->modulus = AX25_MODULUS;
92                                 ax25->window  = ax25->ax25_dev->values[AX25_VALUES_WINDOW];
93                         }
94                 }
95                 break;
96
97         default:
98                 break;
99         }
100
101         return 0;
102 }
103
104 /*
105  *      State machine for state 2, Awaiting Release State.
106  *      The handling of the timer(s) is in file ax25_std_timer.c
107  *      Handling of state 0 and connection release is in ax25.c.
108  */
109 static int ax25_std_state2_machine(ax25_cb *ax25, struct sk_buff *skb, int frametype, int pf, int type)
110 {
111         switch (frametype) {
112         case AX25_SABM:
113         case AX25_SABME:
114                 ax25_send_control(ax25, AX25_DM, pf, AX25_RESPONSE);
115                 break;
116
117         case AX25_DISC:
118                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
119                 ax25_disconnect(ax25, 0);
120                 break;
121
122         case AX25_DM:
123         case AX25_UA:
124                 if (pf)
125                         ax25_disconnect(ax25, 0);
126                 break;
127
128         case AX25_I:
129         case AX25_REJ:
130         case AX25_RNR:
131         case AX25_RR:
132                 if (pf) ax25_send_control(ax25, AX25_DM, AX25_POLLON, AX25_RESPONSE);
133                 break;
134
135         default:
136                 break;
137         }
138
139         return 0;
140 }
141
142 /*
143  *      State machine for state 3, Connected State.
144  *      The handling of the timer(s) is in file ax25_std_timer.c
145  *      Handling of state 0 and connection release is in ax25.c.
146  */
147 static int ax25_std_state3_machine(ax25_cb *ax25, struct sk_buff *skb, int frametype, int ns, int nr, int pf, int type)
148 {
149         int queued = 0;
150
151         switch (frametype) {
152         case AX25_SABM:
153         case AX25_SABME:
154                 if (frametype == AX25_SABM) {
155                         ax25->modulus = AX25_MODULUS;
156                         ax25->window  = ax25->ax25_dev->values[AX25_VALUES_WINDOW];
157                 } else {
158                         ax25->modulus = AX25_EMODULUS;
159                         ax25->window  = ax25->ax25_dev->values[AX25_VALUES_EWINDOW];
160                 }
161                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
162                 ax25_stop_t1timer(ax25);
163                 ax25_stop_t2timer(ax25);
164                 ax25_start_t3timer(ax25);
165                 ax25_start_idletimer(ax25);
166                 ax25->condition = 0x00;
167                 ax25->vs        = 0;
168                 ax25->va        = 0;
169                 ax25->vr        = 0;
170                 ax25_requeue_frames(ax25);
171                 break;
172
173         case AX25_DISC:
174                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
175                 ax25_disconnect(ax25, 0);
176                 break;
177
178         case AX25_DM:
179                 ax25_disconnect(ax25, ECONNRESET);
180                 break;
181
182         case AX25_RR:
183         case AX25_RNR:
184                 if (frametype == AX25_RR)
185                         ax25->condition &= ~AX25_COND_PEER_RX_BUSY;
186                 else
187                         ax25->condition |= AX25_COND_PEER_RX_BUSY;
188                 if (type == AX25_COMMAND && pf)
189                         ax25_std_enquiry_response(ax25);
190                 if (ax25_validate_nr(ax25, nr)) {
191                         ax25_check_iframes_acked(ax25, nr);
192                 } else {
193                         ax25_std_nr_error_recovery(ax25);
194                         ax25->state = AX25_STATE_1;
195                 }
196                 break;
197
198         case AX25_REJ:
199                 ax25->condition &= ~AX25_COND_PEER_RX_BUSY;
200                 if (type == AX25_COMMAND && pf)
201                         ax25_std_enquiry_response(ax25);
202                 if (ax25_validate_nr(ax25, nr)) {
203                         ax25_frames_acked(ax25, nr);
204                         ax25_calculate_rtt(ax25);
205                         ax25_stop_t1timer(ax25);
206                         ax25_start_t3timer(ax25);
207                         ax25_requeue_frames(ax25);
208                 } else {
209                         ax25_std_nr_error_recovery(ax25);
210                         ax25->state = AX25_STATE_1;
211                 }
212                 break;
213
214         case AX25_I:
215                 if (!ax25_validate_nr(ax25, nr)) {
216                         ax25_std_nr_error_recovery(ax25);
217                         ax25->state = AX25_STATE_1;
218                         break;
219                 }
220                 if (ax25->condition & AX25_COND_PEER_RX_BUSY) {
221                         ax25_frames_acked(ax25, nr);
222                 } else {
223                         ax25_check_iframes_acked(ax25, nr);
224                 }
225                 if (ax25->condition & AX25_COND_OWN_RX_BUSY) {
226                         if (pf) ax25_std_enquiry_response(ax25);
227                         break;
228                 }
229                 if (ns == ax25->vr) {
230                         ax25->vr = (ax25->vr + 1) % ax25->modulus;
231                         queued = ax25_rx_iframe(ax25, skb);
232                         if (ax25->condition & AX25_COND_OWN_RX_BUSY)
233                                 ax25->vr = ns;  /* ax25->vr - 1 */
234                         ax25->condition &= ~AX25_COND_REJECT;
235                         if (pf) {
236                                 ax25_std_enquiry_response(ax25);
237                         } else {
238                                 if (!(ax25->condition & AX25_COND_ACK_PENDING)) {
239                                         ax25->condition |= AX25_COND_ACK_PENDING;
240                                         ax25_start_t2timer(ax25);
241                                 }
242                         }
243                 } else {
244                         if (ax25->condition & AX25_COND_REJECT) {
245                                 if (pf) ax25_std_enquiry_response(ax25);
246                         } else {
247                                 ax25->condition |= AX25_COND_REJECT;
248                                 ax25_send_control(ax25, AX25_REJ, pf, AX25_RESPONSE);
249                                 ax25->condition &= ~AX25_COND_ACK_PENDING;
250                         }
251                 }
252                 break;
253
254         case AX25_FRMR:
255         case AX25_ILLEGAL:
256                 ax25_std_establish_data_link(ax25);
257                 ax25->state = AX25_STATE_1;
258                 break;
259
260         default:
261                 break;
262         }
263
264         return queued;
265 }
266
267 /*
268  *      State machine for state 4, Timer Recovery State.
269  *      The handling of the timer(s) is in file ax25_std_timer.c
270  *      Handling of state 0 and connection release is in ax25.c.
271  */
272 static int ax25_std_state4_machine(ax25_cb *ax25, struct sk_buff *skb, int frametype, int ns, int nr, int pf, int type)
273 {
274         int queued = 0;
275
276         switch (frametype) {
277         case AX25_SABM:
278         case AX25_SABME:
279                 if (frametype == AX25_SABM) {
280                         ax25->modulus = AX25_MODULUS;
281                         ax25->window  = ax25->ax25_dev->values[AX25_VALUES_WINDOW];
282                 } else {
283                         ax25->modulus = AX25_EMODULUS;
284                         ax25->window  = ax25->ax25_dev->values[AX25_VALUES_EWINDOW];
285                 }
286                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
287                 ax25_stop_t1timer(ax25);
288                 ax25_stop_t2timer(ax25);
289                 ax25_start_t3timer(ax25);
290                 ax25_start_idletimer(ax25);
291                 ax25->condition = 0x00;
292                 ax25->vs        = 0;
293                 ax25->va        = 0;
294                 ax25->vr        = 0;
295                 ax25->state     = AX25_STATE_3;
296                 ax25->n2count   = 0;
297                 ax25_requeue_frames(ax25);
298                 break;
299
300         case AX25_DISC:
301                 ax25_send_control(ax25, AX25_UA, pf, AX25_RESPONSE);
302                 ax25_disconnect(ax25, 0);
303                 break;
304
305         case AX25_DM:
306                 ax25_disconnect(ax25, ECONNRESET);
307                 break;
308
309         case AX25_RR:
310         case AX25_RNR:
311                 if (frametype == AX25_RR)
312                         ax25->condition &= ~AX25_COND_PEER_RX_BUSY;
313                 else
314                         ax25->condition |= AX25_COND_PEER_RX_BUSY;
315                 if (type == AX25_RESPONSE && pf) {
316                         ax25_stop_t1timer(ax25);
317                         ax25->n2count = 0;
318                         if (ax25_validate_nr(ax25, nr)) {
319                                 ax25_frames_acked(ax25, nr);
320                                 if (ax25->vs == ax25->va) {
321                                         ax25_start_t3timer(ax25);
322                                         ax25->state   = AX25_STATE_3;
323                                 } else {
324                                         ax25_requeue_frames(ax25);
325                                 }
326                         } else {
327                                 ax25_std_nr_error_recovery(ax25);
328                                 ax25->state = AX25_STATE_1;
329                         }
330                         break;
331                 }
332                 if (type == AX25_COMMAND && pf)
333                         ax25_std_enquiry_response(ax25);
334                 if (ax25_validate_nr(ax25, nr)) {
335                         ax25_frames_acked(ax25, nr);
336                 } else {
337                         ax25_std_nr_error_recovery(ax25);
338                         ax25->state = AX25_STATE_1;
339                 }
340                 break;
341
342         case AX25_REJ:
343                 ax25->condition &= ~AX25_COND_PEER_RX_BUSY;
344                 if (pf && type == AX25_RESPONSE) {
345                         ax25_stop_t1timer(ax25);
346                         ax25->n2count = 0;
347                         if (ax25_validate_nr(ax25, nr)) {
348                                 ax25_frames_acked(ax25, nr);
349                                 if (ax25->vs == ax25->va) {
350                                         ax25_start_t3timer(ax25);
351                                         ax25->state   = AX25_STATE_3;
352                                 } else {
353                                         ax25_requeue_frames(ax25);
354                                 }
355                         } else {
356                                 ax25_std_nr_error_recovery(ax25);
357                                 ax25->state = AX25_STATE_1;
358                         }
359                         break;
360                 }
361                 if (type == AX25_COMMAND && pf)
362                         ax25_std_enquiry_response(ax25);
363                 if (ax25_validate_nr(ax25, nr)) {
364                         ax25_frames_acked(ax25, nr);
365                         ax25_requeue_frames(ax25);
366                 } else {
367                         ax25_std_nr_error_recovery(ax25);
368                         ax25->state = AX25_STATE_1;
369                 }
370                 break;
371
372         case AX25_I:
373                 if (!ax25_validate_nr(ax25, nr)) {
374                         ax25_std_nr_error_recovery(ax25);
375                         ax25->state = AX25_STATE_1;
376                         break;
377                 }
378                 ax25_frames_acked(ax25, nr);
379                 if (ax25->condition & AX25_COND_OWN_RX_BUSY) {
380                         if (pf)
381                                 ax25_std_enquiry_response(ax25);
382                         break;
383                 }
384                 if (ns == ax25->vr) {
385                         ax25->vr = (ax25->vr + 1) % ax25->modulus;
386                         queued = ax25_rx_iframe(ax25, skb);
387                         if (ax25->condition & AX25_COND_OWN_RX_BUSY)
388                                 ax25->vr = ns;  /* ax25->vr - 1 */
389                         ax25->condition &= ~AX25_COND_REJECT;
390                         if (pf) {
391                                 ax25_std_enquiry_response(ax25);
392                         } else {
393                                 if (!(ax25->condition & AX25_COND_ACK_PENDING)) {
394                                         ax25->condition |= AX25_COND_ACK_PENDING;
395                                         ax25_start_t2timer(ax25);
396                                 }
397                         }
398                 } else {
399                         if (ax25->condition & AX25_COND_REJECT) {
400                                 if (pf) ax25_std_enquiry_response(ax25);
401                         } else {
402                                 ax25->condition |= AX25_COND_REJECT;
403                                 ax25_send_control(ax25, AX25_REJ, pf, AX25_RESPONSE);
404                                 ax25->condition &= ~AX25_COND_ACK_PENDING;
405                         }
406                 }
407                 break;
408
409         case AX25_FRMR:
410         case AX25_ILLEGAL:
411                 ax25_std_establish_data_link(ax25);
412                 ax25->state = AX25_STATE_1;
413                 break;
414
415         default:
416                 break;
417         }
418
419         return queued;
420 }
421
422 /*
423  *      Higher level upcall for a LAPB frame
424  */
425 int ax25_std_frame_in(ax25_cb *ax25, struct sk_buff *skb, int type)
426 {
427         int queued = 0, frametype, ns, nr, pf;
428
429         frametype = ax25_decode(ax25, skb, &ns, &nr, &pf);
430
431         switch (ax25->state) {
432         case AX25_STATE_1:
433                 queued = ax25_std_state1_machine(ax25, skb, frametype, pf, type);
434                 break;
435         case AX25_STATE_2:
436                 queued = ax25_std_state2_machine(ax25, skb, frametype, pf, type);
437                 break;
438         case AX25_STATE_3:
439                 queued = ax25_std_state3_machine(ax25, skb, frametype, ns, nr, pf, type);
440                 break;
441         case AX25_STATE_4:
442                 queued = ax25_std_state4_machine(ax25, skb, frametype, ns, nr, pf, type);
443                 break;
444         }
445
446         ax25_kick(ax25);
447
448         return queued;
449 }