156 lines
4.1 KiB
C
156 lines
4.1 KiB
C
/* SCTP kernel implementation
|
|
* (C) Copyright Red Hat Inc. 2017
|
|
*
|
|
* This file is part of the SCTP kernel implementation
|
|
*
|
|
* These functions manipulate sctp stream queue/scheduling.
|
|
*
|
|
* This SCTP implementation is free software;
|
|
* you can redistribute it and/or modify it under the terms of
|
|
* the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This SCTP implementation is distributed in the hope that it
|
|
* will be useful, but WITHOUT ANY WARRANTY; without even the implied
|
|
* ************************
|
|
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|
* See the GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with GNU CC; see the file COPYING. If not, see
|
|
* <http://www.gnu.org/licenses/>.
|
|
*
|
|
* Please send any bug reports or fixes you make to the
|
|
* email addresched(es):
|
|
* lksctp developers <linux-sctp@vger.kernel.org>
|
|
*
|
|
* Written or modified by:
|
|
* Xin Long <lucien.xin@gmail.com>
|
|
*/
|
|
|
|
#include <net/sctp/sctp.h>
|
|
#include <net/sctp/sm.h>
|
|
#include <linux/sctp.h>
|
|
|
|
static struct sctp_chunk *sctp_make_idatafrag_empty(
|
|
const struct sctp_association *asoc,
|
|
const struct sctp_sndrcvinfo *sinfo,
|
|
int len, __u8 flags, gfp_t gfp)
|
|
{
|
|
struct sctp_chunk *retval;
|
|
struct sctp_idatahdr dp;
|
|
|
|
memset(&dp, 0, sizeof(dp));
|
|
dp.stream = htons(sinfo->sinfo_stream);
|
|
|
|
if (sinfo->sinfo_flags & SCTP_UNORDERED)
|
|
flags |= SCTP_DATA_UNORDERED;
|
|
|
|
retval = sctp_make_idata(asoc, flags, sizeof(dp) + len, gfp);
|
|
if (!retval)
|
|
return NULL;
|
|
|
|
retval->subh.idata_hdr = sctp_addto_chunk(retval, sizeof(dp), &dp);
|
|
memcpy(&retval->sinfo, sinfo, sizeof(struct sctp_sndrcvinfo));
|
|
|
|
return retval;
|
|
}
|
|
|
|
static void sctp_chunk_assign_mid(struct sctp_chunk *chunk)
|
|
{
|
|
struct sctp_stream *stream;
|
|
struct sctp_chunk *lchunk;
|
|
__u32 cfsn = 0;
|
|
__u16 sid;
|
|
|
|
if (chunk->has_mid)
|
|
return;
|
|
|
|
sid = sctp_chunk_stream_no(chunk);
|
|
stream = &chunk->asoc->stream;
|
|
|
|
list_for_each_entry(lchunk, &chunk->msg->chunks, frag_list) {
|
|
struct sctp_idatahdr *hdr;
|
|
|
|
lchunk->has_mid = 1;
|
|
|
|
if (lchunk->chunk_hdr->flags & SCTP_DATA_UNORDERED)
|
|
continue;
|
|
|
|
hdr = lchunk->subh.idata_hdr;
|
|
|
|
if (lchunk->chunk_hdr->flags & SCTP_DATA_FIRST_FRAG)
|
|
hdr->ppid = lchunk->sinfo.sinfo_ppid;
|
|
else
|
|
hdr->fsn = htonl(cfsn++);
|
|
|
|
if (lchunk->chunk_hdr->flags & SCTP_DATA_LAST_FRAG)
|
|
hdr->mid = htonl(sctp_mid_next(stream, out, sid));
|
|
else
|
|
hdr->mid = htonl(sctp_mid_peek(stream, out, sid));
|
|
}
|
|
}
|
|
|
|
static bool sctp_validate_data(struct sctp_chunk *chunk)
|
|
{
|
|
const struct sctp_stream *stream;
|
|
__u16 sid, ssn;
|
|
|
|
if (chunk->chunk_hdr->type != SCTP_CID_DATA)
|
|
return false;
|
|
|
|
if (chunk->chunk_hdr->flags & SCTP_DATA_UNORDERED)
|
|
return true;
|
|
|
|
stream = &chunk->asoc->stream;
|
|
sid = sctp_chunk_stream_no(chunk);
|
|
ssn = ntohs(chunk->subh.data_hdr->ssn);
|
|
|
|
return !SSN_lt(ssn, sctp_ssn_peek(stream, in, sid));
|
|
}
|
|
|
|
static bool sctp_validate_idata(struct sctp_chunk *chunk)
|
|
{
|
|
struct sctp_stream *stream;
|
|
__u32 mid;
|
|
__u16 sid;
|
|
|
|
if (chunk->chunk_hdr->type != SCTP_CID_I_DATA)
|
|
return false;
|
|
|
|
if (chunk->chunk_hdr->flags & SCTP_DATA_UNORDERED)
|
|
return true;
|
|
|
|
stream = &chunk->asoc->stream;
|
|
sid = sctp_chunk_stream_no(chunk);
|
|
mid = ntohl(chunk->subh.idata_hdr->mid);
|
|
|
|
return !MID_lt(mid, sctp_mid_peek(stream, in, sid));
|
|
}
|
|
|
|
static struct sctp_stream_interleave sctp_stream_interleave_0 = {
|
|
.data_chunk_len = sizeof(struct sctp_data_chunk),
|
|
/* DATA process functions */
|
|
.make_datafrag = sctp_make_datafrag_empty,
|
|
.assign_number = sctp_chunk_assign_ssn,
|
|
.validate_data = sctp_validate_data,
|
|
};
|
|
|
|
static struct sctp_stream_interleave sctp_stream_interleave_1 = {
|
|
.data_chunk_len = sizeof(struct sctp_idata_chunk),
|
|
/* I-DATA process functions */
|
|
.make_datafrag = sctp_make_idatafrag_empty,
|
|
.assign_number = sctp_chunk_assign_mid,
|
|
.validate_data = sctp_validate_idata,
|
|
};
|
|
|
|
void sctp_stream_interleave_init(struct sctp_stream *stream)
|
|
{
|
|
struct sctp_association *asoc;
|
|
|
|
asoc = container_of(stream, struct sctp_association, stream);
|
|
stream->si = asoc->intl_enable ? &sctp_stream_interleave_1
|
|
: &sctp_stream_interleave_0;
|
|
}
|