sctp: implement sender-side procedures for Add Incoming/Outgoing Streams Request...

[mirror_ubuntu-artful-kernel.git] / net / sctp / stream.c

diff --git a/net/sctp/stream.c b/net/sctp/stream.c
index 53e49fc2f0a3665877cba375bc7b3a44ad9decf5..eb02490245ba3da16445d5e5d79f4e5c51bfb534 100644 (file)
--- a/net/sctp/stream.c
+++ b/net/sctp/stream.c
@@ -217,3 +217,80 @@ int sctp_send_reset_assoc(struct sctp_association *asoc)
 
        return 0;
 }
+
+int sctp_send_add_streams(struct sctp_association *asoc,
+                         struct sctp_add_streams *params)
+{
+       struct sctp_stream *stream = asoc->stream;
+       struct sctp_chunk *chunk = NULL;
+       int retval = -ENOMEM;
+       __u32 outcnt, incnt;
+       __u16 out, in;
+
+       if (!asoc->peer.reconf_capable ||
+           !(asoc->strreset_enable & SCTP_ENABLE_CHANGE_ASSOC_REQ)) {
+               retval = -ENOPROTOOPT;
+               goto out;
+       }
+
+       if (asoc->strreset_outstanding) {
+               retval = -EINPROGRESS;
+               goto out;
+       }
+
+       out = params->sas_outstrms;
+       in  = params->sas_instrms;
+       outcnt = stream->outcnt + out;
+       incnt = stream->incnt + in;
+       if (outcnt > SCTP_MAX_STREAM || incnt > SCTP_MAX_STREAM ||
+           (!out && !in)) {
+               retval = -EINVAL;
+               goto out;
+       }
+
+       if (out) {
+               struct sctp_stream_out *streamout;
+
+               streamout = krealloc(stream->out, outcnt * sizeof(*streamout),
+                                    GFP_KERNEL);
+               if (!streamout)
+                       goto out;
+
+               memset(streamout + stream->outcnt, 0, out * sizeof(*streamout));
+               stream->out = streamout;
+       }
+
+       if (in) {
+               struct sctp_stream_in *streamin;
+
+               streamin = krealloc(stream->in, incnt * sizeof(*streamin),
+                                   GFP_KERNEL);
+               if (!streamin)
+                       goto out;
+
+               memset(streamin + stream->incnt, 0, in * sizeof(*streamin));
+               stream->in = streamin;
+       }
+
+       chunk = sctp_make_strreset_addstrm(asoc, out, in);
+       if (!chunk)
+               goto out;
+
+       asoc->strreset_chunk = chunk;
+       sctp_chunk_hold(asoc->strreset_chunk);
+
+       retval = sctp_send_reconf(asoc, chunk);
+       if (retval) {
+               sctp_chunk_put(asoc->strreset_chunk);
+               asoc->strreset_chunk = NULL;
+               goto out;
+       }
+
+       stream->incnt = incnt;
+       stream->outcnt = outcnt;
+
+       asoc->strreset_outstanding = !!out + !!in;
+
+out:
+       return retval;
+}