]>
Commit | Line | Data |
---|---|---|
a8386317 XL |
1 | /* SCTP kernel implementation |
2 | * (C) Copyright IBM Corp. 2001, 2004 | |
3 | * Copyright (c) 1999-2000 Cisco, Inc. | |
4 | * Copyright (c) 1999-2001 Motorola, Inc. | |
5 | * Copyright (c) 2001 Intel Corp. | |
6 | * | |
7 | * This file is part of the SCTP kernel implementation | |
8 | * | |
9 | * These functions manipulate sctp tsn mapping array. | |
10 | * | |
11 | * This SCTP implementation is free software; | |
12 | * you can redistribute it and/or modify it under the terms of | |
13 | * the GNU General Public License as published by | |
14 | * the Free Software Foundation; either version 2, or (at your option) | |
15 | * any later version. | |
16 | * | |
17 | * This SCTP implementation is distributed in the hope that it | |
18 | * will be useful, but WITHOUT ANY WARRANTY; without even the implied | |
19 | * ************************ | |
20 | * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. | |
21 | * See the GNU General Public License for more details. | |
22 | * | |
23 | * You should have received a copy of the GNU General Public License | |
24 | * along with GNU CC; see the file COPYING. If not, see | |
25 | * <http://www.gnu.org/licenses/>. | |
26 | * | |
27 | * Please send any bug reports or fixes you make to the | |
28 | * email address(es): | |
29 | * lksctp developers <linux-sctp@vger.kernel.org> | |
30 | * | |
31 | * Written or modified by: | |
32 | * Xin Long <lucien.xin@gmail.com> | |
33 | */ | |
34 | ||
35 | #include <net/sctp/sctp.h> | |
7f9d68ac | 36 | #include <net/sctp/sm.h> |
a8386317 | 37 | |
3dbcc105 | 38 | int sctp_stream_new(struct sctp_association *asoc, gfp_t gfp) |
a8386317 XL |
39 | { |
40 | struct sctp_stream *stream; | |
41 | int i; | |
42 | ||
43 | stream = kzalloc(sizeof(*stream), gfp); | |
44 | if (!stream) | |
3dbcc105 | 45 | return -ENOMEM; |
a8386317 | 46 | |
3dbcc105 | 47 | stream->outcnt = asoc->c.sinit_num_ostreams; |
a8386317 XL |
48 | stream->out = kcalloc(stream->outcnt, sizeof(*stream->out), gfp); |
49 | if (!stream->out) { | |
50 | kfree(stream); | |
3dbcc105 | 51 | return -ENOMEM; |
a8386317 XL |
52 | } |
53 | for (i = 0; i < stream->outcnt; i++) | |
54 | stream->out[i].state = SCTP_STREAM_OPEN; | |
55 | ||
3dbcc105 XL |
56 | asoc->stream = stream; |
57 | ||
58 | return 0; | |
59 | } | |
60 | ||
61 | int sctp_stream_init(struct sctp_association *asoc, gfp_t gfp) | |
62 | { | |
63 | struct sctp_stream *stream = asoc->stream; | |
64 | int i; | |
65 | ||
66 | /* Initial stream->out size may be very big, so free it and alloc | |
67 | * a new one with new outcnt to save memory. | |
68 | */ | |
69 | kfree(stream->out); | |
70 | stream->outcnt = asoc->c.sinit_num_ostreams; | |
71 | stream->out = kcalloc(stream->outcnt, sizeof(*stream->out), gfp); | |
72 | if (!stream->out) | |
73 | goto nomem; | |
74 | ||
75 | for (i = 0; i < stream->outcnt; i++) | |
76 | stream->out[i].state = SCTP_STREAM_OPEN; | |
77 | ||
78 | stream->incnt = asoc->c.sinit_max_instreams; | |
a8386317 XL |
79 | stream->in = kcalloc(stream->incnt, sizeof(*stream->in), gfp); |
80 | if (!stream->in) { | |
81 | kfree(stream->out); | |
3dbcc105 | 82 | goto nomem; |
a8386317 XL |
83 | } |
84 | ||
3dbcc105 XL |
85 | return 0; |
86 | ||
87 | nomem: | |
88 | asoc->stream = NULL; | |
89 | kfree(stream); | |
90 | ||
91 | return -ENOMEM; | |
a8386317 XL |
92 | } |
93 | ||
94 | void sctp_stream_free(struct sctp_stream *stream) | |
95 | { | |
96 | if (unlikely(!stream)) | |
97 | return; | |
98 | ||
99 | kfree(stream->out); | |
100 | kfree(stream->in); | |
101 | kfree(stream); | |
102 | } | |
103 | ||
104 | void sctp_stream_clear(struct sctp_stream *stream) | |
105 | { | |
106 | int i; | |
107 | ||
108 | for (i = 0; i < stream->outcnt; i++) | |
109 | stream->out[i].ssn = 0; | |
110 | ||
111 | for (i = 0; i < stream->incnt; i++) | |
112 | stream->in[i].ssn = 0; | |
113 | } | |
7f9d68ac XL |
114 | |
115 | static int sctp_send_reconf(struct sctp_association *asoc, | |
116 | struct sctp_chunk *chunk) | |
117 | { | |
118 | struct net *net = sock_net(asoc->base.sk); | |
119 | int retval = 0; | |
120 | ||
121 | retval = sctp_primitive_RECONF(net, asoc, chunk); | |
122 | if (retval) | |
123 | sctp_chunk_free(chunk); | |
124 | ||
125 | return retval; | |
126 | } | |
127 | ||
128 | int sctp_send_reset_streams(struct sctp_association *asoc, | |
129 | struct sctp_reset_streams *params) | |
130 | { | |
131 | struct sctp_stream *stream = asoc->stream; | |
132 | __u16 i, str_nums, *str_list; | |
133 | struct sctp_chunk *chunk; | |
134 | int retval = -EINVAL; | |
135 | bool out, in; | |
136 | ||
137 | if (!asoc->peer.reconf_capable || | |
138 | !(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) { | |
139 | retval = -ENOPROTOOPT; | |
140 | goto out; | |
141 | } | |
142 | ||
143 | if (asoc->strreset_outstanding) { | |
144 | retval = -EINPROGRESS; | |
145 | goto out; | |
146 | } | |
147 | ||
148 | out = params->srs_flags & SCTP_STREAM_RESET_OUTGOING; | |
149 | in = params->srs_flags & SCTP_STREAM_RESET_INCOMING; | |
150 | if (!out && !in) | |
151 | goto out; | |
152 | ||
153 | str_nums = params->srs_number_streams; | |
154 | str_list = params->srs_stream_list; | |
155 | if (out && str_nums) | |
156 | for (i = 0; i < str_nums; i++) | |
157 | if (str_list[i] >= stream->outcnt) | |
158 | goto out; | |
159 | ||
160 | if (in && str_nums) | |
161 | for (i = 0; i < str_nums; i++) | |
162 | if (str_list[i] >= stream->incnt) | |
163 | goto out; | |
164 | ||
16e1a919 XL |
165 | for (i = 0; i < str_nums; i++) |
166 | str_list[i] = htons(str_list[i]); | |
167 | ||
7f9d68ac | 168 | chunk = sctp_make_strreset_req(asoc, str_nums, str_list, out, in); |
16e1a919 XL |
169 | |
170 | for (i = 0; i < str_nums; i++) | |
171 | str_list[i] = ntohs(str_list[i]); | |
172 | ||
119aecba XL |
173 | if (!chunk) { |
174 | retval = -ENOMEM; | |
7f9d68ac | 175 | goto out; |
119aecba | 176 | } |
7f9d68ac XL |
177 | |
178 | if (out) { | |
179 | if (str_nums) | |
180 | for (i = 0; i < str_nums; i++) | |
181 | stream->out[str_list[i]].state = | |
182 | SCTP_STREAM_CLOSED; | |
183 | else | |
184 | for (i = 0; i < stream->outcnt; i++) | |
185 | stream->out[i].state = SCTP_STREAM_CLOSED; | |
186 | } | |
187 | ||
7f9d68ac XL |
188 | asoc->strreset_chunk = chunk; |
189 | sctp_chunk_hold(asoc->strreset_chunk); | |
190 | ||
191 | retval = sctp_send_reconf(asoc, chunk); | |
192 | if (retval) { | |
193 | sctp_chunk_put(asoc->strreset_chunk); | |
194 | asoc->strreset_chunk = NULL; | |
119aecba XL |
195 | if (!out) |
196 | goto out; | |
197 | ||
198 | if (str_nums) | |
199 | for (i = 0; i < str_nums; i++) | |
200 | stream->out[str_list[i]].state = | |
201 | SCTP_STREAM_OPEN; | |
202 | else | |
203 | for (i = 0; i < stream->outcnt; i++) | |
204 | stream->out[i].state = SCTP_STREAM_OPEN; | |
205 | ||
206 | goto out; | |
7f9d68ac XL |
207 | } |
208 | ||
119aecba XL |
209 | asoc->strreset_outstanding = out + in; |
210 | ||
7f9d68ac XL |
211 | out: |
212 | return retval; | |
213 | } | |
a92ce1a4 XL |
214 | |
215 | int sctp_send_reset_assoc(struct sctp_association *asoc) | |
216 | { | |
217 | struct sctp_chunk *chunk = NULL; | |
218 | int retval; | |
219 | __u16 i; | |
220 | ||
221 | if (!asoc->peer.reconf_capable || | |
222 | !(asoc->strreset_enable & SCTP_ENABLE_RESET_ASSOC_REQ)) | |
223 | return -ENOPROTOOPT; | |
224 | ||
225 | if (asoc->strreset_outstanding) | |
226 | return -EINPROGRESS; | |
227 | ||
228 | chunk = sctp_make_strreset_tsnreq(asoc); | |
229 | if (!chunk) | |
230 | return -ENOMEM; | |
231 | ||
232 | /* Block further xmit of data until this request is completed */ | |
233 | for (i = 0; i < asoc->stream->outcnt; i++) | |
234 | asoc->stream->out[i].state = SCTP_STREAM_CLOSED; | |
235 | ||
236 | asoc->strreset_chunk = chunk; | |
237 | sctp_chunk_hold(asoc->strreset_chunk); | |
238 | ||
239 | retval = sctp_send_reconf(asoc, chunk); | |
240 | if (retval) { | |
241 | sctp_chunk_put(asoc->strreset_chunk); | |
242 | asoc->strreset_chunk = NULL; | |
243 | ||
244 | for (i = 0; i < asoc->stream->outcnt; i++) | |
245 | asoc->stream->out[i].state = SCTP_STREAM_OPEN; | |
246 | ||
247 | return retval; | |
248 | } | |
249 | ||
250 | asoc->strreset_outstanding = 1; | |
251 | ||
252 | return 0; | |
253 | } | |
242bd2d5 XL |
254 | |
255 | int sctp_send_add_streams(struct sctp_association *asoc, | |
256 | struct sctp_add_streams *params) | |
257 | { | |
258 | struct sctp_stream *stream = asoc->stream; | |
259 | struct sctp_chunk *chunk = NULL; | |
260 | int retval = -ENOMEM; | |
261 | __u32 outcnt, incnt; | |
262 | __u16 out, in; | |
263 | ||
264 | if (!asoc->peer.reconf_capable || | |
265 | !(asoc->strreset_enable & SCTP_ENABLE_CHANGE_ASSOC_REQ)) { | |
266 | retval = -ENOPROTOOPT; | |
267 | goto out; | |
268 | } | |
269 | ||
270 | if (asoc->strreset_outstanding) { | |
271 | retval = -EINPROGRESS; | |
272 | goto out; | |
273 | } | |
274 | ||
275 | out = params->sas_outstrms; | |
276 | in = params->sas_instrms; | |
277 | outcnt = stream->outcnt + out; | |
278 | incnt = stream->incnt + in; | |
279 | if (outcnt > SCTP_MAX_STREAM || incnt > SCTP_MAX_STREAM || | |
280 | (!out && !in)) { | |
281 | retval = -EINVAL; | |
282 | goto out; | |
283 | } | |
284 | ||
285 | if (out) { | |
286 | struct sctp_stream_out *streamout; | |
287 | ||
288 | streamout = krealloc(stream->out, outcnt * sizeof(*streamout), | |
289 | GFP_KERNEL); | |
290 | if (!streamout) | |
291 | goto out; | |
292 | ||
293 | memset(streamout + stream->outcnt, 0, out * sizeof(*streamout)); | |
294 | stream->out = streamout; | |
295 | } | |
296 | ||
297 | if (in) { | |
298 | struct sctp_stream_in *streamin; | |
299 | ||
300 | streamin = krealloc(stream->in, incnt * sizeof(*streamin), | |
301 | GFP_KERNEL); | |
302 | if (!streamin) | |
303 | goto out; | |
304 | ||
305 | memset(streamin + stream->incnt, 0, in * sizeof(*streamin)); | |
306 | stream->in = streamin; | |
307 | } | |
308 | ||
309 | chunk = sctp_make_strreset_addstrm(asoc, out, in); | |
310 | if (!chunk) | |
311 | goto out; | |
312 | ||
313 | asoc->strreset_chunk = chunk; | |
314 | sctp_chunk_hold(asoc->strreset_chunk); | |
315 | ||
316 | retval = sctp_send_reconf(asoc, chunk); | |
317 | if (retval) { | |
318 | sctp_chunk_put(asoc->strreset_chunk); | |
319 | asoc->strreset_chunk = NULL; | |
320 | goto out; | |
321 | } | |
322 | ||
323 | stream->incnt = incnt; | |
324 | stream->outcnt = outcnt; | |
325 | ||
326 | asoc->strreset_outstanding = !!out + !!in; | |
327 | ||
328 | out: | |
329 | return retval; | |
330 | } | |
81054476 XL |
331 | |
332 | static sctp_paramhdr_t *sctp_chunk_lookup_strreset_param( | |
333 | struct sctp_association *asoc, __u32 resp_seq) | |
334 | { | |
335 | struct sctp_chunk *chunk = asoc->strreset_chunk; | |
336 | struct sctp_reconf_chunk *hdr; | |
337 | union sctp_params param; | |
338 | ||
339 | if (ntohl(resp_seq) != asoc->strreset_outseq || !chunk) | |
340 | return NULL; | |
341 | ||
342 | hdr = (struct sctp_reconf_chunk *)chunk->chunk_hdr; | |
343 | sctp_walk_params(param, hdr, params) { | |
344 | /* sctp_strreset_tsnreq is actually the basic structure | |
345 | * of all stream reconf params, so it's safe to use it | |
346 | * to access request_seq. | |
347 | */ | |
348 | struct sctp_strreset_tsnreq *req = param.v; | |
349 | ||
350 | if (req->request_seq == resp_seq) | |
351 | return param.v; | |
352 | } | |
353 | ||
354 | return NULL; | |
355 | } | |
356 | ||
357 | struct sctp_chunk *sctp_process_strreset_outreq( | |
358 | struct sctp_association *asoc, | |
359 | union sctp_params param, | |
360 | struct sctp_ulpevent **evp) | |
361 | { | |
362 | struct sctp_strreset_outreq *outreq = param.v; | |
363 | struct sctp_stream *stream = asoc->stream; | |
364 | __u16 i, nums, flags = 0, *str_p = NULL; | |
365 | __u32 result = SCTP_STRRESET_DENIED; | |
366 | __u32 request_seq; | |
367 | ||
368 | request_seq = ntohl(outreq->request_seq); | |
369 | ||
370 | if (ntohl(outreq->send_reset_at_tsn) > | |
371 | sctp_tsnmap_get_ctsn(&asoc->peer.tsn_map)) { | |
372 | result = SCTP_STRRESET_IN_PROGRESS; | |
373 | goto out; | |
374 | } | |
375 | ||
376 | if (request_seq > asoc->strreset_inseq) { | |
377 | result = SCTP_STRRESET_ERR_BAD_SEQNO; | |
378 | goto out; | |
379 | } else if (request_seq == asoc->strreset_inseq) { | |
380 | asoc->strreset_inseq++; | |
381 | } | |
382 | ||
383 | /* Check strreset_enable after inseq inc, as sender cannot tell | |
384 | * the peer doesn't enable strreset after receiving response with | |
385 | * result denied, as well as to keep consistent with bsd. | |
386 | */ | |
387 | if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) | |
388 | goto out; | |
389 | ||
390 | if (asoc->strreset_chunk) { | |
391 | sctp_paramhdr_t *param_hdr; | |
392 | struct sctp_transport *t; | |
393 | ||
394 | param_hdr = sctp_chunk_lookup_strreset_param( | |
395 | asoc, outreq->response_seq); | |
396 | if (!param_hdr || param_hdr->type != | |
397 | SCTP_PARAM_RESET_IN_REQUEST) { | |
398 | /* same process with outstanding isn't 0 */ | |
399 | result = SCTP_STRRESET_ERR_IN_PROGRESS; | |
400 | goto out; | |
401 | } | |
402 | ||
403 | asoc->strreset_outstanding--; | |
404 | asoc->strreset_outseq++; | |
405 | ||
406 | if (!asoc->strreset_outstanding) { | |
407 | t = asoc->strreset_chunk->transport; | |
408 | if (del_timer(&t->reconf_timer)) | |
409 | sctp_transport_put(t); | |
410 | ||
411 | sctp_chunk_put(asoc->strreset_chunk); | |
412 | asoc->strreset_chunk = NULL; | |
413 | } | |
414 | ||
415 | flags = SCTP_STREAM_RESET_INCOMING_SSN; | |
416 | } | |
417 | ||
418 | nums = (ntohs(param.p->length) - sizeof(*outreq)) / 2; | |
419 | if (nums) { | |
420 | str_p = outreq->list_of_streams; | |
421 | for (i = 0; i < nums; i++) { | |
422 | if (ntohs(str_p[i]) >= stream->incnt) { | |
423 | result = SCTP_STRRESET_ERR_WRONG_SSN; | |
424 | goto out; | |
425 | } | |
426 | } | |
427 | ||
428 | for (i = 0; i < nums; i++) | |
429 | stream->in[ntohs(str_p[i])].ssn = 0; | |
430 | } else { | |
431 | for (i = 0; i < stream->incnt; i++) | |
432 | stream->in[i].ssn = 0; | |
433 | } | |
434 | ||
435 | result = SCTP_STRRESET_PERFORMED; | |
436 | ||
437 | *evp = sctp_ulpevent_make_stream_reset_event(asoc, | |
438 | flags | SCTP_STREAM_RESET_OUTGOING_SSN, nums, str_p, | |
439 | GFP_ATOMIC); | |
440 | ||
441 | out: | |
442 | return sctp_make_strreset_resp(asoc, result, request_seq); | |
443 | } | |
16e1a919 XL |
444 | |
445 | struct sctp_chunk *sctp_process_strreset_inreq( | |
446 | struct sctp_association *asoc, | |
447 | union sctp_params param, | |
448 | struct sctp_ulpevent **evp) | |
449 | { | |
450 | struct sctp_strreset_inreq *inreq = param.v; | |
451 | struct sctp_stream *stream = asoc->stream; | |
452 | __u32 result = SCTP_STRRESET_DENIED; | |
453 | struct sctp_chunk *chunk = NULL; | |
454 | __u16 i, nums, *str_p; | |
455 | __u32 request_seq; | |
456 | ||
457 | request_seq = ntohl(inreq->request_seq); | |
458 | if (request_seq > asoc->strreset_inseq) { | |
459 | result = SCTP_STRRESET_ERR_BAD_SEQNO; | |
460 | goto out; | |
461 | } else if (request_seq == asoc->strreset_inseq) { | |
462 | asoc->strreset_inseq++; | |
463 | } | |
464 | ||
465 | if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) | |
466 | goto out; | |
467 | ||
468 | if (asoc->strreset_outstanding) { | |
469 | result = SCTP_STRRESET_ERR_IN_PROGRESS; | |
470 | goto out; | |
471 | } | |
472 | ||
473 | nums = (ntohs(param.p->length) - sizeof(*inreq)) / 2; | |
474 | str_p = inreq->list_of_streams; | |
475 | for (i = 0; i < nums; i++) { | |
476 | if (ntohs(str_p[i]) >= stream->outcnt) { | |
477 | result = SCTP_STRRESET_ERR_WRONG_SSN; | |
478 | goto out; | |
479 | } | |
480 | } | |
481 | ||
482 | chunk = sctp_make_strreset_req(asoc, nums, str_p, 1, 0); | |
483 | if (!chunk) | |
484 | goto out; | |
485 | ||
486 | if (nums) | |
487 | for (i = 0; i < nums; i++) | |
488 | stream->out[ntohs(str_p[i])].state = | |
489 | SCTP_STREAM_CLOSED; | |
490 | else | |
491 | for (i = 0; i < stream->outcnt; i++) | |
492 | stream->out[i].state = SCTP_STREAM_CLOSED; | |
493 | ||
494 | asoc->strreset_chunk = chunk; | |
495 | asoc->strreset_outstanding = 1; | |
496 | sctp_chunk_hold(asoc->strreset_chunk); | |
497 | ||
498 | *evp = sctp_ulpevent_make_stream_reset_event(asoc, | |
499 | SCTP_STREAM_RESET_INCOMING_SSN, nums, str_p, GFP_ATOMIC); | |
500 | ||
501 | out: | |
502 | if (!chunk) | |
503 | chunk = sctp_make_strreset_resp(asoc, result, request_seq); | |
504 | ||
505 | return chunk; | |
506 | } |