blob: d1b0dc79bb6f15874bd520c41d08f96bd9ff31bb [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * X.25 Packet Layer release 002
3 *
4 * This is ALPHA test software. This code may break your machine,
5 * randomly fail to work with new releases, misbehave and/or generally
YOSHIFUJI Hideakif8e1d2012007-02-09 23:25:27 +09006 * screw up. It might even work.
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
8 * This code REQUIRES 2.1.15 or higher
9 *
10 * This module:
11 * This module is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License
13 * as published by the Free Software Foundation; either version
14 * 2 of the License, or (at your option) any later version.
15 *
16 * History
17 * X.25 001 Jonathan Naylor Started coding.
18 * X.25 002 Jonathan Naylor Centralised disconnection code.
19 * New timer architecture.
YOSHIFUJI Hideakif8e1d2012007-02-09 23:25:27 +090020 * 2000-03-20 Daniela Squassoni Disabling/enabling of facilities
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 * negotiation.
22 * 2000-11-10 Henner Eisen Check and reset for out-of-sequence
23 * i-frames.
24 */
25
wangweidongb73e9e32013-12-06 19:24:33 +080026#define pr_fmt(fmt) "X25: " fmt
27
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/errno.h>
30#include <linux/kernel.h>
31#include <linux/string.h>
32#include <linux/skbuff.h>
33#include <net/sock.h>
Arnaldo Carvalho de Meloc752f072005-08-09 20:08:28 -070034#include <net/tcp_states.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070035#include <net/x25.h>
36
37static int x25_queue_rx_frame(struct sock *sk, struct sk_buff *skb, int more)
38{
39 struct sk_buff *skbo, *skbn = skb;
40 struct x25_sock *x25 = x25_sk(sk);
41
42 if (more) {
43 x25->fraglen += skb->len;
44 skb_queue_tail(&x25->fragment_queue, skb);
45 skb_set_owner_r(skb, sk);
46 return 0;
47 }
48
49 if (!more && x25->fraglen > 0) { /* End of fragment */
50 int len = x25->fraglen + skb->len;
51
52 if ((skbn = alloc_skb(len, GFP_ATOMIC)) == NULL){
53 kfree_skb(skb);
54 return 1;
55 }
56
57 skb_queue_tail(&x25->fragment_queue, skb);
58
Arnaldo Carvalho de Melobadff6d2007-03-13 13:06:52 -030059 skb_reset_transport_header(skbn);
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
61 skbo = skb_dequeue(&x25->fragment_queue);
Arnaldo Carvalho de Melo1a4e2d02007-03-31 11:55:45 -030062 skb_copy_from_linear_data(skbo, skb_put(skbn, skbo->len),
63 skbo->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -070064 kfree_skb(skbo);
65
66 while ((skbo =
67 skb_dequeue(&x25->fragment_queue)) != NULL) {
68 skb_pull(skbo, (x25->neighbour->extended) ?
69 X25_EXT_MIN_LEN : X25_STD_MIN_LEN);
Arnaldo Carvalho de Melo1a4e2d02007-03-31 11:55:45 -030070 skb_copy_from_linear_data(skbo,
71 skb_put(skbn, skbo->len),
72 skbo->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -070073 kfree_skb(skbo);
74 }
75
YOSHIFUJI Hideakif8e1d2012007-02-09 23:25:27 +090076 x25->fraglen = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070077 }
78
79 skb_set_owner_r(skbn, sk);
80 skb_queue_tail(&sk->sk_receive_queue, skbn);
81 if (!sock_flag(sk, SOCK_DEAD))
82 sk->sk_data_ready(sk, skbn->len);
83
84 return 0;
85}
86
87/*
88 * State machine for state 1, Awaiting Call Accepted State.
89 * The handling of the timer(s) is in file x25_timer.c.
90 * Handling of state 0 and connection release is in af_x25.c.
91 */
92static int x25_state1_machine(struct sock *sk, struct sk_buff *skb, int frametype)
93{
94 struct x25_address source_addr, dest_addr;
John Hughesf5eb9172010-04-07 21:29:25 -070095 int len;
andrew hendry95c30432011-02-07 00:08:15 +000096 struct x25_sock *x25 = x25_sk(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -070097
98 switch (frametype) {
Joe Perchesfddc5f32011-07-01 09:43:13 +000099 case X25_CALL_ACCEPTED: {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Joe Perchesfddc5f32011-07-01 09:43:13 +0000101 x25_stop_timer(sk);
102 x25->condition = 0x00;
103 x25->vs = 0;
104 x25->va = 0;
105 x25->vr = 0;
106 x25->vl = 0;
107 x25->state = X25_STATE_3;
108 sk->sk_state = TCP_ESTABLISHED;
109 /*
110 * Parse the data in the frame.
111 */
Matthew Daleycb101ed2011-10-14 18:45:04 +0000112 if (!pskb_may_pull(skb, X25_STD_MIN_LEN))
113 goto out_clear;
Joe Perchesfddc5f32011-07-01 09:43:13 +0000114 skb_pull(skb, X25_STD_MIN_LEN);
John Hughesf5eb9172010-04-07 21:29:25 -0700115
Joe Perchesfddc5f32011-07-01 09:43:13 +0000116 len = x25_parse_address_block(skb, &source_addr,
117 &dest_addr);
118 if (len > 0)
119 skb_pull(skb, len);
120 else if (len < 0)
121 goto out_clear;
John Hughesf5eb9172010-04-07 21:29:25 -0700122
Joe Perchesfddc5f32011-07-01 09:43:13 +0000123 len = x25_parse_facilities(skb, &x25->facilities,
124 &x25->dte_facilities,
125 &x25->vc_facil_mask);
126 if (len > 0)
127 skb_pull(skb, len);
128 else if (len < 0)
129 goto out_clear;
130 /*
131 * Copy any Call User Data.
132 */
133 if (skb->len > 0) {
Matthew Daleyc7fd0d42011-10-14 18:45:03 +0000134 if (skb->len > X25_MAX_CUD_LEN)
135 goto out_clear;
136
Matthew Daleycb101ed2011-10-14 18:45:04 +0000137 skb_copy_bits(skb, 0, x25->calluserdata.cuddata,
138 skb->len);
Joe Perchesfddc5f32011-07-01 09:43:13 +0000139 x25->calluserdata.cudlength = skb->len;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 }
Joe Perchesfddc5f32011-07-01 09:43:13 +0000141 if (!sock_flag(sk, SOCK_DEAD))
142 sk->sk_state_change(sk);
143 break;
144 }
145 case X25_CLEAR_REQUEST:
Matthew Daleycb101ed2011-10-14 18:45:04 +0000146 if (!pskb_may_pull(skb, X25_STD_MIN_LEN + 2))
147 goto out_clear;
148
Joe Perchesfddc5f32011-07-01 09:43:13 +0000149 x25_write_internal(sk, X25_CLEAR_CONFIRMATION);
150 x25_disconnect(sk, ECONNREFUSED, skb->data[3], skb->data[4]);
151 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152
Joe Perchesfddc5f32011-07-01 09:43:13 +0000153 default:
154 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 }
156
157 return 0;
andrew hendry95c30432011-02-07 00:08:15 +0000158
159out_clear:
160 x25_write_internal(sk, X25_CLEAR_REQUEST);
161 x25->state = X25_STATE_2;
162 x25_start_t23timer(sk);
163 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164}
165
166/*
167 * State machine for state 2, Awaiting Clear Confirmation State.
168 * The handling of the timer(s) is in file x25_timer.c
169 * Handling of state 0 and connection release is in af_x25.c.
170 */
171static int x25_state2_machine(struct sock *sk, struct sk_buff *skb, int frametype)
172{
173 switch (frametype) {
174
175 case X25_CLEAR_REQUEST:
Matthew Daleycb101ed2011-10-14 18:45:04 +0000176 if (!pskb_may_pull(skb, X25_STD_MIN_LEN + 2))
177 goto out_clear;
178
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179 x25_write_internal(sk, X25_CLEAR_CONFIRMATION);
180 x25_disconnect(sk, 0, skb->data[3], skb->data[4]);
181 break;
182
183 case X25_CLEAR_CONFIRMATION:
184 x25_disconnect(sk, 0, 0, 0);
185 break;
186
187 default:
188 break;
189 }
190
191 return 0;
Matthew Daleycb101ed2011-10-14 18:45:04 +0000192
193out_clear:
194 x25_write_internal(sk, X25_CLEAR_REQUEST);
195 x25_start_t23timer(sk);
196 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197}
198
199/*
200 * State machine for state 3, Connected State.
201 * The handling of the timer(s) is in file x25_timer.c
202 * Handling of state 0 and connection release is in af_x25.c.
203 */
204static int x25_state3_machine(struct sock *sk, struct sk_buff *skb, int frametype, int ns, int nr, int q, int d, int m)
205{
206 int queued = 0;
207 int modulus;
208 struct x25_sock *x25 = x25_sk(sk);
YOSHIFUJI Hideakif8e1d2012007-02-09 23:25:27 +0900209
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210 modulus = (x25->neighbour->extended) ? X25_EMODULUS : X25_SMODULUS;
211
212 switch (frametype) {
213
214 case X25_RESET_REQUEST:
215 x25_write_internal(sk, X25_RESET_CONFIRMATION);
216 x25_stop_timer(sk);
217 x25->condition = 0x00;
218 x25->vs = 0;
219 x25->vr = 0;
220 x25->va = 0;
221 x25->vl = 0;
222 x25_requeue_frames(sk);
223 break;
224
225 case X25_CLEAR_REQUEST:
Matthew Daleycb101ed2011-10-14 18:45:04 +0000226 if (!pskb_may_pull(skb, X25_STD_MIN_LEN + 2))
227 goto out_clear;
228
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229 x25_write_internal(sk, X25_CLEAR_CONFIRMATION);
230 x25_disconnect(sk, 0, skb->data[3], skb->data[4]);
231 break;
232
233 case X25_RR:
234 case X25_RNR:
235 if (!x25_validate_nr(sk, nr)) {
236 x25_clear_queues(sk);
237 x25_write_internal(sk, X25_RESET_REQUEST);
238 x25_start_t22timer(sk);
239 x25->condition = 0x00;
240 x25->vs = 0;
241 x25->vr = 0;
242 x25->va = 0;
243 x25->vl = 0;
244 x25->state = X25_STATE_4;
245 } else {
246 x25_frames_acked(sk, nr);
247 if (frametype == X25_RNR) {
248 x25->condition |= X25_COND_PEER_RX_BUSY;
249 } else {
250 x25->condition &= ~X25_COND_PEER_RX_BUSY;
251 }
252 }
253 break;
254
255 case X25_DATA: /* XXX */
256 x25->condition &= ~X25_COND_PEER_RX_BUSY;
257 if ((ns != x25->vr) || !x25_validate_nr(sk, nr)) {
258 x25_clear_queues(sk);
259 x25_write_internal(sk, X25_RESET_REQUEST);
260 x25_start_t22timer(sk);
261 x25->condition = 0x00;
262 x25->vs = 0;
263 x25->vr = 0;
264 x25->va = 0;
265 x25->vl = 0;
266 x25->state = X25_STATE_4;
267 break;
268 }
269 x25_frames_acked(sk, nr);
270 if (ns == x25->vr) {
271 if (x25_queue_rx_frame(sk, skb, m) == 0) {
272 x25->vr = (x25->vr + 1) % modulus;
273 queued = 1;
274 } else {
275 /* Should never happen */
276 x25_clear_queues(sk);
277 x25_write_internal(sk, X25_RESET_REQUEST);
278 x25_start_t22timer(sk);
279 x25->condition = 0x00;
280 x25->vs = 0;
281 x25->vr = 0;
282 x25->va = 0;
283 x25->vl = 0;
284 x25->state = X25_STATE_4;
285 break;
286 }
287 if (atomic_read(&sk->sk_rmem_alloc) >
Eric Dumazet6bf15742008-01-13 22:27:52 -0800288 (sk->sk_rcvbuf >> 1))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 x25->condition |= X25_COND_OWN_RX_BUSY;
290 }
291 /*
292 * If the window is full Ack it immediately, else
293 * start the holdback timer.
294 */
295 if (((x25->vl + x25->facilities.winsize_in) % modulus) == x25->vr) {
296 x25->condition &= ~X25_COND_ACK_PENDING;
297 x25_stop_timer(sk);
298 x25_enquiry_response(sk);
299 } else {
300 x25->condition |= X25_COND_ACK_PENDING;
301 x25_start_t2timer(sk);
302 }
303 break;
304
305 case X25_INTERRUPT_CONFIRMATION:
andrew hendryb7792e32010-05-16 23:00:02 +0000306 clear_bit(X25_INTERRUPT_FLAG, &x25->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 break;
308
309 case X25_INTERRUPT:
310 if (sock_flag(sk, SOCK_URGINLINE))
311 queued = !sock_queue_rcv_skb(sk, skb);
312 else {
313 skb_set_owner_r(skb, sk);
314 skb_queue_tail(&x25->interrupt_in_queue, skb);
315 queued = 1;
316 }
317 sk_send_sigurg(sk);
318 x25_write_internal(sk, X25_INTERRUPT_CONFIRMATION);
319 break;
320
321 default:
wangweidongb73e9e32013-12-06 19:24:33 +0800322 pr_warn("unknown %02X in state 3\n", frametype);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700323 break;
324 }
325
326 return queued;
Matthew Daleycb101ed2011-10-14 18:45:04 +0000327
328out_clear:
329 x25_write_internal(sk, X25_CLEAR_REQUEST);
330 x25->state = X25_STATE_2;
331 x25_start_t23timer(sk);
332 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700333}
334
335/*
336 * State machine for state 4, Awaiting Reset Confirmation State.
337 * The handling of the timer(s) is in file x25_timer.c
338 * Handling of state 0 and connection release is in af_x25.c.
339 */
340static int x25_state4_machine(struct sock *sk, struct sk_buff *skb, int frametype)
341{
Matthew Daleycb101ed2011-10-14 18:45:04 +0000342 struct x25_sock *x25 = x25_sk(sk);
343
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 switch (frametype) {
345
346 case X25_RESET_REQUEST:
347 x25_write_internal(sk, X25_RESET_CONFIRMATION);
348 case X25_RESET_CONFIRMATION: {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 x25_stop_timer(sk);
350 x25->condition = 0x00;
351 x25->va = 0;
352 x25->vr = 0;
353 x25->vs = 0;
354 x25->vl = 0;
355 x25->state = X25_STATE_3;
356 x25_requeue_frames(sk);
357 break;
358 }
359 case X25_CLEAR_REQUEST:
Matthew Daleycb101ed2011-10-14 18:45:04 +0000360 if (!pskb_may_pull(skb, X25_STD_MIN_LEN + 2))
361 goto out_clear;
362
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 x25_write_internal(sk, X25_CLEAR_CONFIRMATION);
364 x25_disconnect(sk, 0, skb->data[3], skb->data[4]);
365 break;
366
367 default:
368 break;
369 }
370
371 return 0;
Matthew Daleycb101ed2011-10-14 18:45:04 +0000372
373out_clear:
374 x25_write_internal(sk, X25_CLEAR_REQUEST);
375 x25->state = X25_STATE_2;
376 x25_start_t23timer(sk);
377 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378}
379
380/* Higher level upcall for a LAPB frame */
381int x25_process_rx_frame(struct sock *sk, struct sk_buff *skb)
382{
383 struct x25_sock *x25 = x25_sk(sk);
384 int queued = 0, frametype, ns, nr, q, d, m;
385
386 if (x25->state == X25_STATE_0)
387 return 0;
388
389 frametype = x25_decode(sk, skb, &ns, &nr, &q, &d, &m);
390
391 switch (x25->state) {
Joe Perchesfddc5f32011-07-01 09:43:13 +0000392 case X25_STATE_1:
393 queued = x25_state1_machine(sk, skb, frametype);
394 break;
395 case X25_STATE_2:
396 queued = x25_state2_machine(sk, skb, frametype);
397 break;
398 case X25_STATE_3:
399 queued = x25_state3_machine(sk, skb, frametype, ns, nr, q, d, m);
400 break;
401 case X25_STATE_4:
402 queued = x25_state4_machine(sk, skb, frametype);
403 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 }
405
406 x25_kick(sk);
407
408 return queued;
409}
410
411int x25_backlog_rcv(struct sock *sk, struct sk_buff *skb)
412{
413 int queued = x25_process_rx_frame(sk, skb);
414
415 if (!queued)
416 kfree_skb(skb);
417
418 return 0;
419}