blob: 6dc95dcc0ff4f065014dbc376aa01b86eb9b2db0 [file] [log] [blame]
Thomas Gleixner47505b82019-05-23 11:14:41 +02001// SPDX-License-Identifier: GPL-2.0-or-later
Xin Longa8386312017-01-06 22:18:33 +08002/* SCTP kernel implementation
3 * (C) Copyright IBM Corp. 2001, 2004
4 * Copyright (c) 1999-2000 Cisco, Inc.
5 * Copyright (c) 1999-2001 Motorola, Inc.
6 * Copyright (c) 2001 Intel Corp.
7 *
8 * This file is part of the SCTP kernel implementation
9 *
Xin Longfae8b6f2018-02-13 19:29:13 +080010 * This file contains sctp stream maniuplation primitives and helpers.
Xin Longa8386312017-01-06 22:18:33 +080011 *
Xin Longa8386312017-01-06 22:18:33 +080012 * Please send any bug reports or fixes you make to the
13 * email address(es):
14 * lksctp developers <linux-sctp@vger.kernel.org>
15 *
16 * Written or modified by:
17 * Xin Long <lucien.xin@gmail.com>
18 */
19
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030020#include <linux/list.h>
Xin Longa8386312017-01-06 22:18:33 +080021#include <net/sctp/sctp.h>
Xin Long7f9d68a2017-01-18 00:44:47 +080022#include <net/sctp/sm.h>
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030023#include <net/sctp/stream_sched.h>
24
Xin Long8f133992020-07-22 23:52:11 +080025static void sctp_stream_shrink_out(struct sctp_stream *stream, __u16 outcnt)
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030026{
27 struct sctp_association *asoc;
28 struct sctp_chunk *ch, *temp;
29 struct sctp_outq *outq;
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030030
31 asoc = container_of(stream, struct sctp_association, stream);
32 outq = &asoc->outqueue;
33
34 list_for_each_entry_safe(ch, temp, &outq->out_chunk_list, list) {
35 __u16 sid = sctp_chunk_stream_no(ch);
36
37 if (sid < outcnt)
38 continue;
39
40 sctp_sched_dequeue_common(outq, ch);
41 /* No need to call dequeue_done here because
42 * the chunks are not scheduled by now.
43 */
44
45 /* Mark as failed send. */
Xin Long08f46072017-11-26 20:16:06 +080046 sctp_chunk_fail(ch, (__force __u32)SCTP_ERROR_INV_STRM);
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030047 if (asoc->peer.prsctp_capable &&
48 SCTP_PR_PRIO_ENABLED(ch->sinfo.sinfo_flags))
49 asoc->sent_cnt_removable--;
50
51 sctp_chunk_free(ch);
52 }
Xin Long8f133992020-07-22 23:52:11 +080053}
54
55/* Migrates chunks from stream queues to new stream queues if needed,
56 * but not across associations. Also, removes those chunks to streams
57 * higher than the new max.
58 */
59static void sctp_stream_outq_migrate(struct sctp_stream *stream,
60 struct sctp_stream *new, __u16 outcnt)
61{
62 int i;
63
64 if (stream->outcnt > outcnt)
65 sctp_stream_shrink_out(stream, outcnt);
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030066
67 if (new) {
68 /* Here we actually move the old ext stuff into the new
69 * buffer, because we want to keep it. Then
70 * sctp_stream_update will swap ->out pointers.
71 */
72 for (i = 0; i < outcnt; i++) {
Konstantin Khorenko0d493b42018-08-10 20:11:43 +030073 kfree(SCTP_SO(new, i)->ext);
74 SCTP_SO(new, i)->ext = SCTP_SO(stream, i)->ext;
75 SCTP_SO(stream, i)->ext = NULL;
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030076 }
77 }
78
Xin Longaf98c5a2019-02-12 18:51:01 +080079 for (i = outcnt; i < stream->outcnt; i++) {
Konstantin Khorenko0d493b42018-08-10 20:11:43 +030080 kfree(SCTP_SO(stream, i)->ext);
Xin Longaf98c5a2019-02-12 18:51:01 +080081 SCTP_SO(stream, i)->ext = NULL;
82 }
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -030083}
Xin Longa8386312017-01-06 22:18:33 +080084
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -030085static int sctp_stream_alloc_out(struct sctp_stream *stream, __u16 outcnt,
86 gfp_t gfp)
87{
Kent Overstreet2075e502019-03-11 23:31:22 -070088 int ret;
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -030089
Kent Overstreet2075e502019-03-11 23:31:22 -070090 if (outcnt <= stream->outcnt)
David Laightab921f32020-08-19 14:40:52 +000091 goto out;
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -030092
Kent Overstreet2075e502019-03-11 23:31:22 -070093 ret = genradix_prealloc(&stream->out, outcnt, gfp);
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -030094 if (ret)
Kent Overstreet2075e502019-03-11 23:31:22 -070095 return ret;
Xin Longcfe4bd72019-02-04 03:27:58 +080096
David Laightab921f32020-08-19 14:40:52 +000097out:
Kent Overstreet2075e502019-03-11 23:31:22 -070098 stream->outcnt = outcnt;
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -030099 return 0;
100}
101
Marcelo Ricardo Leitner1fdb8d82017-10-03 19:20:10 -0300102static int sctp_stream_alloc_in(struct sctp_stream *stream, __u16 incnt,
103 gfp_t gfp)
104{
Kent Overstreet2075e502019-03-11 23:31:22 -0700105 int ret;
Marcelo Ricardo Leitner1fdb8d82017-10-03 19:20:10 -0300106
Kent Overstreet2075e502019-03-11 23:31:22 -0700107 if (incnt <= stream->incnt)
David Laightab921f32020-08-19 14:40:52 +0000108 goto out;
Marcelo Ricardo Leitner1fdb8d82017-10-03 19:20:10 -0300109
Kent Overstreet2075e502019-03-11 23:31:22 -0700110 ret = genradix_prealloc(&stream->in, incnt, gfp);
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -0300111 if (ret)
Kent Overstreet2075e502019-03-11 23:31:22 -0700112 return ret;
Marcelo Ricardo Leitner1fdb8d82017-10-03 19:20:10 -0300113
David Laightab921f32020-08-19 14:40:52 +0000114out:
Kent Overstreet2075e502019-03-11 23:31:22 -0700115 stream->incnt = incnt;
Marcelo Ricardo Leitner1fdb8d82017-10-03 19:20:10 -0300116 return 0;
117}
118
Xin Longff356412017-05-31 16:36:32 +0800119int sctp_stream_init(struct sctp_stream *stream, __u16 outcnt, __u16 incnt,
120 gfp_t gfp)
Xin Longa8386312017-01-06 22:18:33 +0800121{
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300122 struct sctp_sched_ops *sched = sctp_sched_ops_from_stream(stream);
123 int i, ret = 0;
Xin Long3dbcc102017-03-30 01:00:53 +0800124
Marcelo Ricardo Leitner1ae2eaa2017-10-03 19:20:08 -0300125 gfp |= __GFP_NOWARN;
126
Xin Long3dbcc102017-03-30 01:00:53 +0800127 /* Initial stream->out size may be very big, so free it and alloc
Marcelo Ricardo Leitner1ae2eaa2017-10-03 19:20:08 -0300128 * a new one with new outcnt to save memory if needed.
Xin Long3dbcc102017-03-30 01:00:53 +0800129 */
Marcelo Ricardo Leitner1ae2eaa2017-10-03 19:20:08 -0300130 if (outcnt == stream->outcnt)
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -0300131 goto handle_in;
Marcelo Ricardo Leitner1ae2eaa2017-10-03 19:20:08 -0300132
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300133 /* Filter out chunks queued on streams that won't exist anymore */
134 sched->unsched_all(stream);
135 sctp_stream_outq_migrate(stream, NULL, outcnt);
136 sched->sched_all(stream);
137
Marcelo Ricardo Leitner79d08952018-01-02 19:44:37 -0200138 ret = sctp_stream_alloc_out(stream, outcnt, gfp);
139 if (ret)
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -0300140 goto out_err;
Xin Long3dbcc102017-03-30 01:00:53 +0800141
142 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300143 SCTP_SO(stream, i)->state = SCTP_STREAM_OPEN;
Xin Long3dbcc102017-03-30 01:00:53 +0800144
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -0300145handle_in:
Xin Long0c3f6f62017-12-08 21:04:01 +0800146 sctp_stream_interleave_init(stream);
Xin Longff356412017-05-31 16:36:32 +0800147 if (!incnt)
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300148 goto out;
Xin Longff356412017-05-31 16:36:32 +0800149
Marcelo Ricardo Leitner79d08952018-01-02 19:44:37 -0200150 ret = sctp_stream_alloc_in(stream, incnt, gfp);
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -0300151 if (ret)
152 goto in_err;
Xin Longa8386312017-01-06 22:18:33 +0800153
Marcelo Ricardo Leitner61d5d402019-12-20 15:03:44 -0300154 goto out;
155
156in_err:
157 sched->free(stream);
158 genradix_free(&stream->in);
159out_err:
160 genradix_free(&stream->out);
161 stream->outcnt = 0;
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300162out:
163 return ret;
Xin Longa8386312017-01-06 22:18:33 +0800164}
165
Marcelo Ricardo Leitnerf952be72017-10-03 19:20:11 -0300166int sctp_stream_init_ext(struct sctp_stream *stream, __u16 sid)
167{
168 struct sctp_stream_out_ext *soute;
Marcelo Ricardo Leitner4d141582019-06-27 19:48:10 -0300169 int ret;
Marcelo Ricardo Leitnerf952be72017-10-03 19:20:11 -0300170
171 soute = kzalloc(sizeof(*soute), GFP_KERNEL);
172 if (!soute)
173 return -ENOMEM;
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300174 SCTP_SO(stream, sid)->ext = soute;
Marcelo Ricardo Leitnerf952be72017-10-03 19:20:11 -0300175
Marcelo Ricardo Leitner4d141582019-06-27 19:48:10 -0300176 ret = sctp_sched_init_sid(stream, sid, GFP_KERNEL);
177 if (ret) {
178 kfree(SCTP_SO(stream, sid)->ext);
179 SCTP_SO(stream, sid)->ext = NULL;
180 }
181
182 return ret;
Marcelo Ricardo Leitnerf952be72017-10-03 19:20:11 -0300183}
184
Xin Longa8386312017-01-06 22:18:33 +0800185void sctp_stream_free(struct sctp_stream *stream)
186{
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300187 struct sctp_sched_ops *sched = sctp_sched_ops_from_stream(stream);
Marcelo Ricardo Leitnerf952be72017-10-03 19:20:11 -0300188 int i;
189
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300190 sched->free(stream);
Marcelo Ricardo Leitnerf952be72017-10-03 19:20:11 -0300191 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300192 kfree(SCTP_SO(stream, i)->ext);
Kent Overstreet2075e502019-03-11 23:31:22 -0700193 genradix_free(&stream->out);
194 genradix_free(&stream->in);
Xin Longa8386312017-01-06 22:18:33 +0800195}
196
197void sctp_stream_clear(struct sctp_stream *stream)
198{
199 int i;
200
Xin Long107e2422017-12-15 00:41:31 +0800201 for (i = 0; i < stream->outcnt; i++) {
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300202 SCTP_SO(stream, i)->mid = 0;
203 SCTP_SO(stream, i)->mid_uo = 0;
Xin Long107e2422017-12-15 00:41:31 +0800204 }
Xin Longa8386312017-01-06 22:18:33 +0800205
206 for (i = 0; i < stream->incnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300207 SCTP_SI(stream, i)->mid = 0;
Xin Longa8386312017-01-06 22:18:33 +0800208}
Xin Long7f9d68a2017-01-18 00:44:47 +0800209
Xin Longcee360a2017-05-31 16:36:31 +0800210void sctp_stream_update(struct sctp_stream *stream, struct sctp_stream *new)
211{
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300212 struct sctp_sched_ops *sched = sctp_sched_ops_from_stream(stream);
213
214 sched->unsched_all(stream);
215 sctp_stream_outq_migrate(stream, new, new->outcnt);
Xin Longcee360a2017-05-31 16:36:31 +0800216 sctp_stream_free(stream);
217
218 stream->out = new->out;
219 stream->in = new->in;
220 stream->outcnt = new->outcnt;
221 stream->incnt = new->incnt;
222
Marcelo Ricardo Leitner5bbbbe32017-10-03 19:20:13 -0300223 sched->sched_all(stream);
224
Kent Overstreet2075e502019-03-11 23:31:22 -0700225 new->out.tree.root = NULL;
226 new->in.tree.root = NULL;
Xin Long6a9a27d2018-04-26 15:21:44 +0800227 new->outcnt = 0;
228 new->incnt = 0;
Xin Longcee360a2017-05-31 16:36:31 +0800229}
230
Xin Long7f9d68a2017-01-18 00:44:47 +0800231static int sctp_send_reconf(struct sctp_association *asoc,
232 struct sctp_chunk *chunk)
233{
Xin Long7f9d68a2017-01-18 00:44:47 +0800234 int retval = 0;
235
Xin Long4e7696d2019-12-09 13:45:18 +0800236 retval = sctp_primitive_RECONF(asoc->base.net, asoc, chunk);
Xin Long7f9d68a2017-01-18 00:44:47 +0800237 if (retval)
238 sctp_chunk_free(chunk);
239
240 return retval;
241}
242
Xin Longd570a592017-11-25 21:05:33 +0800243static bool sctp_stream_outq_is_empty(struct sctp_stream *stream,
244 __u16 str_nums, __be16 *str_list)
245{
246 struct sctp_association *asoc;
247 __u16 i;
248
249 asoc = container_of(stream, struct sctp_association, stream);
250 if (!asoc->outqueue.out_qlen)
251 return true;
252
253 if (!str_nums)
254 return false;
255
256 for (i = 0; i < str_nums; i++) {
257 __u16 sid = ntohs(str_list[i]);
258
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300259 if (SCTP_SO(stream, sid)->ext &&
260 !list_empty(&SCTP_SO(stream, sid)->ext->outq))
Xin Longd570a592017-11-25 21:05:33 +0800261 return false;
262 }
263
264 return true;
265}
266
Xin Long7f9d68a2017-01-18 00:44:47 +0800267int sctp_send_reset_streams(struct sctp_association *asoc,
268 struct sctp_reset_streams *params)
269{
Xin Longcee360a2017-05-31 16:36:31 +0800270 struct sctp_stream *stream = &asoc->stream;
Xin Long7f9d68a2017-01-18 00:44:47 +0800271 __u16 i, str_nums, *str_list;
272 struct sctp_chunk *chunk;
273 int retval = -EINVAL;
Xin Long1da4fc92017-10-28 19:43:54 +0800274 __be16 *nstr_list;
Xin Long7f9d68a2017-01-18 00:44:47 +0800275 bool out, in;
276
277 if (!asoc->peer.reconf_capable ||
278 !(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ)) {
279 retval = -ENOPROTOOPT;
280 goto out;
281 }
282
283 if (asoc->strreset_outstanding) {
284 retval = -EINPROGRESS;
285 goto out;
286 }
287
288 out = params->srs_flags & SCTP_STREAM_RESET_OUTGOING;
289 in = params->srs_flags & SCTP_STREAM_RESET_INCOMING;
290 if (!out && !in)
291 goto out;
292
293 str_nums = params->srs_number_streams;
294 str_list = params->srs_stream_list;
Xin Long423852f2017-11-15 17:00:11 +0800295 if (str_nums) {
296 int param_len = 0;
Xin Long7f9d68a2017-01-18 00:44:47 +0800297
Xin Long423852f2017-11-15 17:00:11 +0800298 if (out) {
299 for (i = 0; i < str_nums; i++)
300 if (str_list[i] >= stream->outcnt)
301 goto out;
302
303 param_len = str_nums * sizeof(__u16) +
304 sizeof(struct sctp_strreset_outreq);
305 }
306
307 if (in) {
308 for (i = 0; i < str_nums; i++)
309 if (str_list[i] >= stream->incnt)
310 goto out;
311
312 param_len += str_nums * sizeof(__u16) +
313 sizeof(struct sctp_strreset_inreq);
314 }
315
316 if (param_len > SCTP_MAX_CHUNK_LEN -
317 sizeof(struct sctp_reconf_chunk))
318 goto out;
319 }
Xin Long7f9d68a2017-01-18 00:44:47 +0800320
Xin Long1da4fc92017-10-28 19:43:54 +0800321 nstr_list = kcalloc(str_nums, sizeof(__be16), GFP_KERNEL);
322 if (!nstr_list) {
323 retval = -ENOMEM;
324 goto out;
325 }
Xin Long16e1a912017-02-17 12:45:40 +0800326
327 for (i = 0; i < str_nums; i++)
Xin Long1da4fc92017-10-28 19:43:54 +0800328 nstr_list[i] = htons(str_list[i]);
329
Xin Longd570a592017-11-25 21:05:33 +0800330 if (out && !sctp_stream_outq_is_empty(stream, str_nums, nstr_list)) {
zhengbin6d5afe22019-08-13 22:05:50 +0800331 kfree(nstr_list);
Xin Longd570a592017-11-25 21:05:33 +0800332 retval = -EAGAIN;
333 goto out;
334 }
335
Xin Long1da4fc92017-10-28 19:43:54 +0800336 chunk = sctp_make_strreset_req(asoc, str_nums, nstr_list, out, in);
337
338 kfree(nstr_list);
Xin Long16e1a912017-02-17 12:45:40 +0800339
Xin Long119aecb2017-02-09 01:18:16 +0800340 if (!chunk) {
341 retval = -ENOMEM;
Xin Long7f9d68a2017-01-18 00:44:47 +0800342 goto out;
Xin Long119aecb2017-02-09 01:18:16 +0800343 }
Xin Long7f9d68a2017-01-18 00:44:47 +0800344
345 if (out) {
346 if (str_nums)
347 for (i = 0; i < str_nums; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300348 SCTP_SO(stream, str_list[i])->state =
Xin Long7f9d68a2017-01-18 00:44:47 +0800349 SCTP_STREAM_CLOSED;
350 else
351 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300352 SCTP_SO(stream, i)->state = SCTP_STREAM_CLOSED;
Xin Long7f9d68a2017-01-18 00:44:47 +0800353 }
354
Xin Long7f9d68a2017-01-18 00:44:47 +0800355 asoc->strreset_chunk = chunk;
356 sctp_chunk_hold(asoc->strreset_chunk);
357
358 retval = sctp_send_reconf(asoc, chunk);
359 if (retval) {
360 sctp_chunk_put(asoc->strreset_chunk);
361 asoc->strreset_chunk = NULL;
Xin Long119aecb2017-02-09 01:18:16 +0800362 if (!out)
363 goto out;
364
365 if (str_nums)
366 for (i = 0; i < str_nums; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300367 SCTP_SO(stream, str_list[i])->state =
Xin Long119aecb2017-02-09 01:18:16 +0800368 SCTP_STREAM_OPEN;
369 else
370 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300371 SCTP_SO(stream, i)->state = SCTP_STREAM_OPEN;
Xin Long119aecb2017-02-09 01:18:16 +0800372
373 goto out;
Xin Long7f9d68a2017-01-18 00:44:47 +0800374 }
375
Xin Long119aecb2017-02-09 01:18:16 +0800376 asoc->strreset_outstanding = out + in;
377
Xin Long7f9d68a2017-01-18 00:44:47 +0800378out:
379 return retval;
380}
Xin Longa92ce1a2017-02-09 01:18:18 +0800381
382int sctp_send_reset_assoc(struct sctp_association *asoc)
383{
Xin Longcee360a2017-05-31 16:36:31 +0800384 struct sctp_stream *stream = &asoc->stream;
Xin Longa92ce1a2017-02-09 01:18:18 +0800385 struct sctp_chunk *chunk = NULL;
386 int retval;
387 __u16 i;
388
389 if (!asoc->peer.reconf_capable ||
390 !(asoc->strreset_enable & SCTP_ENABLE_RESET_ASSOC_REQ))
391 return -ENOPROTOOPT;
392
393 if (asoc->strreset_outstanding)
394 return -EINPROGRESS;
395
Xin Long5c6144a2017-11-25 21:05:34 +0800396 if (!sctp_outq_is_empty(&asoc->outqueue))
397 return -EAGAIN;
398
Xin Longa92ce1a2017-02-09 01:18:18 +0800399 chunk = sctp_make_strreset_tsnreq(asoc);
400 if (!chunk)
401 return -ENOMEM;
402
403 /* Block further xmit of data until this request is completed */
Xin Longcee360a2017-05-31 16:36:31 +0800404 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300405 SCTP_SO(stream, i)->state = SCTP_STREAM_CLOSED;
Xin Longa92ce1a2017-02-09 01:18:18 +0800406
407 asoc->strreset_chunk = chunk;
408 sctp_chunk_hold(asoc->strreset_chunk);
409
410 retval = sctp_send_reconf(asoc, chunk);
411 if (retval) {
412 sctp_chunk_put(asoc->strreset_chunk);
413 asoc->strreset_chunk = NULL;
414
Xin Longcee360a2017-05-31 16:36:31 +0800415 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300416 SCTP_SO(stream, i)->state = SCTP_STREAM_OPEN;
Xin Longa92ce1a2017-02-09 01:18:18 +0800417
418 return retval;
419 }
420
421 asoc->strreset_outstanding = 1;
422
423 return 0;
424}
Xin Long242bd2d2017-02-09 01:18:20 +0800425
426int sctp_send_add_streams(struct sctp_association *asoc,
427 struct sctp_add_streams *params)
428{
Xin Longcee360a2017-05-31 16:36:31 +0800429 struct sctp_stream *stream = &asoc->stream;
Xin Long242bd2d2017-02-09 01:18:20 +0800430 struct sctp_chunk *chunk = NULL;
Wei Yongjundc826732017-10-31 13:28:16 +0000431 int retval;
Xin Long242bd2d2017-02-09 01:18:20 +0800432 __u32 outcnt, incnt;
433 __u16 out, in;
434
435 if (!asoc->peer.reconf_capable ||
436 !(asoc->strreset_enable & SCTP_ENABLE_CHANGE_ASSOC_REQ)) {
437 retval = -ENOPROTOOPT;
438 goto out;
439 }
440
441 if (asoc->strreset_outstanding) {
442 retval = -EINPROGRESS;
443 goto out;
444 }
445
446 out = params->sas_outstrms;
447 in = params->sas_instrms;
448 outcnt = stream->outcnt + out;
449 incnt = stream->incnt + in;
450 if (outcnt > SCTP_MAX_STREAM || incnt > SCTP_MAX_STREAM ||
451 (!out && !in)) {
452 retval = -EINVAL;
453 goto out;
454 }
455
456 if (out) {
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -0300457 retval = sctp_stream_alloc_out(stream, outcnt, GFP_KERNEL);
458 if (retval)
Xin Long242bd2d2017-02-09 01:18:20 +0800459 goto out;
Xin Long242bd2d2017-02-09 01:18:20 +0800460 }
461
Xin Long242bd2d2017-02-09 01:18:20 +0800462 chunk = sctp_make_strreset_addstrm(asoc, out, in);
Wei Yongjundc826732017-10-31 13:28:16 +0000463 if (!chunk) {
464 retval = -ENOMEM;
Xin Long242bd2d2017-02-09 01:18:20 +0800465 goto out;
Wei Yongjundc826732017-10-31 13:28:16 +0000466 }
Xin Long242bd2d2017-02-09 01:18:20 +0800467
468 asoc->strreset_chunk = chunk;
469 sctp_chunk_hold(asoc->strreset_chunk);
470
471 retval = sctp_send_reconf(asoc, chunk);
472 if (retval) {
473 sctp_chunk_put(asoc->strreset_chunk);
474 asoc->strreset_chunk = NULL;
475 goto out;
476 }
477
Xin Long242bd2d2017-02-09 01:18:20 +0800478 asoc->strreset_outstanding = !!out + !!in;
479
480out:
481 return retval;
482}
Xin Long81054472017-02-17 12:45:39 +0800483
Xin Long3c918702017-06-30 11:52:16 +0800484static struct sctp_paramhdr *sctp_chunk_lookup_strreset_param(
Xin Long1da4fc92017-10-28 19:43:54 +0800485 struct sctp_association *asoc, __be32 resp_seq,
Xin Long50a41592017-03-10 12:11:09 +0800486 __be16 type)
Xin Long81054472017-02-17 12:45:39 +0800487{
488 struct sctp_chunk *chunk = asoc->strreset_chunk;
489 struct sctp_reconf_chunk *hdr;
490 union sctp_params param;
491
Xin Long50a41592017-03-10 12:11:09 +0800492 if (!chunk)
Xin Long81054472017-02-17 12:45:39 +0800493 return NULL;
494
495 hdr = (struct sctp_reconf_chunk *)chunk->chunk_hdr;
496 sctp_walk_params(param, hdr, params) {
497 /* sctp_strreset_tsnreq is actually the basic structure
498 * of all stream reconf params, so it's safe to use it
499 * to access request_seq.
500 */
501 struct sctp_strreset_tsnreq *req = param.v;
502
Xin Long50a41592017-03-10 12:11:09 +0800503 if ((!resp_seq || req->request_seq == resp_seq) &&
504 (!type || type == req->param_hdr.type))
Xin Long81054472017-02-17 12:45:39 +0800505 return param.v;
506 }
507
508 return NULL;
509}
510
Xin Longe4dc99c2017-04-15 22:00:27 +0800511static void sctp_update_strreset_result(struct sctp_association *asoc,
512 __u32 result)
513{
514 asoc->strreset_result[1] = asoc->strreset_result[0];
515 asoc->strreset_result[0] = result;
516}
517
Xin Long81054472017-02-17 12:45:39 +0800518struct sctp_chunk *sctp_process_strreset_outreq(
519 struct sctp_association *asoc,
520 union sctp_params param,
521 struct sctp_ulpevent **evp)
522{
523 struct sctp_strreset_outreq *outreq = param.v;
Xin Longcee360a2017-05-31 16:36:31 +0800524 struct sctp_stream *stream = &asoc->stream;
Xin Long81054472017-02-17 12:45:39 +0800525 __u32 result = SCTP_STRRESET_DENIED;
Xin Long1da4fc92017-10-28 19:43:54 +0800526 __be16 *str_p = NULL;
Xin Long81054472017-02-17 12:45:39 +0800527 __u32 request_seq;
Xin Long2e6dc4d2019-01-22 02:39:34 +0800528 __u16 i, nums;
Xin Long81054472017-02-17 12:45:39 +0800529
530 request_seq = ntohl(outreq->request_seq);
531
532 if (ntohl(outreq->send_reset_at_tsn) >
533 sctp_tsnmap_get_ctsn(&asoc->peer.tsn_map)) {
534 result = SCTP_STRRESET_IN_PROGRESS;
Xin Longe4dc99c2017-04-15 22:00:27 +0800535 goto err;
Xin Long81054472017-02-17 12:45:39 +0800536 }
537
Xin Longe4dc99c2017-04-15 22:00:27 +0800538 if (TSN_lt(asoc->strreset_inseq, request_seq) ||
539 TSN_lt(request_seq, asoc->strreset_inseq - 2)) {
Xin Long81054472017-02-17 12:45:39 +0800540 result = SCTP_STRRESET_ERR_BAD_SEQNO;
Xin Longe4dc99c2017-04-15 22:00:27 +0800541 goto err;
542 } else if (TSN_lt(request_seq, asoc->strreset_inseq)) {
543 i = asoc->strreset_inseq - request_seq - 1;
544 result = asoc->strreset_result[i];
545 goto err;
Xin Long81054472017-02-17 12:45:39 +0800546 }
Xin Longe4dc99c2017-04-15 22:00:27 +0800547 asoc->strreset_inseq++;
Xin Long81054472017-02-17 12:45:39 +0800548
549 /* Check strreset_enable after inseq inc, as sender cannot tell
550 * the peer doesn't enable strreset after receiving response with
551 * result denied, as well as to keep consistent with bsd.
552 */
553 if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ))
554 goto out;
555
Xin Long2e6dc4d2019-01-22 02:39:34 +0800556 nums = (ntohs(param.p->length) - sizeof(*outreq)) / sizeof(__u16);
557 str_p = outreq->list_of_streams;
558 for (i = 0; i < nums; i++) {
559 if (ntohs(str_p[i]) >= stream->incnt) {
560 result = SCTP_STRRESET_ERR_WRONG_SSN;
561 goto out;
562 }
563 }
564
Xin Long81054472017-02-17 12:45:39 +0800565 if (asoc->strreset_chunk) {
Xin Long50a41592017-03-10 12:11:09 +0800566 if (!sctp_chunk_lookup_strreset_param(
567 asoc, outreq->response_seq,
568 SCTP_PARAM_RESET_IN_REQUEST)) {
Xin Long81054472017-02-17 12:45:39 +0800569 /* same process with outstanding isn't 0 */
570 result = SCTP_STRRESET_ERR_IN_PROGRESS;
571 goto out;
572 }
573
574 asoc->strreset_outstanding--;
575 asoc->strreset_outseq++;
576
577 if (!asoc->strreset_outstanding) {
Xin Long50a41592017-03-10 12:11:09 +0800578 struct sctp_transport *t;
579
Xin Long81054472017-02-17 12:45:39 +0800580 t = asoc->strreset_chunk->transport;
581 if (del_timer(&t->reconf_timer))
582 sctp_transport_put(t);
583
584 sctp_chunk_put(asoc->strreset_chunk);
585 asoc->strreset_chunk = NULL;
586 }
Xin Long81054472017-02-17 12:45:39 +0800587 }
588
Xin Long2e6dc4d2019-01-22 02:39:34 +0800589 if (nums)
Xin Long81054472017-02-17 12:45:39 +0800590 for (i = 0; i < nums; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300591 SCTP_SI(stream, ntohs(str_p[i]))->mid = 0;
Xin Long2e6dc4d2019-01-22 02:39:34 +0800592 else
Xin Long81054472017-02-17 12:45:39 +0800593 for (i = 0; i < stream->incnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300594 SCTP_SI(stream, i)->mid = 0;
Xin Long81054472017-02-17 12:45:39 +0800595
596 result = SCTP_STRRESET_PERFORMED;
597
598 *evp = sctp_ulpevent_make_stream_reset_event(asoc,
Xin Long2e6dc4d2019-01-22 02:39:34 +0800599 SCTP_STREAM_RESET_INCOMING_SSN, nums, str_p, GFP_ATOMIC);
Xin Long81054472017-02-17 12:45:39 +0800600
601out:
Xin Longe4dc99c2017-04-15 22:00:27 +0800602 sctp_update_strreset_result(asoc, result);
603err:
Xin Long81054472017-02-17 12:45:39 +0800604 return sctp_make_strreset_resp(asoc, result, request_seq);
605}
Xin Long16e1a912017-02-17 12:45:40 +0800606
607struct sctp_chunk *sctp_process_strreset_inreq(
608 struct sctp_association *asoc,
609 union sctp_params param,
610 struct sctp_ulpevent **evp)
611{
612 struct sctp_strreset_inreq *inreq = param.v;
Xin Longcee360a2017-05-31 16:36:31 +0800613 struct sctp_stream *stream = &asoc->stream;
Xin Long16e1a912017-02-17 12:45:40 +0800614 __u32 result = SCTP_STRRESET_DENIED;
615 struct sctp_chunk *chunk = NULL;
Xin Long16e1a912017-02-17 12:45:40 +0800616 __u32 request_seq;
Xin Long1da4fc92017-10-28 19:43:54 +0800617 __u16 i, nums;
618 __be16 *str_p;
Xin Long16e1a912017-02-17 12:45:40 +0800619
620 request_seq = ntohl(inreq->request_seq);
Xin Longd0f025e2017-04-15 22:00:28 +0800621 if (TSN_lt(asoc->strreset_inseq, request_seq) ||
622 TSN_lt(request_seq, asoc->strreset_inseq - 2)) {
Xin Long16e1a912017-02-17 12:45:40 +0800623 result = SCTP_STRRESET_ERR_BAD_SEQNO;
Xin Longd0f025e2017-04-15 22:00:28 +0800624 goto err;
625 } else if (TSN_lt(request_seq, asoc->strreset_inseq)) {
626 i = asoc->strreset_inseq - request_seq - 1;
627 result = asoc->strreset_result[i];
628 if (result == SCTP_STRRESET_PERFORMED)
629 return NULL;
630 goto err;
Xin Long16e1a912017-02-17 12:45:40 +0800631 }
Xin Longd0f025e2017-04-15 22:00:28 +0800632 asoc->strreset_inseq++;
Xin Long16e1a912017-02-17 12:45:40 +0800633
634 if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_STREAM_REQ))
635 goto out;
636
637 if (asoc->strreset_outstanding) {
638 result = SCTP_STRRESET_ERR_IN_PROGRESS;
639 goto out;
640 }
641
Xin Long3aa623d2017-11-25 21:05:32 +0800642 nums = (ntohs(param.p->length) - sizeof(*inreq)) / sizeof(__u16);
Xin Long16e1a912017-02-17 12:45:40 +0800643 str_p = inreq->list_of_streams;
644 for (i = 0; i < nums; i++) {
645 if (ntohs(str_p[i]) >= stream->outcnt) {
646 result = SCTP_STRRESET_ERR_WRONG_SSN;
647 goto out;
648 }
649 }
650
Xin Longd570a592017-11-25 21:05:33 +0800651 if (!sctp_stream_outq_is_empty(stream, nums, str_p)) {
652 result = SCTP_STRRESET_IN_PROGRESS;
653 asoc->strreset_inseq--;
654 goto err;
655 }
656
Xin Long16e1a912017-02-17 12:45:40 +0800657 chunk = sctp_make_strreset_req(asoc, nums, str_p, 1, 0);
658 if (!chunk)
659 goto out;
660
661 if (nums)
662 for (i = 0; i < nums; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300663 SCTP_SO(stream, ntohs(str_p[i]))->state =
Xin Long16e1a912017-02-17 12:45:40 +0800664 SCTP_STREAM_CLOSED;
665 else
666 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300667 SCTP_SO(stream, i)->state = SCTP_STREAM_CLOSED;
Xin Long16e1a912017-02-17 12:45:40 +0800668
669 asoc->strreset_chunk = chunk;
670 asoc->strreset_outstanding = 1;
671 sctp_chunk_hold(asoc->strreset_chunk);
672
Xin Longd0f025e2017-04-15 22:00:28 +0800673 result = SCTP_STRRESET_PERFORMED;
674
Xin Long16e1a912017-02-17 12:45:40 +0800675out:
Xin Longd0f025e2017-04-15 22:00:28 +0800676 sctp_update_strreset_result(asoc, result);
677err:
Xin Long16e1a912017-02-17 12:45:40 +0800678 if (!chunk)
679 chunk = sctp_make_strreset_resp(asoc, result, request_seq);
680
681 return chunk;
682}
Xin Long692787c2017-03-10 12:11:07 +0800683
684struct sctp_chunk *sctp_process_strreset_tsnreq(
685 struct sctp_association *asoc,
686 union sctp_params param,
687 struct sctp_ulpevent **evp)
688{
689 __u32 init_tsn = 0, next_tsn = 0, max_tsn_seen;
690 struct sctp_strreset_tsnreq *tsnreq = param.v;
Xin Longcee360a2017-05-31 16:36:31 +0800691 struct sctp_stream *stream = &asoc->stream;
Xin Long692787c2017-03-10 12:11:07 +0800692 __u32 result = SCTP_STRRESET_DENIED;
693 __u32 request_seq;
694 __u16 i;
695
696 request_seq = ntohl(tsnreq->request_seq);
Xin Long6c801382017-04-15 22:00:29 +0800697 if (TSN_lt(asoc->strreset_inseq, request_seq) ||
698 TSN_lt(request_seq, asoc->strreset_inseq - 2)) {
Xin Long692787c2017-03-10 12:11:07 +0800699 result = SCTP_STRRESET_ERR_BAD_SEQNO;
Xin Long6c801382017-04-15 22:00:29 +0800700 goto err;
701 } else if (TSN_lt(request_seq, asoc->strreset_inseq)) {
702 i = asoc->strreset_inseq - request_seq - 1;
703 result = asoc->strreset_result[i];
704 if (result == SCTP_STRRESET_PERFORMED) {
Xin Long52a39582017-11-25 21:05:36 +0800705 next_tsn = asoc->ctsn_ack_point + 1;
Xin Long6c801382017-04-15 22:00:29 +0800706 init_tsn =
707 sctp_tsnmap_get_ctsn(&asoc->peer.tsn_map) + 1;
708 }
709 goto err;
Xin Long692787c2017-03-10 12:11:07 +0800710 }
Xin Long5c6144a2017-11-25 21:05:34 +0800711
712 if (!sctp_outq_is_empty(&asoc->outqueue)) {
713 result = SCTP_STRRESET_IN_PROGRESS;
714 goto err;
715 }
716
Xin Long6c801382017-04-15 22:00:29 +0800717 asoc->strreset_inseq++;
Xin Long692787c2017-03-10 12:11:07 +0800718
719 if (!(asoc->strreset_enable & SCTP_ENABLE_RESET_ASSOC_REQ))
720 goto out;
721
722 if (asoc->strreset_outstanding) {
723 result = SCTP_STRRESET_ERR_IN_PROGRESS;
724 goto out;
725 }
726
Xin Long159f2a72017-11-25 21:05:35 +0800727 /* G4: The same processing as though a FWD-TSN chunk (as defined in
728 * [RFC3758]) with all streams affected and a new cumulative TSN
729 * ACK of the Receiver's Next TSN minus 1 were received MUST be
730 * performed.
Xin Long692787c2017-03-10 12:11:07 +0800731 */
732 max_tsn_seen = sctp_tsnmap_get_max_tsn_seen(&asoc->peer.tsn_map);
Xin Long47b20a82017-12-15 00:41:28 +0800733 asoc->stream.si->report_ftsn(&asoc->ulpq, max_tsn_seen);
Xin Long692787c2017-03-10 12:11:07 +0800734
735 /* G1: Compute an appropriate value for the Receiver's Next TSN -- the
736 * TSN that the peer should use to send the next DATA chunk. The
737 * value SHOULD be the smallest TSN not acknowledged by the
738 * receiver of the request plus 2^31.
739 */
740 init_tsn = sctp_tsnmap_get_ctsn(&asoc->peer.tsn_map) + (1 << 31);
741 sctp_tsnmap_init(&asoc->peer.tsn_map, SCTP_TSN_MAP_INITIAL,
742 init_tsn, GFP_ATOMIC);
743
Xin Long159f2a72017-11-25 21:05:35 +0800744 /* G3: The same processing as though a SACK chunk with no gap report
745 * and a cumulative TSN ACK of the Sender's Next TSN minus 1 were
746 * received MUST be performed.
Xin Long692787c2017-03-10 12:11:07 +0800747 */
748 sctp_outq_free(&asoc->outqueue);
749
750 /* G2: Compute an appropriate value for the local endpoint's next TSN,
751 * i.e., the next TSN assigned by the receiver of the SSN/TSN reset
752 * chunk. The value SHOULD be the highest TSN sent by the receiver
753 * of the request plus 1.
754 */
755 next_tsn = asoc->next_tsn;
756 asoc->ctsn_ack_point = next_tsn - 1;
757 asoc->adv_peer_ack_point = asoc->ctsn_ack_point;
758
759 /* G5: The next expected and outgoing SSNs MUST be reset to 0 for all
760 * incoming and outgoing streams.
761 */
Xin Long107e2422017-12-15 00:41:31 +0800762 for (i = 0; i < stream->outcnt; i++) {
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300763 SCTP_SO(stream, i)->mid = 0;
764 SCTP_SO(stream, i)->mid_uo = 0;
Xin Long107e2422017-12-15 00:41:31 +0800765 }
Xin Long692787c2017-03-10 12:11:07 +0800766 for (i = 0; i < stream->incnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300767 SCTP_SI(stream, i)->mid = 0;
Xin Long692787c2017-03-10 12:11:07 +0800768
769 result = SCTP_STRRESET_PERFORMED;
770
771 *evp = sctp_ulpevent_make_assoc_reset_event(asoc, 0, init_tsn,
772 next_tsn, GFP_ATOMIC);
773
774out:
Xin Long6c801382017-04-15 22:00:29 +0800775 sctp_update_strreset_result(asoc, result);
776err:
Xin Long692787c2017-03-10 12:11:07 +0800777 return sctp_make_strreset_tsnresp(asoc, result, request_seq,
778 next_tsn, init_tsn);
779}
Xin Long50a41592017-03-10 12:11:09 +0800780
781struct sctp_chunk *sctp_process_strreset_addstrm_out(
782 struct sctp_association *asoc,
783 union sctp_params param,
784 struct sctp_ulpevent **evp)
785{
786 struct sctp_strreset_addstrm *addstrm = param.v;
Xin Longcee360a2017-05-31 16:36:31 +0800787 struct sctp_stream *stream = &asoc->stream;
Xin Long50a41592017-03-10 12:11:09 +0800788 __u32 result = SCTP_STRRESET_DENIED;
Xin Long50a41592017-03-10 12:11:09 +0800789 __u32 request_seq, incnt;
Xin Longe4dc99c2017-04-15 22:00:27 +0800790 __u16 in, i;
Xin Long50a41592017-03-10 12:11:09 +0800791
792 request_seq = ntohl(addstrm->request_seq);
Xin Longe4dc99c2017-04-15 22:00:27 +0800793 if (TSN_lt(asoc->strreset_inseq, request_seq) ||
794 TSN_lt(request_seq, asoc->strreset_inseq - 2)) {
Xin Long50a41592017-03-10 12:11:09 +0800795 result = SCTP_STRRESET_ERR_BAD_SEQNO;
Xin Longe4dc99c2017-04-15 22:00:27 +0800796 goto err;
797 } else if (TSN_lt(request_seq, asoc->strreset_inseq)) {
798 i = asoc->strreset_inseq - request_seq - 1;
799 result = asoc->strreset_result[i];
800 goto err;
Xin Long50a41592017-03-10 12:11:09 +0800801 }
Xin Longe4dc99c2017-04-15 22:00:27 +0800802 asoc->strreset_inseq++;
Xin Long50a41592017-03-10 12:11:09 +0800803
804 if (!(asoc->strreset_enable & SCTP_ENABLE_CHANGE_ASSOC_REQ))
805 goto out;
806
Xin Long8220c872019-01-22 02:40:12 +0800807 in = ntohs(addstrm->number_of_streams);
808 incnt = stream->incnt + in;
809 if (!in || incnt > SCTP_MAX_STREAM)
810 goto out;
811
812 if (sctp_stream_alloc_in(stream, incnt, GFP_ATOMIC))
813 goto out;
814
Xin Long50a41592017-03-10 12:11:09 +0800815 if (asoc->strreset_chunk) {
816 if (!sctp_chunk_lookup_strreset_param(
817 asoc, 0, SCTP_PARAM_RESET_ADD_IN_STREAMS)) {
818 /* same process with outstanding isn't 0 */
819 result = SCTP_STRRESET_ERR_IN_PROGRESS;
820 goto out;
821 }
822
823 asoc->strreset_outstanding--;
824 asoc->strreset_outseq++;
825
826 if (!asoc->strreset_outstanding) {
827 struct sctp_transport *t;
828
829 t = asoc->strreset_chunk->transport;
830 if (del_timer(&t->reconf_timer))
831 sctp_transport_put(t);
832
833 sctp_chunk_put(asoc->strreset_chunk);
834 asoc->strreset_chunk = NULL;
835 }
836 }
837
Xin Long50a41592017-03-10 12:11:09 +0800838 stream->incnt = incnt;
839
840 result = SCTP_STRRESET_PERFORMED;
841
842 *evp = sctp_ulpevent_make_stream_change_event(asoc,
843 0, ntohs(addstrm->number_of_streams), 0, GFP_ATOMIC);
844
845out:
Xin Longe4dc99c2017-04-15 22:00:27 +0800846 sctp_update_strreset_result(asoc, result);
847err:
Xin Long50a41592017-03-10 12:11:09 +0800848 return sctp_make_strreset_resp(asoc, result, request_seq);
849}
Xin Longc5c4ebb2017-03-10 12:11:10 +0800850
851struct sctp_chunk *sctp_process_strreset_addstrm_in(
852 struct sctp_association *asoc,
853 union sctp_params param,
854 struct sctp_ulpevent **evp)
855{
856 struct sctp_strreset_addstrm *addstrm = param.v;
Xin Longcee360a2017-05-31 16:36:31 +0800857 struct sctp_stream *stream = &asoc->stream;
Xin Longc5c4ebb2017-03-10 12:11:10 +0800858 __u32 result = SCTP_STRRESET_DENIED;
Xin Longc5c4ebb2017-03-10 12:11:10 +0800859 struct sctp_chunk *chunk = NULL;
860 __u32 request_seq, outcnt;
Xin Longd0f025e2017-04-15 22:00:28 +0800861 __u16 out, i;
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -0300862 int ret;
Xin Longc5c4ebb2017-03-10 12:11:10 +0800863
864 request_seq = ntohl(addstrm->request_seq);
Xin Longd0f025e2017-04-15 22:00:28 +0800865 if (TSN_lt(asoc->strreset_inseq, request_seq) ||
866 TSN_lt(request_seq, asoc->strreset_inseq - 2)) {
Xin Longc5c4ebb2017-03-10 12:11:10 +0800867 result = SCTP_STRRESET_ERR_BAD_SEQNO;
Xin Longd0f025e2017-04-15 22:00:28 +0800868 goto err;
869 } else if (TSN_lt(request_seq, asoc->strreset_inseq)) {
870 i = asoc->strreset_inseq - request_seq - 1;
871 result = asoc->strreset_result[i];
872 if (result == SCTP_STRRESET_PERFORMED)
873 return NULL;
874 goto err;
Xin Longc5c4ebb2017-03-10 12:11:10 +0800875 }
Xin Longd0f025e2017-04-15 22:00:28 +0800876 asoc->strreset_inseq++;
Xin Longc5c4ebb2017-03-10 12:11:10 +0800877
878 if (!(asoc->strreset_enable & SCTP_ENABLE_CHANGE_ASSOC_REQ))
879 goto out;
880
881 if (asoc->strreset_outstanding) {
882 result = SCTP_STRRESET_ERR_IN_PROGRESS;
883 goto out;
884 }
885
886 out = ntohs(addstrm->number_of_streams);
887 outcnt = stream->outcnt + out;
888 if (!out || outcnt > SCTP_MAX_STREAM)
889 goto out;
890
Marcelo Ricardo Leitnere090abd2017-10-03 19:20:09 -0300891 ret = sctp_stream_alloc_out(stream, outcnt, GFP_ATOMIC);
892 if (ret)
Xin Longc5c4ebb2017-03-10 12:11:10 +0800893 goto out;
894
Xin Longc5c4ebb2017-03-10 12:11:10 +0800895 chunk = sctp_make_strreset_addstrm(asoc, out, 0);
896 if (!chunk)
897 goto out;
898
899 asoc->strreset_chunk = chunk;
900 asoc->strreset_outstanding = 1;
901 sctp_chunk_hold(asoc->strreset_chunk);
902
903 stream->outcnt = outcnt;
904
Xin Longd0f025e2017-04-15 22:00:28 +0800905 result = SCTP_STRRESET_PERFORMED;
906
Xin Longc5c4ebb2017-03-10 12:11:10 +0800907out:
Xin Longd0f025e2017-04-15 22:00:28 +0800908 sctp_update_strreset_result(asoc, result);
909err:
Xin Longc5c4ebb2017-03-10 12:11:10 +0800910 if (!chunk)
911 chunk = sctp_make_strreset_resp(asoc, result, request_seq);
912
913 return chunk;
914}
Xin Long11ae76e2017-03-10 12:11:11 +0800915
916struct sctp_chunk *sctp_process_strreset_resp(
917 struct sctp_association *asoc,
918 union sctp_params param,
919 struct sctp_ulpevent **evp)
920{
Xin Longcee360a2017-05-31 16:36:31 +0800921 struct sctp_stream *stream = &asoc->stream;
Xin Long11ae76e2017-03-10 12:11:11 +0800922 struct sctp_strreset_resp *resp = param.v;
Xin Long11ae76e2017-03-10 12:11:11 +0800923 struct sctp_transport *t;
924 __u16 i, nums, flags = 0;
Xin Long3c918702017-06-30 11:52:16 +0800925 struct sctp_paramhdr *req;
Xin Long11ae76e2017-03-10 12:11:11 +0800926 __u32 result;
927
928 req = sctp_chunk_lookup_strreset_param(asoc, resp->response_seq, 0);
929 if (!req)
930 return NULL;
931
932 result = ntohl(resp->result);
933 if (result != SCTP_STRRESET_PERFORMED) {
934 /* if in progress, do nothing but retransmit */
935 if (result == SCTP_STRRESET_IN_PROGRESS)
936 return NULL;
937 else if (result == SCTP_STRRESET_DENIED)
938 flags = SCTP_STREAM_RESET_DENIED;
939 else
940 flags = SCTP_STREAM_RESET_FAILED;
941 }
942
943 if (req->type == SCTP_PARAM_RESET_OUT_REQUEST) {
944 struct sctp_strreset_outreq *outreq;
Xin Long1da4fc92017-10-28 19:43:54 +0800945 __be16 *str_p;
Xin Long11ae76e2017-03-10 12:11:11 +0800946
947 outreq = (struct sctp_strreset_outreq *)req;
Xin Longedb12f22017-04-15 21:56:57 +0800948 str_p = outreq->list_of_streams;
Xin Long3aa623d2017-11-25 21:05:32 +0800949 nums = (ntohs(outreq->param_hdr.length) - sizeof(*outreq)) /
950 sizeof(__u16);
Xin Long11ae76e2017-03-10 12:11:11 +0800951
952 if (result == SCTP_STRRESET_PERFORMED) {
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300953 struct sctp_stream_out *sout;
Xin Long11ae76e2017-03-10 12:11:11 +0800954 if (nums) {
Xin Long107e2422017-12-15 00:41:31 +0800955 for (i = 0; i < nums; i++) {
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300956 sout = SCTP_SO(stream, ntohs(str_p[i]));
957 sout->mid = 0;
958 sout->mid_uo = 0;
Xin Long107e2422017-12-15 00:41:31 +0800959 }
Xin Long11ae76e2017-03-10 12:11:11 +0800960 } else {
Xin Long107e2422017-12-15 00:41:31 +0800961 for (i = 0; i < stream->outcnt; i++) {
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300962 sout = SCTP_SO(stream, i);
963 sout->mid = 0;
964 sout->mid_uo = 0;
Xin Long107e2422017-12-15 00:41:31 +0800965 }
Xin Long11ae76e2017-03-10 12:11:11 +0800966 }
Xin Long11ae76e2017-03-10 12:11:11 +0800967 }
968
Xin Long2e6dc4d2019-01-22 02:39:34 +0800969 flags |= SCTP_STREAM_RESET_OUTGOING_SSN;
970
Xin Long11ae76e2017-03-10 12:11:11 +0800971 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +0300972 SCTP_SO(stream, i)->state = SCTP_STREAM_OPEN;
Xin Long11ae76e2017-03-10 12:11:11 +0800973
974 *evp = sctp_ulpevent_make_stream_reset_event(asoc, flags,
975 nums, str_p, GFP_ATOMIC);
976 } else if (req->type == SCTP_PARAM_RESET_IN_REQUEST) {
977 struct sctp_strreset_inreq *inreq;
Xin Long1da4fc92017-10-28 19:43:54 +0800978 __be16 *str_p;
Xin Long11ae76e2017-03-10 12:11:11 +0800979
980 /* if the result is performed, it's impossible for inreq */
981 if (result == SCTP_STRRESET_PERFORMED)
982 return NULL;
983
984 inreq = (struct sctp_strreset_inreq *)req;
Xin Longedb12f22017-04-15 21:56:57 +0800985 str_p = inreq->list_of_streams;
Xin Long3aa623d2017-11-25 21:05:32 +0800986 nums = (ntohs(inreq->param_hdr.length) - sizeof(*inreq)) /
987 sizeof(__u16);
Xin Long11ae76e2017-03-10 12:11:11 +0800988
Xin Long2e6dc4d2019-01-22 02:39:34 +0800989 flags |= SCTP_STREAM_RESET_INCOMING_SSN;
990
Xin Long11ae76e2017-03-10 12:11:11 +0800991 *evp = sctp_ulpevent_make_stream_reset_event(asoc, flags,
992 nums, str_p, GFP_ATOMIC);
993 } else if (req->type == SCTP_PARAM_RESET_TSN_REQUEST) {
994 struct sctp_strreset_resptsn *resptsn;
995 __u32 stsn, rtsn;
996
997 /* check for resptsn, as sctp_verify_reconf didn't do it*/
998 if (ntohs(param.p->length) != sizeof(*resptsn))
999 return NULL;
1000
1001 resptsn = (struct sctp_strreset_resptsn *)resp;
1002 stsn = ntohl(resptsn->senders_next_tsn);
1003 rtsn = ntohl(resptsn->receivers_next_tsn);
1004
1005 if (result == SCTP_STRRESET_PERFORMED) {
1006 __u32 mtsn = sctp_tsnmap_get_max_tsn_seen(
1007 &asoc->peer.tsn_map);
Xin Long159f2a72017-11-25 21:05:35 +08001008 LIST_HEAD(temp);
Xin Long11ae76e2017-03-10 12:11:11 +08001009
Xin Long47b20a82017-12-15 00:41:28 +08001010 asoc->stream.si->report_ftsn(&asoc->ulpq, mtsn);
Xin Long11ae76e2017-03-10 12:11:11 +08001011
1012 sctp_tsnmap_init(&asoc->peer.tsn_map,
1013 SCTP_TSN_MAP_INITIAL,
1014 stsn, GFP_ATOMIC);
1015
Xin Long159f2a72017-11-25 21:05:35 +08001016 /* Clean up sacked and abandoned queues only. As the
1017 * out_chunk_list may not be empty, splice it to temp,
1018 * then get it back after sctp_outq_free is done.
1019 */
1020 list_splice_init(&asoc->outqueue.out_chunk_list, &temp);
Xin Long11ae76e2017-03-10 12:11:11 +08001021 sctp_outq_free(&asoc->outqueue);
Xin Long159f2a72017-11-25 21:05:35 +08001022 list_splice_init(&temp, &asoc->outqueue.out_chunk_list);
Xin Long11ae76e2017-03-10 12:11:11 +08001023
1024 asoc->next_tsn = rtsn;
1025 asoc->ctsn_ack_point = asoc->next_tsn - 1;
1026 asoc->adv_peer_ack_point = asoc->ctsn_ack_point;
1027
Xin Long107e2422017-12-15 00:41:31 +08001028 for (i = 0; i < stream->outcnt; i++) {
Konstantin Khorenko05364ca2018-08-10 20:11:42 +03001029 SCTP_SO(stream, i)->mid = 0;
1030 SCTP_SO(stream, i)->mid_uo = 0;
Xin Long107e2422017-12-15 00:41:31 +08001031 }
Xin Long11ae76e2017-03-10 12:11:11 +08001032 for (i = 0; i < stream->incnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +03001033 SCTP_SI(stream, i)->mid = 0;
Xin Long11ae76e2017-03-10 12:11:11 +08001034 }
1035
1036 for (i = 0; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +03001037 SCTP_SO(stream, i)->state = SCTP_STREAM_OPEN;
Xin Long11ae76e2017-03-10 12:11:11 +08001038
1039 *evp = sctp_ulpevent_make_assoc_reset_event(asoc, flags,
1040 stsn, rtsn, GFP_ATOMIC);
1041 } else if (req->type == SCTP_PARAM_RESET_ADD_OUT_STREAMS) {
1042 struct sctp_strreset_addstrm *addstrm;
1043 __u16 number;
1044
1045 addstrm = (struct sctp_strreset_addstrm *)req;
1046 nums = ntohs(addstrm->number_of_streams);
1047 number = stream->outcnt - nums;
1048
Xin Long3ecdda32020-07-22 23:52:12 +08001049 if (result == SCTP_STRRESET_PERFORMED) {
Xin Long11ae76e2017-03-10 12:11:11 +08001050 for (i = number; i < stream->outcnt; i++)
Konstantin Khorenko05364ca2018-08-10 20:11:42 +03001051 SCTP_SO(stream, i)->state = SCTP_STREAM_OPEN;
Xin Long3ecdda32020-07-22 23:52:12 +08001052 } else {
1053 sctp_stream_shrink_out(stream, number);
Xin Long11ae76e2017-03-10 12:11:11 +08001054 stream->outcnt = number;
Xin Long3ecdda32020-07-22 23:52:12 +08001055 }
Xin Long11ae76e2017-03-10 12:11:11 +08001056
1057 *evp = sctp_ulpevent_make_stream_change_event(asoc, flags,
1058 0, nums, GFP_ATOMIC);
1059 } else if (req->type == SCTP_PARAM_RESET_ADD_IN_STREAMS) {
1060 struct sctp_strreset_addstrm *addstrm;
1061
1062 /* if the result is performed, it's impossible for addstrm in
1063 * request.
1064 */
1065 if (result == SCTP_STRRESET_PERFORMED)
1066 return NULL;
1067
1068 addstrm = (struct sctp_strreset_addstrm *)req;
1069 nums = ntohs(addstrm->number_of_streams);
1070
1071 *evp = sctp_ulpevent_make_stream_change_event(asoc, flags,
1072 nums, 0, GFP_ATOMIC);
1073 }
1074
1075 asoc->strreset_outstanding--;
1076 asoc->strreset_outseq++;
1077
1078 /* remove everything for this reconf request */
1079 if (!asoc->strreset_outstanding) {
1080 t = asoc->strreset_chunk->transport;
1081 if (del_timer(&t->reconf_timer))
1082 sctp_transport_put(t);
1083
1084 sctp_chunk_put(asoc->strreset_chunk);
1085 asoc->strreset_chunk = NULL;
1086 }
1087
1088 return NULL;
1089}