blob: f731de3e8428c951583c3217586da0609bb25d3a [file] [log] [blame]
Vlad Yasevich60c778b2008-01-11 09:57:09 -05001/* SCTP kernel implementation
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * Copyright (c) 1999-2000 Cisco, Inc.
3 * Copyright (c) 1999-2001 Motorola, Inc.
4 * Copyright (c) 2002 International Business Machines, Corp.
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +09005 *
Vlad Yasevich60c778b2008-01-11 09:57:09 -05006 * This file is part of the SCTP kernel implementation
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +09007 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07008 * These functions are the methods for accessing the SCTP inqueue.
9 *
10 * An SCTP inqueue is a queue into which you push SCTP packets
11 * (which might be bundles or fragments of chunks) and out of which you
12 * pop SCTP whole chunks.
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090013 *
Vlad Yasevich60c778b2008-01-11 09:57:09 -050014 * This SCTP implementation is free software;
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090015 * you can redistribute it and/or modify it under the terms of
Linus Torvalds1da177e2005-04-16 15:20:36 -070016 * the GNU General Public License as published by
17 * the Free Software Foundation; either version 2, or (at your option)
18 * any later version.
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090019 *
Vlad Yasevich60c778b2008-01-11 09:57:09 -050020 * This SCTP implementation is distributed in the hope that it
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 * will be useful, but WITHOUT ANY WARRANTY; without even the implied
22 * ************************
23 * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
24 * See the GNU General Public License for more details.
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090025 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070026 * You should have received a copy of the GNU General Public License
Jeff Kirsher4b2f13a2013-12-06 06:28:48 -080027 * along with GNU CC; see the file COPYING. If not, see
28 * <http://www.gnu.org/licenses/>.
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090029 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070030 * Please send any bug reports or fixes you make to the
31 * email address(es):
Daniel Borkmann91705c62013-07-23 14:51:47 +020032 * lksctp developers <linux-sctp@vger.kernel.org>
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090033 *
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +090034 * Written or modified by:
Linus Torvalds1da177e2005-04-16 15:20:36 -070035 * La Monte H.P. Yarroll <piggy@acm.org>
36 * Karl Knutson <karl@athena.chicago.il.us>
Linus Torvalds1da177e2005-04-16 15:20:36 -070037 */
38
Joe Perches145ce502010-08-24 13:21:08 +000039#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
40
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#include <net/sctp/sctp.h>
42#include <net/sctp/sm.h>
43#include <linux/interrupt.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090044#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070045
46/* Initialize an SCTP inqueue. */
47void sctp_inq_init(struct sctp_inq *queue)
48{
David S. Miller79af02c2005-07-08 21:47:49 -070049 INIT_LIST_HEAD(&queue->in_chunk_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070050 queue->in_progress = NULL;
51
52 /* Create a task for delivering data. */
David Howellsc4028952006-11-22 14:57:56 +000053 INIT_WORK(&queue->immediate, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -070054}
55
56/* Release the memory associated with an SCTP inqueue. */
57void sctp_inq_free(struct sctp_inq *queue)
58{
David S. Miller79af02c2005-07-08 21:47:49 -070059 struct sctp_chunk *chunk, *tmp;
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
61 /* Empty the queue. */
David S. Miller79af02c2005-07-08 21:47:49 -070062 list_for_each_entry_safe(chunk, tmp, &queue->in_chunk_list, list) {
63 list_del_init(&chunk->list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070064 sctp_chunk_free(chunk);
David S. Miller79af02c2005-07-08 21:47:49 -070065 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
67 /* If there is a packet which is currently being worked on,
68 * free it as well.
69 */
Sridhar Samudrala7a48f922006-01-17 11:51:28 -080070 if (queue->in_progress) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 sctp_chunk_free(queue->in_progress);
Sridhar Samudrala7a48f922006-01-17 11:51:28 -080072 queue->in_progress = NULL;
73 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070074}
75
76/* Put a new packet in an SCTP inqueue.
77 * We assume that packet->sctp_hdr is set and in host byte order.
78 */
Sridhar Samudralaac0b0462006-08-22 00:15:33 -070079void sctp_inq_push(struct sctp_inq *q, struct sctp_chunk *chunk)
Linus Torvalds1da177e2005-04-16 15:20:36 -070080{
81 /* Directly call the packet handling routine. */
Vlad Yasevich027f6e12007-11-07 11:39:27 -050082 if (chunk->rcvr->dead) {
83 sctp_chunk_free(chunk);
84 return;
85 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
87 /* We are now calling this either from the soft interrupt
88 * or from the backlog processing.
89 * Eventually, we should clean up inqueue to not rely
90 * on the BH related data structures.
91 */
Sridhar Samudralaac0b0462006-08-22 00:15:33 -070092 list_add_tail(&chunk->list, &q->in_chunk_list);
Michele Baldessari196d6752012-12-01 04:49:42 +000093 if (chunk->asoc)
94 chunk->asoc->stats.ipackets++;
David Howellsc4028952006-11-22 14:57:56 +000095 q->immediate.func(&q->immediate);
Linus Torvalds1da177e2005-04-16 15:20:36 -070096}
97
Vlad Yasevichbbd0d592007-10-03 17:51:34 -070098/* Peek at the next chunk on the inqeue. */
99struct sctp_chunkhdr *sctp_inq_peek(struct sctp_inq *queue)
100{
101 struct sctp_chunk *chunk;
102 sctp_chunkhdr_t *ch = NULL;
103
104 chunk = queue->in_progress;
105 /* If there is no more chunks in this packet, say so */
106 if (chunk->singleton ||
107 chunk->end_of_packet ||
108 chunk->pdiscard)
109 return NULL;
110
111 ch = (sctp_chunkhdr_t *)chunk->chunk_end;
112
113 return ch;
114}
115
116
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117/* Extract a chunk from an SCTP inqueue.
118 *
119 * WARNING: If you need to put the chunk on another queue, you need to
120 * make a shallow copy (clone) of it.
121 */
122struct sctp_chunk *sctp_inq_pop(struct sctp_inq *queue)
123{
124 struct sctp_chunk *chunk;
125 sctp_chunkhdr_t *ch = NULL;
126
127 /* The assumption is that we are safe to process the chunks
128 * at this time.
129 */
130
Marcelo Ricardo Leitner3acb50c2016-06-02 15:05:42 -0300131 chunk = queue->in_progress;
132 if (chunk) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 /* There is a packet that we have been working on.
134 * Any post processing work to do before we move on?
135 */
136 if (chunk->singleton ||
137 chunk->end_of_packet ||
138 chunk->pdiscard) {
Marcelo Ricardo Leitner90017ac2016-06-02 15:05:43 -0300139 if (chunk->head_skb == chunk->skb) {
140 chunk->skb = skb_shinfo(chunk->skb)->frag_list;
141 goto new_skb;
142 }
143 if (chunk->skb->next) {
144 chunk->skb = chunk->skb->next;
145 goto new_skb;
146 }
147
148 if (chunk->head_skb)
149 chunk->skb = chunk->head_skb;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150 sctp_chunk_free(chunk);
151 chunk = queue->in_progress = NULL;
152 } else {
153 /* Nothing to do. Next chunk in the packet, please. */
154 ch = (sctp_chunkhdr_t *) chunk->chunk_end;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 /* Force chunk->skb->data to chunk->chunk_end. */
Daniel Borkmann26b87c72014-10-09 22:55:33 +0200156 skb_pull(chunk->skb, chunk->chunk_end - chunk->skb->data);
157 /* We are guaranteed to pull a SCTP header. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158 }
159 }
160
161 /* Do we need to take the next packet out of the queue to process? */
162 if (!chunk) {
David S. Miller79af02c2005-07-08 21:47:49 -0700163 struct list_head *entry;
164
Marcelo Ricardo Leitner3acb50c2016-06-02 15:05:42 -0300165next_chunk:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166 /* Is the queue empty? */
Marcelo Ricardo Leitner90017ac2016-06-02 15:05:43 -0300167 entry = sctp_list_dequeue(&queue->in_chunk_list);
168 if (!entry)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169 return NULL;
170
Marcelo Ricardo Leitner3acb50c2016-06-02 15:05:42 -0300171 chunk = list_entry(entry, struct sctp_chunk, list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172
Marcelo Ricardo Leitner90017ac2016-06-02 15:05:43 -0300173 if ((skb_shinfo(chunk->skb)->gso_type & SKB_GSO_SCTP) == SKB_GSO_SCTP) {
174 /* GSO-marked skbs but without frags, handle
175 * them normally
176 */
177 if (skb_shinfo(chunk->skb)->frag_list)
178 chunk->head_skb = chunk->skb;
Marcelo Ricardo Leitner3acb50c2016-06-02 15:05:42 -0300179
Marcelo Ricardo Leitner90017ac2016-06-02 15:05:43 -0300180 /* skbs with "cover letter" */
181 if (chunk->head_skb && chunk->skb->data_len == chunk->skb->len)
182 chunk->skb = skb_shinfo(chunk->skb)->frag_list;
183
184 if (WARN_ON(!chunk->skb)) {
185 __SCTP_INC_STATS(dev_net(chunk->skb->dev), SCTP_MIB_IN_PKT_DISCARDS);
186 sctp_chunk_free(chunk);
187 goto next_chunk;
188 }
189 }
Marcelo Ricardo Leitner486bdee2016-04-12 18:11:31 -0300190
191 if (chunk->asoc)
192 sock_rps_save_rxhash(chunk->asoc->base.sk, chunk->skb);
Marcelo Ricardo Leitner90017ac2016-06-02 15:05:43 -0300193
194 queue->in_progress = chunk;
195
196new_skb:
197 /* This is the first chunk in the packet. */
198 ch = (sctp_chunkhdr_t *) chunk->skb->data;
199 chunk->singleton = 1;
200 chunk->data_accepted = 0;
201 chunk->pdiscard = 0;
202 chunk->auth = 0;
203 chunk->has_asconf = 0;
204 chunk->end_of_packet = 0;
Marcelo Ricardo Leitner1f45f782016-07-13 15:08:57 -0300205 if (chunk->head_skb) {
206 struct sctp_input_cb
207 *cb = SCTP_INPUT_CB(chunk->skb),
208 *head_cb = SCTP_INPUT_CB(chunk->head_skb);
209
210 cb->chunk = head_cb->chunk;
Marcelo Ricardo Leitnere7487c82016-07-13 15:08:58 -0300211 cb->af = head_cb->af;
Marcelo Ricardo Leitner1f45f782016-07-13 15:08:57 -0300212 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 }
214
YOSHIFUJI Hideakid808ad92007-02-09 23:25:18 +0900215 chunk->chunk_hdr = ch;
Marcelo Ricardo Leitnere2f036a2016-09-21 08:45:55 -0300216 chunk->chunk_end = ((__u8 *)ch) + SCTP_PAD4(ntohs(ch->length));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217 skb_pull(chunk->skb, sizeof(sctp_chunkhdr_t));
218 chunk->subh.v = NULL; /* Subheader is no longer valid. */
219
Daniel Borkmann26b87c72014-10-09 22:55:33 +0200220 if (chunk->chunk_end + sizeof(sctp_chunkhdr_t) <
221 skb_tail_pointer(chunk->skb)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222 /* This is not a singleton */
223 chunk->singleton = 0;
Arnaldo Carvalho de Melo27a884d2007-04-19 20:29:13 -0700224 } else if (chunk->chunk_end > skb_tail_pointer(chunk->skb)) {
Daniel Borkmann26b87c72014-10-09 22:55:33 +0200225 /* Discard inside state machine. */
226 chunk->pdiscard = 1;
227 chunk->chunk_end = skb_tail_pointer(chunk->skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 } else {
229 /* We are at the end of the packet, so mark the chunk
230 * in case we need to send a SACK.
231 */
232 chunk->end_of_packet = 1;
233 }
234
Daniel Borkmannbb333812013-06-28 19:49:40 +0200235 pr_debug("+++sctp_inq_pop+++ chunk:%p[%s], length:%d, skb->len:%d\n",
236 chunk, sctp_cname(SCTP_ST_CHUNK(chunk->chunk_hdr->type)),
237 ntohs(chunk->chunk_hdr->length), chunk->skb->len);
238
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 return chunk;
240}
241
242/* Set a top-half handler.
243 *
244 * Originally, we the top-half handler was scheduled as a BH. We now
245 * call the handler directly in sctp_inq_push() at a time that
246 * we know we are lock safe.
247 * The intent is that this routine will pull stuff out of the
248 * inqueue and process it.
249 */
David Howellsc4028952006-11-22 14:57:56 +0000250void sctp_inq_set_th_handler(struct sctp_inq *q, work_func_t callback)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251{
David Howellsc4028952006-11-22 14:57:56 +0000252 INIT_WORK(&q->immediate, callback);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253}