xref: /openbmc/linux/net/sctp/sm_make_chunk.c (revision 559cf710)
11da177e4SLinus Torvalds /* SCTP kernel reference Implementation
21da177e4SLinus Torvalds  * (C) Copyright IBM Corp. 2001, 2004
31da177e4SLinus Torvalds  * Copyright (c) 1999-2000 Cisco, Inc.
41da177e4SLinus Torvalds  * Copyright (c) 1999-2001 Motorola, Inc.
51da177e4SLinus Torvalds  * Copyright (c) 2001-2002 Intel Corp.
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  * This file is part of the SCTP kernel reference Implementation
81da177e4SLinus Torvalds  *
91da177e4SLinus Torvalds  * These functions work with the state functions in sctp_sm_statefuns.c
101da177e4SLinus Torvalds  * to implement the state operations.  These functions implement the
111da177e4SLinus Torvalds  * steps which require modifying existing data structures.
121da177e4SLinus Torvalds  *
131da177e4SLinus Torvalds  * The SCTP reference implementation is free software;
141da177e4SLinus Torvalds  * you can redistribute it and/or modify it under the terms of
151da177e4SLinus Torvalds  * the GNU General Public License as published by
161da177e4SLinus Torvalds  * the Free Software Foundation; either version 2, or (at your option)
171da177e4SLinus Torvalds  * any later version.
181da177e4SLinus Torvalds  *
191da177e4SLinus Torvalds  * The SCTP reference implementation is distributed in the hope that it
201da177e4SLinus Torvalds  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
211da177e4SLinus Torvalds  *                 ************************
221da177e4SLinus Torvalds  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
231da177e4SLinus Torvalds  * See the GNU General Public License for more details.
241da177e4SLinus Torvalds  *
251da177e4SLinus Torvalds  * You should have received a copy of the GNU General Public License
261da177e4SLinus Torvalds  * along with GNU CC; see the file COPYING.  If not, write to
271da177e4SLinus Torvalds  * the Free Software Foundation, 59 Temple Place - Suite 330,
281da177e4SLinus Torvalds  * Boston, MA 02111-1307, USA.
291da177e4SLinus Torvalds  *
301da177e4SLinus Torvalds  * Please send any bug reports or fixes you make to the
311da177e4SLinus Torvalds  * email address(es):
321da177e4SLinus Torvalds  *    lksctp developers <lksctp-developers@lists.sourceforge.net>
331da177e4SLinus Torvalds  *
341da177e4SLinus Torvalds  * Or submit a bug report through the following website:
351da177e4SLinus Torvalds  *    http://www.sf.net/projects/lksctp
361da177e4SLinus Torvalds  *
371da177e4SLinus Torvalds  * Written or modified by:
381da177e4SLinus Torvalds  *    La Monte H.P. Yarroll <piggy@acm.org>
391da177e4SLinus Torvalds  *    Karl Knutson          <karl@athena.chicago.il.us>
401da177e4SLinus Torvalds  *    C. Robin              <chris@hundredacre.ac.uk>
411da177e4SLinus Torvalds  *    Jon Grimm             <jgrimm@us.ibm.com>
421da177e4SLinus Torvalds  *    Xingang Guo           <xingang.guo@intel.com>
431da177e4SLinus Torvalds  *    Dajiang Zhang	    <dajiang.zhang@nokia.com>
441da177e4SLinus Torvalds  *    Sridhar Samudrala	    <sri@us.ibm.com>
451da177e4SLinus Torvalds  *    Daisy Chang	    <daisyc@us.ibm.com>
461da177e4SLinus Torvalds  *    Ardelle Fan	    <ardelle.fan@intel.com>
471da177e4SLinus Torvalds  *    Kevin Gao             <kevin.gao@intel.com>
481da177e4SLinus Torvalds  *
491da177e4SLinus Torvalds  * Any bugs reported given to us we will try to fix... any fixes shared will
501da177e4SLinus Torvalds  * be incorporated into the next SCTP release.
511da177e4SLinus Torvalds  */
521da177e4SLinus Torvalds 
531da177e4SLinus Torvalds #include <linux/types.h>
541da177e4SLinus Torvalds #include <linux/kernel.h>
551da177e4SLinus Torvalds #include <linux/ip.h>
561da177e4SLinus Torvalds #include <linux/ipv6.h>
571da177e4SLinus Torvalds #include <linux/net.h>
581da177e4SLinus Torvalds #include <linux/inet.h>
591da177e4SLinus Torvalds #include <asm/scatterlist.h>
601da177e4SLinus Torvalds #include <linux/crypto.h>
611da177e4SLinus Torvalds #include <net/sock.h>
621da177e4SLinus Torvalds 
631da177e4SLinus Torvalds #include <linux/skbuff.h>
641da177e4SLinus Torvalds #include <linux/random.h>	/* for get_random_bytes */
651da177e4SLinus Torvalds #include <net/sctp/sctp.h>
661da177e4SLinus Torvalds #include <net/sctp/sm.h>
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds SCTP_STATIC
691da177e4SLinus Torvalds struct sctp_chunk *sctp_make_chunk(const struct sctp_association *asoc,
701da177e4SLinus Torvalds 				   __u8 type, __u8 flags, int paylen);
711da177e4SLinus Torvalds static sctp_cookie_param_t *sctp_pack_cookie(const struct sctp_endpoint *ep,
721da177e4SLinus Torvalds 					const struct sctp_association *asoc,
731da177e4SLinus Torvalds 					const struct sctp_chunk *init_chunk,
741da177e4SLinus Torvalds 					int *cookie_len,
751da177e4SLinus Torvalds 					const __u8 *raw_addrs, int addrs_len);
761da177e4SLinus Torvalds static int sctp_process_param(struct sctp_association *asoc,
771da177e4SLinus Torvalds 			      union sctp_params param,
781da177e4SLinus Torvalds 			      const union sctp_addr *peer_addr,
79dd0fc66fSAl Viro 			      gfp_t gfp);
801da177e4SLinus Torvalds 
811da177e4SLinus Torvalds /* What was the inbound interface for this chunk? */
821da177e4SLinus Torvalds int sctp_chunk_iif(const struct sctp_chunk *chunk)
831da177e4SLinus Torvalds {
841da177e4SLinus Torvalds 	struct sctp_af *af;
851da177e4SLinus Torvalds 	int iif = 0;
861da177e4SLinus Torvalds 
87eddc9ec5SArnaldo Carvalho de Melo 	af = sctp_get_af_specific(ipver2af(ip_hdr(chunk->skb)->version));
881da177e4SLinus Torvalds 	if (af)
891da177e4SLinus Torvalds 		iif = af->skb_iif(chunk->skb);
901da177e4SLinus Torvalds 
911da177e4SLinus Torvalds 	return iif;
921da177e4SLinus Torvalds }
931da177e4SLinus Torvalds 
941da177e4SLinus Torvalds /* RFC 2960 3.3.2 Initiation (INIT) (1)
951da177e4SLinus Torvalds  *
961da177e4SLinus Torvalds  * Note 2: The ECN capable field is reserved for future use of
971da177e4SLinus Torvalds  * Explicit Congestion Notification.
981da177e4SLinus Torvalds  */
991da177e4SLinus Torvalds static const struct sctp_paramhdr ecap_param = {
1001da177e4SLinus Torvalds 	SCTP_PARAM_ECN_CAPABLE,
1011da177e4SLinus Torvalds 	__constant_htons(sizeof(struct sctp_paramhdr)),
1021da177e4SLinus Torvalds };
1031da177e4SLinus Torvalds static const struct sctp_paramhdr prsctp_param = {
1041da177e4SLinus Torvalds 	SCTP_PARAM_FWD_TSN_SUPPORT,
1051da177e4SLinus Torvalds 	__constant_htons(sizeof(struct sctp_paramhdr)),
1061da177e4SLinus Torvalds };
1071da177e4SLinus Torvalds 
1081da177e4SLinus Torvalds /* A helper to initialize to initialize an op error inside a
1091da177e4SLinus Torvalds  * provided chunk, as most cause codes will be embedded inside an
1101da177e4SLinus Torvalds  * abort chunk.
1111da177e4SLinus Torvalds  */
1125bf2db03SAl Viro void  sctp_init_cause(struct sctp_chunk *chunk, __be16 cause_code,
11300f1c2dfSWei Yongjun 		      size_t paylen)
1141da177e4SLinus Torvalds {
1151da177e4SLinus Torvalds 	sctp_errhdr_t err;
1161da177e4SLinus Torvalds 	__u16 len;
1171da177e4SLinus Torvalds 
1181da177e4SLinus Torvalds 	/* Cause code constants are now defined in network order.  */
1191da177e4SLinus Torvalds 	err.cause = cause_code;
1201da177e4SLinus Torvalds 	len = sizeof(sctp_errhdr_t) + paylen;
1211da177e4SLinus Torvalds 	err.length  = htons(len);
1224a1c0107SVlad Yasevich 	chunk->subh.err_hdr = sctp_addto_chunk(chunk, sizeof(sctp_errhdr_t), &err);
1231da177e4SLinus Torvalds }
1241da177e4SLinus Torvalds 
1251da177e4SLinus Torvalds /* 3.3.2 Initiation (INIT) (1)
1261da177e4SLinus Torvalds  *
1271da177e4SLinus Torvalds  * This chunk is used to initiate a SCTP association between two
1281da177e4SLinus Torvalds  * endpoints. The format of the INIT chunk is shown below:
1291da177e4SLinus Torvalds  *
1301da177e4SLinus Torvalds  *     0                   1                   2                   3
1311da177e4SLinus Torvalds  *     0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
1321da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1331da177e4SLinus Torvalds  *    |   Type = 1    |  Chunk Flags  |      Chunk Length             |
1341da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1351da177e4SLinus Torvalds  *    |                         Initiate Tag                          |
1361da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1371da177e4SLinus Torvalds  *    |           Advertised Receiver Window Credit (a_rwnd)          |
1381da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1391da177e4SLinus Torvalds  *    |  Number of Outbound Streams   |  Number of Inbound Streams    |
1401da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1411da177e4SLinus Torvalds  *    |                          Initial TSN                          |
1421da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1431da177e4SLinus Torvalds  *    \                                                               \
1441da177e4SLinus Torvalds  *    /              Optional/Variable-Length Parameters              /
1451da177e4SLinus Torvalds  *    \                                                               \
1461da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1471da177e4SLinus Torvalds  *
1481da177e4SLinus Torvalds  *
1491da177e4SLinus Torvalds  * The INIT chunk contains the following parameters. Unless otherwise
1501da177e4SLinus Torvalds  * noted, each parameter MUST only be included once in the INIT chunk.
1511da177e4SLinus Torvalds  *
1521da177e4SLinus Torvalds  * Fixed Parameters                     Status
1531da177e4SLinus Torvalds  * ----------------------------------------------
1541da177e4SLinus Torvalds  * Initiate Tag                        Mandatory
1551da177e4SLinus Torvalds  * Advertised Receiver Window Credit   Mandatory
1561da177e4SLinus Torvalds  * Number of Outbound Streams          Mandatory
1571da177e4SLinus Torvalds  * Number of Inbound Streams           Mandatory
1581da177e4SLinus Torvalds  * Initial TSN                         Mandatory
1591da177e4SLinus Torvalds  *
1601da177e4SLinus Torvalds  * Variable Parameters                  Status     Type Value
1611da177e4SLinus Torvalds  * -------------------------------------------------------------
1621da177e4SLinus Torvalds  * IPv4 Address (Note 1)               Optional    5
1631da177e4SLinus Torvalds  * IPv6 Address (Note 1)               Optional    6
1641da177e4SLinus Torvalds  * Cookie Preservative                 Optional    9
1651da177e4SLinus Torvalds  * Reserved for ECN Capable (Note 2)   Optional    32768 (0x8000)
1661da177e4SLinus Torvalds  * Host Name Address (Note 3)          Optional    11
1671da177e4SLinus Torvalds  * Supported Address Types (Note 4)    Optional    12
1681da177e4SLinus Torvalds  */
1691da177e4SLinus Torvalds struct sctp_chunk *sctp_make_init(const struct sctp_association *asoc,
1701da177e4SLinus Torvalds 			     const struct sctp_bind_addr *bp,
171dd0fc66fSAl Viro 			     gfp_t gfp, int vparam_len)
1721da177e4SLinus Torvalds {
1731da177e4SLinus Torvalds 	sctp_inithdr_t init;
1741da177e4SLinus Torvalds 	union sctp_params addrs;
1751da177e4SLinus Torvalds 	size_t chunksize;
1761da177e4SLinus Torvalds 	struct sctp_chunk *retval = NULL;
1771da177e4SLinus Torvalds 	int num_types, addrs_len = 0;
1781da177e4SLinus Torvalds 	struct sctp_sock *sp;
1791da177e4SLinus Torvalds 	sctp_supported_addrs_param_t sat;
1803dbe8656SAl Viro 	__be16 types[2];
1810f3fffd8SIvan Skytte Jorgensen 	sctp_adaptation_ind_param_t aiparam;
1821da177e4SLinus Torvalds 
1831da177e4SLinus Torvalds 	/* RFC 2960 3.3.2 Initiation (INIT) (1)
1841da177e4SLinus Torvalds 	 *
1851da177e4SLinus Torvalds 	 * Note 1: The INIT chunks can contain multiple addresses that
1861da177e4SLinus Torvalds 	 * can be IPv4 and/or IPv6 in any combination.
1871da177e4SLinus Torvalds 	 */
1881da177e4SLinus Torvalds 	retval = NULL;
1891da177e4SLinus Torvalds 
1901da177e4SLinus Torvalds 	/* Convert the provided bind address list to raw format. */
1911da177e4SLinus Torvalds 	addrs = sctp_bind_addrs_to_raw(bp, &addrs_len, gfp);
1921da177e4SLinus Torvalds 
1931da177e4SLinus Torvalds 	init.init_tag		   = htonl(asoc->c.my_vtag);
1941da177e4SLinus Torvalds 	init.a_rwnd		   = htonl(asoc->rwnd);
1951da177e4SLinus Torvalds 	init.num_outbound_streams  = htons(asoc->c.sinit_num_ostreams);
1961da177e4SLinus Torvalds 	init.num_inbound_streams   = htons(asoc->c.sinit_max_instreams);
1971da177e4SLinus Torvalds 	init.initial_tsn	   = htonl(asoc->c.initial_tsn);
1981da177e4SLinus Torvalds 
1991da177e4SLinus Torvalds 	/* How many address types are needed? */
2001da177e4SLinus Torvalds 	sp = sctp_sk(asoc->base.sk);
2011da177e4SLinus Torvalds 	num_types = sp->pf->supported_addrs(sp, types);
2021da177e4SLinus Torvalds 
2031da177e4SLinus Torvalds 	chunksize = sizeof(init) + addrs_len + SCTP_SAT_LEN(num_types);
2041da177e4SLinus Torvalds 	chunksize += sizeof(ecap_param);
2051da177e4SLinus Torvalds 	if (sctp_prsctp_enable)
2061da177e4SLinus Torvalds 		chunksize += sizeof(prsctp_param);
2071da177e4SLinus Torvalds 	chunksize += sizeof(aiparam);
2081da177e4SLinus Torvalds 	chunksize += vparam_len;
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds 	/* RFC 2960 3.3.2 Initiation (INIT) (1)
2111da177e4SLinus Torvalds 	 *
2121da177e4SLinus Torvalds 	 * Note 3: An INIT chunk MUST NOT contain more than one Host
2131da177e4SLinus Torvalds 	 * Name address parameter. Moreover, the sender of the INIT
2141da177e4SLinus Torvalds 	 * MUST NOT combine any other address types with the Host Name
2151da177e4SLinus Torvalds 	 * address in the INIT. The receiver of INIT MUST ignore any
2161da177e4SLinus Torvalds 	 * other address types if the Host Name address parameter is
2171da177e4SLinus Torvalds 	 * present in the received INIT chunk.
2181da177e4SLinus Torvalds 	 *
2191da177e4SLinus Torvalds 	 * PLEASE DO NOT FIXME [This version does not support Host Name.]
2201da177e4SLinus Torvalds 	 */
2211da177e4SLinus Torvalds 
2221da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_INIT, 0, chunksize);
2231da177e4SLinus Torvalds 	if (!retval)
2241da177e4SLinus Torvalds 		goto nodata;
2251da177e4SLinus Torvalds 
2261da177e4SLinus Torvalds 	retval->subh.init_hdr =
2271da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(init), &init);
2281da177e4SLinus Torvalds 	retval->param_hdr.v =
2291da177e4SLinus Torvalds 		sctp_addto_chunk(retval, addrs_len, addrs.v);
2301da177e4SLinus Torvalds 
2311da177e4SLinus Torvalds 	/* RFC 2960 3.3.2 Initiation (INIT) (1)
2321da177e4SLinus Torvalds 	 *
2331da177e4SLinus Torvalds 	 * Note 4: This parameter, when present, specifies all the
2341da177e4SLinus Torvalds 	 * address types the sending endpoint can support. The absence
2351da177e4SLinus Torvalds 	 * of this parameter indicates that the sending endpoint can
2361da177e4SLinus Torvalds 	 * support any address type.
2371da177e4SLinus Torvalds 	 */
2381da177e4SLinus Torvalds 	sat.param_hdr.type = SCTP_PARAM_SUPPORTED_ADDRESS_TYPES;
2391da177e4SLinus Torvalds 	sat.param_hdr.length = htons(SCTP_SAT_LEN(num_types));
2401da177e4SLinus Torvalds 	sctp_addto_chunk(retval, sizeof(sat), &sat);
2411da177e4SLinus Torvalds 	sctp_addto_chunk(retval, num_types * sizeof(__u16), &types);
2421da177e4SLinus Torvalds 
2431da177e4SLinus Torvalds 	sctp_addto_chunk(retval, sizeof(ecap_param), &ecap_param);
2441da177e4SLinus Torvalds 	if (sctp_prsctp_enable)
2451da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(prsctp_param), &prsctp_param);
2460f3fffd8SIvan Skytte Jorgensen 	aiparam.param_hdr.type = SCTP_PARAM_ADAPTATION_LAYER_IND;
2471da177e4SLinus Torvalds 	aiparam.param_hdr.length = htons(sizeof(aiparam));
2480f3fffd8SIvan Skytte Jorgensen 	aiparam.adaptation_ind = htonl(sp->adaptation_ind);
2491da177e4SLinus Torvalds 	sctp_addto_chunk(retval, sizeof(aiparam), &aiparam);
2501da177e4SLinus Torvalds nodata:
2511da177e4SLinus Torvalds 	kfree(addrs.v);
2521da177e4SLinus Torvalds 	return retval;
2531da177e4SLinus Torvalds }
2541da177e4SLinus Torvalds 
2551da177e4SLinus Torvalds struct sctp_chunk *sctp_make_init_ack(const struct sctp_association *asoc,
2561da177e4SLinus Torvalds 				 const struct sctp_chunk *chunk,
257dd0fc66fSAl Viro 				 gfp_t gfp, int unkparam_len)
2581da177e4SLinus Torvalds {
2591da177e4SLinus Torvalds 	sctp_inithdr_t initack;
2601da177e4SLinus Torvalds 	struct sctp_chunk *retval;
2611da177e4SLinus Torvalds 	union sctp_params addrs;
2621da177e4SLinus Torvalds 	int addrs_len;
2631da177e4SLinus Torvalds 	sctp_cookie_param_t *cookie;
2641da177e4SLinus Torvalds 	int cookie_len;
2651da177e4SLinus Torvalds 	size_t chunksize;
2660f3fffd8SIvan Skytte Jorgensen 	sctp_adaptation_ind_param_t aiparam;
2671da177e4SLinus Torvalds 
2681da177e4SLinus Torvalds 	retval = NULL;
2691da177e4SLinus Torvalds 
2701da177e4SLinus Torvalds 	/* Note: there may be no addresses to embed. */
2711da177e4SLinus Torvalds 	addrs = sctp_bind_addrs_to_raw(&asoc->base.bind_addr, &addrs_len, gfp);
2721da177e4SLinus Torvalds 
2731da177e4SLinus Torvalds 	initack.init_tag	        = htonl(asoc->c.my_vtag);
2741da177e4SLinus Torvalds 	initack.a_rwnd			= htonl(asoc->rwnd);
2751da177e4SLinus Torvalds 	initack.num_outbound_streams	= htons(asoc->c.sinit_num_ostreams);
2761da177e4SLinus Torvalds 	initack.num_inbound_streams	= htons(asoc->c.sinit_max_instreams);
2771da177e4SLinus Torvalds 	initack.initial_tsn		= htonl(asoc->c.initial_tsn);
2781da177e4SLinus Torvalds 
2791da177e4SLinus Torvalds 	/* FIXME:  We really ought to build the cookie right
2801da177e4SLinus Torvalds 	 * into the packet instead of allocating more fresh memory.
2811da177e4SLinus Torvalds 	 */
2821da177e4SLinus Torvalds 	cookie = sctp_pack_cookie(asoc->ep, asoc, chunk, &cookie_len,
2831da177e4SLinus Torvalds 				  addrs.v, addrs_len);
2841da177e4SLinus Torvalds 	if (!cookie)
2851da177e4SLinus Torvalds 		goto nomem_cookie;
2861da177e4SLinus Torvalds 
2871da177e4SLinus Torvalds 	/* Calculate the total size of allocation, include the reserved
2881da177e4SLinus Torvalds 	 * space for reporting unknown parameters if it is specified.
2891da177e4SLinus Torvalds 	 */
2901da177e4SLinus Torvalds 	chunksize = sizeof(initack) + addrs_len + cookie_len + unkparam_len;
2911da177e4SLinus Torvalds 
2921da177e4SLinus Torvalds 	/* Tell peer that we'll do ECN only if peer advertised such cap.  */
2931da177e4SLinus Torvalds 	if (asoc->peer.ecn_capable)
2941da177e4SLinus Torvalds 		chunksize += sizeof(ecap_param);
2951da177e4SLinus Torvalds 
2961da177e4SLinus Torvalds 	/* Tell peer that we'll do PR-SCTP only if peer advertised.  */
2971da177e4SLinus Torvalds 	if (asoc->peer.prsctp_capable)
2981da177e4SLinus Torvalds 		chunksize += sizeof(prsctp_param);
2991da177e4SLinus Torvalds 
3001da177e4SLinus Torvalds 	chunksize += sizeof(aiparam);
3011da177e4SLinus Torvalds 
3021da177e4SLinus Torvalds 	/* Now allocate and fill out the chunk.  */
3031da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_INIT_ACK, 0, chunksize);
3041da177e4SLinus Torvalds 	if (!retval)
3051da177e4SLinus Torvalds 		goto nomem_chunk;
3061da177e4SLinus Torvalds 
3071da177e4SLinus Torvalds 	/* Per the advice in RFC 2960 6.4, send this reply to
3081da177e4SLinus Torvalds 	 * the source of the INIT packet.
3091da177e4SLinus Torvalds 	 */
3101da177e4SLinus Torvalds 	retval->transport = chunk->transport;
3111da177e4SLinus Torvalds 	retval->subh.init_hdr =
3121da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(initack), &initack);
3131da177e4SLinus Torvalds 	retval->param_hdr.v = sctp_addto_chunk(retval, addrs_len, addrs.v);
3141da177e4SLinus Torvalds 	sctp_addto_chunk(retval, cookie_len, cookie);
3151da177e4SLinus Torvalds 	if (asoc->peer.ecn_capable)
3161da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(ecap_param), &ecap_param);
3171da177e4SLinus Torvalds 	if (asoc->peer.prsctp_capable)
3181da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(prsctp_param), &prsctp_param);
3191da177e4SLinus Torvalds 
3200f3fffd8SIvan Skytte Jorgensen 	aiparam.param_hdr.type = SCTP_PARAM_ADAPTATION_LAYER_IND;
3211da177e4SLinus Torvalds 	aiparam.param_hdr.length = htons(sizeof(aiparam));
3220f3fffd8SIvan Skytte Jorgensen 	aiparam.adaptation_ind = htonl(sctp_sk(asoc->base.sk)->adaptation_ind);
3231da177e4SLinus Torvalds 	sctp_addto_chunk(retval, sizeof(aiparam), &aiparam);
3241da177e4SLinus Torvalds 
3251da177e4SLinus Torvalds 	/* We need to remove the const qualifier at this point.  */
3261da177e4SLinus Torvalds 	retval->asoc = (struct sctp_association *) asoc;
3271da177e4SLinus Torvalds 
3281da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
3291da177e4SLinus Torvalds 	 *
3301da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
3311da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
3321da177e4SLinus Torvalds 	 * address from which it received the DATA or control chunk
3331da177e4SLinus Torvalds 	 * to which it is replying.
3341da177e4SLinus Torvalds 	 *
3351da177e4SLinus Torvalds 	 * [INIT ACK back to where the INIT came from.]
3361da177e4SLinus Torvalds 	 */
3371da177e4SLinus Torvalds 	if (chunk)
3381da177e4SLinus Torvalds 		retval->transport = chunk->transport;
3391da177e4SLinus Torvalds 
3401da177e4SLinus Torvalds nomem_chunk:
3411da177e4SLinus Torvalds 	kfree(cookie);
3421da177e4SLinus Torvalds nomem_cookie:
3431da177e4SLinus Torvalds 	kfree(addrs.v);
3441da177e4SLinus Torvalds 	return retval;
3451da177e4SLinus Torvalds }
3461da177e4SLinus Torvalds 
3471da177e4SLinus Torvalds /* 3.3.11 Cookie Echo (COOKIE ECHO) (10):
3481da177e4SLinus Torvalds  *
3491da177e4SLinus Torvalds  * This chunk is used only during the initialization of an association.
3501da177e4SLinus Torvalds  * It is sent by the initiator of an association to its peer to complete
3511da177e4SLinus Torvalds  * the initialization process. This chunk MUST precede any DATA chunk
3521da177e4SLinus Torvalds  * sent within the association, but MAY be bundled with one or more DATA
3531da177e4SLinus Torvalds  * chunks in the same packet.
3541da177e4SLinus Torvalds  *
3551da177e4SLinus Torvalds  *      0                   1                   2                   3
3561da177e4SLinus Torvalds  *      0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
3571da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
3581da177e4SLinus Torvalds  *     |   Type = 10   |Chunk  Flags   |         Length                |
3591da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
3601da177e4SLinus Torvalds  *     /                     Cookie                                    /
3611da177e4SLinus Torvalds  *     \                                                               \
3621da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
3631da177e4SLinus Torvalds  *
3641da177e4SLinus Torvalds  * Chunk Flags: 8 bit
3651da177e4SLinus Torvalds  *
3661da177e4SLinus Torvalds  *   Set to zero on transmit and ignored on receipt.
3671da177e4SLinus Torvalds  *
3681da177e4SLinus Torvalds  * Length: 16 bits (unsigned integer)
3691da177e4SLinus Torvalds  *
3701da177e4SLinus Torvalds  *   Set to the size of the chunk in bytes, including the 4 bytes of
3711da177e4SLinus Torvalds  *   the chunk header and the size of the Cookie.
3721da177e4SLinus Torvalds  *
3731da177e4SLinus Torvalds  * Cookie: variable size
3741da177e4SLinus Torvalds  *
3751da177e4SLinus Torvalds  *   This field must contain the exact cookie received in the
3761da177e4SLinus Torvalds  *   State Cookie parameter from the previous INIT ACK.
3771da177e4SLinus Torvalds  *
3781da177e4SLinus Torvalds  *   An implementation SHOULD make the cookie as small as possible
3791da177e4SLinus Torvalds  *   to insure interoperability.
3801da177e4SLinus Torvalds  */
3811da177e4SLinus Torvalds struct sctp_chunk *sctp_make_cookie_echo(const struct sctp_association *asoc,
3821da177e4SLinus Torvalds 				    const struct sctp_chunk *chunk)
3831da177e4SLinus Torvalds {
3841da177e4SLinus Torvalds 	struct sctp_chunk *retval;
3851da177e4SLinus Torvalds 	void *cookie;
3861da177e4SLinus Torvalds 	int cookie_len;
3871da177e4SLinus Torvalds 
3881da177e4SLinus Torvalds 	cookie = asoc->peer.cookie;
3891da177e4SLinus Torvalds 	cookie_len = asoc->peer.cookie_len;
3901da177e4SLinus Torvalds 
3911da177e4SLinus Torvalds 	/* Build a cookie echo chunk.  */
3921da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_COOKIE_ECHO, 0, cookie_len);
3931da177e4SLinus Torvalds 	if (!retval)
3941da177e4SLinus Torvalds 		goto nodata;
3951da177e4SLinus Torvalds 	retval->subh.cookie_hdr =
3961da177e4SLinus Torvalds 		sctp_addto_chunk(retval, cookie_len, cookie);
3971da177e4SLinus Torvalds 
3981da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
3991da177e4SLinus Torvalds 	 *
4001da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
4011da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
4021da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
4031da177e4SLinus Torvalds 	 * to which it is replying.
4041da177e4SLinus Torvalds 	 *
4051da177e4SLinus Torvalds 	 * [COOKIE ECHO back to where the INIT ACK came from.]
4061da177e4SLinus Torvalds 	 */
4071da177e4SLinus Torvalds 	if (chunk)
4081da177e4SLinus Torvalds 		retval->transport = chunk->transport;
4091da177e4SLinus Torvalds 
4101da177e4SLinus Torvalds nodata:
4111da177e4SLinus Torvalds 	return retval;
4121da177e4SLinus Torvalds }
4131da177e4SLinus Torvalds 
4141da177e4SLinus Torvalds /* 3.3.12 Cookie Acknowledgement (COOKIE ACK) (11):
4151da177e4SLinus Torvalds  *
4161da177e4SLinus Torvalds  * This chunk is used only during the initialization of an
4171da177e4SLinus Torvalds  * association.  It is used to acknowledge the receipt of a COOKIE
4181da177e4SLinus Torvalds  * ECHO chunk.  This chunk MUST precede any DATA or SACK chunk sent
4191da177e4SLinus Torvalds  * within the association, but MAY be bundled with one or more DATA
4201da177e4SLinus Torvalds  * chunks or SACK chunk in the same SCTP packet.
4211da177e4SLinus Torvalds  *
4221da177e4SLinus Torvalds  *      0                   1                   2                   3
4231da177e4SLinus Torvalds  *      0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
4241da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
4251da177e4SLinus Torvalds  *     |   Type = 11   |Chunk  Flags   |     Length = 4                |
4261da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
4271da177e4SLinus Torvalds  *
4281da177e4SLinus Torvalds  * Chunk Flags: 8 bits
4291da177e4SLinus Torvalds  *
4301da177e4SLinus Torvalds  *   Set to zero on transmit and ignored on receipt.
4311da177e4SLinus Torvalds  */
4321da177e4SLinus Torvalds struct sctp_chunk *sctp_make_cookie_ack(const struct sctp_association *asoc,
4331da177e4SLinus Torvalds 				   const struct sctp_chunk *chunk)
4341da177e4SLinus Torvalds {
4351da177e4SLinus Torvalds 	struct sctp_chunk *retval;
4361da177e4SLinus Torvalds 
4371da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_COOKIE_ACK, 0, 0);
4381da177e4SLinus Torvalds 
4391da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
4401da177e4SLinus Torvalds 	 *
4411da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
4421da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
4431da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
4441da177e4SLinus Torvalds 	 * to which it is replying.
4451da177e4SLinus Torvalds 	 *
4461da177e4SLinus Torvalds 	 * [COOKIE ACK back to where the COOKIE ECHO came from.]
4471da177e4SLinus Torvalds 	 */
4481da177e4SLinus Torvalds 	if (retval && chunk)
4491da177e4SLinus Torvalds 		retval->transport = chunk->transport;
4501da177e4SLinus Torvalds 
4511da177e4SLinus Torvalds 	return retval;
4521da177e4SLinus Torvalds }
4531da177e4SLinus Torvalds 
4541da177e4SLinus Torvalds /*
4551da177e4SLinus Torvalds  *  Appendix A: Explicit Congestion Notification:
4561da177e4SLinus Torvalds  *  CWR:
4571da177e4SLinus Torvalds  *
4581da177e4SLinus Torvalds  *  RFC 2481 details a specific bit for a sender to send in the header of
4591da177e4SLinus Torvalds  *  its next outbound TCP segment to indicate to its peer that it has
4601da177e4SLinus Torvalds  *  reduced its congestion window.  This is termed the CWR bit.  For
4611da177e4SLinus Torvalds  *  SCTP the same indication is made by including the CWR chunk.
4621da177e4SLinus Torvalds  *  This chunk contains one data element, i.e. the TSN number that
4631da177e4SLinus Torvalds  *  was sent in the ECNE chunk.  This element represents the lowest
4641da177e4SLinus Torvalds  *  TSN number in the datagram that was originally marked with the
4651da177e4SLinus Torvalds  *  CE bit.
4661da177e4SLinus Torvalds  *
4671da177e4SLinus Torvalds  *     0                   1                   2                   3
4681da177e4SLinus Torvalds  *     0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
4691da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
4701da177e4SLinus Torvalds  *    | Chunk Type=13 | Flags=00000000|    Chunk Length = 8           |
4711da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
4721da177e4SLinus Torvalds  *    |                      Lowest TSN Number                        |
4731da177e4SLinus Torvalds  *    +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
4741da177e4SLinus Torvalds  *
4751da177e4SLinus Torvalds  *     Note: The CWR is considered a Control chunk.
4761da177e4SLinus Torvalds  */
4771da177e4SLinus Torvalds struct sctp_chunk *sctp_make_cwr(const struct sctp_association *asoc,
4781da177e4SLinus Torvalds 			    const __u32 lowest_tsn,
4791da177e4SLinus Torvalds 			    const struct sctp_chunk *chunk)
4801da177e4SLinus Torvalds {
4811da177e4SLinus Torvalds 	struct sctp_chunk *retval;
4821da177e4SLinus Torvalds 	sctp_cwrhdr_t cwr;
4831da177e4SLinus Torvalds 
4841da177e4SLinus Torvalds 	cwr.lowest_tsn = htonl(lowest_tsn);
4851da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_ECN_CWR, 0,
4861da177e4SLinus Torvalds 				 sizeof(sctp_cwrhdr_t));
4871da177e4SLinus Torvalds 
4881da177e4SLinus Torvalds 	if (!retval)
4891da177e4SLinus Torvalds 		goto nodata;
4901da177e4SLinus Torvalds 
4911da177e4SLinus Torvalds 	retval->subh.ecn_cwr_hdr =
4921da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(cwr), &cwr);
4931da177e4SLinus Torvalds 
4941da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
4951da177e4SLinus Torvalds 	 *
4961da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
4971da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
4981da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
4991da177e4SLinus Torvalds 	 * to which it is replying.
5001da177e4SLinus Torvalds 	 *
5011da177e4SLinus Torvalds 	 * [Report a reduced congestion window back to where the ECNE
5021da177e4SLinus Torvalds 	 * came from.]
5031da177e4SLinus Torvalds 	 */
5041da177e4SLinus Torvalds 	if (chunk)
5051da177e4SLinus Torvalds 		retval->transport = chunk->transport;
5061da177e4SLinus Torvalds 
5071da177e4SLinus Torvalds nodata:
5081da177e4SLinus Torvalds 	return retval;
5091da177e4SLinus Torvalds }
5101da177e4SLinus Torvalds 
5111da177e4SLinus Torvalds /* Make an ECNE chunk.  This is a congestion experienced report.  */
5121da177e4SLinus Torvalds struct sctp_chunk *sctp_make_ecne(const struct sctp_association *asoc,
5131da177e4SLinus Torvalds 			     const __u32 lowest_tsn)
5141da177e4SLinus Torvalds {
5151da177e4SLinus Torvalds 	struct sctp_chunk *retval;
5161da177e4SLinus Torvalds 	sctp_ecnehdr_t ecne;
5171da177e4SLinus Torvalds 
5181da177e4SLinus Torvalds 	ecne.lowest_tsn = htonl(lowest_tsn);
5191da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_ECN_ECNE, 0,
5201da177e4SLinus Torvalds 				 sizeof(sctp_ecnehdr_t));
5211da177e4SLinus Torvalds 	if (!retval)
5221da177e4SLinus Torvalds 		goto nodata;
5231da177e4SLinus Torvalds 	retval->subh.ecne_hdr =
5241da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(ecne), &ecne);
5251da177e4SLinus Torvalds 
5261da177e4SLinus Torvalds nodata:
5271da177e4SLinus Torvalds 	return retval;
5281da177e4SLinus Torvalds }
5291da177e4SLinus Torvalds 
5301da177e4SLinus Torvalds /* Make a DATA chunk for the given association from the provided
5311da177e4SLinus Torvalds  * parameters.  However, do not populate the data payload.
5321da177e4SLinus Torvalds  */
5331da177e4SLinus Torvalds struct sctp_chunk *sctp_make_datafrag_empty(struct sctp_association *asoc,
5341da177e4SLinus Torvalds 				       const struct sctp_sndrcvinfo *sinfo,
5351da177e4SLinus Torvalds 				       int data_len, __u8 flags, __u16 ssn)
5361da177e4SLinus Torvalds {
5371da177e4SLinus Torvalds 	struct sctp_chunk *retval;
5381da177e4SLinus Torvalds 	struct sctp_datahdr dp;
5391da177e4SLinus Torvalds 	int chunk_len;
5401da177e4SLinus Torvalds 
5411da177e4SLinus Torvalds 	/* We assign the TSN as LATE as possible, not here when
5421da177e4SLinus Torvalds 	 * creating the chunk.
5431da177e4SLinus Torvalds 	 */
5441da177e4SLinus Torvalds 	dp.tsn = 0;
5451da177e4SLinus Torvalds 	dp.stream = htons(sinfo->sinfo_stream);
5461da177e4SLinus Torvalds 	dp.ppid   = sinfo->sinfo_ppid;
5471da177e4SLinus Torvalds 
5481da177e4SLinus Torvalds 	/* Set the flags for an unordered send.  */
549eaa5c54dSIvan Skytte Jorgensen 	if (sinfo->sinfo_flags & SCTP_UNORDERED) {
5501da177e4SLinus Torvalds 		flags |= SCTP_DATA_UNORDERED;
5511da177e4SLinus Torvalds 		dp.ssn = 0;
5521da177e4SLinus Torvalds 	} else
5531da177e4SLinus Torvalds 		dp.ssn = htons(ssn);
5541da177e4SLinus Torvalds 
5551da177e4SLinus Torvalds 	chunk_len = sizeof(dp) + data_len;
5561da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_DATA, flags, chunk_len);
5571da177e4SLinus Torvalds 	if (!retval)
5581da177e4SLinus Torvalds 		goto nodata;
5591da177e4SLinus Torvalds 
5601da177e4SLinus Torvalds 	retval->subh.data_hdr = sctp_addto_chunk(retval, sizeof(dp), &dp);
5611da177e4SLinus Torvalds 	memcpy(&retval->sinfo, sinfo, sizeof(struct sctp_sndrcvinfo));
5621da177e4SLinus Torvalds 
5631da177e4SLinus Torvalds nodata:
5641da177e4SLinus Torvalds 	return retval;
5651da177e4SLinus Torvalds }
5661da177e4SLinus Torvalds 
5671da177e4SLinus Torvalds /* Create a selective ackowledgement (SACK) for the given
5681da177e4SLinus Torvalds  * association.  This reports on which TSN's we've seen to date,
5691da177e4SLinus Torvalds  * including duplicates and gaps.
5701da177e4SLinus Torvalds  */
5711da177e4SLinus Torvalds struct sctp_chunk *sctp_make_sack(const struct sctp_association *asoc)
5721da177e4SLinus Torvalds {
5731da177e4SLinus Torvalds 	struct sctp_chunk *retval;
5741da177e4SLinus Torvalds 	struct sctp_sackhdr sack;
5751da177e4SLinus Torvalds 	int len;
5761da177e4SLinus Torvalds 	__u32 ctsn;
5771da177e4SLinus Torvalds 	__u16 num_gabs, num_dup_tsns;
5781da177e4SLinus Torvalds 	struct sctp_tsnmap *map = (struct sctp_tsnmap *)&asoc->peer.tsn_map;
5791da177e4SLinus Torvalds 
5801da177e4SLinus Torvalds 	ctsn = sctp_tsnmap_get_ctsn(map);
5811da177e4SLinus Torvalds 	SCTP_DEBUG_PRINTK("sackCTSNAck sent:  0x%x.\n", ctsn);
5821da177e4SLinus Torvalds 
5831da177e4SLinus Torvalds 	/* How much room is needed in the chunk? */
5841da177e4SLinus Torvalds 	num_gabs = sctp_tsnmap_num_gabs(map);
5851da177e4SLinus Torvalds 	num_dup_tsns = sctp_tsnmap_num_dups(map);
5861da177e4SLinus Torvalds 
5871da177e4SLinus Torvalds 	/* Initialize the SACK header.  */
5881da177e4SLinus Torvalds 	sack.cum_tsn_ack	    = htonl(ctsn);
5891da177e4SLinus Torvalds 	sack.a_rwnd 		    = htonl(asoc->a_rwnd);
5901da177e4SLinus Torvalds 	sack.num_gap_ack_blocks     = htons(num_gabs);
5911da177e4SLinus Torvalds 	sack.num_dup_tsns           = htons(num_dup_tsns);
5921da177e4SLinus Torvalds 
5931da177e4SLinus Torvalds 	len = sizeof(sack)
5941da177e4SLinus Torvalds 		+ sizeof(struct sctp_gap_ack_block) * num_gabs
5951da177e4SLinus Torvalds 		+ sizeof(__u32) * num_dup_tsns;
5961da177e4SLinus Torvalds 
5971da177e4SLinus Torvalds 	/* Create the chunk.  */
5981da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_SACK, 0, len);
5991da177e4SLinus Torvalds 	if (!retval)
6001da177e4SLinus Torvalds 		goto nodata;
6011da177e4SLinus Torvalds 
6021da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
6031da177e4SLinus Torvalds 	 *
6041da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
6051da177e4SLinus Torvalds 	 * HEARTBEAT ACK, etc.) to the same destination transport
6061da177e4SLinus Torvalds 	 * address from which it received the DATA or control chunk to
6071da177e4SLinus Torvalds 	 * which it is replying.  This rule should also be followed if
6081da177e4SLinus Torvalds 	 * the endpoint is bundling DATA chunks together with the
6091da177e4SLinus Torvalds 	 * reply chunk.
6101da177e4SLinus Torvalds 	 *
6111da177e4SLinus Torvalds 	 * However, when acknowledging multiple DATA chunks received
6121da177e4SLinus Torvalds 	 * in packets from different source addresses in a single
6131da177e4SLinus Torvalds 	 * SACK, the SACK chunk may be transmitted to one of the
6141da177e4SLinus Torvalds 	 * destination transport addresses from which the DATA or
6151da177e4SLinus Torvalds 	 * control chunks being acknowledged were received.
6161da177e4SLinus Torvalds 	 *
6171da177e4SLinus Torvalds 	 * [BUG:  We do not implement the following paragraph.
6181da177e4SLinus Torvalds 	 * Perhaps we should remember the last transport we used for a
6191da177e4SLinus Torvalds 	 * SACK and avoid that (if possible) if we have seen any
6201da177e4SLinus Torvalds 	 * duplicates. --piggy]
6211da177e4SLinus Torvalds 	 *
6221da177e4SLinus Torvalds 	 * When a receiver of a duplicate DATA chunk sends a SACK to a
6231da177e4SLinus Torvalds 	 * multi- homed endpoint it MAY be beneficial to vary the
6241da177e4SLinus Torvalds 	 * destination address and not use the source address of the
6251da177e4SLinus Torvalds 	 * DATA chunk.  The reason being that receiving a duplicate
6261da177e4SLinus Torvalds 	 * from a multi-homed endpoint might indicate that the return
6271da177e4SLinus Torvalds 	 * path (as specified in the source address of the DATA chunk)
6281da177e4SLinus Torvalds 	 * for the SACK is broken.
6291da177e4SLinus Torvalds 	 *
6301da177e4SLinus Torvalds 	 * [Send to the address from which we last received a DATA chunk.]
6311da177e4SLinus Torvalds 	 */
6321da177e4SLinus Torvalds 	retval->transport = asoc->peer.last_data_from;
6331da177e4SLinus Torvalds 
6341da177e4SLinus Torvalds 	retval->subh.sack_hdr =
6351da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(sack), &sack);
6361da177e4SLinus Torvalds 
6371da177e4SLinus Torvalds 	/* Add the gap ack block information.   */
6381da177e4SLinus Torvalds 	if (num_gabs)
6391da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(__u32) * num_gabs,
6401da177e4SLinus Torvalds 				 sctp_tsnmap_get_gabs(map));
6411da177e4SLinus Torvalds 
6421da177e4SLinus Torvalds 	/* Add the duplicate TSN information.  */
6431da177e4SLinus Torvalds 	if (num_dup_tsns)
6441da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(__u32) * num_dup_tsns,
6451da177e4SLinus Torvalds 				 sctp_tsnmap_get_dups(map));
6461da177e4SLinus Torvalds 
6471da177e4SLinus Torvalds nodata:
6481da177e4SLinus Torvalds 	return retval;
6491da177e4SLinus Torvalds }
6501da177e4SLinus Torvalds 
6511da177e4SLinus Torvalds /* Make a SHUTDOWN chunk. */
6521da177e4SLinus Torvalds struct sctp_chunk *sctp_make_shutdown(const struct sctp_association *asoc,
6531da177e4SLinus Torvalds 				      const struct sctp_chunk *chunk)
6541da177e4SLinus Torvalds {
6551da177e4SLinus Torvalds 	struct sctp_chunk *retval;
6561da177e4SLinus Torvalds 	sctp_shutdownhdr_t shut;
6571da177e4SLinus Torvalds 	__u32 ctsn;
6581da177e4SLinus Torvalds 
6591da177e4SLinus Torvalds 	ctsn = sctp_tsnmap_get_ctsn(&asoc->peer.tsn_map);
6601da177e4SLinus Torvalds 	shut.cum_tsn_ack = htonl(ctsn);
6611da177e4SLinus Torvalds 
6621da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_SHUTDOWN, 0,
6631da177e4SLinus Torvalds 				 sizeof(sctp_shutdownhdr_t));
6641da177e4SLinus Torvalds 	if (!retval)
6651da177e4SLinus Torvalds 		goto nodata;
6661da177e4SLinus Torvalds 
6671da177e4SLinus Torvalds 	retval->subh.shutdown_hdr =
6681da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(shut), &shut);
6691da177e4SLinus Torvalds 
6701da177e4SLinus Torvalds 	if (chunk)
6711da177e4SLinus Torvalds 		retval->transport = chunk->transport;
6721da177e4SLinus Torvalds nodata:
6731da177e4SLinus Torvalds 	return retval;
6741da177e4SLinus Torvalds }
6751da177e4SLinus Torvalds 
6761da177e4SLinus Torvalds struct sctp_chunk *sctp_make_shutdown_ack(const struct sctp_association *asoc,
6771da177e4SLinus Torvalds 				     const struct sctp_chunk *chunk)
6781da177e4SLinus Torvalds {
6791da177e4SLinus Torvalds 	struct sctp_chunk *retval;
6801da177e4SLinus Torvalds 
6811da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_SHUTDOWN_ACK, 0, 0);
6821da177e4SLinus Torvalds 
6831da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
6841da177e4SLinus Torvalds 	 *
6851da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
6861da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
6871da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
6881da177e4SLinus Torvalds 	 * to which it is replying.
6891da177e4SLinus Torvalds 	 *
6901da177e4SLinus Torvalds 	 * [ACK back to where the SHUTDOWN came from.]
6911da177e4SLinus Torvalds 	 */
6921da177e4SLinus Torvalds 	if (retval && chunk)
6931da177e4SLinus Torvalds 		retval->transport = chunk->transport;
6941da177e4SLinus Torvalds 
6951da177e4SLinus Torvalds 	return retval;
6961da177e4SLinus Torvalds }
6971da177e4SLinus Torvalds 
6981da177e4SLinus Torvalds struct sctp_chunk *sctp_make_shutdown_complete(
6991da177e4SLinus Torvalds 	const struct sctp_association *asoc,
7001da177e4SLinus Torvalds 	const struct sctp_chunk *chunk)
7011da177e4SLinus Torvalds {
7021da177e4SLinus Torvalds 	struct sctp_chunk *retval;
7031da177e4SLinus Torvalds 	__u8 flags = 0;
7041da177e4SLinus Torvalds 
705047a2428SJerome Forissier 	/* Set the T-bit if we have no association (vtag will be
706047a2428SJerome Forissier 	 * reflected)
707047a2428SJerome Forissier 	 */
7081da177e4SLinus Torvalds 	flags |= asoc ? 0 : SCTP_CHUNK_FLAG_T;
7091da177e4SLinus Torvalds 
7101da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_SHUTDOWN_COMPLETE, flags, 0);
7111da177e4SLinus Torvalds 
7121da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
7131da177e4SLinus Torvalds 	 *
7141da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
7151da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
7161da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
7171da177e4SLinus Torvalds 	 * to which it is replying.
7181da177e4SLinus Torvalds 	 *
7191da177e4SLinus Torvalds 	 * [Report SHUTDOWN COMPLETE back to where the SHUTDOWN ACK
7201da177e4SLinus Torvalds 	 * came from.]
7211da177e4SLinus Torvalds 	 */
7221da177e4SLinus Torvalds 	if (retval && chunk)
7231da177e4SLinus Torvalds 		retval->transport = chunk->transport;
7241da177e4SLinus Torvalds 
7251da177e4SLinus Torvalds 	return retval;
7261da177e4SLinus Torvalds }
7271da177e4SLinus Torvalds 
7281da177e4SLinus Torvalds /* Create an ABORT.  Note that we set the T bit if we have no
729047a2428SJerome Forissier  * association, except when responding to an INIT (sctpimpguide 2.41).
7301da177e4SLinus Torvalds  */
7311da177e4SLinus Torvalds struct sctp_chunk *sctp_make_abort(const struct sctp_association *asoc,
7321da177e4SLinus Torvalds 			      const struct sctp_chunk *chunk,
7331da177e4SLinus Torvalds 			      const size_t hint)
7341da177e4SLinus Torvalds {
7351da177e4SLinus Torvalds 	struct sctp_chunk *retval;
7361da177e4SLinus Torvalds 	__u8 flags = 0;
7371da177e4SLinus Torvalds 
738047a2428SJerome Forissier 	/* Set the T-bit if we have no association and 'chunk' is not
739047a2428SJerome Forissier 	 * an INIT (vtag will be reflected).
740047a2428SJerome Forissier 	 */
741047a2428SJerome Forissier 	if (!asoc) {
742047a2428SJerome Forissier 		if (chunk && chunk->chunk_hdr &&
743047a2428SJerome Forissier 		    chunk->chunk_hdr->type == SCTP_CID_INIT)
744047a2428SJerome Forissier 			flags = 0;
745047a2428SJerome Forissier 		else
746047a2428SJerome Forissier 			flags = SCTP_CHUNK_FLAG_T;
747047a2428SJerome Forissier 	}
7481da177e4SLinus Torvalds 
7491da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_ABORT, flags, hint);
7501da177e4SLinus Torvalds 
7511da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
7521da177e4SLinus Torvalds 	 *
7531da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
7541da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
7551da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
7561da177e4SLinus Torvalds 	 * to which it is replying.
7571da177e4SLinus Torvalds 	 *
7581da177e4SLinus Torvalds 	 * [ABORT back to where the offender came from.]
7591da177e4SLinus Torvalds 	 */
7601da177e4SLinus Torvalds 	if (retval && chunk)
7611da177e4SLinus Torvalds 		retval->transport = chunk->transport;
7621da177e4SLinus Torvalds 
7631da177e4SLinus Torvalds 	return retval;
7641da177e4SLinus Torvalds }
7651da177e4SLinus Torvalds 
7661da177e4SLinus Torvalds /* Helper to create ABORT with a NO_USER_DATA error.  */
7671da177e4SLinus Torvalds struct sctp_chunk *sctp_make_abort_no_data(
7681da177e4SLinus Torvalds 	const struct sctp_association *asoc,
7691da177e4SLinus Torvalds 	const struct sctp_chunk *chunk, __u32 tsn)
7701da177e4SLinus Torvalds {
7711da177e4SLinus Torvalds 	struct sctp_chunk *retval;
7729f81bcd9SAl Viro 	__be32 payload;
7731da177e4SLinus Torvalds 
7741da177e4SLinus Torvalds 	retval = sctp_make_abort(asoc, chunk, sizeof(sctp_errhdr_t)
7751da177e4SLinus Torvalds 				 + sizeof(tsn));
7761da177e4SLinus Torvalds 
7771da177e4SLinus Torvalds 	if (!retval)
7781da177e4SLinus Torvalds 		goto no_mem;
7791da177e4SLinus Torvalds 
7801da177e4SLinus Torvalds 	/* Put the tsn back into network byte order.  */
7811da177e4SLinus Torvalds 	payload = htonl(tsn);
78200f1c2dfSWei Yongjun 	sctp_init_cause(retval, SCTP_ERROR_NO_DATA, sizeof(payload));
78300f1c2dfSWei Yongjun 	sctp_addto_chunk(retval, sizeof(payload), (const void *)&payload);
7841da177e4SLinus Torvalds 
7851da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
7861da177e4SLinus Torvalds 	 *
7871da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
7881da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
7891da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
7901da177e4SLinus Torvalds 	 * to which it is replying.
7911da177e4SLinus Torvalds 	 *
7921da177e4SLinus Torvalds 	 * [ABORT back to where the offender came from.]
7931da177e4SLinus Torvalds 	 */
7941da177e4SLinus Torvalds 	if (chunk)
7951da177e4SLinus Torvalds 		retval->transport = chunk->transport;
7961da177e4SLinus Torvalds 
7971da177e4SLinus Torvalds no_mem:
7981da177e4SLinus Torvalds 	return retval;
7991da177e4SLinus Torvalds }
8001da177e4SLinus Torvalds 
8011da177e4SLinus Torvalds /* Helper to create ABORT with a SCTP_ERROR_USER_ABORT error.  */
8021da177e4SLinus Torvalds struct sctp_chunk *sctp_make_abort_user(const struct sctp_association *asoc,
803c164a9baSSridhar Samudrala 					const struct msghdr *msg,
804c164a9baSSridhar Samudrala 					size_t paylen)
8051da177e4SLinus Torvalds {
8061da177e4SLinus Torvalds 	struct sctp_chunk *retval;
807c164a9baSSridhar Samudrala 	void *payload = NULL;
808c164a9baSSridhar Samudrala 	int err;
8091da177e4SLinus Torvalds 
810c164a9baSSridhar Samudrala 	retval = sctp_make_abort(asoc, NULL, sizeof(sctp_errhdr_t) + paylen);
8111da177e4SLinus Torvalds 	if (!retval)
8121da177e4SLinus Torvalds 		goto err_chunk;
8131da177e4SLinus Torvalds 
8141da177e4SLinus Torvalds 	if (paylen) {
8151da177e4SLinus Torvalds 		/* Put the msg_iov together into payload.  */
816c164a9baSSridhar Samudrala 		payload = kmalloc(paylen, GFP_KERNEL);
8171da177e4SLinus Torvalds 		if (!payload)
8181da177e4SLinus Torvalds 			goto err_payload;
8191da177e4SLinus Torvalds 
820c164a9baSSridhar Samudrala 		err = memcpy_fromiovec(payload, msg->msg_iov, paylen);
821c164a9baSSridhar Samudrala 		if (err < 0)
8221da177e4SLinus Torvalds 			goto err_copy;
8231da177e4SLinus Torvalds 	}
8241da177e4SLinus Torvalds 
82500f1c2dfSWei Yongjun 	sctp_init_cause(retval, SCTP_ERROR_USER_ABORT, paylen);
82600f1c2dfSWei Yongjun 	sctp_addto_chunk(retval, paylen, payload);
8271da177e4SLinus Torvalds 
8281da177e4SLinus Torvalds 	if (paylen)
8291da177e4SLinus Torvalds 		kfree(payload);
8301da177e4SLinus Torvalds 
8311da177e4SLinus Torvalds 	return retval;
8321da177e4SLinus Torvalds 
8331da177e4SLinus Torvalds err_copy:
8341da177e4SLinus Torvalds 	kfree(payload);
8351da177e4SLinus Torvalds err_payload:
8361da177e4SLinus Torvalds 	sctp_chunk_free(retval);
8371da177e4SLinus Torvalds 	retval = NULL;
8381da177e4SLinus Torvalds err_chunk:
8391da177e4SLinus Torvalds 	return retval;
8401da177e4SLinus Torvalds }
8411da177e4SLinus Torvalds 
8421da177e4SLinus Torvalds /* Make an ABORT chunk with a PROTOCOL VIOLATION cause code. */
8431da177e4SLinus Torvalds struct sctp_chunk *sctp_make_abort_violation(
8441da177e4SLinus Torvalds 	const struct sctp_association *asoc,
8451da177e4SLinus Torvalds 	const struct sctp_chunk *chunk,
8461da177e4SLinus Torvalds 	const __u8   *payload,
8471da177e4SLinus Torvalds 	const size_t paylen)
8481da177e4SLinus Torvalds {
8491da177e4SLinus Torvalds 	struct sctp_chunk  *retval;
8501da177e4SLinus Torvalds 	struct sctp_paramhdr phdr;
8511da177e4SLinus Torvalds 
8521da177e4SLinus Torvalds 	retval = sctp_make_abort(asoc, chunk, sizeof(sctp_errhdr_t) + paylen
85300f1c2dfSWei Yongjun 					+ sizeof(sctp_paramhdr_t));
8541da177e4SLinus Torvalds 	if (!retval)
8551da177e4SLinus Torvalds 		goto end;
8561da177e4SLinus Torvalds 
85700f1c2dfSWei Yongjun 	sctp_init_cause(retval, SCTP_ERROR_PROTO_VIOLATION, paylen
85800f1c2dfSWei Yongjun 					+ sizeof(sctp_paramhdr_t));
8591da177e4SLinus Torvalds 
8601da177e4SLinus Torvalds 	phdr.type = htons(chunk->chunk_hdr->type);
8611da177e4SLinus Torvalds 	phdr.length = chunk->chunk_hdr->length;
86200f1c2dfSWei Yongjun 	sctp_addto_chunk(retval, paylen, payload);
86300f1c2dfSWei Yongjun 	sctp_addto_param(retval, sizeof(sctp_paramhdr_t), &phdr);
8641da177e4SLinus Torvalds 
8651da177e4SLinus Torvalds end:
8661da177e4SLinus Torvalds 	return retval;
8671da177e4SLinus Torvalds }
8681da177e4SLinus Torvalds 
8691da177e4SLinus Torvalds /* Make a HEARTBEAT chunk.  */
8701da177e4SLinus Torvalds struct sctp_chunk *sctp_make_heartbeat(const struct sctp_association *asoc,
8711da177e4SLinus Torvalds 				  const struct sctp_transport *transport,
8721da177e4SLinus Torvalds 				  const void *payload, const size_t paylen)
8731da177e4SLinus Torvalds {
8741da177e4SLinus Torvalds 	struct sctp_chunk *retval = sctp_make_chunk(asoc, SCTP_CID_HEARTBEAT,
8751da177e4SLinus Torvalds 						    0, paylen);
8761da177e4SLinus Torvalds 
8771da177e4SLinus Torvalds 	if (!retval)
8781da177e4SLinus Torvalds 		goto nodata;
8791da177e4SLinus Torvalds 
8801da177e4SLinus Torvalds 	/* Cast away the 'const', as this is just telling the chunk
8811da177e4SLinus Torvalds 	 * what transport it belongs to.
8821da177e4SLinus Torvalds 	 */
8831da177e4SLinus Torvalds 	retval->transport = (struct sctp_transport *) transport;
8841da177e4SLinus Torvalds 	retval->subh.hbs_hdr = sctp_addto_chunk(retval, paylen, payload);
8851da177e4SLinus Torvalds 
8861da177e4SLinus Torvalds nodata:
8871da177e4SLinus Torvalds 	return retval;
8881da177e4SLinus Torvalds }
8891da177e4SLinus Torvalds 
8901da177e4SLinus Torvalds struct sctp_chunk *sctp_make_heartbeat_ack(const struct sctp_association *asoc,
8911da177e4SLinus Torvalds 				      const struct sctp_chunk *chunk,
8921da177e4SLinus Torvalds 				      const void *payload, const size_t paylen)
8931da177e4SLinus Torvalds {
8941da177e4SLinus Torvalds 	struct sctp_chunk *retval;
8951da177e4SLinus Torvalds 
8961da177e4SLinus Torvalds 	retval  = sctp_make_chunk(asoc, SCTP_CID_HEARTBEAT_ACK, 0, paylen);
8971da177e4SLinus Torvalds 	if (!retval)
8981da177e4SLinus Torvalds 		goto nodata;
8991da177e4SLinus Torvalds 
9001da177e4SLinus Torvalds 	retval->subh.hbs_hdr = sctp_addto_chunk(retval, paylen, payload);
9011da177e4SLinus Torvalds 
9021da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
9031da177e4SLinus Torvalds 	 *
9041da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
9051da177e4SLinus Torvalds 	 * HEARTBEAT ACK, * etc.) to the same destination transport
9061da177e4SLinus Torvalds 	 * address from which it * received the DATA or control chunk
9071da177e4SLinus Torvalds 	 * to which it is replying.
9081da177e4SLinus Torvalds 	 *
9091da177e4SLinus Torvalds 	 * [HBACK back to where the HEARTBEAT came from.]
9101da177e4SLinus Torvalds 	 */
9111da177e4SLinus Torvalds 	if (chunk)
9121da177e4SLinus Torvalds 		retval->transport = chunk->transport;
9131da177e4SLinus Torvalds 
9141da177e4SLinus Torvalds nodata:
9151da177e4SLinus Torvalds 	return retval;
9161da177e4SLinus Torvalds }
9171da177e4SLinus Torvalds 
9181da177e4SLinus Torvalds /* Create an Operation Error chunk with the specified space reserved.
9191da177e4SLinus Torvalds  * This routine can be used for containing multiple causes in the chunk.
9201da177e4SLinus Torvalds  */
9211da177e4SLinus Torvalds static struct sctp_chunk *sctp_make_op_error_space(
9221da177e4SLinus Torvalds 	const struct sctp_association *asoc,
9231da177e4SLinus Torvalds 	const struct sctp_chunk *chunk,
9241da177e4SLinus Torvalds 	size_t size)
9251da177e4SLinus Torvalds {
9261da177e4SLinus Torvalds 	struct sctp_chunk *retval;
9271da177e4SLinus Torvalds 
9281da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_ERROR, 0,
9291da177e4SLinus Torvalds 				 sizeof(sctp_errhdr_t) + size);
9301da177e4SLinus Torvalds 	if (!retval)
9311da177e4SLinus Torvalds 		goto nodata;
9321da177e4SLinus Torvalds 
9331da177e4SLinus Torvalds 	/* RFC 2960 6.4 Multi-homed SCTP Endpoints
9341da177e4SLinus Torvalds 	 *
9351da177e4SLinus Torvalds 	 * An endpoint SHOULD transmit reply chunks (e.g., SACK,
9361da177e4SLinus Torvalds 	 * HEARTBEAT ACK, etc.) to the same destination transport
9371da177e4SLinus Torvalds 	 * address from which it received the DATA or control chunk
9381da177e4SLinus Torvalds 	 * to which it is replying.
9391da177e4SLinus Torvalds 	 *
9401da177e4SLinus Torvalds 	 */
9411da177e4SLinus Torvalds 	if (chunk)
9421da177e4SLinus Torvalds 		retval->transport = chunk->transport;
9431da177e4SLinus Torvalds 
9441da177e4SLinus Torvalds nodata:
9451da177e4SLinus Torvalds 	return retval;
9461da177e4SLinus Torvalds }
9471da177e4SLinus Torvalds 
9481da177e4SLinus Torvalds /* Create an Operation Error chunk.  */
9491da177e4SLinus Torvalds struct sctp_chunk *sctp_make_op_error(const struct sctp_association *asoc,
9501da177e4SLinus Torvalds 				 const struct sctp_chunk *chunk,
95163706c5cSAl Viro 				 __be16 cause_code, const void *payload,
9521da177e4SLinus Torvalds 				 size_t paylen)
9531da177e4SLinus Torvalds {
9541da177e4SLinus Torvalds 	struct sctp_chunk *retval;
9551da177e4SLinus Torvalds 
9561da177e4SLinus Torvalds 	retval = sctp_make_op_error_space(asoc, chunk, paylen);
9571da177e4SLinus Torvalds 	if (!retval)
9581da177e4SLinus Torvalds 		goto nodata;
9591da177e4SLinus Torvalds 
96000f1c2dfSWei Yongjun 	sctp_init_cause(retval, cause_code, paylen);
96100f1c2dfSWei Yongjun 	sctp_addto_chunk(retval, paylen, payload);
9621da177e4SLinus Torvalds 
9631da177e4SLinus Torvalds nodata:
9641da177e4SLinus Torvalds 	return retval;
9651da177e4SLinus Torvalds }
9661da177e4SLinus Torvalds 
9671da177e4SLinus Torvalds /********************************************************************
9681da177e4SLinus Torvalds  * 2nd Level Abstractions
9691da177e4SLinus Torvalds  ********************************************************************/
9701da177e4SLinus Torvalds 
9711da177e4SLinus Torvalds /* Turn an skb into a chunk.
9721da177e4SLinus Torvalds  * FIXME: Eventually move the structure directly inside the skb->cb[].
9731da177e4SLinus Torvalds  */
9741da177e4SLinus Torvalds struct sctp_chunk *sctp_chunkify(struct sk_buff *skb,
9751da177e4SLinus Torvalds 			    const struct sctp_association *asoc,
9761da177e4SLinus Torvalds 			    struct sock *sk)
9771da177e4SLinus Torvalds {
9781da177e4SLinus Torvalds 	struct sctp_chunk *retval;
9791da177e4SLinus Torvalds 
980c3762229SRobert P. J. Day 	retval = kmem_cache_zalloc(sctp_chunk_cachep, GFP_ATOMIC);
9811da177e4SLinus Torvalds 
9821da177e4SLinus Torvalds 	if (!retval)
9831da177e4SLinus Torvalds 		goto nodata;
9841da177e4SLinus Torvalds 
9851da177e4SLinus Torvalds 	if (!sk) {
9861da177e4SLinus Torvalds 		SCTP_DEBUG_PRINTK("chunkifying skb %p w/o an sk\n", skb);
9871da177e4SLinus Torvalds 	}
9881da177e4SLinus Torvalds 
98979af02c2SDavid S. Miller 	INIT_LIST_HEAD(&retval->list);
9901da177e4SLinus Torvalds 	retval->skb		= skb;
9911da177e4SLinus Torvalds 	retval->asoc		= (struct sctp_association *)asoc;
9921da177e4SLinus Torvalds 	retval->resent  	= 0;
9931da177e4SLinus Torvalds 	retval->has_tsn		= 0;
9941da177e4SLinus Torvalds 	retval->has_ssn         = 0;
9951da177e4SLinus Torvalds 	retval->rtt_in_progress	= 0;
9961da177e4SLinus Torvalds 	retval->sent_at		= 0;
9971da177e4SLinus Torvalds 	retval->singleton	= 1;
9981da177e4SLinus Torvalds 	retval->end_of_packet	= 0;
9991da177e4SLinus Torvalds 	retval->ecn_ce_done	= 0;
10001da177e4SLinus Torvalds 	retval->pdiscard	= 0;
10011da177e4SLinus Torvalds 
10021da177e4SLinus Torvalds 	/* sctpimpguide-05.txt Section 2.8.2
10031da177e4SLinus Torvalds 	 * M1) Each time a new DATA chunk is transmitted
10041da177e4SLinus Torvalds 	 * set the 'TSN.Missing.Report' count for that TSN to 0. The
10051da177e4SLinus Torvalds 	 * 'TSN.Missing.Report' count will be used to determine missing chunks
10061da177e4SLinus Torvalds 	 * and when to fast retransmit.
10071da177e4SLinus Torvalds 	 */
10081da177e4SLinus Torvalds 	retval->tsn_missing_report = 0;
10091da177e4SLinus Torvalds 	retval->tsn_gap_acked = 0;
10101da177e4SLinus Torvalds 	retval->fast_retransmit = 0;
10111da177e4SLinus Torvalds 
10121da177e4SLinus Torvalds 	/* If this is a fragmented message, track all fragments
10131da177e4SLinus Torvalds 	 * of the message (for SEND_FAILED).
10141da177e4SLinus Torvalds 	 */
10151da177e4SLinus Torvalds 	retval->msg = NULL;
10161da177e4SLinus Torvalds 
10171da177e4SLinus Torvalds 	/* Polish the bead hole.  */
10181da177e4SLinus Torvalds 	INIT_LIST_HEAD(&retval->transmitted_list);
10191da177e4SLinus Torvalds 	INIT_LIST_HEAD(&retval->frag_list);
10201da177e4SLinus Torvalds 	SCTP_DBG_OBJCNT_INC(chunk);
10211da177e4SLinus Torvalds 	atomic_set(&retval->refcnt, 1);
10221da177e4SLinus Torvalds 
10231da177e4SLinus Torvalds nodata:
10241da177e4SLinus Torvalds 	return retval;
10251da177e4SLinus Torvalds }
10261da177e4SLinus Torvalds 
10271da177e4SLinus Torvalds /* Set chunk->source and dest based on the IP header in chunk->skb.  */
10281da177e4SLinus Torvalds void sctp_init_addrs(struct sctp_chunk *chunk, union sctp_addr *src,
10291da177e4SLinus Torvalds 		     union sctp_addr *dest)
10301da177e4SLinus Torvalds {
1031f235fca3SAl Viro 	memcpy(&chunk->source, src, sizeof(union sctp_addr));
103216b0a030SAl Viro 	memcpy(&chunk->dest, dest, sizeof(union sctp_addr));
10331da177e4SLinus Torvalds }
10341da177e4SLinus Torvalds 
10351da177e4SLinus Torvalds /* Extract the source address from a chunk.  */
10361da177e4SLinus Torvalds const union sctp_addr *sctp_source(const struct sctp_chunk *chunk)
10371da177e4SLinus Torvalds {
10381da177e4SLinus Torvalds 	/* If we have a known transport, use that.  */
10391da177e4SLinus Torvalds 	if (chunk->transport) {
10406a1e5f33SAl Viro 		return &chunk->transport->ipaddr;
10411da177e4SLinus Torvalds 	} else {
10421da177e4SLinus Torvalds 		/* Otherwise, extract it from the IP header.  */
10436a1e5f33SAl Viro 		return &chunk->source;
10441da177e4SLinus Torvalds 	}
10451da177e4SLinus Torvalds }
10461da177e4SLinus Torvalds 
10471da177e4SLinus Torvalds /* Create a new chunk, setting the type and flags headers from the
10481da177e4SLinus Torvalds  * arguments, reserving enough space for a 'paylen' byte payload.
10491da177e4SLinus Torvalds  */
10501da177e4SLinus Torvalds SCTP_STATIC
10511da177e4SLinus Torvalds struct sctp_chunk *sctp_make_chunk(const struct sctp_association *asoc,
10521da177e4SLinus Torvalds 				   __u8 type, __u8 flags, int paylen)
10531da177e4SLinus Torvalds {
10541da177e4SLinus Torvalds 	struct sctp_chunk *retval;
10551da177e4SLinus Torvalds 	sctp_chunkhdr_t *chunk_hdr;
10561da177e4SLinus Torvalds 	struct sk_buff *skb;
10571da177e4SLinus Torvalds 	struct sock *sk;
10581da177e4SLinus Torvalds 
10591da177e4SLinus Torvalds 	/* No need to allocate LL here, as this is only a chunk. */
10601da177e4SLinus Torvalds 	skb = alloc_skb(WORD_ROUND(sizeof(sctp_chunkhdr_t) + paylen),
10611da177e4SLinus Torvalds 			GFP_ATOMIC);
10621da177e4SLinus Torvalds 	if (!skb)
10631da177e4SLinus Torvalds 		goto nodata;
10641da177e4SLinus Torvalds 
10651da177e4SLinus Torvalds 	/* Make room for the chunk header.  */
10661da177e4SLinus Torvalds 	chunk_hdr = (sctp_chunkhdr_t *)skb_put(skb, sizeof(sctp_chunkhdr_t));
10671da177e4SLinus Torvalds 	chunk_hdr->type	  = type;
10681da177e4SLinus Torvalds 	chunk_hdr->flags  = flags;
10691da177e4SLinus Torvalds 	chunk_hdr->length = htons(sizeof(sctp_chunkhdr_t));
10701da177e4SLinus Torvalds 
10711da177e4SLinus Torvalds 	sk = asoc ? asoc->base.sk : NULL;
10721da177e4SLinus Torvalds 	retval = sctp_chunkify(skb, asoc, sk);
10731da177e4SLinus Torvalds 	if (!retval) {
10741da177e4SLinus Torvalds 		kfree_skb(skb);
10751da177e4SLinus Torvalds 		goto nodata;
10761da177e4SLinus Torvalds 	}
10771da177e4SLinus Torvalds 
10781da177e4SLinus Torvalds 	retval->chunk_hdr = chunk_hdr;
10791da177e4SLinus Torvalds 	retval->chunk_end = ((__u8 *)chunk_hdr) + sizeof(struct sctp_chunkhdr);
10801da177e4SLinus Torvalds 
10811da177e4SLinus Torvalds 	/* Set the skb to the belonging sock for accounting.  */
10821da177e4SLinus Torvalds 	skb->sk = sk;
10831da177e4SLinus Torvalds 
10841da177e4SLinus Torvalds 	return retval;
10851da177e4SLinus Torvalds nodata:
10861da177e4SLinus Torvalds 	return NULL;
10871da177e4SLinus Torvalds }
10881da177e4SLinus Torvalds 
10891da177e4SLinus Torvalds 
10901da177e4SLinus Torvalds /* Release the memory occupied by a chunk.  */
10911da177e4SLinus Torvalds static void sctp_chunk_destroy(struct sctp_chunk *chunk)
10921da177e4SLinus Torvalds {
10931da177e4SLinus Torvalds 	/* Free the chunk skb data and the SCTP_chunk stub itself. */
10941da177e4SLinus Torvalds 	dev_kfree_skb(chunk->skb);
10951da177e4SLinus Torvalds 
10961da177e4SLinus Torvalds 	SCTP_DBG_OBJCNT_DEC(chunk);
10971da177e4SLinus Torvalds 	kmem_cache_free(sctp_chunk_cachep, chunk);
10981da177e4SLinus Torvalds }
10991da177e4SLinus Torvalds 
11001da177e4SLinus Torvalds /* Possibly, free the chunk.  */
11011da177e4SLinus Torvalds void sctp_chunk_free(struct sctp_chunk *chunk)
11021da177e4SLinus Torvalds {
110379af02c2SDavid S. Miller 	BUG_ON(!list_empty(&chunk->list));
11041da177e4SLinus Torvalds 	list_del_init(&chunk->transmitted_list);
11051da177e4SLinus Torvalds 
11061da177e4SLinus Torvalds 	/* Release our reference on the message tracker. */
11071da177e4SLinus Torvalds 	if (chunk->msg)
11081da177e4SLinus Torvalds 		sctp_datamsg_put(chunk->msg);
11091da177e4SLinus Torvalds 
11101da177e4SLinus Torvalds 	sctp_chunk_put(chunk);
11111da177e4SLinus Torvalds }
11121da177e4SLinus Torvalds 
11131da177e4SLinus Torvalds /* Grab a reference to the chunk. */
11141da177e4SLinus Torvalds void sctp_chunk_hold(struct sctp_chunk *ch)
11151da177e4SLinus Torvalds {
11161da177e4SLinus Torvalds 	atomic_inc(&ch->refcnt);
11171da177e4SLinus Torvalds }
11181da177e4SLinus Torvalds 
11191da177e4SLinus Torvalds /* Release a reference to the chunk. */
11201da177e4SLinus Torvalds void sctp_chunk_put(struct sctp_chunk *ch)
11211da177e4SLinus Torvalds {
11221da177e4SLinus Torvalds 	if (atomic_dec_and_test(&ch->refcnt))
11231da177e4SLinus Torvalds 		sctp_chunk_destroy(ch);
11241da177e4SLinus Torvalds }
11251da177e4SLinus Torvalds 
11261da177e4SLinus Torvalds /* Append bytes to the end of a chunk.  Will panic if chunk is not big
11271da177e4SLinus Torvalds  * enough.
11281da177e4SLinus Torvalds  */
11291da177e4SLinus Torvalds void *sctp_addto_chunk(struct sctp_chunk *chunk, int len, const void *data)
11301da177e4SLinus Torvalds {
11311da177e4SLinus Torvalds 	void *target;
11321da177e4SLinus Torvalds 	void *padding;
11331da177e4SLinus Torvalds 	int chunklen = ntohs(chunk->chunk_hdr->length);
11348d614adeSWei Yongjun 	int padlen = WORD_ROUND(chunklen) - chunklen;
11351da177e4SLinus Torvalds 
11361da177e4SLinus Torvalds 	padding = skb_put(chunk->skb, padlen);
11371da177e4SLinus Torvalds 	target = skb_put(chunk->skb, len);
11381da177e4SLinus Torvalds 
11391da177e4SLinus Torvalds 	memset(padding, 0, padlen);
11401da177e4SLinus Torvalds 	memcpy(target, data, len);
11411da177e4SLinus Torvalds 
11421da177e4SLinus Torvalds 	/* Adjust the chunk length field.  */
11431da177e4SLinus Torvalds 	chunk->chunk_hdr->length = htons(chunklen + padlen + len);
114427a884dcSArnaldo Carvalho de Melo 	chunk->chunk_end = skb_tail_pointer(chunk->skb);
11451da177e4SLinus Torvalds 
11461da177e4SLinus Torvalds 	return target;
11471da177e4SLinus Torvalds }
11481da177e4SLinus Torvalds 
114900f1c2dfSWei Yongjun /* Append bytes to the end of a parameter.  Will panic if chunk is not big
115000f1c2dfSWei Yongjun  * enough.
115100f1c2dfSWei Yongjun  */
115200f1c2dfSWei Yongjun void *sctp_addto_param(struct sctp_chunk *chunk, int len, const void *data)
115300f1c2dfSWei Yongjun {
115400f1c2dfSWei Yongjun 	void *target;
115500f1c2dfSWei Yongjun 	int chunklen = ntohs(chunk->chunk_hdr->length);
115600f1c2dfSWei Yongjun 
115700f1c2dfSWei Yongjun 	target = skb_put(chunk->skb, len);
115800f1c2dfSWei Yongjun 
115900f1c2dfSWei Yongjun 	memcpy(target, data, len);
116000f1c2dfSWei Yongjun 
116100f1c2dfSWei Yongjun 	/* Adjust the chunk length field.  */
116200f1c2dfSWei Yongjun 	chunk->chunk_hdr->length = htons(chunklen + len);
116300f1c2dfSWei Yongjun 	chunk->chunk_end = skb_tail_pointer(chunk->skb);
116400f1c2dfSWei Yongjun 
116500f1c2dfSWei Yongjun 	return target;
116600f1c2dfSWei Yongjun }
116700f1c2dfSWei Yongjun 
11681da177e4SLinus Torvalds /* Append bytes from user space to the end of a chunk.  Will panic if
11691da177e4SLinus Torvalds  * chunk is not big enough.
11701da177e4SLinus Torvalds  * Returns a kernel err value.
11711da177e4SLinus Torvalds  */
11721da177e4SLinus Torvalds int sctp_user_addto_chunk(struct sctp_chunk *chunk, int off, int len,
11731da177e4SLinus Torvalds 			  struct iovec *data)
11741da177e4SLinus Torvalds {
11751da177e4SLinus Torvalds 	__u8 *target;
11761da177e4SLinus Torvalds 	int err = 0;
11771da177e4SLinus Torvalds 
11781da177e4SLinus Torvalds 	/* Make room in chunk for data.  */
11791da177e4SLinus Torvalds 	target = skb_put(chunk->skb, len);
11801da177e4SLinus Torvalds 
11811da177e4SLinus Torvalds 	/* Copy data (whole iovec) into chunk */
11821da177e4SLinus Torvalds 	if ((err = memcpy_fromiovecend(target, data, off, len)))
11831da177e4SLinus Torvalds 		goto out;
11841da177e4SLinus Torvalds 
11851da177e4SLinus Torvalds 	/* Adjust the chunk length field.  */
11861da177e4SLinus Torvalds 	chunk->chunk_hdr->length =
11871da177e4SLinus Torvalds 		htons(ntohs(chunk->chunk_hdr->length) + len);
118827a884dcSArnaldo Carvalho de Melo 	chunk->chunk_end = skb_tail_pointer(chunk->skb);
11891da177e4SLinus Torvalds 
11901da177e4SLinus Torvalds out:
11911da177e4SLinus Torvalds 	return err;
11921da177e4SLinus Torvalds }
11931da177e4SLinus Torvalds 
11941da177e4SLinus Torvalds /* Helper function to assign a TSN if needed.  This assumes that both
11951da177e4SLinus Torvalds  * the data_hdr and association have already been assigned.
11961da177e4SLinus Torvalds  */
11971da177e4SLinus Torvalds void sctp_chunk_assign_ssn(struct sctp_chunk *chunk)
11981da177e4SLinus Torvalds {
1199ab3e5e7bSVlad Yasevich 	struct sctp_datamsg *msg;
1200ab3e5e7bSVlad Yasevich 	struct sctp_chunk *lchunk;
1201ab3e5e7bSVlad Yasevich 	struct sctp_stream *stream;
12021da177e4SLinus Torvalds 	__u16 ssn;
12031da177e4SLinus Torvalds 	__u16 sid;
12041da177e4SLinus Torvalds 
12051da177e4SLinus Torvalds 	if (chunk->has_ssn)
12061da177e4SLinus Torvalds 		return;
12071da177e4SLinus Torvalds 
1208ab3e5e7bSVlad Yasevich 	/* All fragments will be on the same stream */
1209ab3e5e7bSVlad Yasevich 	sid = ntohs(chunk->subh.data_hdr->stream);
1210ab3e5e7bSVlad Yasevich 	stream = &chunk->asoc->ssnmap->out;
1211ab3e5e7bSVlad Yasevich 
1212ab3e5e7bSVlad Yasevich 	/* Now assign the sequence number to the entire message.
1213ab3e5e7bSVlad Yasevich 	 * All fragments must have the same stream sequence number.
1214ab3e5e7bSVlad Yasevich 	 */
1215ab3e5e7bSVlad Yasevich 	msg = chunk->msg;
1216ab3e5e7bSVlad Yasevich 	list_for_each_entry(lchunk, &msg->chunks, frag_list) {
1217ab3e5e7bSVlad Yasevich 		if (lchunk->chunk_hdr->flags & SCTP_DATA_UNORDERED) {
12181da177e4SLinus Torvalds 			ssn = 0;
12191da177e4SLinus Torvalds 		} else {
1220ab3e5e7bSVlad Yasevich 			if (lchunk->chunk_hdr->flags & SCTP_DATA_LAST_FRAG)
1221ab3e5e7bSVlad Yasevich 				ssn = sctp_ssn_next(stream, sid);
12221da177e4SLinus Torvalds 			else
1223ab3e5e7bSVlad Yasevich 				ssn = sctp_ssn_peek(stream, sid);
12241da177e4SLinus Torvalds 		}
12251da177e4SLinus Torvalds 
1226ab3e5e7bSVlad Yasevich 		lchunk->subh.data_hdr->ssn = htons(ssn);
1227ab3e5e7bSVlad Yasevich 		lchunk->has_ssn = 1;
1228ab3e5e7bSVlad Yasevich 	}
12291da177e4SLinus Torvalds }
12301da177e4SLinus Torvalds 
12311da177e4SLinus Torvalds /* Helper function to assign a TSN if needed.  This assumes that both
12321da177e4SLinus Torvalds  * the data_hdr and association have already been assigned.
12331da177e4SLinus Torvalds  */
12341da177e4SLinus Torvalds void sctp_chunk_assign_tsn(struct sctp_chunk *chunk)
12351da177e4SLinus Torvalds {
12361da177e4SLinus Torvalds 	if (!chunk->has_tsn) {
12371da177e4SLinus Torvalds 		/* This is the last possible instant to
12381da177e4SLinus Torvalds 		 * assign a TSN.
12391da177e4SLinus Torvalds 		 */
12401da177e4SLinus Torvalds 		chunk->subh.data_hdr->tsn =
12411da177e4SLinus Torvalds 			htonl(sctp_association_get_next_tsn(chunk->asoc));
12421da177e4SLinus Torvalds 		chunk->has_tsn = 1;
12431da177e4SLinus Torvalds 	}
12441da177e4SLinus Torvalds }
12451da177e4SLinus Torvalds 
12461da177e4SLinus Torvalds /* Create a CLOSED association to use with an incoming packet.  */
12471da177e4SLinus Torvalds struct sctp_association *sctp_make_temp_asoc(const struct sctp_endpoint *ep,
12483182cd84SAlexey Dobriyan 					struct sctp_chunk *chunk,
1249dd0fc66fSAl Viro 					gfp_t gfp)
12501da177e4SLinus Torvalds {
12511da177e4SLinus Torvalds 	struct sctp_association *asoc;
12521da177e4SLinus Torvalds 	struct sk_buff *skb;
12531da177e4SLinus Torvalds 	sctp_scope_t scope;
12541da177e4SLinus Torvalds 	struct sctp_af *af;
12551da177e4SLinus Torvalds 
12561da177e4SLinus Torvalds 	/* Create the bare association.  */
12571da177e4SLinus Torvalds 	scope = sctp_scope(sctp_source(chunk));
12581da177e4SLinus Torvalds 	asoc = sctp_association_new(ep, ep->base.sk, scope, gfp);
12591da177e4SLinus Torvalds 	if (!asoc)
12601da177e4SLinus Torvalds 		goto nodata;
12611da177e4SLinus Torvalds 	asoc->temp = 1;
12621da177e4SLinus Torvalds 	skb = chunk->skb;
12631da177e4SLinus Torvalds 	/* Create an entry for the source address of the packet.  */
1264eddc9ec5SArnaldo Carvalho de Melo 	af = sctp_get_af_specific(ipver2af(ip_hdr(skb)->version));
12651da177e4SLinus Torvalds 	if (unlikely(!af))
12661da177e4SLinus Torvalds 		goto fail;
1267d55c41b1SAl Viro 	af->from_skb(&asoc->c.peer_addr, skb, 1);
12681da177e4SLinus Torvalds nodata:
12691da177e4SLinus Torvalds 	return asoc;
12701da177e4SLinus Torvalds 
12711da177e4SLinus Torvalds fail:
12721da177e4SLinus Torvalds 	sctp_association_free(asoc);
12731da177e4SLinus Torvalds 	return NULL;
12741da177e4SLinus Torvalds }
12751da177e4SLinus Torvalds 
12761da177e4SLinus Torvalds /* Build a cookie representing asoc.
12771da177e4SLinus Torvalds  * This INCLUDES the param header needed to put the cookie in the INIT ACK.
12781da177e4SLinus Torvalds  */
12791da177e4SLinus Torvalds static sctp_cookie_param_t *sctp_pack_cookie(const struct sctp_endpoint *ep,
12801da177e4SLinus Torvalds 				      const struct sctp_association *asoc,
12811da177e4SLinus Torvalds 				      const struct sctp_chunk *init_chunk,
12821da177e4SLinus Torvalds 				      int *cookie_len,
12831da177e4SLinus Torvalds 				      const __u8 *raw_addrs, int addrs_len)
12841da177e4SLinus Torvalds {
12851da177e4SLinus Torvalds 	sctp_cookie_param_t *retval;
12861da177e4SLinus Torvalds 	struct sctp_signed_cookie *cookie;
12871da177e4SLinus Torvalds 	struct scatterlist sg;
12881da177e4SLinus Torvalds 	int headersize, bodysize;
12891da177e4SLinus Torvalds 	unsigned int keylen;
12901da177e4SLinus Torvalds 	char *key;
12911da177e4SLinus Torvalds 
12929834a2bbSVlad Yasevich 	/* Header size is static data prior to the actual cookie, including
12939834a2bbSVlad Yasevich 	 * any padding.
12949834a2bbSVlad Yasevich 	 */
12959834a2bbSVlad Yasevich 	headersize = sizeof(sctp_paramhdr_t) +
12969834a2bbSVlad Yasevich 		     (sizeof(struct sctp_signed_cookie) -
12979834a2bbSVlad Yasevich 		      sizeof(struct sctp_cookie));
12981da177e4SLinus Torvalds 	bodysize = sizeof(struct sctp_cookie)
12991da177e4SLinus Torvalds 		+ ntohs(init_chunk->chunk_hdr->length) + addrs_len;
13001da177e4SLinus Torvalds 
13011da177e4SLinus Torvalds 	/* Pad out the cookie to a multiple to make the signature
13021da177e4SLinus Torvalds 	 * functions simpler to write.
13031da177e4SLinus Torvalds 	 */
13041da177e4SLinus Torvalds 	if (bodysize % SCTP_COOKIE_MULTIPLE)
13051da177e4SLinus Torvalds 		bodysize += SCTP_COOKIE_MULTIPLE
13061da177e4SLinus Torvalds 			- (bodysize % SCTP_COOKIE_MULTIPLE);
13071da177e4SLinus Torvalds 	*cookie_len = headersize + bodysize;
13081da177e4SLinus Torvalds 
13091da177e4SLinus Torvalds 	/* Clear this memory since we are sending this data structure
13101da177e4SLinus Torvalds 	 * out on the network.
13111da177e4SLinus Torvalds 	 */
1312af997d8cSArnaldo Carvalho de Melo 	retval = kzalloc(*cookie_len, GFP_ATOMIC);
1313af997d8cSArnaldo Carvalho de Melo 	if (!retval)
1314af997d8cSArnaldo Carvalho de Melo 		goto nodata;
1315af997d8cSArnaldo Carvalho de Melo 
13161da177e4SLinus Torvalds 	cookie = (struct sctp_signed_cookie *) retval->body;
13171da177e4SLinus Torvalds 
13181da177e4SLinus Torvalds 	/* Set up the parameter header.  */
13191da177e4SLinus Torvalds 	retval->p.type = SCTP_PARAM_STATE_COOKIE;
13201da177e4SLinus Torvalds 	retval->p.length = htons(*cookie_len);
13211da177e4SLinus Torvalds 
13221da177e4SLinus Torvalds 	/* Copy the cookie part of the association itself.  */
13231da177e4SLinus Torvalds 	cookie->c = asoc->c;
13241da177e4SLinus Torvalds 	/* Save the raw address list length in the cookie. */
13251da177e4SLinus Torvalds 	cookie->c.raw_addr_list_len = addrs_len;
13261da177e4SLinus Torvalds 
13271da177e4SLinus Torvalds 	/* Remember PR-SCTP capability. */
13281da177e4SLinus Torvalds 	cookie->c.prsctp_capable = asoc->peer.prsctp_capable;
13291da177e4SLinus Torvalds 
13300f3fffd8SIvan Skytte Jorgensen 	/* Save adaptation indication in the cookie. */
13310f3fffd8SIvan Skytte Jorgensen 	cookie->c.adaptation_ind = asoc->peer.adaptation_ind;
13321da177e4SLinus Torvalds 
13331da177e4SLinus Torvalds 	/* Set an expiration time for the cookie.  */
13341da177e4SLinus Torvalds 	do_gettimeofday(&cookie->c.expiration);
13351da177e4SLinus Torvalds 	TIMEVAL_ADD(asoc->cookie_life, cookie->c.expiration);
13361da177e4SLinus Torvalds 
13371da177e4SLinus Torvalds 	/* Copy the peer's init packet.  */
13381da177e4SLinus Torvalds 	memcpy(&cookie->c.peer_init[0], init_chunk->chunk_hdr,
13391da177e4SLinus Torvalds 	       ntohs(init_chunk->chunk_hdr->length));
13401da177e4SLinus Torvalds 
13411da177e4SLinus Torvalds 	/* Copy the raw local address list of the association. */
13421da177e4SLinus Torvalds 	memcpy((__u8 *)&cookie->c.peer_init[0] +
13431da177e4SLinus Torvalds 	       ntohs(init_chunk->chunk_hdr->length), raw_addrs, addrs_len);
13441da177e4SLinus Torvalds 
13451da177e4SLinus Torvalds 	if (sctp_sk(ep->base.sk)->hmac) {
13461b489e11SHerbert Xu 		struct hash_desc desc;
13471b489e11SHerbert Xu 
13481da177e4SLinus Torvalds 		/* Sign the message.  */
13491da177e4SLinus Torvalds 		sg.page = virt_to_page(&cookie->c);
13501da177e4SLinus Torvalds 		sg.offset = (unsigned long)(&cookie->c) % PAGE_SIZE;
13511da177e4SLinus Torvalds 		sg.length = bodysize;
13521da177e4SLinus Torvalds 		keylen = SCTP_SECRET_SIZE;
13531da177e4SLinus Torvalds 		key = (char *)ep->secret_key[ep->current_key];
13541b489e11SHerbert Xu 		desc.tfm = sctp_sk(ep->base.sk)->hmac;
13551b489e11SHerbert Xu 		desc.flags = 0;
13561da177e4SLinus Torvalds 
13571b489e11SHerbert Xu 		if (crypto_hash_setkey(desc.tfm, key, keylen) ||
13581b489e11SHerbert Xu 		    crypto_hash_digest(&desc, &sg, bodysize, cookie->signature))
13591b489e11SHerbert Xu 			goto free_cookie;
13601da177e4SLinus Torvalds 	}
13611da177e4SLinus Torvalds 
13621da177e4SLinus Torvalds 	return retval;
13631b489e11SHerbert Xu 
13641b489e11SHerbert Xu free_cookie:
13651b489e11SHerbert Xu 	kfree(retval);
13661b489e11SHerbert Xu nodata:
13671b489e11SHerbert Xu 	*cookie_len = 0;
13681b489e11SHerbert Xu 	return NULL;
13691da177e4SLinus Torvalds }
13701da177e4SLinus Torvalds 
13711da177e4SLinus Torvalds /* Unpack the cookie from COOKIE ECHO chunk, recreating the association.  */
13721da177e4SLinus Torvalds struct sctp_association *sctp_unpack_cookie(
13731da177e4SLinus Torvalds 	const struct sctp_endpoint *ep,
13741da177e4SLinus Torvalds 	const struct sctp_association *asoc,
1375dd0fc66fSAl Viro 	struct sctp_chunk *chunk, gfp_t gfp,
13761da177e4SLinus Torvalds 	int *error, struct sctp_chunk **errp)
13771da177e4SLinus Torvalds {
13781da177e4SLinus Torvalds 	struct sctp_association *retval = NULL;
13791da177e4SLinus Torvalds 	struct sctp_signed_cookie *cookie;
13801da177e4SLinus Torvalds 	struct sctp_cookie *bear_cookie;
13811da177e4SLinus Torvalds 	int headersize, bodysize, fixed_size;
1382313e7b4dSVlad Yasevich 	__u8 *digest = ep->digest;
13831da177e4SLinus Torvalds 	struct scatterlist sg;
13841da177e4SLinus Torvalds 	unsigned int keylen, len;
13851da177e4SLinus Torvalds 	char *key;
13861da177e4SLinus Torvalds 	sctp_scope_t scope;
13871da177e4SLinus Torvalds 	struct sk_buff *skb = chunk->skb;
1388a61bbcf2SPatrick McHardy 	struct timeval tv;
13891b489e11SHerbert Xu 	struct hash_desc desc;
13901da177e4SLinus Torvalds 
13919834a2bbSVlad Yasevich 	/* Header size is static data prior to the actual cookie, including
13929834a2bbSVlad Yasevich 	 * any padding.
13939834a2bbSVlad Yasevich 	 */
13949834a2bbSVlad Yasevich 	headersize = sizeof(sctp_chunkhdr_t) +
13959834a2bbSVlad Yasevich 		     (sizeof(struct sctp_signed_cookie) -
13969834a2bbSVlad Yasevich 		      sizeof(struct sctp_cookie));
13971da177e4SLinus Torvalds 	bodysize = ntohs(chunk->chunk_hdr->length) - headersize;
13981da177e4SLinus Torvalds 	fixed_size = headersize + sizeof(struct sctp_cookie);
13991da177e4SLinus Torvalds 
14001da177e4SLinus Torvalds 	/* Verify that the chunk looks like it even has a cookie.
14011da177e4SLinus Torvalds 	 * There must be enough room for our cookie and our peer's
14021da177e4SLinus Torvalds 	 * INIT chunk.
14031da177e4SLinus Torvalds 	 */
14041da177e4SLinus Torvalds 	len = ntohs(chunk->chunk_hdr->length);
14051da177e4SLinus Torvalds 	if (len < fixed_size + sizeof(struct sctp_chunkhdr))
14061da177e4SLinus Torvalds 		goto malformed;
14071da177e4SLinus Torvalds 
14081da177e4SLinus Torvalds 	/* Verify that the cookie has been padded out. */
14091da177e4SLinus Torvalds 	if (bodysize % SCTP_COOKIE_MULTIPLE)
14101da177e4SLinus Torvalds 		goto malformed;
14111da177e4SLinus Torvalds 
14121da177e4SLinus Torvalds 	/* Process the cookie.  */
14131da177e4SLinus Torvalds 	cookie = chunk->subh.cookie_hdr;
14141da177e4SLinus Torvalds 	bear_cookie = &cookie->c;
14151da177e4SLinus Torvalds 
14161da177e4SLinus Torvalds 	if (!sctp_sk(ep->base.sk)->hmac)
14171da177e4SLinus Torvalds 		goto no_hmac;
14181da177e4SLinus Torvalds 
14191da177e4SLinus Torvalds 	/* Check the signature.  */
14201da177e4SLinus Torvalds 	keylen = SCTP_SECRET_SIZE;
14211da177e4SLinus Torvalds 	sg.page = virt_to_page(bear_cookie);
14221da177e4SLinus Torvalds 	sg.offset = (unsigned long)(bear_cookie) % PAGE_SIZE;
14231da177e4SLinus Torvalds 	sg.length = bodysize;
14241da177e4SLinus Torvalds 	key = (char *)ep->secret_key[ep->current_key];
14251b489e11SHerbert Xu 	desc.tfm = sctp_sk(ep->base.sk)->hmac;
14261b489e11SHerbert Xu 	desc.flags = 0;
14271da177e4SLinus Torvalds 
14288ca84481SAl Viro 	memset(digest, 0x00, SCTP_SIGNATURE_SIZE);
14291b489e11SHerbert Xu 	if (crypto_hash_setkey(desc.tfm, key, keylen) ||
14301b489e11SHerbert Xu 	    crypto_hash_digest(&desc, &sg, bodysize, digest)) {
14311b489e11SHerbert Xu 		*error = -SCTP_IERROR_NOMEM;
14321b489e11SHerbert Xu 		goto fail;
14331b489e11SHerbert Xu 	}
14341da177e4SLinus Torvalds 
14351da177e4SLinus Torvalds 	if (memcmp(digest, cookie->signature, SCTP_SIGNATURE_SIZE)) {
14361da177e4SLinus Torvalds 		/* Try the previous key. */
14371da177e4SLinus Torvalds 		key = (char *)ep->secret_key[ep->last_key];
14388ca84481SAl Viro 		memset(digest, 0x00, SCTP_SIGNATURE_SIZE);
14391b489e11SHerbert Xu 		if (crypto_hash_setkey(desc.tfm, key, keylen) ||
14401b489e11SHerbert Xu 		    crypto_hash_digest(&desc, &sg, bodysize, digest)) {
14411b489e11SHerbert Xu 			*error = -SCTP_IERROR_NOMEM;
14421b489e11SHerbert Xu 			goto fail;
14431b489e11SHerbert Xu 		}
14441da177e4SLinus Torvalds 
14451da177e4SLinus Torvalds 		if (memcmp(digest, cookie->signature, SCTP_SIGNATURE_SIZE)) {
14461da177e4SLinus Torvalds 			/* Yikes!  Still bad signature! */
14471da177e4SLinus Torvalds 			*error = -SCTP_IERROR_BAD_SIG;
14481da177e4SLinus Torvalds 			goto fail;
14491da177e4SLinus Torvalds 		}
14501da177e4SLinus Torvalds 	}
14511da177e4SLinus Torvalds 
14521da177e4SLinus Torvalds no_hmac:
14531da177e4SLinus Torvalds 	/* IG Section 2.35.2:
14541da177e4SLinus Torvalds 	 *  3) Compare the port numbers and the verification tag contained
14551da177e4SLinus Torvalds 	 *     within the COOKIE ECHO chunk to the actual port numbers and the
14561da177e4SLinus Torvalds 	 *     verification tag within the SCTP common header of the received
14571da177e4SLinus Torvalds 	 *     packet. If these values do not match the packet MUST be silently
14581da177e4SLinus Torvalds 	 *     discarded,
14591da177e4SLinus Torvalds 	 */
14601da177e4SLinus Torvalds 	if (ntohl(chunk->sctp_hdr->vtag) != bear_cookie->my_vtag) {
14611da177e4SLinus Torvalds 		*error = -SCTP_IERROR_BAD_TAG;
14621da177e4SLinus Torvalds 		goto fail;
14631da177e4SLinus Torvalds 	}
14641da177e4SLinus Torvalds 
14659b1dfad0SAl Viro 	if (chunk->sctp_hdr->source != bear_cookie->peer_addr.v4.sin_port ||
14661da177e4SLinus Torvalds 	    ntohs(chunk->sctp_hdr->dest) != bear_cookie->my_port) {
14671da177e4SLinus Torvalds 		*error = -SCTP_IERROR_BAD_PORTS;
14681da177e4SLinus Torvalds 		goto fail;
14691da177e4SLinus Torvalds 	}
14701da177e4SLinus Torvalds 
14711da177e4SLinus Torvalds 	/* Check to see if the cookie is stale.  If there is already
14721da177e4SLinus Torvalds 	 * an association, there is no need to check cookie's expiration
14731da177e4SLinus Torvalds 	 * for init collision case of lost COOKIE ACK.
1474f236218bSVlad Yasevich 	 * If skb has been timestamped, then use the stamp, otherwise
1475f236218bSVlad Yasevich 	 * use current time.  This introduces a small possibility that
1476f236218bSVlad Yasevich 	 * that a cookie may be considered expired, but his would only slow
1477f236218bSVlad Yasevich 	 * down the new association establishment instead of every packet.
14781da177e4SLinus Torvalds 	 */
1479f236218bSVlad Yasevich 	if (sock_flag(ep->base.sk, SOCK_TIMESTAMP))
1480a61bbcf2SPatrick McHardy 		skb_get_timestamp(skb, &tv);
1481f236218bSVlad Yasevich 	else
1482f236218bSVlad Yasevich 		do_gettimeofday(&tv);
1483f236218bSVlad Yasevich 
1484a61bbcf2SPatrick McHardy 	if (!asoc && tv_lt(bear_cookie->expiration, tv)) {
14851da177e4SLinus Torvalds 		/*
14861da177e4SLinus Torvalds 		 * Section 3.3.10.3 Stale Cookie Error (3)
14871da177e4SLinus Torvalds 		 *
14881da177e4SLinus Torvalds 		 * Cause of error
14891da177e4SLinus Torvalds 		 * ---------------
14901da177e4SLinus Torvalds 		 * Stale Cookie Error:  Indicates the receipt of a valid State
14911da177e4SLinus Torvalds 		 * Cookie that has expired.
14921da177e4SLinus Torvalds 		 */
14931da177e4SLinus Torvalds 		len = ntohs(chunk->chunk_hdr->length);
14941da177e4SLinus Torvalds 		*errp = sctp_make_op_error_space(asoc, chunk, len);
14951da177e4SLinus Torvalds 		if (*errp) {
1496a61bbcf2SPatrick McHardy 			suseconds_t usecs = (tv.tv_sec -
14971da177e4SLinus Torvalds 				bear_cookie->expiration.tv_sec) * 1000000L +
1498a61bbcf2SPatrick McHardy 				tv.tv_usec - bear_cookie->expiration.tv_usec;
149934bcca28SAl Viro 			__be32 n = htonl(usecs);
15001da177e4SLinus Torvalds 
15011da177e4SLinus Torvalds 			sctp_init_cause(*errp, SCTP_ERROR_STALE_COOKIE,
150200f1c2dfSWei Yongjun 					sizeof(n));
150300f1c2dfSWei Yongjun 			sctp_addto_chunk(*errp, sizeof(n), &n);
15041da177e4SLinus Torvalds 			*error = -SCTP_IERROR_STALE_COOKIE;
15051da177e4SLinus Torvalds 		} else
15061da177e4SLinus Torvalds 			*error = -SCTP_IERROR_NOMEM;
15071da177e4SLinus Torvalds 
15081da177e4SLinus Torvalds 		goto fail;
15091da177e4SLinus Torvalds 	}
15101da177e4SLinus Torvalds 
15111da177e4SLinus Torvalds 	/* Make a new base association.  */
15121da177e4SLinus Torvalds 	scope = sctp_scope(sctp_source(chunk));
15131da177e4SLinus Torvalds 	retval = sctp_association_new(ep, ep->base.sk, scope, gfp);
15141da177e4SLinus Torvalds 	if (!retval) {
15151da177e4SLinus Torvalds 		*error = -SCTP_IERROR_NOMEM;
15161da177e4SLinus Torvalds 		goto fail;
15171da177e4SLinus Torvalds 	}
15181da177e4SLinus Torvalds 
15191da177e4SLinus Torvalds 	/* Set up our peer's port number.  */
15201da177e4SLinus Torvalds 	retval->peer.port = ntohs(chunk->sctp_hdr->source);
15211da177e4SLinus Torvalds 
15221da177e4SLinus Torvalds 	/* Populate the association from the cookie.  */
15231da177e4SLinus Torvalds 	memcpy(&retval->c, bear_cookie, sizeof(*bear_cookie));
15241da177e4SLinus Torvalds 
15251da177e4SLinus Torvalds 	if (sctp_assoc_set_bind_addr_from_cookie(retval, bear_cookie,
15261da177e4SLinus Torvalds 						 GFP_ATOMIC) < 0) {
15271da177e4SLinus Torvalds 		*error = -SCTP_IERROR_NOMEM;
15281da177e4SLinus Torvalds 		goto fail;
15291da177e4SLinus Torvalds 	}
15301da177e4SLinus Torvalds 
15311da177e4SLinus Torvalds 	/* Also, add the destination address. */
15321da177e4SLinus Torvalds 	if (list_empty(&retval->base.bind_addr.address_list)) {
153316b0a030SAl Viro 		sctp_add_bind_addr(&retval->base.bind_addr, &chunk->dest, 1,
15341da177e4SLinus Torvalds 				GFP_ATOMIC);
15351da177e4SLinus Torvalds 	}
15361da177e4SLinus Torvalds 
15371da177e4SLinus Torvalds 	retval->next_tsn = retval->c.initial_tsn;
15381da177e4SLinus Torvalds 	retval->ctsn_ack_point = retval->next_tsn - 1;
15391da177e4SLinus Torvalds 	retval->addip_serial = retval->c.initial_tsn;
15401da177e4SLinus Torvalds 	retval->adv_peer_ack_point = retval->ctsn_ack_point;
15411da177e4SLinus Torvalds 	retval->peer.prsctp_capable = retval->c.prsctp_capable;
15420f3fffd8SIvan Skytte Jorgensen 	retval->peer.adaptation_ind = retval->c.adaptation_ind;
15431da177e4SLinus Torvalds 
15441da177e4SLinus Torvalds 	/* The INIT stuff will be done by the side effects.  */
15451da177e4SLinus Torvalds 	return retval;
15461da177e4SLinus Torvalds 
15471da177e4SLinus Torvalds fail:
15481da177e4SLinus Torvalds 	if (retval)
15491da177e4SLinus Torvalds 		sctp_association_free(retval);
15501da177e4SLinus Torvalds 
15511da177e4SLinus Torvalds 	return NULL;
15521da177e4SLinus Torvalds 
15531da177e4SLinus Torvalds malformed:
15541da177e4SLinus Torvalds 	/* Yikes!  The packet is either corrupt or deliberately
15551da177e4SLinus Torvalds 	 * malformed.
15561da177e4SLinus Torvalds 	 */
15571da177e4SLinus Torvalds 	*error = -SCTP_IERROR_MALFORMED;
15581da177e4SLinus Torvalds 	goto fail;
15591da177e4SLinus Torvalds }
15601da177e4SLinus Torvalds 
15611da177e4SLinus Torvalds /********************************************************************
15621da177e4SLinus Torvalds  * 3rd Level Abstractions
15631da177e4SLinus Torvalds  ********************************************************************/
15641da177e4SLinus Torvalds 
15651da177e4SLinus Torvalds struct __sctp_missing {
15669f81bcd9SAl Viro 	__be32 num_missing;
15679f81bcd9SAl Viro 	__be16 type;
15681da177e4SLinus Torvalds }  __attribute__((packed));
15691da177e4SLinus Torvalds 
15701da177e4SLinus Torvalds /*
15711da177e4SLinus Torvalds  * Report a missing mandatory parameter.
15721da177e4SLinus Torvalds  */
15731da177e4SLinus Torvalds static int sctp_process_missing_param(const struct sctp_association *asoc,
15741da177e4SLinus Torvalds 				      sctp_param_t paramtype,
15751da177e4SLinus Torvalds 				      struct sctp_chunk *chunk,
15761da177e4SLinus Torvalds 				      struct sctp_chunk **errp)
15771da177e4SLinus Torvalds {
15781da177e4SLinus Torvalds 	struct __sctp_missing report;
15791da177e4SLinus Torvalds 	__u16 len;
15801da177e4SLinus Torvalds 
15811da177e4SLinus Torvalds 	len = WORD_ROUND(sizeof(report));
15821da177e4SLinus Torvalds 
15831da177e4SLinus Torvalds 	/* Make an ERROR chunk, preparing enough room for
15841da177e4SLinus Torvalds 	 * returning multiple unknown parameters.
15851da177e4SLinus Torvalds 	 */
15861da177e4SLinus Torvalds 	if (!*errp)
15871da177e4SLinus Torvalds 		*errp = sctp_make_op_error_space(asoc, chunk, len);
15881da177e4SLinus Torvalds 
15891da177e4SLinus Torvalds 	if (*errp) {
15901da177e4SLinus Torvalds 		report.num_missing = htonl(1);
15911da177e4SLinus Torvalds 		report.type = paramtype;
1592ebdfcad4SVlad Yasevich 		sctp_init_cause(*errp, SCTP_ERROR_MISS_PARAM,
159300f1c2dfSWei Yongjun 				sizeof(report));
159400f1c2dfSWei Yongjun 		sctp_addto_chunk(*errp, sizeof(report), &report);
15951da177e4SLinus Torvalds 	}
15961da177e4SLinus Torvalds 
15971da177e4SLinus Torvalds 	/* Stop processing this chunk. */
15981da177e4SLinus Torvalds 	return 0;
15991da177e4SLinus Torvalds }
16001da177e4SLinus Torvalds 
16011da177e4SLinus Torvalds /* Report an Invalid Mandatory Parameter.  */
16021da177e4SLinus Torvalds static int sctp_process_inv_mandatory(const struct sctp_association *asoc,
16031da177e4SLinus Torvalds 				      struct sctp_chunk *chunk,
16041da177e4SLinus Torvalds 				      struct sctp_chunk **errp)
16051da177e4SLinus Torvalds {
16061da177e4SLinus Torvalds 	/* Invalid Mandatory Parameter Error has no payload. */
16071da177e4SLinus Torvalds 
16081da177e4SLinus Torvalds 	if (!*errp)
16091da177e4SLinus Torvalds 		*errp = sctp_make_op_error_space(asoc, chunk, 0);
16101da177e4SLinus Torvalds 
16111da177e4SLinus Torvalds 	if (*errp)
161200f1c2dfSWei Yongjun 		sctp_init_cause(*errp, SCTP_ERROR_INV_PARAM, 0);
16131da177e4SLinus Torvalds 
16141da177e4SLinus Torvalds 	/* Stop processing this chunk. */
16151da177e4SLinus Torvalds 	return 0;
16161da177e4SLinus Torvalds }
16171da177e4SLinus Torvalds 
16181da177e4SLinus Torvalds static int sctp_process_inv_paramlength(const struct sctp_association *asoc,
16191da177e4SLinus Torvalds 					struct sctp_paramhdr *param,
16201da177e4SLinus Torvalds 					const struct sctp_chunk *chunk,
16211da177e4SLinus Torvalds 					struct sctp_chunk **errp)
16221da177e4SLinus Torvalds {
16231da177e4SLinus Torvalds 	char		error[] = "The following parameter had invalid length:";
16241da177e4SLinus Torvalds 	size_t		payload_len = WORD_ROUND(sizeof(error)) +
16251da177e4SLinus Torvalds 						sizeof(sctp_paramhdr_t);
16261da177e4SLinus Torvalds 
16271da177e4SLinus Torvalds 
16281da177e4SLinus Torvalds 	/* Create an error chunk and fill it in with our payload. */
16291da177e4SLinus Torvalds 	if (!*errp)
16301da177e4SLinus Torvalds 		*errp = sctp_make_op_error_space(asoc, chunk, payload_len);
16311da177e4SLinus Torvalds 
16321da177e4SLinus Torvalds 	if (*errp) {
163300f1c2dfSWei Yongjun 		sctp_init_cause(*errp, SCTP_ERROR_PROTO_VIOLATION,
163400f1c2dfSWei Yongjun 				sizeof(error) + sizeof(sctp_paramhdr_t));
163500f1c2dfSWei Yongjun 		sctp_addto_chunk(*errp, sizeof(error), error);
163600f1c2dfSWei Yongjun 		sctp_addto_param(*errp, sizeof(sctp_paramhdr_t), param);
16371da177e4SLinus Torvalds 	}
16381da177e4SLinus Torvalds 
16391da177e4SLinus Torvalds 	return 0;
16401da177e4SLinus Torvalds }
16411da177e4SLinus Torvalds 
16421da177e4SLinus Torvalds 
16431da177e4SLinus Torvalds /* Do not attempt to handle the HOST_NAME parm.  However, do
16441da177e4SLinus Torvalds  * send back an indicator to the peer.
16451da177e4SLinus Torvalds  */
16461da177e4SLinus Torvalds static int sctp_process_hn_param(const struct sctp_association *asoc,
16471da177e4SLinus Torvalds 				 union sctp_params param,
16481da177e4SLinus Torvalds 				 struct sctp_chunk *chunk,
16491da177e4SLinus Torvalds 				 struct sctp_chunk **errp)
16501da177e4SLinus Torvalds {
16511da177e4SLinus Torvalds 	__u16 len = ntohs(param.p->length);
16521da177e4SLinus Torvalds 
16531da177e4SLinus Torvalds 	/* Make an ERROR chunk. */
16541da177e4SLinus Torvalds 	if (!*errp)
16551da177e4SLinus Torvalds 		*errp = sctp_make_op_error_space(asoc, chunk, len);
16561da177e4SLinus Torvalds 
165700f1c2dfSWei Yongjun 	if (*errp) {
165800f1c2dfSWei Yongjun 		sctp_init_cause(*errp, SCTP_ERROR_DNS_FAILED, len);
165900f1c2dfSWei Yongjun 		sctp_addto_chunk(*errp, len, param.v);
166000f1c2dfSWei Yongjun 	}
16611da177e4SLinus Torvalds 
16621da177e4SLinus Torvalds 	/* Stop processing this chunk. */
16631da177e4SLinus Torvalds 	return 0;
16641da177e4SLinus Torvalds }
16651da177e4SLinus Torvalds 
16661da177e4SLinus Torvalds /* RFC 3.2.1 & the Implementers Guide 2.2.
16671da177e4SLinus Torvalds  *
16681da177e4SLinus Torvalds  * The Parameter Types are encoded such that the
16691da177e4SLinus Torvalds  * highest-order two bits specify the action that must be
16701da177e4SLinus Torvalds  * taken if the processing endpoint does not recognize the
16711da177e4SLinus Torvalds  * Parameter Type.
16721da177e4SLinus Torvalds  *
16731da177e4SLinus Torvalds  * 00 - Stop processing this SCTP chunk and discard it,
16741da177e4SLinus Torvalds  *	do not process any further chunks within it.
16751da177e4SLinus Torvalds  *
16761da177e4SLinus Torvalds  * 01 - Stop processing this SCTP chunk and discard it,
16771da177e4SLinus Torvalds  *	do not process any further chunks within it, and report
16781da177e4SLinus Torvalds  *	the unrecognized parameter in an 'Unrecognized
16791da177e4SLinus Torvalds  *	Parameter Type' (in either an ERROR or in the INIT ACK).
16801da177e4SLinus Torvalds  *
16811da177e4SLinus Torvalds  * 10 - Skip this parameter and continue processing.
16821da177e4SLinus Torvalds  *
16831da177e4SLinus Torvalds  * 11 - Skip this parameter and continue processing but
16841da177e4SLinus Torvalds  *	report the unrecognized parameter in an
16851da177e4SLinus Torvalds  *	'Unrecognized Parameter Type' (in either an ERROR or in
16861da177e4SLinus Torvalds  *	the INIT ACK).
16871da177e4SLinus Torvalds  *
16881da177e4SLinus Torvalds  * Return value:
16891da177e4SLinus Torvalds  * 	0 - discard the chunk
16901da177e4SLinus Torvalds  * 	1 - continue with the chunk
16911da177e4SLinus Torvalds  */
16921da177e4SLinus Torvalds static int sctp_process_unk_param(const struct sctp_association *asoc,
16931da177e4SLinus Torvalds 				  union sctp_params param,
16941da177e4SLinus Torvalds 				  struct sctp_chunk *chunk,
16951da177e4SLinus Torvalds 				  struct sctp_chunk **errp)
16961da177e4SLinus Torvalds {
16971da177e4SLinus Torvalds 	int retval = 1;
16981da177e4SLinus Torvalds 
16991da177e4SLinus Torvalds 	switch (param.p->type & SCTP_PARAM_ACTION_MASK) {
17001da177e4SLinus Torvalds 	case SCTP_PARAM_ACTION_DISCARD:
17011da177e4SLinus Torvalds 		retval =  0;
17021da177e4SLinus Torvalds 		break;
17031da177e4SLinus Torvalds 	case SCTP_PARAM_ACTION_DISCARD_ERR:
17041da177e4SLinus Torvalds 		retval =  0;
17051da177e4SLinus Torvalds 		/* Make an ERROR chunk, preparing enough room for
17061da177e4SLinus Torvalds 		 * returning multiple unknown parameters.
17071da177e4SLinus Torvalds 		 */
17081da177e4SLinus Torvalds 		if (NULL == *errp)
17091da177e4SLinus Torvalds 			*errp = sctp_make_op_error_space(asoc, chunk,
17101da177e4SLinus Torvalds 					ntohs(chunk->chunk_hdr->length));
17111da177e4SLinus Torvalds 
171200f1c2dfSWei Yongjun 		if (*errp) {
17131da177e4SLinus Torvalds 			sctp_init_cause(*errp, SCTP_ERROR_UNKNOWN_PARAM,
17141da177e4SLinus Torvalds 					WORD_ROUND(ntohs(param.p->length)));
171500f1c2dfSWei Yongjun 			sctp_addto_chunk(*errp,
171600f1c2dfSWei Yongjun 					WORD_ROUND(ntohs(param.p->length)),
171700f1c2dfSWei Yongjun 					param.v);
171800f1c2dfSWei Yongjun 		}
17191da177e4SLinus Torvalds 
17201da177e4SLinus Torvalds 		break;
17211da177e4SLinus Torvalds 	case SCTP_PARAM_ACTION_SKIP:
17221da177e4SLinus Torvalds 		break;
17231da177e4SLinus Torvalds 	case SCTP_PARAM_ACTION_SKIP_ERR:
17241da177e4SLinus Torvalds 		/* Make an ERROR chunk, preparing enough room for
17251da177e4SLinus Torvalds 		 * returning multiple unknown parameters.
17261da177e4SLinus Torvalds 		 */
17271da177e4SLinus Torvalds 		if (NULL == *errp)
17281da177e4SLinus Torvalds 			*errp = sctp_make_op_error_space(asoc, chunk,
17291da177e4SLinus Torvalds 					ntohs(chunk->chunk_hdr->length));
17301da177e4SLinus Torvalds 
17311da177e4SLinus Torvalds 		if (*errp) {
17321da177e4SLinus Torvalds 			sctp_init_cause(*errp, SCTP_ERROR_UNKNOWN_PARAM,
17331da177e4SLinus Torvalds 					WORD_ROUND(ntohs(param.p->length)));
173400f1c2dfSWei Yongjun 			sctp_addto_chunk(*errp,
173500f1c2dfSWei Yongjun 					WORD_ROUND(ntohs(param.p->length)),
173600f1c2dfSWei Yongjun 					param.v);
17371da177e4SLinus Torvalds 		} else {
17381da177e4SLinus Torvalds 			/* If there is no memory for generating the ERROR
17391da177e4SLinus Torvalds 			 * report as specified, an ABORT will be triggered
17401da177e4SLinus Torvalds 			 * to the peer and the association won't be
17411da177e4SLinus Torvalds 			 * established.
17421da177e4SLinus Torvalds 			 */
17431da177e4SLinus Torvalds 			retval = 0;
17441da177e4SLinus Torvalds 		}
17451da177e4SLinus Torvalds 
17461da177e4SLinus Torvalds 		break;
17471da177e4SLinus Torvalds 	default:
17481da177e4SLinus Torvalds 		break;
17491da177e4SLinus Torvalds 	}
17501da177e4SLinus Torvalds 
17511da177e4SLinus Torvalds 	return retval;
17521da177e4SLinus Torvalds }
17531da177e4SLinus Torvalds 
17541da177e4SLinus Torvalds /* Find unrecognized parameters in the chunk.
17551da177e4SLinus Torvalds  * Return values:
17561da177e4SLinus Torvalds  * 	0 - discard the chunk
17571da177e4SLinus Torvalds  * 	1 - continue with the chunk
17581da177e4SLinus Torvalds  */
17591da177e4SLinus Torvalds static int sctp_verify_param(const struct sctp_association *asoc,
17601da177e4SLinus Torvalds 			     union sctp_params param,
17611da177e4SLinus Torvalds 			     sctp_cid_t cid,
17621da177e4SLinus Torvalds 			     struct sctp_chunk *chunk,
17631da177e4SLinus Torvalds 			     struct sctp_chunk **err_chunk)
17641da177e4SLinus Torvalds {
17651da177e4SLinus Torvalds 	int retval = 1;
17661da177e4SLinus Torvalds 
17671da177e4SLinus Torvalds 	/* FIXME - This routine is not looking at each parameter per the
17681da177e4SLinus Torvalds 	 * chunk type, i.e., unrecognized parameters should be further
17691da177e4SLinus Torvalds 	 * identified based on the chunk id.
17701da177e4SLinus Torvalds 	 */
17711da177e4SLinus Torvalds 
17721da177e4SLinus Torvalds 	switch (param.p->type) {
17731da177e4SLinus Torvalds 	case SCTP_PARAM_IPV4_ADDRESS:
17741da177e4SLinus Torvalds 	case SCTP_PARAM_IPV6_ADDRESS:
17751da177e4SLinus Torvalds 	case SCTP_PARAM_COOKIE_PRESERVATIVE:
17761da177e4SLinus Torvalds 	case SCTP_PARAM_SUPPORTED_ADDRESS_TYPES:
17771da177e4SLinus Torvalds 	case SCTP_PARAM_STATE_COOKIE:
17781da177e4SLinus Torvalds 	case SCTP_PARAM_HEARTBEAT_INFO:
17791da177e4SLinus Torvalds 	case SCTP_PARAM_UNRECOGNIZED_PARAMETERS:
17801da177e4SLinus Torvalds 	case SCTP_PARAM_ECN_CAPABLE:
17810f3fffd8SIvan Skytte Jorgensen 	case SCTP_PARAM_ADAPTATION_LAYER_IND:
17821da177e4SLinus Torvalds 		break;
17831da177e4SLinus Torvalds 
17841da177e4SLinus Torvalds 	case SCTP_PARAM_HOST_NAME_ADDRESS:
17851da177e4SLinus Torvalds 		/* Tell the peer, we won't support this param.  */
17861da177e4SLinus Torvalds 		return sctp_process_hn_param(asoc, param, chunk, err_chunk);
17871da177e4SLinus Torvalds 	case SCTP_PARAM_FWD_TSN_SUPPORT:
17881da177e4SLinus Torvalds 		if (sctp_prsctp_enable)
17891da177e4SLinus Torvalds 			break;
17901da177e4SLinus Torvalds 		/* Fall Through */
17911da177e4SLinus Torvalds 	default:
17921da177e4SLinus Torvalds 		SCTP_DEBUG_PRINTK("Unrecognized param: %d for chunk %d.\n",
17931da177e4SLinus Torvalds 				ntohs(param.p->type), cid);
17941da177e4SLinus Torvalds 		return sctp_process_unk_param(asoc, param, chunk, err_chunk);
17951da177e4SLinus Torvalds 
17961da177e4SLinus Torvalds 		break;
17971da177e4SLinus Torvalds 	}
17981da177e4SLinus Torvalds 	return retval;
17991da177e4SLinus Torvalds }
18001da177e4SLinus Torvalds 
18011da177e4SLinus Torvalds /* Verify the INIT packet before we process it.  */
18021da177e4SLinus Torvalds int sctp_verify_init(const struct sctp_association *asoc,
18031da177e4SLinus Torvalds 		     sctp_cid_t cid,
18041da177e4SLinus Torvalds 		     sctp_init_chunk_t *peer_init,
18051da177e4SLinus Torvalds 		     struct sctp_chunk *chunk,
18061da177e4SLinus Torvalds 		     struct sctp_chunk **errp)
18071da177e4SLinus Torvalds {
18081da177e4SLinus Torvalds 	union sctp_params param;
18091da177e4SLinus Torvalds 	int has_cookie = 0;
18101da177e4SLinus Torvalds 
18111da177e4SLinus Torvalds 	/* Verify stream values are non-zero. */
18121da177e4SLinus Torvalds 	if ((0 == peer_init->init_hdr.num_outbound_streams) ||
1813d023f629SVlad Yasevich 	    (0 == peer_init->init_hdr.num_inbound_streams) ||
1814d023f629SVlad Yasevich 	    (0 == peer_init->init_hdr.init_tag) ||
1815d023f629SVlad Yasevich 	    (SCTP_DEFAULT_MINWINDOW > ntohl(peer_init->init_hdr.a_rwnd))) {
18161da177e4SLinus Torvalds 
18171da177e4SLinus Torvalds 		sctp_process_inv_mandatory(asoc, chunk, errp);
18181da177e4SLinus Torvalds 		return 0;
18191da177e4SLinus Torvalds 	}
18201da177e4SLinus Torvalds 
18211da177e4SLinus Torvalds 	/* Check for missing mandatory parameters.  */
18221da177e4SLinus Torvalds 	sctp_walk_params(param, peer_init, init_hdr.params) {
18231da177e4SLinus Torvalds 
18241da177e4SLinus Torvalds 		if (SCTP_PARAM_STATE_COOKIE == param.p->type)
18251da177e4SLinus Torvalds 			has_cookie = 1;
18261da177e4SLinus Torvalds 
18271da177e4SLinus Torvalds 	} /* for (loop through all parameters) */
18281da177e4SLinus Torvalds 
18291da177e4SLinus Torvalds 	/* There is a possibility that a parameter length was bad and
18301da177e4SLinus Torvalds 	 * in that case we would have stoped walking the parameters.
18311da177e4SLinus Torvalds 	 * The current param.p would point at the bad one.
18321da177e4SLinus Torvalds 	 * Current consensus on the mailing list is to generate a PROTOCOL
18331da177e4SLinus Torvalds 	 * VIOLATION error.  We build the ERROR chunk here and let the normal
18341da177e4SLinus Torvalds 	 * error handling code build and send the packet.
18351da177e4SLinus Torvalds 	 */
1836cb243a1aSWei Yongjun 	if (param.v != (void*)chunk->chunk_end) {
18371da177e4SLinus Torvalds 		sctp_process_inv_paramlength(asoc, param.p, chunk, errp);
18381da177e4SLinus Torvalds 		return 0;
18391da177e4SLinus Torvalds 	}
18401da177e4SLinus Torvalds 
18411da177e4SLinus Torvalds 	/* The only missing mandatory param possible today is
18421da177e4SLinus Torvalds 	 * the state cookie for an INIT-ACK chunk.
18431da177e4SLinus Torvalds 	 */
18441da177e4SLinus Torvalds 	if ((SCTP_CID_INIT_ACK == cid) && !has_cookie) {
18451da177e4SLinus Torvalds 		sctp_process_missing_param(asoc, SCTP_PARAM_STATE_COOKIE,
18461da177e4SLinus Torvalds 					   chunk, errp);
18471da177e4SLinus Torvalds 		return 0;
18481da177e4SLinus Torvalds 	}
18491da177e4SLinus Torvalds 
18501da177e4SLinus Torvalds 	/* Find unrecognized parameters. */
18511da177e4SLinus Torvalds 
18521da177e4SLinus Torvalds 	sctp_walk_params(param, peer_init, init_hdr.params) {
18531da177e4SLinus Torvalds 
18541da177e4SLinus Torvalds 		if (!sctp_verify_param(asoc, param, cid, chunk, errp)) {
18551da177e4SLinus Torvalds 			if (SCTP_PARAM_HOST_NAME_ADDRESS == param.p->type)
18561da177e4SLinus Torvalds 				return 0;
18571da177e4SLinus Torvalds 			else
18581da177e4SLinus Torvalds 				return 1;
18591da177e4SLinus Torvalds 		}
18601da177e4SLinus Torvalds 
18611da177e4SLinus Torvalds 	} /* for (loop through all parameters) */
18621da177e4SLinus Torvalds 
18631da177e4SLinus Torvalds 	return 1;
18641da177e4SLinus Torvalds }
18651da177e4SLinus Torvalds 
18661da177e4SLinus Torvalds /* Unpack the parameters in an INIT packet into an association.
18671da177e4SLinus Torvalds  * Returns 0 on failure, else success.
18681da177e4SLinus Torvalds  * FIXME:  This is an association method.
18691da177e4SLinus Torvalds  */
18701da177e4SLinus Torvalds int sctp_process_init(struct sctp_association *asoc, sctp_cid_t cid,
18711da177e4SLinus Torvalds 		      const union sctp_addr *peer_addr,
1872dd0fc66fSAl Viro 		      sctp_init_chunk_t *peer_init, gfp_t gfp)
18731da177e4SLinus Torvalds {
18741da177e4SLinus Torvalds 	union sctp_params param;
18751da177e4SLinus Torvalds 	struct sctp_transport *transport;
18761da177e4SLinus Torvalds 	struct list_head *pos, *temp;
18771da177e4SLinus Torvalds 	char *cookie;
18781da177e4SLinus Torvalds 
18791da177e4SLinus Torvalds 	/* We must include the address that the INIT packet came from.
18801da177e4SLinus Torvalds 	 * This is the only address that matters for an INIT packet.
18811da177e4SLinus Torvalds 	 * When processing a COOKIE ECHO, we retrieve the from address
18821da177e4SLinus Torvalds 	 * of the INIT from the cookie.
18831da177e4SLinus Torvalds 	 */
18841da177e4SLinus Torvalds 
18851da177e4SLinus Torvalds 	/* This implementation defaults to making the first transport
18861da177e4SLinus Torvalds 	 * added as the primary transport.  The source address seems to
18871da177e4SLinus Torvalds 	 * be a a better choice than any of the embedded addresses.
18881da177e4SLinus Torvalds 	 */
18894bdf4b5fSAl Viro 	if (peer_addr) {
18906a1e5f33SAl Viro 		if(!sctp_assoc_add_peer(asoc, peer_addr, gfp, SCTP_ACTIVE))
18911da177e4SLinus Torvalds 			goto nomem;
18924bdf4b5fSAl Viro 	}
18931da177e4SLinus Torvalds 
18941da177e4SLinus Torvalds 	/* Process the initialization parameters.  */
18951da177e4SLinus Torvalds 
18961da177e4SLinus Torvalds 	sctp_walk_params(param, peer_init, init_hdr.params) {
18971da177e4SLinus Torvalds 
18981da177e4SLinus Torvalds 		if (!sctp_process_param(asoc, param, peer_addr, gfp))
18991da177e4SLinus Torvalds 			goto clean_up;
19001da177e4SLinus Torvalds 	}
19011da177e4SLinus Torvalds 
19023f7a87d2SFrank Filz 	/* Walk list of transports, removing transports in the UNKNOWN state. */
19033f7a87d2SFrank Filz 	list_for_each_safe(pos, temp, &asoc->peer.transport_addr_list) {
19043f7a87d2SFrank Filz 		transport = list_entry(pos, struct sctp_transport, transports);
19053f7a87d2SFrank Filz 		if (transport->state == SCTP_UNKNOWN) {
19063f7a87d2SFrank Filz 			sctp_assoc_rm_peer(asoc, transport);
19073f7a87d2SFrank Filz 		}
19083f7a87d2SFrank Filz 	}
19093f7a87d2SFrank Filz 
19101da177e4SLinus Torvalds 	/* The fixed INIT headers are always in network byte
19111da177e4SLinus Torvalds 	 * order.
19121da177e4SLinus Torvalds 	 */
19131da177e4SLinus Torvalds 	asoc->peer.i.init_tag =
19141da177e4SLinus Torvalds 		ntohl(peer_init->init_hdr.init_tag);
19151da177e4SLinus Torvalds 	asoc->peer.i.a_rwnd =
19161da177e4SLinus Torvalds 		ntohl(peer_init->init_hdr.a_rwnd);
19171da177e4SLinus Torvalds 	asoc->peer.i.num_outbound_streams =
19181da177e4SLinus Torvalds 		ntohs(peer_init->init_hdr.num_outbound_streams);
19191da177e4SLinus Torvalds 	asoc->peer.i.num_inbound_streams =
19201da177e4SLinus Torvalds 		ntohs(peer_init->init_hdr.num_inbound_streams);
19211da177e4SLinus Torvalds 	asoc->peer.i.initial_tsn =
19221da177e4SLinus Torvalds 		ntohl(peer_init->init_hdr.initial_tsn);
19231da177e4SLinus Torvalds 
19241da177e4SLinus Torvalds 	/* Apply the upper bounds for output streams based on peer's
19251da177e4SLinus Torvalds 	 * number of inbound streams.
19261da177e4SLinus Torvalds 	 */
19271da177e4SLinus Torvalds 	if (asoc->c.sinit_num_ostreams  >
19281da177e4SLinus Torvalds 	    ntohs(peer_init->init_hdr.num_inbound_streams)) {
19291da177e4SLinus Torvalds 		asoc->c.sinit_num_ostreams =
19301da177e4SLinus Torvalds 			ntohs(peer_init->init_hdr.num_inbound_streams);
19311da177e4SLinus Torvalds 	}
19321da177e4SLinus Torvalds 
19331da177e4SLinus Torvalds 	if (asoc->c.sinit_max_instreams >
19341da177e4SLinus Torvalds 	    ntohs(peer_init->init_hdr.num_outbound_streams)) {
19351da177e4SLinus Torvalds 		asoc->c.sinit_max_instreams =
19361da177e4SLinus Torvalds 			ntohs(peer_init->init_hdr.num_outbound_streams);
19371da177e4SLinus Torvalds 	}
19381da177e4SLinus Torvalds 
19391da177e4SLinus Torvalds 	/* Copy Initiation tag from INIT to VT_peer in cookie.   */
19401da177e4SLinus Torvalds 	asoc->c.peer_vtag = asoc->peer.i.init_tag;
19411da177e4SLinus Torvalds 
19421da177e4SLinus Torvalds 	/* Peer Rwnd   : Current calculated value of the peer's rwnd.  */
19431da177e4SLinus Torvalds 	asoc->peer.rwnd = asoc->peer.i.a_rwnd;
19441da177e4SLinus Torvalds 
19451da177e4SLinus Torvalds 	/* Copy cookie in case we need to resend COOKIE-ECHO. */
19461da177e4SLinus Torvalds 	cookie = asoc->peer.cookie;
19471da177e4SLinus Torvalds 	if (cookie) {
1948af997d8cSArnaldo Carvalho de Melo 		asoc->peer.cookie = kmemdup(cookie, asoc->peer.cookie_len, gfp);
19491da177e4SLinus Torvalds 		if (!asoc->peer.cookie)
19501da177e4SLinus Torvalds 			goto clean_up;
19511da177e4SLinus Torvalds 	}
19521da177e4SLinus Torvalds 
19531da177e4SLinus Torvalds 	/* RFC 2960 7.2.1 The initial value of ssthresh MAY be arbitrarily
19541da177e4SLinus Torvalds 	 * high (for example, implementations MAY use the size of the receiver
19551da177e4SLinus Torvalds 	 * advertised window).
19561da177e4SLinus Torvalds 	 */
19571da177e4SLinus Torvalds 	list_for_each(pos, &asoc->peer.transport_addr_list) {
19581da177e4SLinus Torvalds 		transport = list_entry(pos, struct sctp_transport, transports);
19591da177e4SLinus Torvalds 		transport->ssthresh = asoc->peer.i.a_rwnd;
19601da177e4SLinus Torvalds 	}
19611da177e4SLinus Torvalds 
19621da177e4SLinus Torvalds 	/* Set up the TSN tracking pieces.  */
19631da177e4SLinus Torvalds 	sctp_tsnmap_init(&asoc->peer.tsn_map, SCTP_TSN_MAP_SIZE,
19641da177e4SLinus Torvalds 			 asoc->peer.i.initial_tsn);
19651da177e4SLinus Torvalds 
19661da177e4SLinus Torvalds 	/* RFC 2960 6.5 Stream Identifier and Stream Sequence Number
19671da177e4SLinus Torvalds 	 *
19681da177e4SLinus Torvalds 	 * The stream sequence number in all the streams shall start
19691da177e4SLinus Torvalds 	 * from 0 when the association is established.  Also, when the
19701da177e4SLinus Torvalds 	 * stream sequence number reaches the value 65535 the next
19711da177e4SLinus Torvalds 	 * stream sequence number shall be set to 0.
19721da177e4SLinus Torvalds 	 */
19731da177e4SLinus Torvalds 
19743f7a87d2SFrank Filz 	/* Allocate storage for the negotiated streams if it is not a temporary
19753f7a87d2SFrank Filz 	 * association.
19761da177e4SLinus Torvalds 	 */
19771da177e4SLinus Torvalds 	if (!asoc->temp) {
19781da177e4SLinus Torvalds 		int error;
19791da177e4SLinus Torvalds 
19801da177e4SLinus Torvalds 		asoc->ssnmap = sctp_ssnmap_new(asoc->c.sinit_max_instreams,
19811da177e4SLinus Torvalds 					       asoc->c.sinit_num_ostreams, gfp);
19821da177e4SLinus Torvalds 		if (!asoc->ssnmap)
19831da177e4SLinus Torvalds 			goto clean_up;
19841da177e4SLinus Torvalds 
198507d93967SVlad Yasevich 		error = sctp_assoc_set_id(asoc, gfp);
198607d93967SVlad Yasevich 		if (error)
19871da177e4SLinus Torvalds 			goto clean_up;
19881da177e4SLinus Torvalds 	}
19891da177e4SLinus Torvalds 
19901da177e4SLinus Torvalds 	/* ADDIP Section 4.1 ASCONF Chunk Procedures
19911da177e4SLinus Torvalds 	 *
19921da177e4SLinus Torvalds 	 * When an endpoint has an ASCONF signaled change to be sent to the
19931da177e4SLinus Torvalds 	 * remote endpoint it should do the following:
19941da177e4SLinus Torvalds 	 * ...
19951da177e4SLinus Torvalds 	 * A2) A serial number should be assigned to the Chunk. The serial
19961da177e4SLinus Torvalds 	 * number should be a monotonically increasing number. All serial
19971da177e4SLinus Torvalds 	 * numbers are defined to be initialized at the start of the
19981da177e4SLinus Torvalds 	 * association to the same value as the Initial TSN.
19991da177e4SLinus Torvalds 	 */
20001da177e4SLinus Torvalds 	asoc->peer.addip_serial = asoc->peer.i.initial_tsn - 1;
20011da177e4SLinus Torvalds 	return 1;
20021da177e4SLinus Torvalds 
20031da177e4SLinus Torvalds clean_up:
20041da177e4SLinus Torvalds 	/* Release the transport structures. */
20051da177e4SLinus Torvalds 	list_for_each_safe(pos, temp, &asoc->peer.transport_addr_list) {
20061da177e4SLinus Torvalds 		transport = list_entry(pos, struct sctp_transport, transports);
20071da177e4SLinus Torvalds 		list_del_init(pos);
20081da177e4SLinus Torvalds 		sctp_transport_free(transport);
20091da177e4SLinus Torvalds 	}
20103f7a87d2SFrank Filz 
20113f7a87d2SFrank Filz 	asoc->peer.transport_count = 0;
20123f7a87d2SFrank Filz 
20131da177e4SLinus Torvalds nomem:
20141da177e4SLinus Torvalds 	return 0;
20151da177e4SLinus Torvalds }
20161da177e4SLinus Torvalds 
20171da177e4SLinus Torvalds 
20181da177e4SLinus Torvalds /* Update asoc with the option described in param.
20191da177e4SLinus Torvalds  *
20201da177e4SLinus Torvalds  * RFC2960 3.3.2.1 Optional/Variable Length Parameters in INIT
20211da177e4SLinus Torvalds  *
20221da177e4SLinus Torvalds  * asoc is the association to update.
20231da177e4SLinus Torvalds  * param is the variable length parameter to use for update.
20241da177e4SLinus Torvalds  * cid tells us if this is an INIT, INIT ACK or COOKIE ECHO.
20251da177e4SLinus Torvalds  * If the current packet is an INIT we want to minimize the amount of
20261da177e4SLinus Torvalds  * work we do.  In particular, we should not build transport
20271da177e4SLinus Torvalds  * structures for the addresses.
20281da177e4SLinus Torvalds  */
20291da177e4SLinus Torvalds static int sctp_process_param(struct sctp_association *asoc,
20301da177e4SLinus Torvalds 			      union sctp_params param,
20311da177e4SLinus Torvalds 			      const union sctp_addr *peer_addr,
2032dd0fc66fSAl Viro 			      gfp_t gfp)
20331da177e4SLinus Torvalds {
20341da177e4SLinus Torvalds 	union sctp_addr addr;
20351da177e4SLinus Torvalds 	int i;
20361da177e4SLinus Torvalds 	__u16 sat;
20371da177e4SLinus Torvalds 	int retval = 1;
20381da177e4SLinus Torvalds 	sctp_scope_t scope;
20391da177e4SLinus Torvalds 	time_t stale;
20401da177e4SLinus Torvalds 	struct sctp_af *af;
20411da177e4SLinus Torvalds 
20421da177e4SLinus Torvalds 	/* We maintain all INIT parameters in network byte order all the
20431da177e4SLinus Torvalds 	 * time.  This allows us to not worry about whether the parameters
20441da177e4SLinus Torvalds 	 * came from a fresh INIT, and INIT ACK, or were stored in a cookie.
20451da177e4SLinus Torvalds 	 */
20461da177e4SLinus Torvalds 	switch (param.p->type) {
20471da177e4SLinus Torvalds 	case SCTP_PARAM_IPV6_ADDRESS:
20481da177e4SLinus Torvalds 		if (PF_INET6 != asoc->base.sk->sk_family)
20491da177e4SLinus Torvalds 			break;
20501da177e4SLinus Torvalds 		/* Fall through. */
20511da177e4SLinus Torvalds 	case SCTP_PARAM_IPV4_ADDRESS:
20521da177e4SLinus Torvalds 		af = sctp_get_af_specific(param_type2af(param.p->type));
2053dd86d136SAl Viro 		af->from_addr_param(&addr, param.addr, htons(asoc->peer.port), 0);
20541da177e4SLinus Torvalds 		scope = sctp_scope(peer_addr);
2055dd86d136SAl Viro 		if (sctp_in_scope(&addr, scope))
2056dd86d136SAl Viro 			if (!sctp_assoc_add_peer(asoc, &addr, gfp, SCTP_UNCONFIRMED))
20571da177e4SLinus Torvalds 				return 0;
20581da177e4SLinus Torvalds 		break;
20591da177e4SLinus Torvalds 
20601da177e4SLinus Torvalds 	case SCTP_PARAM_COOKIE_PRESERVATIVE:
20611da177e4SLinus Torvalds 		if (!sctp_cookie_preserve_enable)
20621da177e4SLinus Torvalds 			break;
20631da177e4SLinus Torvalds 
20641da177e4SLinus Torvalds 		stale = ntohl(param.life->lifespan_increment);
20651da177e4SLinus Torvalds 
20661da177e4SLinus Torvalds 		/* Suggested Cookie Life span increment's unit is msec,
20671da177e4SLinus Torvalds 		 * (1/1000sec).
20681da177e4SLinus Torvalds 		 */
20691da177e4SLinus Torvalds 		asoc->cookie_life.tv_sec += stale / 1000;
20701da177e4SLinus Torvalds 		asoc->cookie_life.tv_usec += (stale % 1000) * 1000;
20711da177e4SLinus Torvalds 		break;
20721da177e4SLinus Torvalds 
20731da177e4SLinus Torvalds 	case SCTP_PARAM_HOST_NAME_ADDRESS:
20741da177e4SLinus Torvalds 		SCTP_DEBUG_PRINTK("unimplemented SCTP_HOST_NAME_ADDRESS\n");
20751da177e4SLinus Torvalds 		break;
20761da177e4SLinus Torvalds 
20771da177e4SLinus Torvalds 	case SCTP_PARAM_SUPPORTED_ADDRESS_TYPES:
20781da177e4SLinus Torvalds 		/* Turn off the default values first so we'll know which
20791da177e4SLinus Torvalds 		 * ones are really set by the peer.
20801da177e4SLinus Torvalds 		 */
20811da177e4SLinus Torvalds 		asoc->peer.ipv4_address = 0;
20821da177e4SLinus Torvalds 		asoc->peer.ipv6_address = 0;
20831da177e4SLinus Torvalds 
20841da177e4SLinus Torvalds 		/* Cycle through address types; avoid divide by 0. */
20851da177e4SLinus Torvalds 		sat = ntohs(param.p->length) - sizeof(sctp_paramhdr_t);
20861da177e4SLinus Torvalds 		if (sat)
20871da177e4SLinus Torvalds 			sat /= sizeof(__u16);
20881da177e4SLinus Torvalds 
20891da177e4SLinus Torvalds 		for (i = 0; i < sat; ++i) {
20901da177e4SLinus Torvalds 			switch (param.sat->types[i]) {
20911da177e4SLinus Torvalds 			case SCTP_PARAM_IPV4_ADDRESS:
20921da177e4SLinus Torvalds 				asoc->peer.ipv4_address = 1;
20931da177e4SLinus Torvalds 				break;
20941da177e4SLinus Torvalds 
20951da177e4SLinus Torvalds 			case SCTP_PARAM_IPV6_ADDRESS:
20961da177e4SLinus Torvalds 				asoc->peer.ipv6_address = 1;
20971da177e4SLinus Torvalds 				break;
20981da177e4SLinus Torvalds 
20991da177e4SLinus Torvalds 			case SCTP_PARAM_HOST_NAME_ADDRESS:
21001da177e4SLinus Torvalds 				asoc->peer.hostname_address = 1;
21011da177e4SLinus Torvalds 				break;
21021da177e4SLinus Torvalds 
21031da177e4SLinus Torvalds 			default: /* Just ignore anything else.  */
21041da177e4SLinus Torvalds 				break;
21053ff50b79SStephen Hemminger 			}
21061da177e4SLinus Torvalds 		}
21071da177e4SLinus Torvalds 		break;
21081da177e4SLinus Torvalds 
21091da177e4SLinus Torvalds 	case SCTP_PARAM_STATE_COOKIE:
21101da177e4SLinus Torvalds 		asoc->peer.cookie_len =
21111da177e4SLinus Torvalds 			ntohs(param.p->length) - sizeof(sctp_paramhdr_t);
21121da177e4SLinus Torvalds 		asoc->peer.cookie = param.cookie->body;
21131da177e4SLinus Torvalds 		break;
21141da177e4SLinus Torvalds 
21151da177e4SLinus Torvalds 	case SCTP_PARAM_HEARTBEAT_INFO:
21161da177e4SLinus Torvalds 		/* Would be odd to receive, but it causes no problems. */
21171da177e4SLinus Torvalds 		break;
21181da177e4SLinus Torvalds 
21191da177e4SLinus Torvalds 	case SCTP_PARAM_UNRECOGNIZED_PARAMETERS:
21201da177e4SLinus Torvalds 		/* Rejected during verify stage. */
21211da177e4SLinus Torvalds 		break;
21221da177e4SLinus Torvalds 
21231da177e4SLinus Torvalds 	case SCTP_PARAM_ECN_CAPABLE:
21241da177e4SLinus Torvalds 		asoc->peer.ecn_capable = 1;
21251da177e4SLinus Torvalds 		break;
21261da177e4SLinus Torvalds 
21270f3fffd8SIvan Skytte Jorgensen 	case SCTP_PARAM_ADAPTATION_LAYER_IND:
21280f3fffd8SIvan Skytte Jorgensen 		asoc->peer.adaptation_ind = param.aind->adaptation_ind;
21291da177e4SLinus Torvalds 		break;
21301da177e4SLinus Torvalds 
21311da177e4SLinus Torvalds 	case SCTP_PARAM_FWD_TSN_SUPPORT:
21321da177e4SLinus Torvalds 		if (sctp_prsctp_enable) {
21331da177e4SLinus Torvalds 			asoc->peer.prsctp_capable = 1;
21341da177e4SLinus Torvalds 			break;
21351da177e4SLinus Torvalds 		}
21361da177e4SLinus Torvalds 		/* Fall Through */
21371da177e4SLinus Torvalds 	default:
21381da177e4SLinus Torvalds 		/* Any unrecognized parameters should have been caught
21391da177e4SLinus Torvalds 		 * and handled by sctp_verify_param() which should be
21401da177e4SLinus Torvalds 		 * called prior to this routine.  Simply log the error
21411da177e4SLinus Torvalds 		 * here.
21421da177e4SLinus Torvalds 		 */
21431da177e4SLinus Torvalds 		SCTP_DEBUG_PRINTK("Ignoring param: %d for association %p.\n",
21441da177e4SLinus Torvalds 				  ntohs(param.p->type), asoc);
21451da177e4SLinus Torvalds 		break;
21463ff50b79SStephen Hemminger 	}
21471da177e4SLinus Torvalds 
21481da177e4SLinus Torvalds 	return retval;
21491da177e4SLinus Torvalds }
21501da177e4SLinus Torvalds 
21511da177e4SLinus Torvalds /* Select a new verification tag.  */
21521da177e4SLinus Torvalds __u32 sctp_generate_tag(const struct sctp_endpoint *ep)
21531da177e4SLinus Torvalds {
21541da177e4SLinus Torvalds 	/* I believe that this random number generator complies with RFC1750.
21551da177e4SLinus Torvalds 	 * A tag of 0 is reserved for special cases (e.g. INIT).
21561da177e4SLinus Torvalds 	 */
21571da177e4SLinus Torvalds 	__u32 x;
21581da177e4SLinus Torvalds 
21591da177e4SLinus Torvalds 	do {
21601da177e4SLinus Torvalds 		get_random_bytes(&x, sizeof(__u32));
21611da177e4SLinus Torvalds 	} while (x == 0);
21621da177e4SLinus Torvalds 
21631da177e4SLinus Torvalds 	return x;
21641da177e4SLinus Torvalds }
21651da177e4SLinus Torvalds 
21661da177e4SLinus Torvalds /* Select an initial TSN to send during startup.  */
21671da177e4SLinus Torvalds __u32 sctp_generate_tsn(const struct sctp_endpoint *ep)
21681da177e4SLinus Torvalds {
21691da177e4SLinus Torvalds 	__u32 retval;
21701da177e4SLinus Torvalds 
21711da177e4SLinus Torvalds 	get_random_bytes(&retval, sizeof(__u32));
21721da177e4SLinus Torvalds 	return retval;
21731da177e4SLinus Torvalds }
21741da177e4SLinus Torvalds 
21751da177e4SLinus Torvalds /*
21761da177e4SLinus Torvalds  * ADDIP 3.1.1 Address Configuration Change Chunk (ASCONF)
21771da177e4SLinus Torvalds  *      0                   1                   2                   3
21781da177e4SLinus Torvalds  *      0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
21791da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21801da177e4SLinus Torvalds  *     | Type = 0xC1   |  Chunk Flags  |      Chunk Length             |
21811da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21821da177e4SLinus Torvalds  *     |                       Serial Number                           |
21831da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21841da177e4SLinus Torvalds  *     |                    Address Parameter                          |
21851da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21861da177e4SLinus Torvalds  *     |                     ASCONF Parameter #1                       |
21871da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21881da177e4SLinus Torvalds  *     \                                                               \
21891da177e4SLinus Torvalds  *     /                             ....                              /
21901da177e4SLinus Torvalds  *     \                                                               \
21911da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21921da177e4SLinus Torvalds  *     |                     ASCONF Parameter #N                       |
21931da177e4SLinus Torvalds  *      +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
21941da177e4SLinus Torvalds  *
21951da177e4SLinus Torvalds  * Address Parameter and other parameter will not be wrapped in this function
21961da177e4SLinus Torvalds  */
21971da177e4SLinus Torvalds static struct sctp_chunk *sctp_make_asconf(struct sctp_association *asoc,
21981da177e4SLinus Torvalds 					   union sctp_addr *addr,
21991da177e4SLinus Torvalds 					   int vparam_len)
22001da177e4SLinus Torvalds {
22011da177e4SLinus Torvalds 	sctp_addiphdr_t asconf;
22021da177e4SLinus Torvalds 	struct sctp_chunk *retval;
22031da177e4SLinus Torvalds 	int length = sizeof(asconf) + vparam_len;
22041da177e4SLinus Torvalds 	union sctp_addr_param addrparam;
22051da177e4SLinus Torvalds 	int addrlen;
22061da177e4SLinus Torvalds 	struct sctp_af *af = sctp_get_af_specific(addr->v4.sin_family);
22071da177e4SLinus Torvalds 
22081da177e4SLinus Torvalds 	addrlen = af->to_addr_param(addr, &addrparam);
22091da177e4SLinus Torvalds 	if (!addrlen)
22101da177e4SLinus Torvalds 		return NULL;
22111da177e4SLinus Torvalds 	length += addrlen;
22121da177e4SLinus Torvalds 
22131da177e4SLinus Torvalds 	/* Create the chunk.  */
22141da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_ASCONF, 0, length);
22151da177e4SLinus Torvalds 	if (!retval)
22161da177e4SLinus Torvalds 		return NULL;
22171da177e4SLinus Torvalds 
22181da177e4SLinus Torvalds 	asconf.serial = htonl(asoc->addip_serial++);
22191da177e4SLinus Torvalds 
22201da177e4SLinus Torvalds 	retval->subh.addip_hdr =
22211da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(asconf), &asconf);
22221da177e4SLinus Torvalds 	retval->param_hdr.v =
22231da177e4SLinus Torvalds 		sctp_addto_chunk(retval, addrlen, &addrparam);
22241da177e4SLinus Torvalds 
22251da177e4SLinus Torvalds 	return retval;
22261da177e4SLinus Torvalds }
22271da177e4SLinus Torvalds 
22281da177e4SLinus Torvalds /* ADDIP
22291da177e4SLinus Torvalds  * 3.2.1 Add IP Address
22301da177e4SLinus Torvalds  * 	0                   1                   2                   3
22311da177e4SLinus Torvalds  * 	0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
22321da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22331da177e4SLinus Torvalds  *     |        Type = 0xC001          |    Length = Variable          |
22341da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22351da177e4SLinus Torvalds  *     |               ASCONF-Request Correlation ID                   |
22361da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22371da177e4SLinus Torvalds  *     |                       Address Parameter                       |
22381da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22391da177e4SLinus Torvalds  *
22401da177e4SLinus Torvalds  * 3.2.2 Delete IP Address
22411da177e4SLinus Torvalds  * 	0                   1                   2                   3
22421da177e4SLinus Torvalds  * 	0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
22431da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22441da177e4SLinus Torvalds  *     |        Type = 0xC002          |    Length = Variable          |
22451da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22461da177e4SLinus Torvalds  *     |               ASCONF-Request Correlation ID                   |
22471da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22481da177e4SLinus Torvalds  *     |                       Address Parameter                       |
22491da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
22501da177e4SLinus Torvalds  *
22511da177e4SLinus Torvalds  */
22521da177e4SLinus Torvalds struct sctp_chunk *sctp_make_asconf_update_ip(struct sctp_association *asoc,
22531da177e4SLinus Torvalds 					      union sctp_addr	      *laddr,
22541da177e4SLinus Torvalds 					      struct sockaddr	      *addrs,
22551da177e4SLinus Torvalds 					      int		      addrcnt,
2256dbc16db1SAl Viro 					      __be16		      flags)
22571da177e4SLinus Torvalds {
22581da177e4SLinus Torvalds 	sctp_addip_param_t	param;
22591da177e4SLinus Torvalds 	struct sctp_chunk	*retval;
22601da177e4SLinus Torvalds 	union sctp_addr_param	addr_param;
22611da177e4SLinus Torvalds 	union sctp_addr		*addr;
22621da177e4SLinus Torvalds 	void			*addr_buf;
22631da177e4SLinus Torvalds 	struct sctp_af		*af;
22641da177e4SLinus Torvalds 	int			paramlen = sizeof(param);
22651da177e4SLinus Torvalds 	int			addr_param_len = 0;
22661da177e4SLinus Torvalds 	int 			totallen = 0;
22671da177e4SLinus Torvalds 	int 			i;
22681da177e4SLinus Torvalds 
22691da177e4SLinus Torvalds 	/* Get total length of all the address parameters. */
22701da177e4SLinus Torvalds 	addr_buf = addrs;
22711da177e4SLinus Torvalds 	for (i = 0; i < addrcnt; i++) {
22721da177e4SLinus Torvalds 		addr = (union sctp_addr *)addr_buf;
22731da177e4SLinus Torvalds 		af = sctp_get_af_specific(addr->v4.sin_family);
22741da177e4SLinus Torvalds 		addr_param_len = af->to_addr_param(addr, &addr_param);
22751da177e4SLinus Torvalds 
22761da177e4SLinus Torvalds 		totallen += paramlen;
22771da177e4SLinus Torvalds 		totallen += addr_param_len;
22781da177e4SLinus Torvalds 
22791da177e4SLinus Torvalds 		addr_buf += af->sockaddr_len;
22801da177e4SLinus Torvalds 	}
22811da177e4SLinus Torvalds 
22821da177e4SLinus Torvalds 	/* Create an asconf chunk with the required length. */
22831da177e4SLinus Torvalds 	retval = sctp_make_asconf(asoc, laddr, totallen);
22841da177e4SLinus Torvalds 	if (!retval)
22851da177e4SLinus Torvalds 		return NULL;
22861da177e4SLinus Torvalds 
22871da177e4SLinus Torvalds 	/* Add the address parameters to the asconf chunk. */
22881da177e4SLinus Torvalds 	addr_buf = addrs;
22891da177e4SLinus Torvalds 	for (i = 0; i < addrcnt; i++) {
22901da177e4SLinus Torvalds 		addr = (union sctp_addr *)addr_buf;
22911da177e4SLinus Torvalds 		af = sctp_get_af_specific(addr->v4.sin_family);
22921da177e4SLinus Torvalds 		addr_param_len = af->to_addr_param(addr, &addr_param);
22931da177e4SLinus Torvalds 		param.param_hdr.type = flags;
22941da177e4SLinus Torvalds 		param.param_hdr.length = htons(paramlen + addr_param_len);
22951da177e4SLinus Torvalds 		param.crr_id = i;
22961da177e4SLinus Torvalds 
22971da177e4SLinus Torvalds 		sctp_addto_chunk(retval, paramlen, &param);
22981da177e4SLinus Torvalds 		sctp_addto_chunk(retval, addr_param_len, &addr_param);
22991da177e4SLinus Torvalds 
23001da177e4SLinus Torvalds 		addr_buf += af->sockaddr_len;
23011da177e4SLinus Torvalds 	}
23021da177e4SLinus Torvalds 	return retval;
23031da177e4SLinus Torvalds }
23041da177e4SLinus Torvalds 
23051da177e4SLinus Torvalds /* ADDIP
23061da177e4SLinus Torvalds  * 3.2.4 Set Primary IP Address
23071da177e4SLinus Torvalds  *	0                   1                   2                   3
23081da177e4SLinus Torvalds  *	0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
23091da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23101da177e4SLinus Torvalds  *     |        Type =0xC004           |    Length = Variable          |
23111da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23121da177e4SLinus Torvalds  *     |               ASCONF-Request Correlation ID                   |
23131da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23141da177e4SLinus Torvalds  *     |                       Address Parameter                       |
23151da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23161da177e4SLinus Torvalds  *
23171da177e4SLinus Torvalds  * Create an ASCONF chunk with Set Primary IP address parameter.
23181da177e4SLinus Torvalds  */
23191da177e4SLinus Torvalds struct sctp_chunk *sctp_make_asconf_set_prim(struct sctp_association *asoc,
23201da177e4SLinus Torvalds 					     union sctp_addr *addr)
23211da177e4SLinus Torvalds {
23221da177e4SLinus Torvalds 	sctp_addip_param_t	param;
23231da177e4SLinus Torvalds 	struct sctp_chunk 	*retval;
23241da177e4SLinus Torvalds 	int 			len = sizeof(param);
23251da177e4SLinus Torvalds 	union sctp_addr_param	addrparam;
23261da177e4SLinus Torvalds 	int			addrlen;
23271da177e4SLinus Torvalds 	struct sctp_af		*af = sctp_get_af_specific(addr->v4.sin_family);
23281da177e4SLinus Torvalds 
23291da177e4SLinus Torvalds 	addrlen = af->to_addr_param(addr, &addrparam);
23301da177e4SLinus Torvalds 	if (!addrlen)
23311da177e4SLinus Torvalds 		return NULL;
23321da177e4SLinus Torvalds 	len += addrlen;
23331da177e4SLinus Torvalds 
23341da177e4SLinus Torvalds 	/* Create the chunk and make asconf header. */
23351da177e4SLinus Torvalds 	retval = sctp_make_asconf(asoc, addr, len);
23361da177e4SLinus Torvalds 	if (!retval)
23371da177e4SLinus Torvalds 		return NULL;
23381da177e4SLinus Torvalds 
23391da177e4SLinus Torvalds 	param.param_hdr.type = SCTP_PARAM_SET_PRIMARY;
23401da177e4SLinus Torvalds 	param.param_hdr.length = htons(len);
23411da177e4SLinus Torvalds 	param.crr_id = 0;
23421da177e4SLinus Torvalds 
23431da177e4SLinus Torvalds 	sctp_addto_chunk(retval, sizeof(param), &param);
23441da177e4SLinus Torvalds 	sctp_addto_chunk(retval, addrlen, &addrparam);
23451da177e4SLinus Torvalds 
23461da177e4SLinus Torvalds 	return retval;
23471da177e4SLinus Torvalds }
23481da177e4SLinus Torvalds 
23491da177e4SLinus Torvalds /* ADDIP 3.1.2 Address Configuration Acknowledgement Chunk (ASCONF-ACK)
23501da177e4SLinus Torvalds  *      0                   1                   2                   3
23511da177e4SLinus Torvalds  *      0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
23521da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23531da177e4SLinus Torvalds  *     | Type = 0x80   |  Chunk Flags  |      Chunk Length             |
23541da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23551da177e4SLinus Torvalds  *     |                       Serial Number                           |
23561da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23571da177e4SLinus Torvalds  *     |                 ASCONF Parameter Response#1                   |
23581da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23591da177e4SLinus Torvalds  *     \                                                               \
23601da177e4SLinus Torvalds  *     /                             ....                              /
23611da177e4SLinus Torvalds  *     \                                                               \
23621da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23631da177e4SLinus Torvalds  *     |                 ASCONF Parameter Response#N                   |
23641da177e4SLinus Torvalds  *     +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
23651da177e4SLinus Torvalds  *
23661da177e4SLinus Torvalds  * Create an ASCONF_ACK chunk with enough space for the parameter responses.
23671da177e4SLinus Torvalds  */
23681da177e4SLinus Torvalds static struct sctp_chunk *sctp_make_asconf_ack(const struct sctp_association *asoc,
23691da177e4SLinus Torvalds 					       __u32 serial, int vparam_len)
23701da177e4SLinus Torvalds {
23711da177e4SLinus Torvalds 	sctp_addiphdr_t		asconf;
23721da177e4SLinus Torvalds 	struct sctp_chunk	*retval;
23731da177e4SLinus Torvalds 	int			length = sizeof(asconf) + vparam_len;
23741da177e4SLinus Torvalds 
23751da177e4SLinus Torvalds 	/* Create the chunk.  */
23761da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_ASCONF_ACK, 0, length);
23771da177e4SLinus Torvalds 	if (!retval)
23781da177e4SLinus Torvalds 		return NULL;
23791da177e4SLinus Torvalds 
23801da177e4SLinus Torvalds 	asconf.serial = htonl(serial);
23811da177e4SLinus Torvalds 
23821da177e4SLinus Torvalds 	retval->subh.addip_hdr =
23831da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(asconf), &asconf);
23841da177e4SLinus Torvalds 
23851da177e4SLinus Torvalds 	return retval;
23861da177e4SLinus Torvalds }
23871da177e4SLinus Torvalds 
23881da177e4SLinus Torvalds /* Add response parameters to an ASCONF_ACK chunk. */
23899f81bcd9SAl Viro static void sctp_add_asconf_response(struct sctp_chunk *chunk, __be32 crr_id,
2390dbc16db1SAl Viro 			      __be16 err_code, sctp_addip_param_t *asconf_param)
23911da177e4SLinus Torvalds {
23921da177e4SLinus Torvalds 	sctp_addip_param_t 	ack_param;
23931da177e4SLinus Torvalds 	sctp_errhdr_t		err_param;
23941da177e4SLinus Torvalds 	int			asconf_param_len = 0;
23951da177e4SLinus Torvalds 	int			err_param_len = 0;
2396dbc16db1SAl Viro 	__be16			response_type;
23971da177e4SLinus Torvalds 
23981da177e4SLinus Torvalds 	if (SCTP_ERROR_NO_ERROR == err_code) {
23991da177e4SLinus Torvalds 		response_type = SCTP_PARAM_SUCCESS_REPORT;
24001da177e4SLinus Torvalds 	} else {
24011da177e4SLinus Torvalds 		response_type = SCTP_PARAM_ERR_CAUSE;
24021da177e4SLinus Torvalds 		err_param_len = sizeof(err_param);
24031da177e4SLinus Torvalds 		if (asconf_param)
24041da177e4SLinus Torvalds 			asconf_param_len =
24051da177e4SLinus Torvalds 				 ntohs(asconf_param->param_hdr.length);
24061da177e4SLinus Torvalds 	}
24071da177e4SLinus Torvalds 
24081da177e4SLinus Torvalds 	/* Add Success Indication or Error Cause Indication parameter. */
24091da177e4SLinus Torvalds 	ack_param.param_hdr.type = response_type;
24101da177e4SLinus Torvalds 	ack_param.param_hdr.length = htons(sizeof(ack_param) +
24111da177e4SLinus Torvalds 					   err_param_len +
24121da177e4SLinus Torvalds 					   asconf_param_len);
24131da177e4SLinus Torvalds 	ack_param.crr_id = crr_id;
24141da177e4SLinus Torvalds 	sctp_addto_chunk(chunk, sizeof(ack_param), &ack_param);
24151da177e4SLinus Torvalds 
24161da177e4SLinus Torvalds 	if (SCTP_ERROR_NO_ERROR == err_code)
24171da177e4SLinus Torvalds 		return;
24181da177e4SLinus Torvalds 
24191da177e4SLinus Torvalds 	/* Add Error Cause parameter. */
24201da177e4SLinus Torvalds 	err_param.cause = err_code;
24211da177e4SLinus Torvalds 	err_param.length = htons(err_param_len + asconf_param_len);
24221da177e4SLinus Torvalds 	sctp_addto_chunk(chunk, err_param_len, &err_param);
24231da177e4SLinus Torvalds 
24241da177e4SLinus Torvalds 	/* Add the failed TLV copied from ASCONF chunk. */
24251da177e4SLinus Torvalds 	if (asconf_param)
24261da177e4SLinus Torvalds 		sctp_addto_chunk(chunk, asconf_param_len, asconf_param);
24271da177e4SLinus Torvalds }
24281da177e4SLinus Torvalds 
24291da177e4SLinus Torvalds /* Process a asconf parameter. */
2430dbc16db1SAl Viro static __be16 sctp_process_asconf_param(struct sctp_association *asoc,
24311da177e4SLinus Torvalds 				       struct sctp_chunk *asconf,
24321da177e4SLinus Torvalds 				       sctp_addip_param_t *asconf_param)
24331da177e4SLinus Torvalds {
24341da177e4SLinus Torvalds 	struct sctp_transport *peer;
24351da177e4SLinus Torvalds 	struct sctp_af *af;
24361da177e4SLinus Torvalds 	union sctp_addr	addr;
24371da177e4SLinus Torvalds 	struct list_head *pos;
24381da177e4SLinus Torvalds 	union sctp_addr_param *addr_param;
24391da177e4SLinus Torvalds 
24401da177e4SLinus Torvalds 	addr_param = (union sctp_addr_param *)
24411da177e4SLinus Torvalds 			((void *)asconf_param + sizeof(sctp_addip_param_t));
24421da177e4SLinus Torvalds 
24431da177e4SLinus Torvalds 	af = sctp_get_af_specific(param_type2af(addr_param->v4.param_hdr.type));
24441da177e4SLinus Torvalds 	if (unlikely(!af))
24451da177e4SLinus Torvalds 		return SCTP_ERROR_INV_PARAM;
24461da177e4SLinus Torvalds 
2447dd86d136SAl Viro 	af->from_addr_param(&addr, addr_param, htons(asoc->peer.port), 0);
24481da177e4SLinus Torvalds 	switch (asconf_param->param_hdr.type) {
24491da177e4SLinus Torvalds 	case SCTP_PARAM_ADD_IP:
24501da177e4SLinus Torvalds 		/* ADDIP 4.3 D9) If an endpoint receives an ADD IP address
24511da177e4SLinus Torvalds 		 * request and does not have the local resources to add this
24521da177e4SLinus Torvalds 		 * new address to the association, it MUST return an Error
24531da177e4SLinus Torvalds 		 * Cause TLV set to the new error code 'Operation Refused
24541da177e4SLinus Torvalds 		 * Due to Resource Shortage'.
24551da177e4SLinus Torvalds 		 */
24561da177e4SLinus Torvalds 
2457dd86d136SAl Viro 		peer = sctp_assoc_add_peer(asoc, &addr, GFP_ATOMIC, SCTP_UNCONFIRMED);
24581da177e4SLinus Torvalds 		if (!peer)
24591da177e4SLinus Torvalds 			return SCTP_ERROR_RSRC_LOW;
24601da177e4SLinus Torvalds 
24611da177e4SLinus Torvalds 		/* Start the heartbeat timer. */
24621da177e4SLinus Torvalds 		if (!mod_timer(&peer->hb_timer, sctp_transport_timeout(peer)))
24631da177e4SLinus Torvalds 			sctp_transport_hold(peer);
24641da177e4SLinus Torvalds 		break;
24651da177e4SLinus Torvalds 	case SCTP_PARAM_DEL_IP:
24661da177e4SLinus Torvalds 		/* ADDIP 4.3 D7) If a request is received to delete the
24671da177e4SLinus Torvalds 		 * last remaining IP address of a peer endpoint, the receiver
24681da177e4SLinus Torvalds 		 * MUST send an Error Cause TLV with the error cause set to the
24691da177e4SLinus Torvalds 		 * new error code 'Request to Delete Last Remaining IP Address'.
24701da177e4SLinus Torvalds 		 */
24711da177e4SLinus Torvalds 		pos = asoc->peer.transport_addr_list.next;
24721da177e4SLinus Torvalds 		if (pos->next == &asoc->peer.transport_addr_list)
24731da177e4SLinus Torvalds 			return SCTP_ERROR_DEL_LAST_IP;
24741da177e4SLinus Torvalds 
24751da177e4SLinus Torvalds 		/* ADDIP 4.3 D8) If a request is received to delete an IP
24761da177e4SLinus Torvalds 		 * address which is also the source address of the IP packet
24771da177e4SLinus Torvalds 		 * which contained the ASCONF chunk, the receiver MUST reject
24781da177e4SLinus Torvalds 		 * this request. To reject the request the receiver MUST send
24791da177e4SLinus Torvalds 		 * an Error Cause TLV set to the new error code 'Request to
24801da177e4SLinus Torvalds 		 * Delete Source IP Address'
24811da177e4SLinus Torvalds 		 */
24826a1e5f33SAl Viro 		if (sctp_cmp_addr_exact(sctp_source(asconf), &addr))
24831da177e4SLinus Torvalds 			return SCTP_ERROR_DEL_SRC_IP;
24841da177e4SLinus Torvalds 
2485dd86d136SAl Viro 		sctp_assoc_del_peer(asoc, &addr);
24861da177e4SLinus Torvalds 		break;
24871da177e4SLinus Torvalds 	case SCTP_PARAM_SET_PRIMARY:
2488dd86d136SAl Viro 		peer = sctp_assoc_lookup_paddr(asoc, &addr);
24891da177e4SLinus Torvalds 		if (!peer)
24901da177e4SLinus Torvalds 			return SCTP_ERROR_INV_PARAM;
24911da177e4SLinus Torvalds 
24921da177e4SLinus Torvalds 		sctp_assoc_set_primary(asoc, peer);
24931da177e4SLinus Torvalds 		break;
24941da177e4SLinus Torvalds 	default:
24951da177e4SLinus Torvalds 		return SCTP_ERROR_INV_PARAM;
24961da177e4SLinus Torvalds 		break;
24971da177e4SLinus Torvalds 	}
24981da177e4SLinus Torvalds 
24991da177e4SLinus Torvalds 	return SCTP_ERROR_NO_ERROR;
25001da177e4SLinus Torvalds }
25011da177e4SLinus Torvalds 
25021da177e4SLinus Torvalds /* Process an incoming ASCONF chunk with the next expected serial no. and
25031da177e4SLinus Torvalds  * return an ASCONF_ACK chunk to be sent in response.
25041da177e4SLinus Torvalds  */
25051da177e4SLinus Torvalds struct sctp_chunk *sctp_process_asconf(struct sctp_association *asoc,
25061da177e4SLinus Torvalds 				       struct sctp_chunk *asconf)
25071da177e4SLinus Torvalds {
25081da177e4SLinus Torvalds 	sctp_addiphdr_t		*hdr;
25091da177e4SLinus Torvalds 	union sctp_addr_param	*addr_param;
25101da177e4SLinus Torvalds 	sctp_addip_param_t	*asconf_param;
25111da177e4SLinus Torvalds 	struct sctp_chunk	*asconf_ack;
25121da177e4SLinus Torvalds 
2513dbc16db1SAl Viro 	__be16	err_code;
25141da177e4SLinus Torvalds 	int	length = 0;
25151da177e4SLinus Torvalds 	int	chunk_len = asconf->skb->len;
25161da177e4SLinus Torvalds 	__u32	serial;
25171da177e4SLinus Torvalds 	int	all_param_pass = 1;
25181da177e4SLinus Torvalds 
25191da177e4SLinus Torvalds 	hdr = (sctp_addiphdr_t *)asconf->skb->data;
25201da177e4SLinus Torvalds 	serial = ntohl(hdr->serial);
25211da177e4SLinus Torvalds 
25221da177e4SLinus Torvalds 	/* Skip the addiphdr and store a pointer to address parameter.  */
25231da177e4SLinus Torvalds 	length = sizeof(sctp_addiphdr_t);
25241da177e4SLinus Torvalds 	addr_param = (union sctp_addr_param *)(asconf->skb->data + length);
25251da177e4SLinus Torvalds 	chunk_len -= length;
25261da177e4SLinus Torvalds 
25271da177e4SLinus Torvalds 	/* Skip the address parameter and store a pointer to the first
25281da177e4SLinus Torvalds 	 * asconf paramter.
25291da177e4SLinus Torvalds 	 */
25301da177e4SLinus Torvalds 	length = ntohs(addr_param->v4.param_hdr.length);
25311da177e4SLinus Torvalds 	asconf_param = (sctp_addip_param_t *)((void *)addr_param + length);
25321da177e4SLinus Torvalds 	chunk_len -= length;
25331da177e4SLinus Torvalds 
25341da177e4SLinus Torvalds 	/* create an ASCONF_ACK chunk.
25351da177e4SLinus Torvalds 	 * Based on the definitions of parameters, we know that the size of
25361da177e4SLinus Torvalds 	 * ASCONF_ACK parameters are less than or equal to the twice of ASCONF
25371da177e4SLinus Torvalds 	 * paramters.
25381da177e4SLinus Torvalds 	 */
25391da177e4SLinus Torvalds 	asconf_ack = sctp_make_asconf_ack(asoc, serial, chunk_len * 2);
25401da177e4SLinus Torvalds 	if (!asconf_ack)
25411da177e4SLinus Torvalds 		goto done;
25421da177e4SLinus Torvalds 
25431da177e4SLinus Torvalds 	/* Process the TLVs contained within the ASCONF chunk. */
25441da177e4SLinus Torvalds 	while (chunk_len > 0) {
25451da177e4SLinus Torvalds 		err_code = sctp_process_asconf_param(asoc, asconf,
25461da177e4SLinus Torvalds 						     asconf_param);
25471da177e4SLinus Torvalds 		/* ADDIP 4.1 A7)
25481da177e4SLinus Torvalds 		 * If an error response is received for a TLV parameter,
25491da177e4SLinus Torvalds 		 * all TLVs with no response before the failed TLV are
25501da177e4SLinus Torvalds 		 * considered successful if not reported.  All TLVs after
25511da177e4SLinus Torvalds 		 * the failed response are considered unsuccessful unless
25521da177e4SLinus Torvalds 		 * a specific success indication is present for the parameter.
25531da177e4SLinus Torvalds 		 */
25541da177e4SLinus Torvalds 		if (SCTP_ERROR_NO_ERROR != err_code)
25551da177e4SLinus Torvalds 			all_param_pass = 0;
25561da177e4SLinus Torvalds 
25571da177e4SLinus Torvalds 		if (!all_param_pass)
25581da177e4SLinus Torvalds 			sctp_add_asconf_response(asconf_ack,
25591da177e4SLinus Torvalds 						 asconf_param->crr_id, err_code,
25601da177e4SLinus Torvalds 						 asconf_param);
25611da177e4SLinus Torvalds 
25621da177e4SLinus Torvalds 		/* ADDIP 4.3 D11) When an endpoint receiving an ASCONF to add
25631da177e4SLinus Torvalds 		 * an IP address sends an 'Out of Resource' in its response, it
25641da177e4SLinus Torvalds 		 * MUST also fail any subsequent add or delete requests bundled
25651da177e4SLinus Torvalds 		 * in the ASCONF.
25661da177e4SLinus Torvalds 		 */
25671da177e4SLinus Torvalds 		if (SCTP_ERROR_RSRC_LOW == err_code)
25681da177e4SLinus Torvalds 			goto done;
25691da177e4SLinus Torvalds 
25701da177e4SLinus Torvalds 		/* Move to the next ASCONF param. */
25711da177e4SLinus Torvalds 		length = ntohs(asconf_param->param_hdr.length);
25721da177e4SLinus Torvalds 		asconf_param = (sctp_addip_param_t *)((void *)asconf_param +
25731da177e4SLinus Torvalds 						      length);
25741da177e4SLinus Torvalds 		chunk_len -= length;
25751da177e4SLinus Torvalds 	}
25761da177e4SLinus Torvalds 
25771da177e4SLinus Torvalds done:
25781da177e4SLinus Torvalds 	asoc->peer.addip_serial++;
25791da177e4SLinus Torvalds 
25801da177e4SLinus Torvalds 	/* If we are sending a new ASCONF_ACK hold a reference to it in assoc
25811da177e4SLinus Torvalds 	 * after freeing the reference to old asconf ack if any.
25821da177e4SLinus Torvalds 	 */
25831da177e4SLinus Torvalds 	if (asconf_ack) {
25841da177e4SLinus Torvalds 		if (asoc->addip_last_asconf_ack)
25851da177e4SLinus Torvalds 			sctp_chunk_free(asoc->addip_last_asconf_ack);
25861da177e4SLinus Torvalds 
25871da177e4SLinus Torvalds 		sctp_chunk_hold(asconf_ack);
25881da177e4SLinus Torvalds 		asoc->addip_last_asconf_ack = asconf_ack;
25891da177e4SLinus Torvalds 	}
25901da177e4SLinus Torvalds 
25911da177e4SLinus Torvalds 	return asconf_ack;
25921da177e4SLinus Torvalds }
25931da177e4SLinus Torvalds 
25941da177e4SLinus Torvalds /* Process a asconf parameter that is successfully acked. */
25951da177e4SLinus Torvalds static int sctp_asconf_param_success(struct sctp_association *asoc,
25961da177e4SLinus Torvalds 				     sctp_addip_param_t *asconf_param)
25971da177e4SLinus Torvalds {
25981da177e4SLinus Torvalds 	struct sctp_af *af;
25991da177e4SLinus Torvalds 	union sctp_addr	addr;
26001da177e4SLinus Torvalds 	struct sctp_bind_addr *bp = &asoc->base.bind_addr;
26011da177e4SLinus Torvalds 	union sctp_addr_param *addr_param;
26021da177e4SLinus Torvalds 	struct list_head *pos;
26031da177e4SLinus Torvalds 	struct sctp_transport *transport;
2604dc022a98SSridhar Samudrala 	struct sctp_sockaddr_entry *saddr;
26051da177e4SLinus Torvalds 	int retval = 0;
26061da177e4SLinus Torvalds 
26071da177e4SLinus Torvalds 	addr_param = (union sctp_addr_param *)
26081da177e4SLinus Torvalds 			((void *)asconf_param + sizeof(sctp_addip_param_t));
26091da177e4SLinus Torvalds 
26101da177e4SLinus Torvalds 	/* We have checked the packet before, so we do not check again.	*/
26111da177e4SLinus Torvalds 	af = sctp_get_af_specific(param_type2af(addr_param->v4.param_hdr.type));
2612dd86d136SAl Viro 	af->from_addr_param(&addr, addr_param, htons(bp->port), 0);
26131da177e4SLinus Torvalds 
26141da177e4SLinus Torvalds 	switch (asconf_param->param_hdr.type) {
26151da177e4SLinus Torvalds 	case SCTP_PARAM_ADD_IP:
2616559cf710SVlad Yasevich 		/* This is always done in BH context with a socket lock
2617559cf710SVlad Yasevich 		 * held, so the list can not change.
2618559cf710SVlad Yasevich 		 */
2619559cf710SVlad Yasevich 		list_for_each_entry(saddr, &bp->address_list, list) {
2620dd86d136SAl Viro 			if (sctp_cmp_addr_exact(&saddr->a, &addr))
2621dc022a98SSridhar Samudrala 				saddr->use_as_src = 1;
2622dc022a98SSridhar Samudrala 		}
26231da177e4SLinus Torvalds 		break;
26241da177e4SLinus Torvalds 	case SCTP_PARAM_DEL_IP:
2625559cf710SVlad Yasevich 		retval = sctp_del_bind_addr(bp, &addr, call_rcu_bh);
26261da177e4SLinus Torvalds 		list_for_each(pos, &asoc->peer.transport_addr_list) {
26271da177e4SLinus Torvalds 			transport = list_entry(pos, struct sctp_transport,
26281da177e4SLinus Torvalds 						 transports);
2629dc022a98SSridhar Samudrala 			dst_release(transport->dst);
26301da177e4SLinus Torvalds 			sctp_transport_route(transport, NULL,
26311da177e4SLinus Torvalds 					     sctp_sk(asoc->base.sk));
26321da177e4SLinus Torvalds 		}
26331da177e4SLinus Torvalds 		break;
26341da177e4SLinus Torvalds 	default:
26351da177e4SLinus Torvalds 		break;
26361da177e4SLinus Torvalds 	}
26371da177e4SLinus Torvalds 
26381da177e4SLinus Torvalds 	return retval;
26391da177e4SLinus Torvalds }
26401da177e4SLinus Torvalds 
26411da177e4SLinus Torvalds /* Get the corresponding ASCONF response error code from the ASCONF_ACK chunk
26421da177e4SLinus Torvalds  * for the given asconf parameter.  If there is no response for this parameter,
26431da177e4SLinus Torvalds  * return the error code based on the third argument 'no_err'.
26441da177e4SLinus Torvalds  * ADDIP 4.1
26451da177e4SLinus Torvalds  * A7) If an error response is received for a TLV parameter, all TLVs with no
26461da177e4SLinus Torvalds  * response before the failed TLV are considered successful if not reported.
26471da177e4SLinus Torvalds  * All TLVs after the failed response are considered unsuccessful unless a
26481da177e4SLinus Torvalds  * specific success indication is present for the parameter.
26491da177e4SLinus Torvalds  */
2650dbc16db1SAl Viro static __be16 sctp_get_asconf_response(struct sctp_chunk *asconf_ack,
26511da177e4SLinus Torvalds 				      sctp_addip_param_t *asconf_param,
26521da177e4SLinus Torvalds 				      int no_err)
26531da177e4SLinus Torvalds {
26541da177e4SLinus Torvalds 	sctp_addip_param_t	*asconf_ack_param;
26551da177e4SLinus Torvalds 	sctp_errhdr_t		*err_param;
26561da177e4SLinus Torvalds 	int			length;
26571da177e4SLinus Torvalds 	int			asconf_ack_len = asconf_ack->skb->len;
2658dbc16db1SAl Viro 	__be16			err_code;
26591da177e4SLinus Torvalds 
26601da177e4SLinus Torvalds 	if (no_err)
26611da177e4SLinus Torvalds 		err_code = SCTP_ERROR_NO_ERROR;
26621da177e4SLinus Torvalds 	else
26631da177e4SLinus Torvalds 		err_code = SCTP_ERROR_REQ_REFUSED;
26641da177e4SLinus Torvalds 
26651da177e4SLinus Torvalds 	/* Skip the addiphdr from the asconf_ack chunk and store a pointer to
26661da177e4SLinus Torvalds 	 * the first asconf_ack parameter.
26671da177e4SLinus Torvalds 	 */
26681da177e4SLinus Torvalds 	length = sizeof(sctp_addiphdr_t);
26691da177e4SLinus Torvalds 	asconf_ack_param = (sctp_addip_param_t *)(asconf_ack->skb->data +
26701da177e4SLinus Torvalds 						  length);
26711da177e4SLinus Torvalds 	asconf_ack_len -= length;
26721da177e4SLinus Torvalds 
26731da177e4SLinus Torvalds 	while (asconf_ack_len > 0) {
26741da177e4SLinus Torvalds 		if (asconf_ack_param->crr_id == asconf_param->crr_id) {
26751da177e4SLinus Torvalds 			switch(asconf_ack_param->param_hdr.type) {
26761da177e4SLinus Torvalds 			case SCTP_PARAM_SUCCESS_REPORT:
26771da177e4SLinus Torvalds 				return SCTP_ERROR_NO_ERROR;
26781da177e4SLinus Torvalds 			case SCTP_PARAM_ERR_CAUSE:
26791da177e4SLinus Torvalds 				length = sizeof(sctp_addip_param_t);
26801da177e4SLinus Torvalds 				err_param = (sctp_errhdr_t *)
26811da177e4SLinus Torvalds 					   ((void *)asconf_ack_param + length);
26821da177e4SLinus Torvalds 				asconf_ack_len -= length;
26831da177e4SLinus Torvalds 				if (asconf_ack_len > 0)
26841da177e4SLinus Torvalds 					return err_param->cause;
26851da177e4SLinus Torvalds 				else
26861da177e4SLinus Torvalds 					return SCTP_ERROR_INV_PARAM;
26871da177e4SLinus Torvalds 				break;
26881da177e4SLinus Torvalds 			default:
26891da177e4SLinus Torvalds 				return SCTP_ERROR_INV_PARAM;
26901da177e4SLinus Torvalds 			}
26911da177e4SLinus Torvalds 		}
26921da177e4SLinus Torvalds 
26931da177e4SLinus Torvalds 		length = ntohs(asconf_ack_param->param_hdr.length);
26941da177e4SLinus Torvalds 		asconf_ack_param = (sctp_addip_param_t *)
26951da177e4SLinus Torvalds 					((void *)asconf_ack_param + length);
26961da177e4SLinus Torvalds 		asconf_ack_len -= length;
26971da177e4SLinus Torvalds 	}
26981da177e4SLinus Torvalds 
26991da177e4SLinus Torvalds 	return err_code;
27001da177e4SLinus Torvalds }
27011da177e4SLinus Torvalds 
27021da177e4SLinus Torvalds /* Process an incoming ASCONF_ACK chunk against the cached last ASCONF chunk. */
27031da177e4SLinus Torvalds int sctp_process_asconf_ack(struct sctp_association *asoc,
27041da177e4SLinus Torvalds 			    struct sctp_chunk *asconf_ack)
27051da177e4SLinus Torvalds {
27061da177e4SLinus Torvalds 	struct sctp_chunk	*asconf = asoc->addip_last_asconf;
27071da177e4SLinus Torvalds 	union sctp_addr_param	*addr_param;
27081da177e4SLinus Torvalds 	sctp_addip_param_t	*asconf_param;
27091da177e4SLinus Torvalds 	int	length = 0;
27101da177e4SLinus Torvalds 	int	asconf_len = asconf->skb->len;
27111da177e4SLinus Torvalds 	int	all_param_pass = 0;
27121da177e4SLinus Torvalds 	int	no_err = 1;
27131da177e4SLinus Torvalds 	int	retval = 0;
2714dbc16db1SAl Viro 	__be16	err_code = SCTP_ERROR_NO_ERROR;
27151da177e4SLinus Torvalds 
27161da177e4SLinus Torvalds 	/* Skip the chunkhdr and addiphdr from the last asconf sent and store
27171da177e4SLinus Torvalds 	 * a pointer to address parameter.
27181da177e4SLinus Torvalds 	 */
27191da177e4SLinus Torvalds 	length = sizeof(sctp_addip_chunk_t);
27201da177e4SLinus Torvalds 	addr_param = (union sctp_addr_param *)(asconf->skb->data + length);
27211da177e4SLinus Torvalds 	asconf_len -= length;
27221da177e4SLinus Torvalds 
27231da177e4SLinus Torvalds 	/* Skip the address parameter in the last asconf sent and store a
27241da177e4SLinus Torvalds 	 * pointer to the first asconf paramter.
27251da177e4SLinus Torvalds 	 */
27261da177e4SLinus Torvalds 	length = ntohs(addr_param->v4.param_hdr.length);
27271da177e4SLinus Torvalds 	asconf_param = (sctp_addip_param_t *)((void *)addr_param + length);
27281da177e4SLinus Torvalds 	asconf_len -= length;
27291da177e4SLinus Torvalds 
27301da177e4SLinus Torvalds 	/* ADDIP 4.1
27311da177e4SLinus Torvalds 	 * A8) If there is no response(s) to specific TLV parameter(s), and no
27321da177e4SLinus Torvalds 	 * failures are indicated, then all request(s) are considered
27331da177e4SLinus Torvalds 	 * successful.
27341da177e4SLinus Torvalds 	 */
27351da177e4SLinus Torvalds 	if (asconf_ack->skb->len == sizeof(sctp_addiphdr_t))
27361da177e4SLinus Torvalds 		all_param_pass = 1;
27371da177e4SLinus Torvalds 
27381da177e4SLinus Torvalds 	/* Process the TLVs contained in the last sent ASCONF chunk. */
27391da177e4SLinus Torvalds 	while (asconf_len > 0) {
27401da177e4SLinus Torvalds 		if (all_param_pass)
27411da177e4SLinus Torvalds 			err_code = SCTP_ERROR_NO_ERROR;
27421da177e4SLinus Torvalds 		else {
27431da177e4SLinus Torvalds 			err_code = sctp_get_asconf_response(asconf_ack,
27441da177e4SLinus Torvalds 							    asconf_param,
27451da177e4SLinus Torvalds 							    no_err);
27461da177e4SLinus Torvalds 			if (no_err && (SCTP_ERROR_NO_ERROR != err_code))
27471da177e4SLinus Torvalds 				no_err = 0;
27481da177e4SLinus Torvalds 		}
27491da177e4SLinus Torvalds 
27501da177e4SLinus Torvalds 		switch (err_code) {
27511da177e4SLinus Torvalds 		case SCTP_ERROR_NO_ERROR:
27521da177e4SLinus Torvalds 			retval = sctp_asconf_param_success(asoc, asconf_param);
27531da177e4SLinus Torvalds 			break;
27541da177e4SLinus Torvalds 
27551da177e4SLinus Torvalds 		case SCTP_ERROR_RSRC_LOW:
27561da177e4SLinus Torvalds 			retval = 1;
27571da177e4SLinus Torvalds 			break;
27581da177e4SLinus Torvalds 
27591da177e4SLinus Torvalds 		case SCTP_ERROR_INV_PARAM:
27601da177e4SLinus Torvalds 			/* Disable sending this type of asconf parameter in
27611da177e4SLinus Torvalds 			 * future.
27621da177e4SLinus Torvalds 			 */
27631da177e4SLinus Torvalds 			asoc->peer.addip_disabled_mask |=
27641da177e4SLinus Torvalds 				asconf_param->param_hdr.type;
27651da177e4SLinus Torvalds 			break;
27661da177e4SLinus Torvalds 
27671da177e4SLinus Torvalds 		case SCTP_ERROR_REQ_REFUSED:
27681da177e4SLinus Torvalds 		case SCTP_ERROR_DEL_LAST_IP:
27691da177e4SLinus Torvalds 		case SCTP_ERROR_DEL_SRC_IP:
27701da177e4SLinus Torvalds 		default:
27711da177e4SLinus Torvalds 			 break;
27721da177e4SLinus Torvalds 		}
27731da177e4SLinus Torvalds 
27741da177e4SLinus Torvalds 		/* Skip the processed asconf parameter and move to the next
27751da177e4SLinus Torvalds 		 * one.
27761da177e4SLinus Torvalds 		 */
27771da177e4SLinus Torvalds 		length = ntohs(asconf_param->param_hdr.length);
27781da177e4SLinus Torvalds 		asconf_param = (sctp_addip_param_t *)((void *)asconf_param +
27791da177e4SLinus Torvalds 						      length);
27801da177e4SLinus Torvalds 		asconf_len -= length;
27811da177e4SLinus Torvalds 	}
27821da177e4SLinus Torvalds 
27831da177e4SLinus Torvalds 	/* Free the cached last sent asconf chunk. */
27841da177e4SLinus Torvalds 	sctp_chunk_free(asconf);
27851da177e4SLinus Torvalds 	asoc->addip_last_asconf = NULL;
27861da177e4SLinus Torvalds 
27871da177e4SLinus Torvalds 	/* Send the next asconf chunk from the addip chunk queue. */
278879af02c2SDavid S. Miller 	if (!list_empty(&asoc->addip_chunk_list)) {
278979af02c2SDavid S. Miller 		struct list_head *entry = asoc->addip_chunk_list.next;
279079af02c2SDavid S. Miller 		asconf = list_entry(entry, struct sctp_chunk, list);
279179af02c2SDavid S. Miller 
279279af02c2SDavid S. Miller 		list_del_init(entry);
279379af02c2SDavid S. Miller 
27941da177e4SLinus Torvalds 		/* Hold the chunk until an ASCONF_ACK is received. */
27951da177e4SLinus Torvalds 		sctp_chunk_hold(asconf);
27961da177e4SLinus Torvalds 		if (sctp_primitive_ASCONF(asoc, asconf))
27971da177e4SLinus Torvalds 			sctp_chunk_free(asconf);
27981da177e4SLinus Torvalds 		else
27991da177e4SLinus Torvalds 			asoc->addip_last_asconf = asconf;
28001da177e4SLinus Torvalds 	}
28011da177e4SLinus Torvalds 
28021da177e4SLinus Torvalds 	return retval;
28031da177e4SLinus Torvalds }
28041da177e4SLinus Torvalds 
28051da177e4SLinus Torvalds /* Make a FWD TSN chunk. */
28061da177e4SLinus Torvalds struct sctp_chunk *sctp_make_fwdtsn(const struct sctp_association *asoc,
28071da177e4SLinus Torvalds 				    __u32 new_cum_tsn, size_t nstreams,
28081da177e4SLinus Torvalds 				    struct sctp_fwdtsn_skip *skiplist)
28091da177e4SLinus Torvalds {
28101da177e4SLinus Torvalds 	struct sctp_chunk *retval = NULL;
28111da177e4SLinus Torvalds 	struct sctp_fwdtsn_chunk *ftsn_chunk;
28121da177e4SLinus Torvalds 	struct sctp_fwdtsn_hdr ftsn_hdr;
28131da177e4SLinus Torvalds 	struct sctp_fwdtsn_skip skip;
28141da177e4SLinus Torvalds 	size_t hint;
28151da177e4SLinus Torvalds 	int i;
28161da177e4SLinus Torvalds 
28171da177e4SLinus Torvalds 	hint = (nstreams + 1) * sizeof(__u32);
28181da177e4SLinus Torvalds 
28191da177e4SLinus Torvalds 	retval = sctp_make_chunk(asoc, SCTP_CID_FWD_TSN, 0, hint);
28201da177e4SLinus Torvalds 
28211da177e4SLinus Torvalds 	if (!retval)
28221da177e4SLinus Torvalds 		return NULL;
28231da177e4SLinus Torvalds 
28241da177e4SLinus Torvalds 	ftsn_chunk = (struct sctp_fwdtsn_chunk *)retval->subh.fwdtsn_hdr;
28251da177e4SLinus Torvalds 
28261da177e4SLinus Torvalds 	ftsn_hdr.new_cum_tsn = htonl(new_cum_tsn);
28271da177e4SLinus Torvalds 	retval->subh.fwdtsn_hdr =
28281da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(ftsn_hdr), &ftsn_hdr);
28291da177e4SLinus Torvalds 
28301da177e4SLinus Torvalds 	for (i = 0; i < nstreams; i++) {
28311da177e4SLinus Torvalds 		skip.stream = skiplist[i].stream;
28321da177e4SLinus Torvalds 		skip.ssn = skiplist[i].ssn;
28331da177e4SLinus Torvalds 		sctp_addto_chunk(retval, sizeof(skip), &skip);
28341da177e4SLinus Torvalds 	}
28351da177e4SLinus Torvalds 
28361da177e4SLinus Torvalds 	return retval;
28371da177e4SLinus Torvalds }
2838