]>
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 XL |
37 | |
38 | struct sctp_stream *sctp_stream_new(__u16 incnt, __u16 outcnt, gfp_t gfp) | |
39 | { | |
40 | struct sctp_stream *stream; | |
41 | int i; | |
42 | ||
43 | stream = kzalloc(sizeof(*stream), gfp); | |
44 | if (!stream) | |
45 | return NULL; | |
46 | ||
47 | stream->outcnt = outcnt; | |
48 | stream->out = kcalloc(stream->outcnt, sizeof(*stream->out), gfp); | |
49 | if (!stream->out) { | |
50 | kfree(stream); | |
51 | return NULL; | |
52 | } | |
53 | for (i = 0; i < stream->outcnt; i++) | |
54 | stream->out[i].state = SCTP_STREAM_OPEN; | |
55 | ||
56 | stream->incnt = incnt; | |
57 | stream->in = kcalloc(stream->incnt, sizeof(*stream->in), gfp); | |
58 | if (!stream->in) { | |
59 | kfree(stream->out); | |
60 | kfree(stream); | |
61 | return NULL; | |
62 | } | |
63 | ||
64 | return stream; | |
65 | } | |
66 | ||
67 | void sctp_stream_free(struct sctp_stream *stream) | |
68 | { | |
69 | if (unlikely(!stream)) | |
70 | return; | |
71 | ||
72 | kfree(stream->out); | |
73 | kfree(stream->in); | |
74 | kfree(stream); | |
75 | } | |
76 | ||
77 | void sctp_stream_clear(struct sctp_stream *stream) | |
78 | { | |
79 | int i; | |
80 | ||
81 | for (i = 0; i < stream->outcnt; i++) | |
82 | stream->out[i].ssn = 0; | |
83 | ||
84 | for (i = 0; i < stream->incnt; i++) | |
85 | stream->in[i].ssn = 0; | |
86 | } | |
7f9d68ac XL |
87 | |
88 | static int sctp_send_reconf(struct sctp_association *asoc, | |
89 | struct sctp_chunk *chunk) | |
90 | { | |
91 | struct net *net = sock_net(asoc->base.sk); | |
92 | int retval = 0; | |
93 | ||
94 | retval = sctp_primitive_RECONF(net, asoc, chunk); | |
95 | if (retval) | |
96 | sctp_chunk_free(chunk); | |
97 | ||
98 | return retval; | |
99 | } | |
100 | ||
101 | int sctp_send_reset_streams(struct sctp_association *asoc, | |
102 | struct sctp_reset_streams *params) | |
103 | { | |
104 | struct sctp_stream *stream = asoc->stream; | |
105 | __u16 i, str_nums, *str_list; | |
106 | struct sctp_chunk *chunk; | |
107 | int retval = -EINVAL; | |
108 | bool out, in; | |
109 | ||
110 | if (!asoc->peer.reconf_capable || | |
111 | !(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) { | |
112 | retval = -ENOPROTOOPT; | |
113 | goto out; | |
114 | } | |
115 | ||
116 | if (asoc->strreset_outstanding) { | |
117 | retval = -EINPROGRESS; | |
118 | goto out; | |
119 | } | |
120 | ||
121 | out = params->srs_flags & SCTP_STREAM_RESET_OUTGOING; | |
122 | in = params->srs_flags & SCTP_STREAM_RESET_INCOMING; | |
123 | if (!out && !in) | |
124 | goto out; | |
125 | ||
126 | str_nums = params->srs_number_streams; | |
127 | str_list = params->srs_stream_list; | |
128 | if (out && str_nums) | |
129 | for (i = 0; i < str_nums; i++) | |
130 | if (str_list[i] >= stream->outcnt) | |
131 | goto out; | |
132 | ||
133 | if (in && str_nums) | |
134 | for (i = 0; i < str_nums; i++) | |
135 | if (str_list[i] >= stream->incnt) | |
136 | goto out; | |
137 | ||
16e1a919 XL |
138 | for (i = 0; i < str_nums; i++) |
139 | str_list[i] = htons(str_list[i]); | |
140 | ||
7f9d68ac | 141 | chunk = sctp_make_strreset_req(asoc, str_nums, str_list, out, in); |
16e1a919 XL |
142 | |
143 | for (i = 0; i < str_nums; i++) | |
144 | str_list[i] = ntohs(str_list[i]); | |
145 | ||
119aecba XL |
146 | if (!chunk) { |
147 | retval = -ENOMEM; | |
7f9d68ac | 148 | goto out; |
119aecba | 149 | } |
7f9d68ac XL |
150 | |
151 | if (out) { | |
152 | if (str_nums) | |
153 | for (i = 0; i < str_nums; i++) | |
154 | stream->out[str_list[i]].state = | |
155 | SCTP_STREAM_CLOSED; | |
156 | else | |
157 | for (i = 0; i < stream->outcnt; i++) | |
158 | stream->out[i].state = SCTP_STREAM_CLOSED; | |
159 | } | |
160 | ||
7f9d68ac XL |
161 | asoc->strreset_chunk = chunk; |
162 | sctp_chunk_hold(asoc->strreset_chunk); | |
163 | ||
164 | retval = sctp_send_reconf(asoc, chunk); | |
165 | if (retval) { | |
166 | sctp_chunk_put(asoc->strreset_chunk); | |
167 | asoc->strreset_chunk = NULL; | |
119aecba XL |
168 | if (!out) |
169 | goto out; | |
170 | ||
171 | if (str_nums) | |
172 | for (i = 0; i < str_nums; i++) | |
173 | stream->out[str_list[i]].state = | |
174 | SCTP_STREAM_OPEN; | |
175 | else | |
176 | for (i = 0; i < stream->outcnt; i++) | |
177 | stream->out[i].state = SCTP_STREAM_OPEN; | |
178 | ||
179 | goto out; | |
7f9d68ac XL |
180 | } |
181 | ||
119aecba XL |
182 | asoc->strreset_outstanding = out + in; |
183 | ||
7f9d68ac XL |
184 | out: |
185 | return retval; | |
186 | } | |
a92ce1a4 XL |
187 | |
188 | int sctp_send_reset_assoc(struct sctp_association *asoc) | |
189 | { | |
190 | struct sctp_chunk *chunk = NULL; | |
191 | int retval; | |
192 | __u16 i; | |
193 | ||
194 | if (!asoc->peer.reconf_capable || | |
195 | !(asoc->strreset_enable & SCTP_ENABLE_RESET_ASSOC_REQ)) | |
196 | return -ENOPROTOOPT; | |
197 | ||
198 | if (asoc->strreset_outstanding) | |
199 | return -EINPROGRESS; | |
200 | ||
201 | chunk = sctp_make_strreset_tsnreq(asoc); | |
202 | if (!chunk) | |
203 | return -ENOMEM; | |
204 | ||
205 | /* Block further xmit of data until this request is completed */ | |
206 | for (i = 0; i < asoc->stream->outcnt; i++) | |
207 | asoc->stream->out[i].state = SCTP_STREAM_CLOSED; | |
208 | ||
209 | asoc->strreset_chunk = chunk; | |
210 | sctp_chunk_hold(asoc->strreset_chunk); | |
211 | ||
212 | retval = sctp_send_reconf(asoc, chunk); | |
213 | if (retval) { | |
214 | sctp_chunk_put(asoc->strreset_chunk); | |
215 | asoc->strreset_chunk = NULL; | |
216 | ||
217 | for (i = 0; i < asoc->stream->outcnt; i++) | |
218 | asoc->stream->out[i].state = SCTP_STREAM_OPEN; | |
219 | ||
220 | return retval; | |
221 | } | |
222 | ||
223 | asoc->strreset_outstanding = 1; | |
224 | ||
225 | return 0; | |
226 | } | |
242bd2d5 XL |
227 | |
228 | int sctp_send_add_streams(struct sctp_association *asoc, | |
229 | struct sctp_add_streams *params) | |
230 | { | |
231 | struct sctp_stream *stream = asoc->stream; | |
232 | struct sctp_chunk *chunk = NULL; | |
233 | int retval = -ENOMEM; | |
234 | __u32 outcnt, incnt; | |
235 | __u16 out, in; | |
236 | ||
237 | if (!asoc->peer.reconf_capable || | |
238 | !(asoc->strreset_enable & SCTP_ENABLE_CHANGE_ASSOC_REQ)) { | |
239 | retval = -ENOPROTOOPT; | |
240 | goto out; | |
241 | } | |
242 | ||
243 | if (asoc->strreset_outstanding) { | |
244 | retval = -EINPROGRESS; | |
245 | goto out; | |
246 | } | |
247 | ||
248 | out = params->sas_outstrms; | |
249 | in = params->sas_instrms; | |
250 | outcnt = stream->outcnt + out; | |
251 | incnt = stream->incnt + in; | |
252 | if (outcnt > SCTP_MAX_STREAM || incnt > SCTP_MAX_STREAM || | |
253 | (!out && !in)) { | |
254 | retval = -EINVAL; | |
255 | goto out; | |
256 | } | |
257 | ||
258 | if (out) { | |
259 | struct sctp_stream_out *streamout; | |
260 | ||
261 | streamout = krealloc(stream->out, outcnt * sizeof(*streamout), | |
262 | GFP_KERNEL); | |
263 | if (!streamout) | |
264 | goto out; | |
265 | ||
266 | memset(streamout + stream->outcnt, 0, out * sizeof(*streamout)); | |
267 | stream->out = streamout; | |
268 | } | |
269 | ||
270 | if (in) { | |
271 | struct sctp_stream_in *streamin; | |
272 | ||
273 | streamin = krealloc(stream->in, incnt * sizeof(*streamin), | |
274 | GFP_KERNEL); | |
275 | if (!streamin) | |
276 | goto out; | |
277 | ||
278 | memset(streamin + stream->incnt, 0, in * sizeof(*streamin)); | |
279 | stream->in = streamin; | |
280 | } | |
281 | ||
282 | chunk = sctp_make_strreset_addstrm(asoc, out, in); | |
283 | if (!chunk) | |
284 | goto out; | |
285 | ||
286 | asoc->strreset_chunk = chunk; | |
287 | sctp_chunk_hold(asoc->strreset_chunk); | |
288 | ||
289 | retval = sctp_send_reconf(asoc, chunk); | |
290 | if (retval) { | |
291 | sctp_chunk_put(asoc->strreset_chunk); | |
292 | asoc->strreset_chunk = NULL; | |
293 | goto out; | |
294 | } | |
295 | ||
296 | stream->incnt = incnt; | |
297 | stream->outcnt = outcnt; | |
298 | ||
299 | asoc->strreset_outstanding = !!out + !!in; | |
300 | ||
301 | out: | |
302 | return retval; | |
303 | } | |
81054476 XL |
304 | |
305 | static sctp_paramhdr_t *sctp_chunk_lookup_strreset_param( | |
306 | struct sctp_association *asoc, __u32 resp_seq) | |
307 | { | |
308 | struct sctp_chunk *chunk = asoc->strreset_chunk; | |
309 | struct sctp_reconf_chunk *hdr; | |
310 | union sctp_params param; | |
311 | ||
312 | if (ntohl(resp_seq) != asoc->strreset_outseq || !chunk) | |
313 | return NULL; | |
314 | ||
315 | hdr = (struct sctp_reconf_chunk *)chunk->chunk_hdr; | |
316 | sctp_walk_params(param, hdr, params) { | |
317 | /* sctp_strreset_tsnreq is actually the basic structure | |
318 | * of all stream reconf params, so it's safe to use it | |
319 | * to access request_seq. | |
320 | */ | |
321 | struct sctp_strreset_tsnreq *req = param.v; | |
322 | ||
323 | if (req->request_seq == resp_seq) | |
324 | return param.v; | |
325 | } | |
326 | ||
327 | return NULL; | |
328 | } | |
329 | ||
330 | struct sctp_chunk *sctp_process_strreset_outreq( | |
331 | struct sctp_association *asoc, | |
332 | union sctp_params param, | |
333 | struct sctp_ulpevent **evp) | |
334 | { | |
335 | struct sctp_strreset_outreq *outreq = param.v; | |
336 | struct sctp_stream *stream = asoc->stream; | |
337 | __u16 i, nums, flags = 0, *str_p = NULL; | |
338 | __u32 result = SCTP_STRRESET_DENIED; | |
339 | __u32 request_seq; | |
340 | ||
341 | request_seq = ntohl(outreq->request_seq); | |
342 | ||
343 | if (ntohl(outreq->send_reset_at_tsn) > | |
344 | sctp_tsnmap_get_ctsn(&asoc->peer.tsn_map)) { | |
345 | result = SCTP_STRRESET_IN_PROGRESS; | |
346 | goto out; | |
347 | } | |
348 | ||
349 | if (request_seq > asoc->strreset_inseq) { | |
350 | result = SCTP_STRRESET_ERR_BAD_SEQNO; | |
351 | goto out; | |
352 | } else if (request_seq == asoc->strreset_inseq) { | |
353 | asoc->strreset_inseq++; | |
354 | } | |
355 | ||
356 | /* Check strreset_enable after inseq inc, as sender cannot tell | |
357 | * the peer doesn't enable strreset after receiving response with | |
358 | * result denied, as well as to keep consistent with bsd. | |
359 | */ | |
360 | if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) | |
361 | goto out; | |
362 | ||
363 | if (asoc->strreset_chunk) { | |
364 | sctp_paramhdr_t *param_hdr; | |
365 | struct sctp_transport *t; | |
366 | ||
367 | param_hdr = sctp_chunk_lookup_strreset_param( | |
368 | asoc, outreq->response_seq); | |
369 | if (!param_hdr || param_hdr->type != | |
370 | SCTP_PARAM_RESET_IN_REQUEST) { | |
371 | /* same process with outstanding isn't 0 */ | |
372 | result = SCTP_STRRESET_ERR_IN_PROGRESS; | |
373 | goto out; | |
374 | } | |
375 | ||
376 | asoc->strreset_outstanding--; | |
377 | asoc->strreset_outseq++; | |
378 | ||
379 | if (!asoc->strreset_outstanding) { | |
380 | t = asoc->strreset_chunk->transport; | |
381 | if (del_timer(&t->reconf_timer)) | |
382 | sctp_transport_put(t); | |
383 | ||
384 | sctp_chunk_put(asoc->strreset_chunk); | |
385 | asoc->strreset_chunk = NULL; | |
386 | } | |
387 | ||
388 | flags = SCTP_STREAM_RESET_INCOMING_SSN; | |
389 | } | |
390 | ||
391 | nums = (ntohs(param.p->length) - sizeof(*outreq)) / 2; | |
392 | if (nums) { | |
393 | str_p = outreq->list_of_streams; | |
394 | for (i = 0; i < nums; i++) { | |
395 | if (ntohs(str_p[i]) >= stream->incnt) { | |
396 | result = SCTP_STRRESET_ERR_WRONG_SSN; | |
397 | goto out; | |
398 | } | |
399 | } | |
400 | ||
401 | for (i = 0; i < nums; i++) | |
402 | stream->in[ntohs(str_p[i])].ssn = 0; | |
403 | } else { | |
404 | for (i = 0; i < stream->incnt; i++) | |
405 | stream->in[i].ssn = 0; | |
406 | } | |
407 | ||
408 | result = SCTP_STRRESET_PERFORMED; | |
409 | ||
410 | *evp = sctp_ulpevent_make_stream_reset_event(asoc, | |
411 | flags | SCTP_STREAM_RESET_OUTGOING_SSN, nums, str_p, | |
412 | GFP_ATOMIC); | |
413 | ||
414 | out: | |
415 | return sctp_make_strreset_resp(asoc, result, request_seq); | |
416 | } | |
16e1a919 XL |
417 | |
418 | struct sctp_chunk *sctp_process_strreset_inreq( | |
419 | struct sctp_association *asoc, | |
420 | union sctp_params param, | |
421 | struct sctp_ulpevent **evp) | |
422 | { | |
423 | struct sctp_strreset_inreq *inreq = param.v; | |
424 | struct sctp_stream *stream = asoc->stream; | |
425 | __u32 result = SCTP_STRRESET_DENIED; | |
426 | struct sctp_chunk *chunk = NULL; | |
427 | __u16 i, nums, *str_p; | |
428 | __u32 request_seq; | |
429 | ||
430 | request_seq = ntohl(inreq->request_seq); | |
431 | if (request_seq > asoc->strreset_inseq) { | |
432 | result = SCTP_STRRESET_ERR_BAD_SEQNO; | |
433 | goto out; | |
434 | } else if (request_seq == asoc->strreset_inseq) { | |
435 | asoc->strreset_inseq++; | |
436 | } | |
437 | ||
438 | if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) | |
439 | goto out; | |
440 | ||
441 | if (asoc->strreset_outstanding) { | |
442 | result = SCTP_STRRESET_ERR_IN_PROGRESS; | |
443 | goto out; | |
444 | } | |
445 | ||
446 | nums = (ntohs(param.p->length) - sizeof(*inreq)) / 2; | |
447 | str_p = inreq->list_of_streams; | |
448 | for (i = 0; i < nums; i++) { | |
449 | if (ntohs(str_p[i]) >= stream->outcnt) { | |
450 | result = SCTP_STRRESET_ERR_WRONG_SSN; | |
451 | goto out; | |
452 | } | |
453 | } | |
454 | ||
455 | chunk = sctp_make_strreset_req(asoc, nums, str_p, 1, 0); | |
456 | if (!chunk) | |
457 | goto out; | |
458 | ||
459 | if (nums) | |
460 | for (i = 0; i < nums; i++) | |
461 | stream->out[ntohs(str_p[i])].state = | |
462 | SCTP_STREAM_CLOSED; | |
463 | else | |
464 | for (i = 0; i < stream->outcnt; i++) | |
465 | stream->out[i].state = SCTP_STREAM_CLOSED; | |
466 | ||
467 | asoc->strreset_chunk = chunk; | |
468 | asoc->strreset_outstanding = 1; | |
469 | sctp_chunk_hold(asoc->strreset_chunk); | |
470 | ||
471 | *evp = sctp_ulpevent_make_stream_reset_event(asoc, | |
472 | SCTP_STREAM_RESET_INCOMING_SSN, nums, str_p, GFP_ATOMIC); | |
473 | ||
474 | out: | |
475 | if (!chunk) | |
476 | chunk = sctp_make_strreset_resp(asoc, result, request_seq); | |
477 | ||
478 | return chunk; | |
479 | } |