xref: /openbmc/linux/net/dccp/feat.c (revision d90ebcbfa7f5a8b4e20518c9f94c5c4e4cd3c2e5)
1afe00251SAndrea Bittau /*
2afe00251SAndrea Bittau  *  net/dccp/feat.c
3afe00251SAndrea Bittau  *
4afe00251SAndrea Bittau  *  An implementation of the DCCP protocol
5afe00251SAndrea Bittau  *  Andrea Bittau <a.bittau@cs.ucl.ac.uk>
6afe00251SAndrea Bittau  *
75cdae198SGerrit Renker  *  ASSUMPTIONS
85cdae198SGerrit Renker  *  -----------
9f74e91b6SGerrit Renker  *  o Feature negotiation is coordinated with connection setup (as in TCP), wild
10f74e91b6SGerrit Renker  *    changes of parameters of an established connection are not supported.
115cdae198SGerrit Renker  *  o All currently known SP features have 1-byte quantities. If in the future
125cdae198SGerrit Renker  *    extensions of RFCs 4340..42 define features with item lengths larger than
135cdae198SGerrit Renker  *    one byte, a feature-specific extension of the code will be required.
145cdae198SGerrit Renker  *
15afe00251SAndrea Bittau  *  This program is free software; you can redistribute it and/or
16afe00251SAndrea Bittau  *  modify it under the terms of the GNU General Public License
17afe00251SAndrea Bittau  *  as published by the Free Software Foundation; either version
18afe00251SAndrea Bittau  *  2 of the License, or (at your option) any later version.
19afe00251SAndrea Bittau  */
20afe00251SAndrea Bittau 
21afe00251SAndrea Bittau #include <linux/module.h>
22afe00251SAndrea Bittau 
236ffd30fbSAndrea Bittau #include "ccid.h"
24afe00251SAndrea Bittau #include "feat.h"
25afe00251SAndrea Bittau 
26afe00251SAndrea Bittau #define DCCP_FEAT_SP_NOAGREE (-123)
27afe00251SAndrea Bittau 
287d43d1a0SGerrit Renker static const struct {
297d43d1a0SGerrit Renker 	u8			feat_num;		/* DCCPF_xxx */
307d43d1a0SGerrit Renker 	enum dccp_feat_type	rxtx;			/* RX or TX  */
317d43d1a0SGerrit Renker 	enum dccp_feat_type	reconciliation;		/* SP or NN  */
327d43d1a0SGerrit Renker 	u8			default_value;		/* as in 6.4 */
337d43d1a0SGerrit Renker /*
347d43d1a0SGerrit Renker  *    Lookup table for location and type of features (from RFC 4340/4342)
357d43d1a0SGerrit Renker  *  +--------------------------+----+-----+----+----+---------+-----------+
367d43d1a0SGerrit Renker  *  | Feature                  | Location | Reconc. | Initial |  Section  |
377d43d1a0SGerrit Renker  *  |                          | RX | TX  | SP | NN |  Value  | Reference |
387d43d1a0SGerrit Renker  *  +--------------------------+----+-----+----+----+---------+-----------+
397d43d1a0SGerrit Renker  *  | DCCPF_CCID               |    |  X  | X  |    |   2     | 10        |
407d43d1a0SGerrit Renker  *  | DCCPF_SHORT_SEQNOS       |    |  X  | X  |    |   0     |  7.6.1    |
417d43d1a0SGerrit Renker  *  | DCCPF_SEQUENCE_WINDOW    |    |  X  |    | X  | 100     |  7.5.2    |
427d43d1a0SGerrit Renker  *  | DCCPF_ECN_INCAPABLE      | X  |     | X  |    |   0     | 12.1      |
437d43d1a0SGerrit Renker  *  | DCCPF_ACK_RATIO          |    |  X  |    | X  |   2     | 11.3      |
447d43d1a0SGerrit Renker  *  | DCCPF_SEND_ACK_VECTOR    | X  |     | X  |    |   0     | 11.5      |
457d43d1a0SGerrit Renker  *  | DCCPF_SEND_NDP_COUNT     |    |  X  | X  |    |   0     |  7.7.2    |
467d43d1a0SGerrit Renker  *  | DCCPF_MIN_CSUM_COVER     | X  |     | X  |    |   0     |  9.2.1    |
477d43d1a0SGerrit Renker  *  | DCCPF_DATA_CHECKSUM      | X  |     | X  |    |   0     |  9.3.1    |
487d43d1a0SGerrit Renker  *  | DCCPF_SEND_LEV_RATE      | X  |     | X  |    |   0     | 4342/8.4  |
497d43d1a0SGerrit Renker  *  +--------------------------+----+-----+----+----+---------+-----------+
507d43d1a0SGerrit Renker  */
517d43d1a0SGerrit Renker } dccp_feat_table[] = {
527d43d1a0SGerrit Renker 	{ DCCPF_CCID,		 FEAT_AT_TX, FEAT_SP, 2 },
537d43d1a0SGerrit Renker 	{ DCCPF_SHORT_SEQNOS,	 FEAT_AT_TX, FEAT_SP, 0 },
547d43d1a0SGerrit Renker 	{ DCCPF_SEQUENCE_WINDOW, FEAT_AT_TX, FEAT_NN, 100 },
557d43d1a0SGerrit Renker 	{ DCCPF_ECN_INCAPABLE,	 FEAT_AT_RX, FEAT_SP, 0 },
567d43d1a0SGerrit Renker 	{ DCCPF_ACK_RATIO,	 FEAT_AT_TX, FEAT_NN, 2 },
577d43d1a0SGerrit Renker 	{ DCCPF_SEND_ACK_VECTOR, FEAT_AT_RX, FEAT_SP, 0 },
587d43d1a0SGerrit Renker 	{ DCCPF_SEND_NDP_COUNT,  FEAT_AT_TX, FEAT_SP, 0 },
597d43d1a0SGerrit Renker 	{ DCCPF_MIN_CSUM_COVER,  FEAT_AT_RX, FEAT_SP, 0 },
607d43d1a0SGerrit Renker 	{ DCCPF_DATA_CHECKSUM,	 FEAT_AT_RX, FEAT_SP, 0 },
617d43d1a0SGerrit Renker 	{ DCCPF_SEND_LEV_RATE,	 FEAT_AT_RX, FEAT_SP, 0 },
627d43d1a0SGerrit Renker };
637d43d1a0SGerrit Renker #define DCCP_FEAT_SUPPORTED_MAX		ARRAY_SIZE(dccp_feat_table)
647d43d1a0SGerrit Renker 
6561e6473eSGerrit Renker /**
6661e6473eSGerrit Renker  * dccp_feat_index  -  Hash function to map feature number into array position
6761e6473eSGerrit Renker  * Returns consecutive array index or -1 if the feature is not understood.
6861e6473eSGerrit Renker  */
6961e6473eSGerrit Renker static int dccp_feat_index(u8 feat_num)
7061e6473eSGerrit Renker {
7161e6473eSGerrit Renker 	/* The first 9 entries are occupied by the types from RFC 4340, 6.4 */
7261e6473eSGerrit Renker 	if (feat_num > DCCPF_RESERVED && feat_num <= DCCPF_DATA_CHECKSUM)
7361e6473eSGerrit Renker 		return feat_num - 1;
7461e6473eSGerrit Renker 
7561e6473eSGerrit Renker 	/*
7661e6473eSGerrit Renker 	 * Other features: add cases for new feature types here after adding
7761e6473eSGerrit Renker 	 * them to the above table.
7861e6473eSGerrit Renker 	 */
7961e6473eSGerrit Renker 	switch (feat_num) {
8061e6473eSGerrit Renker 	case DCCPF_SEND_LEV_RATE:
8161e6473eSGerrit Renker 			return DCCP_FEAT_SUPPORTED_MAX - 1;
8261e6473eSGerrit Renker 	}
8361e6473eSGerrit Renker 	return -1;
8461e6473eSGerrit Renker }
8561e6473eSGerrit Renker 
8661e6473eSGerrit Renker static u8 dccp_feat_type(u8 feat_num)
8761e6473eSGerrit Renker {
8861e6473eSGerrit Renker 	int idx = dccp_feat_index(feat_num);
8961e6473eSGerrit Renker 
9061e6473eSGerrit Renker 	if (idx < 0)
9161e6473eSGerrit Renker 		return FEAT_UNKNOWN;
9261e6473eSGerrit Renker 	return dccp_feat_table[idx].reconciliation;
9361e6473eSGerrit Renker }
9461e6473eSGerrit Renker 
95e8ef967aSGerrit Renker static int dccp_feat_default_value(u8 feat_num)
96e8ef967aSGerrit Renker {
97e8ef967aSGerrit Renker 	int idx = dccp_feat_index(feat_num);
98e8ef967aSGerrit Renker 	/*
99e8ef967aSGerrit Renker 	 * There are no default values for unknown features, so encountering a
100e8ef967aSGerrit Renker 	 * negative index here indicates a serious problem somewhere else.
101e8ef967aSGerrit Renker 	 */
102e8ef967aSGerrit Renker 	DCCP_BUG_ON(idx < 0);
103e8ef967aSGerrit Renker 
104e8ef967aSGerrit Renker 	return idx < 0 ? 0 : dccp_feat_table[idx].default_value;
105e8ef967aSGerrit Renker }
106e8ef967aSGerrit Renker 
107ac75773cSGerrit Renker /* copy constructor, fval must not already contain allocated memory */
108ac75773cSGerrit Renker static int dccp_feat_clone_sp_val(dccp_feat_val *fval, u8 const *val, u8 len)
109ac75773cSGerrit Renker {
110ac75773cSGerrit Renker 	fval->sp.len = len;
111ac75773cSGerrit Renker 	if (fval->sp.len > 0) {
112ac75773cSGerrit Renker 		fval->sp.vec = kmemdup(val, len, gfp_any());
113ac75773cSGerrit Renker 		if (fval->sp.vec == NULL) {
114ac75773cSGerrit Renker 			fval->sp.len = 0;
115ac75773cSGerrit Renker 			return -ENOBUFS;
116ac75773cSGerrit Renker 		}
117ac75773cSGerrit Renker 	}
118ac75773cSGerrit Renker 	return 0;
119ac75773cSGerrit Renker }
120ac75773cSGerrit Renker 
12161e6473eSGerrit Renker static void dccp_feat_val_destructor(u8 feat_num, dccp_feat_val *val)
12261e6473eSGerrit Renker {
12361e6473eSGerrit Renker 	if (unlikely(val == NULL))
12461e6473eSGerrit Renker 		return;
12561e6473eSGerrit Renker 	if (dccp_feat_type(feat_num) == FEAT_SP)
12661e6473eSGerrit Renker 		kfree(val->sp.vec);
12761e6473eSGerrit Renker 	memset(val, 0, sizeof(*val));
12861e6473eSGerrit Renker }
12961e6473eSGerrit Renker 
130ac75773cSGerrit Renker static struct dccp_feat_entry *
131ac75773cSGerrit Renker 	      dccp_feat_clone_entry(struct dccp_feat_entry const *original)
132ac75773cSGerrit Renker {
133ac75773cSGerrit Renker 	struct dccp_feat_entry *new;
134ac75773cSGerrit Renker 	u8 type = dccp_feat_type(original->feat_num);
135ac75773cSGerrit Renker 
136ac75773cSGerrit Renker 	if (type == FEAT_UNKNOWN)
137ac75773cSGerrit Renker 		return NULL;
138ac75773cSGerrit Renker 
139ac75773cSGerrit Renker 	new = kmemdup(original, sizeof(struct dccp_feat_entry), gfp_any());
140ac75773cSGerrit Renker 	if (new == NULL)
141ac75773cSGerrit Renker 		return NULL;
142ac75773cSGerrit Renker 
143ac75773cSGerrit Renker 	if (type == FEAT_SP && dccp_feat_clone_sp_val(&new->val,
144ac75773cSGerrit Renker 						      original->val.sp.vec,
145ac75773cSGerrit Renker 						      original->val.sp.len)) {
146ac75773cSGerrit Renker 		kfree(new);
147ac75773cSGerrit Renker 		return NULL;
148ac75773cSGerrit Renker 	}
149ac75773cSGerrit Renker 	return new;
150ac75773cSGerrit Renker }
151ac75773cSGerrit Renker 
15261e6473eSGerrit Renker static void dccp_feat_entry_destructor(struct dccp_feat_entry *entry)
15361e6473eSGerrit Renker {
15461e6473eSGerrit Renker 	if (entry != NULL) {
15561e6473eSGerrit Renker 		dccp_feat_val_destructor(entry->feat_num, &entry->val);
15661e6473eSGerrit Renker 		kfree(entry);
15761e6473eSGerrit Renker 	}
15861e6473eSGerrit Renker }
15961e6473eSGerrit Renker 
16061e6473eSGerrit Renker /*
16161e6473eSGerrit Renker  * List management functions
16261e6473eSGerrit Renker  *
16361e6473eSGerrit Renker  * Feature negotiation lists rely on and maintain the following invariants:
16461e6473eSGerrit Renker  * - each feat_num in the list is known, i.e. we know its type and default value
16561e6473eSGerrit Renker  * - each feat_num/is_local combination is unique (old entries are overwritten)
16661e6473eSGerrit Renker  * - SP values are always freshly allocated
16761e6473eSGerrit Renker  * - list is sorted in increasing order of feature number (faster lookup)
16861e6473eSGerrit Renker  */
16961e6473eSGerrit Renker 
170e8ef967aSGerrit Renker /**
171e8ef967aSGerrit Renker  * dccp_feat_entry_new  -  Central list update routine (called by all others)
172e8ef967aSGerrit Renker  * @head:  list to add to
173e8ef967aSGerrit Renker  * @feat:  feature number
174e8ef967aSGerrit Renker  * @local: whether the local (1) or remote feature with number @feat is meant
175e8ef967aSGerrit Renker  * This is the only constructor and serves to ensure the above invariants.
176e8ef967aSGerrit Renker  */
177e8ef967aSGerrit Renker static struct dccp_feat_entry *
178e8ef967aSGerrit Renker 	      dccp_feat_entry_new(struct list_head *head, u8 feat, bool local)
179e8ef967aSGerrit Renker {
180e8ef967aSGerrit Renker 	struct dccp_feat_entry *entry;
181e8ef967aSGerrit Renker 
182e8ef967aSGerrit Renker 	list_for_each_entry(entry, head, node)
183e8ef967aSGerrit Renker 		if (entry->feat_num == feat && entry->is_local == local) {
184e8ef967aSGerrit Renker 			dccp_feat_val_destructor(entry->feat_num, &entry->val);
185e8ef967aSGerrit Renker 			return entry;
186e8ef967aSGerrit Renker 		} else if (entry->feat_num > feat) {
187e8ef967aSGerrit Renker 			head = &entry->node;
188e8ef967aSGerrit Renker 			break;
189e8ef967aSGerrit Renker 		}
190e8ef967aSGerrit Renker 
191e8ef967aSGerrit Renker 	entry = kmalloc(sizeof(*entry), gfp_any());
192e8ef967aSGerrit Renker 	if (entry != NULL) {
193e8ef967aSGerrit Renker 		entry->feat_num = feat;
194e8ef967aSGerrit Renker 		entry->is_local = local;
195e8ef967aSGerrit Renker 		list_add_tail(&entry->node, head);
196e8ef967aSGerrit Renker 	}
197e8ef967aSGerrit Renker 	return entry;
198e8ef967aSGerrit Renker }
199e8ef967aSGerrit Renker 
200e8ef967aSGerrit Renker /**
201e8ef967aSGerrit Renker  * dccp_feat_push_change  -  Add/overwrite a Change option in the list
202e8ef967aSGerrit Renker  * @fn_list: feature-negotiation list to update
203e8ef967aSGerrit Renker  * @feat: one of %dccp_feature_numbers
204e8ef967aSGerrit Renker  * @local: whether local (1) or remote (0) @feat_num is meant
205e8ef967aSGerrit Renker  * @needs_mandatory: whether to use Mandatory feature negotiation options
206e8ef967aSGerrit Renker  * @fval: pointer to NN/SP value to be inserted (will be copied)
207e8ef967aSGerrit Renker  */
208e8ef967aSGerrit Renker static int dccp_feat_push_change(struct list_head *fn_list, u8 feat, u8 local,
209e8ef967aSGerrit Renker 				 u8 mandatory, dccp_feat_val *fval)
210e8ef967aSGerrit Renker {
211e8ef967aSGerrit Renker 	struct dccp_feat_entry *new = dccp_feat_entry_new(fn_list, feat, local);
212e8ef967aSGerrit Renker 
213e8ef967aSGerrit Renker 	if (new == NULL)
214e8ef967aSGerrit Renker 		return -ENOMEM;
215e8ef967aSGerrit Renker 
216e8ef967aSGerrit Renker 	new->feat_num	     = feat;
217e8ef967aSGerrit Renker 	new->is_local	     = local;
218e8ef967aSGerrit Renker 	new->state	     = FEAT_INITIALISING;
219e8ef967aSGerrit Renker 	new->needs_confirm   = 0;
220e8ef967aSGerrit Renker 	new->empty_confirm   = 0;
221e8ef967aSGerrit Renker 	new->val	     = *fval;
222e8ef967aSGerrit Renker 	new->needs_mandatory = mandatory;
223e8ef967aSGerrit Renker 
224e8ef967aSGerrit Renker 	return 0;
225e8ef967aSGerrit Renker }
226e8ef967aSGerrit Renker 
22761e6473eSGerrit Renker static inline void dccp_feat_list_pop(struct dccp_feat_entry *entry)
22861e6473eSGerrit Renker {
22961e6473eSGerrit Renker 	list_del(&entry->node);
23061e6473eSGerrit Renker 	dccp_feat_entry_destructor(entry);
23161e6473eSGerrit Renker }
23261e6473eSGerrit Renker 
23361e6473eSGerrit Renker void dccp_feat_list_purge(struct list_head *fn_list)
23461e6473eSGerrit Renker {
23561e6473eSGerrit Renker 	struct dccp_feat_entry *entry, *next;
23661e6473eSGerrit Renker 
23761e6473eSGerrit Renker 	list_for_each_entry_safe(entry, next, fn_list, node)
23861e6473eSGerrit Renker 		dccp_feat_entry_destructor(entry);
23961e6473eSGerrit Renker 	INIT_LIST_HEAD(fn_list);
24061e6473eSGerrit Renker }
24161e6473eSGerrit Renker EXPORT_SYMBOL_GPL(dccp_feat_list_purge);
24261e6473eSGerrit Renker 
243ac75773cSGerrit Renker /* generate @to as full clone of @from - @to must not contain any nodes */
244ac75773cSGerrit Renker int dccp_feat_clone_list(struct list_head const *from, struct list_head *to)
245ac75773cSGerrit Renker {
246ac75773cSGerrit Renker 	struct dccp_feat_entry *entry, *new;
247ac75773cSGerrit Renker 
248ac75773cSGerrit Renker 	INIT_LIST_HEAD(to);
249ac75773cSGerrit Renker 	list_for_each_entry(entry, from, node) {
250ac75773cSGerrit Renker 		new = dccp_feat_clone_entry(entry);
251ac75773cSGerrit Renker 		if (new == NULL)
252ac75773cSGerrit Renker 			goto cloning_failed;
253ac75773cSGerrit Renker 		list_add_tail(&new->node, to);
254ac75773cSGerrit Renker 	}
255ac75773cSGerrit Renker 	return 0;
256ac75773cSGerrit Renker 
257ac75773cSGerrit Renker cloning_failed:
258ac75773cSGerrit Renker 	dccp_feat_list_purge(to);
259ac75773cSGerrit Renker 	return -ENOMEM;
260ac75773cSGerrit Renker }
261ac75773cSGerrit Renker 
262e8ef967aSGerrit Renker static u8 dccp_feat_is_valid_nn_val(u8 feat_num, u64 val)
263e8ef967aSGerrit Renker {
264e8ef967aSGerrit Renker 	switch (feat_num) {
265e8ef967aSGerrit Renker 	case DCCPF_ACK_RATIO:
266e8ef967aSGerrit Renker 		return val <= DCCPF_ACK_RATIO_MAX;
267e8ef967aSGerrit Renker 	case DCCPF_SEQUENCE_WINDOW:
268e8ef967aSGerrit Renker 		return val >= DCCPF_SEQ_WMIN && val <= DCCPF_SEQ_WMAX;
269e8ef967aSGerrit Renker 	}
270e8ef967aSGerrit Renker 	return 0;	/* feature unknown - so we can't tell */
271e8ef967aSGerrit Renker }
272e8ef967aSGerrit Renker 
273e8ef967aSGerrit Renker /* check that SP values are within the ranges defined in RFC 4340 */
274e8ef967aSGerrit Renker static u8 dccp_feat_is_valid_sp_val(u8 feat_num, u8 val)
275e8ef967aSGerrit Renker {
276e8ef967aSGerrit Renker 	switch (feat_num) {
277e8ef967aSGerrit Renker 	case DCCPF_CCID:
278e8ef967aSGerrit Renker 		return val == DCCPC_CCID2 || val == DCCPC_CCID3;
279e8ef967aSGerrit Renker 	/* Type-check Boolean feature values: */
280e8ef967aSGerrit Renker 	case DCCPF_SHORT_SEQNOS:
281e8ef967aSGerrit Renker 	case DCCPF_ECN_INCAPABLE:
282e8ef967aSGerrit Renker 	case DCCPF_SEND_ACK_VECTOR:
283e8ef967aSGerrit Renker 	case DCCPF_SEND_NDP_COUNT:
284e8ef967aSGerrit Renker 	case DCCPF_DATA_CHECKSUM:
285e8ef967aSGerrit Renker 	case DCCPF_SEND_LEV_RATE:
286e8ef967aSGerrit Renker 		return val < 2;
287e8ef967aSGerrit Renker 	case DCCPF_MIN_CSUM_COVER:
288e8ef967aSGerrit Renker 		return val < 16;
289e8ef967aSGerrit Renker 	}
290e8ef967aSGerrit Renker 	return 0;			/* feature unknown */
291e8ef967aSGerrit Renker }
292e8ef967aSGerrit Renker 
293e8ef967aSGerrit Renker static u8 dccp_feat_sp_list_ok(u8 feat_num, u8 const *sp_list, u8 sp_len)
294e8ef967aSGerrit Renker {
295e8ef967aSGerrit Renker 	if (sp_list == NULL || sp_len < 1)
296e8ef967aSGerrit Renker 		return 0;
297e8ef967aSGerrit Renker 	while (sp_len--)
298e8ef967aSGerrit Renker 		if (!dccp_feat_is_valid_sp_val(feat_num, *sp_list++))
299e8ef967aSGerrit Renker 			return 0;
300e8ef967aSGerrit Renker 	return 1;
301e8ef967aSGerrit Renker }
302e8ef967aSGerrit Renker 
303e8ef967aSGerrit Renker /**
304e8ef967aSGerrit Renker  * __feat_register_nn  -  Register new NN value on socket
305e8ef967aSGerrit Renker  * @fn: feature-negotiation list to register with
306e8ef967aSGerrit Renker  * @feat: an NN feature from %dccp_feature_numbers
307e8ef967aSGerrit Renker  * @mandatory: use Mandatory option if 1
308e8ef967aSGerrit Renker  * @nn_val: value to register (restricted to 4 bytes)
309e8ef967aSGerrit Renker  * Note that NN features are local by definition (RFC 4340, 6.3.2).
310e8ef967aSGerrit Renker  */
311e8ef967aSGerrit Renker static int __feat_register_nn(struct list_head *fn, u8 feat,
312e8ef967aSGerrit Renker 			      u8 mandatory, u64 nn_val)
313e8ef967aSGerrit Renker {
314e8ef967aSGerrit Renker 	dccp_feat_val fval = { .nn = nn_val };
315e8ef967aSGerrit Renker 
316e8ef967aSGerrit Renker 	if (dccp_feat_type(feat) != FEAT_NN ||
317e8ef967aSGerrit Renker 	    !dccp_feat_is_valid_nn_val(feat, nn_val))
318e8ef967aSGerrit Renker 		return -EINVAL;
319e8ef967aSGerrit Renker 
320e8ef967aSGerrit Renker 	/* Don't bother with default values, they will be activated anyway. */
321e8ef967aSGerrit Renker 	if (nn_val - (u64)dccp_feat_default_value(feat) == 0)
322e8ef967aSGerrit Renker 		return 0;
323e8ef967aSGerrit Renker 
324e8ef967aSGerrit Renker 	return dccp_feat_push_change(fn, feat, 1, mandatory, &fval);
325e8ef967aSGerrit Renker }
326e8ef967aSGerrit Renker 
327e8ef967aSGerrit Renker /**
328e8ef967aSGerrit Renker  * __feat_register_sp  -  Register new SP value/list on socket
329e8ef967aSGerrit Renker  * @fn: feature-negotiation list to register with
330e8ef967aSGerrit Renker  * @feat: an SP feature from %dccp_feature_numbers
331e8ef967aSGerrit Renker  * @is_local: whether the local (1) or the remote (0) @feat is meant
332e8ef967aSGerrit Renker  * @mandatory: use Mandatory option if 1
333e8ef967aSGerrit Renker  * @sp_val: SP value followed by optional preference list
334e8ef967aSGerrit Renker  * @sp_len: length of @sp_val in bytes
335e8ef967aSGerrit Renker  */
336e8ef967aSGerrit Renker static int __feat_register_sp(struct list_head *fn, u8 feat, u8 is_local,
337e8ef967aSGerrit Renker 			      u8 mandatory, u8 const *sp_val, u8 sp_len)
338e8ef967aSGerrit Renker {
339e8ef967aSGerrit Renker 	dccp_feat_val fval;
340e8ef967aSGerrit Renker 
341e8ef967aSGerrit Renker 	if (dccp_feat_type(feat) != FEAT_SP ||
342e8ef967aSGerrit Renker 	    !dccp_feat_sp_list_ok(feat, sp_val, sp_len))
343e8ef967aSGerrit Renker 		return -EINVAL;
344e8ef967aSGerrit Renker 
345*d90ebcbfSGerrit Renker 	/* Avoid negotiating alien CCIDs by only advertising supported ones */
346*d90ebcbfSGerrit Renker 	if (feat == DCCPF_CCID && !ccid_support_check(sp_val, sp_len))
347*d90ebcbfSGerrit Renker 		return -EOPNOTSUPP;
348*d90ebcbfSGerrit Renker 
349e8ef967aSGerrit Renker 	if (dccp_feat_clone_sp_val(&fval, sp_val, sp_len))
350e8ef967aSGerrit Renker 		return -ENOMEM;
351e8ef967aSGerrit Renker 
352e8ef967aSGerrit Renker 	return dccp_feat_push_change(fn, feat, is_local, mandatory, &fval);
353e8ef967aSGerrit Renker }
354e8ef967aSGerrit Renker 
3558ca0d17bSArnaldo Carvalho de Melo int dccp_feat_change(struct dccp_minisock *dmsk, u8 type, u8 feature,
3568ca0d17bSArnaldo Carvalho de Melo 		     u8 *val, u8 len, gfp_t gfp)
357afe00251SAndrea Bittau {
358afe00251SAndrea Bittau 	struct dccp_opt_pend *opt;
359afe00251SAndrea Bittau 
360c02fdc0eSGerrit Renker 	dccp_feat_debug(type, feature, *val);
361afe00251SAndrea Bittau 
362dd6303dfSGerrit Renker 	if (len > 3) {
36359348b19SGerrit Renker 		DCCP_WARN("invalid length %d\n", len);
36419443178SChris Wright 		return -EINVAL;
365c02fdc0eSGerrit Renker 	}
366c02fdc0eSGerrit Renker 	/* XXX add further sanity checks */
3676ffd30fbSAndrea Bittau 
368afe00251SAndrea Bittau 	/* check if that feature is already being negotiated */
369a4bf3902SArnaldo Carvalho de Melo 	list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
370afe00251SAndrea Bittau 		/* ok we found a negotiation for this option already */
371afe00251SAndrea Bittau 		if (opt->dccpop_feat == feature && opt->dccpop_type == type) {
372afe00251SAndrea Bittau 			dccp_pr_debug("Replacing old\n");
373afe00251SAndrea Bittau 			/* replace */
374afe00251SAndrea Bittau 			BUG_ON(opt->dccpop_val == NULL);
375afe00251SAndrea Bittau 			kfree(opt->dccpop_val);
376afe00251SAndrea Bittau 			opt->dccpop_val	 = val;
377afe00251SAndrea Bittau 			opt->dccpop_len	 = len;
378afe00251SAndrea Bittau 			opt->dccpop_conf = 0;
379afe00251SAndrea Bittau 			return 0;
380afe00251SAndrea Bittau 		}
381afe00251SAndrea Bittau 	}
382afe00251SAndrea Bittau 
383afe00251SAndrea Bittau 	/* negotiation for a new feature */
384afe00251SAndrea Bittau 	opt = kmalloc(sizeof(*opt), gfp);
385afe00251SAndrea Bittau 	if (opt == NULL)
386afe00251SAndrea Bittau 		return -ENOMEM;
387afe00251SAndrea Bittau 
388afe00251SAndrea Bittau 	opt->dccpop_type = type;
389afe00251SAndrea Bittau 	opt->dccpop_feat = feature;
390afe00251SAndrea Bittau 	opt->dccpop_len	 = len;
391afe00251SAndrea Bittau 	opt->dccpop_val	 = val;
392afe00251SAndrea Bittau 	opt->dccpop_conf = 0;
393afe00251SAndrea Bittau 	opt->dccpop_sc	 = NULL;
394afe00251SAndrea Bittau 
395afe00251SAndrea Bittau 	BUG_ON(opt->dccpop_val == NULL);
396afe00251SAndrea Bittau 
397a4bf3902SArnaldo Carvalho de Melo 	list_add_tail(&opt->dccpop_node, &dmsk->dccpms_pending);
398afe00251SAndrea Bittau 	return 0;
399afe00251SAndrea Bittau }
400afe00251SAndrea Bittau 
401afe00251SAndrea Bittau EXPORT_SYMBOL_GPL(dccp_feat_change);
402afe00251SAndrea Bittau 
4036ffd30fbSAndrea Bittau static int dccp_feat_update_ccid(struct sock *sk, u8 type, u8 new_ccid_nr)
4046ffd30fbSAndrea Bittau {
4056ffd30fbSAndrea Bittau 	struct dccp_sock *dp = dccp_sk(sk);
406a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *dmsk = dccp_msk(sk);
4076ffd30fbSAndrea Bittau 	/* figure out if we are changing our CCID or the peer's */
4086ffd30fbSAndrea Bittau 	const int rx = type == DCCPO_CHANGE_R;
409a4bf3902SArnaldo Carvalho de Melo 	const u8 ccid_nr = rx ? dmsk->dccpms_rx_ccid : dmsk->dccpms_tx_ccid;
4106ffd30fbSAndrea Bittau 	struct ccid *new_ccid;
4116ffd30fbSAndrea Bittau 
4126ffd30fbSAndrea Bittau 	/* Check if nothing is being changed. */
4136ffd30fbSAndrea Bittau 	if (ccid_nr == new_ccid_nr)
4146ffd30fbSAndrea Bittau 		return 0;
4156ffd30fbSAndrea Bittau 
4166ffd30fbSAndrea Bittau 	new_ccid = ccid_new(new_ccid_nr, sk, rx, GFP_ATOMIC);
4176ffd30fbSAndrea Bittau 	if (new_ccid == NULL)
4186ffd30fbSAndrea Bittau 		return -ENOMEM;
4196ffd30fbSAndrea Bittau 
4206ffd30fbSAndrea Bittau 	if (rx) {
4216ffd30fbSAndrea Bittau 		ccid_hc_rx_delete(dp->dccps_hc_rx_ccid, sk);
4226ffd30fbSAndrea Bittau 		dp->dccps_hc_rx_ccid = new_ccid;
423a4bf3902SArnaldo Carvalho de Melo 		dmsk->dccpms_rx_ccid = new_ccid_nr;
4246ffd30fbSAndrea Bittau 	} else {
4256ffd30fbSAndrea Bittau 		ccid_hc_tx_delete(dp->dccps_hc_tx_ccid, sk);
4266ffd30fbSAndrea Bittau 		dp->dccps_hc_tx_ccid = new_ccid;
427a4bf3902SArnaldo Carvalho de Melo 		dmsk->dccpms_tx_ccid = new_ccid_nr;
4286ffd30fbSAndrea Bittau 	}
4296ffd30fbSAndrea Bittau 
4306ffd30fbSAndrea Bittau 	return 0;
4316ffd30fbSAndrea Bittau }
4326ffd30fbSAndrea Bittau 
433afe00251SAndrea Bittau static int dccp_feat_update(struct sock *sk, u8 type, u8 feat, u8 val)
434afe00251SAndrea Bittau {
435c02fdc0eSGerrit Renker 	dccp_feat_debug(type, feat, val);
4366ffd30fbSAndrea Bittau 
4376ffd30fbSAndrea Bittau 	switch (feat) {
4386ffd30fbSAndrea Bittau 	case DCCPF_CCID:
4396ffd30fbSAndrea Bittau 		return dccp_feat_update_ccid(sk, type, val);
4406ffd30fbSAndrea Bittau 	default:
441c02fdc0eSGerrit Renker 		dccp_pr_debug("UNIMPLEMENTED: %s(%d, ...)\n",
442c02fdc0eSGerrit Renker 			      dccp_feat_typename(type), feat);
4436ffd30fbSAndrea Bittau 		break;
4446ffd30fbSAndrea Bittau 	}
445afe00251SAndrea Bittau 	return 0;
446afe00251SAndrea Bittau }
447afe00251SAndrea Bittau 
448afe00251SAndrea Bittau static int dccp_feat_reconcile(struct sock *sk, struct dccp_opt_pend *opt,
449afe00251SAndrea Bittau 			       u8 *rpref, u8 rlen)
450afe00251SAndrea Bittau {
451afe00251SAndrea Bittau 	struct dccp_sock *dp = dccp_sk(sk);
452afe00251SAndrea Bittau 	u8 *spref, slen, *res = NULL;
453afe00251SAndrea Bittau 	int i, j, rc, agree = 1;
454afe00251SAndrea Bittau 
455afe00251SAndrea Bittau 	BUG_ON(rpref == NULL);
456afe00251SAndrea Bittau 
457afe00251SAndrea Bittau 	/* check if we are the black sheep */
458afe00251SAndrea Bittau 	if (dp->dccps_role == DCCP_ROLE_CLIENT) {
459afe00251SAndrea Bittau 		spref = rpref;
460afe00251SAndrea Bittau 		slen  = rlen;
461afe00251SAndrea Bittau 		rpref = opt->dccpop_val;
462afe00251SAndrea Bittau 		rlen  = opt->dccpop_len;
463afe00251SAndrea Bittau 	} else {
464afe00251SAndrea Bittau 		spref = opt->dccpop_val;
465afe00251SAndrea Bittau 		slen  = opt->dccpop_len;
466afe00251SAndrea Bittau 	}
467afe00251SAndrea Bittau 	/*
468afe00251SAndrea Bittau 	 * Now we have server preference list in spref and client preference in
469afe00251SAndrea Bittau 	 * rpref
470afe00251SAndrea Bittau 	 */
471afe00251SAndrea Bittau 	BUG_ON(spref == NULL);
472afe00251SAndrea Bittau 	BUG_ON(rpref == NULL);
473afe00251SAndrea Bittau 
474afe00251SAndrea Bittau 	/* FIXME sanity check vals */
475afe00251SAndrea Bittau 
476afe00251SAndrea Bittau 	/* Are values in any order?  XXX Lame "algorithm" here */
477afe00251SAndrea Bittau 	for (i = 0; i < slen; i++) {
478afe00251SAndrea Bittau 		for (j = 0; j < rlen; j++) {
479afe00251SAndrea Bittau 			if (spref[i] == rpref[j]) {
480afe00251SAndrea Bittau 				res = &spref[i];
481afe00251SAndrea Bittau 				break;
482afe00251SAndrea Bittau 			}
483afe00251SAndrea Bittau 		}
484afe00251SAndrea Bittau 		if (res)
485afe00251SAndrea Bittau 			break;
486afe00251SAndrea Bittau 	}
487afe00251SAndrea Bittau 
488afe00251SAndrea Bittau 	/* we didn't agree on anything */
489afe00251SAndrea Bittau 	if (res == NULL) {
490afe00251SAndrea Bittau 		/* confirm previous value */
491afe00251SAndrea Bittau 		switch (opt->dccpop_feat) {
492afe00251SAndrea Bittau 		case DCCPF_CCID:
493afe00251SAndrea Bittau 			/* XXX did i get this right? =P */
494afe00251SAndrea Bittau 			if (opt->dccpop_type == DCCPO_CHANGE_L)
495a4bf3902SArnaldo Carvalho de Melo 				res = &dccp_msk(sk)->dccpms_tx_ccid;
496afe00251SAndrea Bittau 			else
497a4bf3902SArnaldo Carvalho de Melo 				res = &dccp_msk(sk)->dccpms_rx_ccid;
498afe00251SAndrea Bittau 			break;
499afe00251SAndrea Bittau 
500afe00251SAndrea Bittau 		default:
50159348b19SGerrit Renker 			DCCP_BUG("Fell through, feat=%d", opt->dccpop_feat);
50259348b19SGerrit Renker 			/* XXX implement res */
503afe00251SAndrea Bittau 			return -EFAULT;
504afe00251SAndrea Bittau 		}
505afe00251SAndrea Bittau 
506afe00251SAndrea Bittau 		dccp_pr_debug("Don't agree... reconfirming %d\n", *res);
507afe00251SAndrea Bittau 		agree = 0; /* this is used for mandatory options... */
508afe00251SAndrea Bittau 	}
509afe00251SAndrea Bittau 
510afe00251SAndrea Bittau 	/* need to put result and our preference list */
511afe00251SAndrea Bittau 	rlen = 1 + opt->dccpop_len;
512afe00251SAndrea Bittau 	rpref = kmalloc(rlen, GFP_ATOMIC);
513afe00251SAndrea Bittau 	if (rpref == NULL)
514afe00251SAndrea Bittau 		return -ENOMEM;
515afe00251SAndrea Bittau 
516afe00251SAndrea Bittau 	*rpref = *res;
517afe00251SAndrea Bittau 	memcpy(&rpref[1], opt->dccpop_val, opt->dccpop_len);
518afe00251SAndrea Bittau 
519afe00251SAndrea Bittau 	/* put it in the "confirm queue" */
520afe00251SAndrea Bittau 	if (opt->dccpop_sc == NULL) {
521afe00251SAndrea Bittau 		opt->dccpop_sc = kmalloc(sizeof(*opt->dccpop_sc), GFP_ATOMIC);
522afe00251SAndrea Bittau 		if (opt->dccpop_sc == NULL) {
523afe00251SAndrea Bittau 			kfree(rpref);
524afe00251SAndrea Bittau 			return -ENOMEM;
525afe00251SAndrea Bittau 		}
526afe00251SAndrea Bittau 	} else {
527afe00251SAndrea Bittau 		/* recycle the confirm slot */
528afe00251SAndrea Bittau 		BUG_ON(opt->dccpop_sc->dccpoc_val == NULL);
529afe00251SAndrea Bittau 		kfree(opt->dccpop_sc->dccpoc_val);
530afe00251SAndrea Bittau 		dccp_pr_debug("recycling confirm slot\n");
531afe00251SAndrea Bittau 	}
532afe00251SAndrea Bittau 	memset(opt->dccpop_sc, 0, sizeof(*opt->dccpop_sc));
533afe00251SAndrea Bittau 
534afe00251SAndrea Bittau 	opt->dccpop_sc->dccpoc_val = rpref;
535afe00251SAndrea Bittau 	opt->dccpop_sc->dccpoc_len = rlen;
536afe00251SAndrea Bittau 
537afe00251SAndrea Bittau 	/* update the option on our side [we are about to send the confirm] */
538afe00251SAndrea Bittau 	rc = dccp_feat_update(sk, opt->dccpop_type, opt->dccpop_feat, *res);
539afe00251SAndrea Bittau 	if (rc) {
540afe00251SAndrea Bittau 		kfree(opt->dccpop_sc->dccpoc_val);
541afe00251SAndrea Bittau 		kfree(opt->dccpop_sc);
54268907dadSRandy Dunlap 		opt->dccpop_sc = NULL;
543afe00251SAndrea Bittau 		return rc;
544afe00251SAndrea Bittau 	}
545afe00251SAndrea Bittau 
546afe00251SAndrea Bittau 	dccp_pr_debug("Will confirm %d\n", *rpref);
547afe00251SAndrea Bittau 
548afe00251SAndrea Bittau 	/* say we want to change to X but we just got a confirm X, suppress our
549afe00251SAndrea Bittau 	 * change
550afe00251SAndrea Bittau 	 */
551afe00251SAndrea Bittau 	if (!opt->dccpop_conf) {
552afe00251SAndrea Bittau 		if (*opt->dccpop_val == *res)
553afe00251SAndrea Bittau 			opt->dccpop_conf = 1;
554afe00251SAndrea Bittau 		dccp_pr_debug("won't ask for change of same feature\n");
555afe00251SAndrea Bittau 	}
556afe00251SAndrea Bittau 
557afe00251SAndrea Bittau 	return agree ? 0 : DCCP_FEAT_SP_NOAGREE; /* used for mandatory opts */
558afe00251SAndrea Bittau }
559afe00251SAndrea Bittau 
560afe00251SAndrea Bittau static int dccp_feat_sp(struct sock *sk, u8 type, u8 feature, u8 *val, u8 len)
561afe00251SAndrea Bittau {
562a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *dmsk = dccp_msk(sk);
563afe00251SAndrea Bittau 	struct dccp_opt_pend *opt;
564afe00251SAndrea Bittau 	int rc = 1;
565afe00251SAndrea Bittau 	u8 t;
566afe00251SAndrea Bittau 
567afe00251SAndrea Bittau 	/*
568afe00251SAndrea Bittau 	 * We received a CHANGE.  We gotta match it against our own preference
569afe00251SAndrea Bittau 	 * list.  If we got a CHANGE_R it means it's a change for us, so we need
570afe00251SAndrea Bittau 	 * to compare our CHANGE_L list.
571afe00251SAndrea Bittau 	 */
572afe00251SAndrea Bittau 	if (type == DCCPO_CHANGE_L)
573afe00251SAndrea Bittau 		t = DCCPO_CHANGE_R;
574afe00251SAndrea Bittau 	else
575afe00251SAndrea Bittau 		t = DCCPO_CHANGE_L;
576afe00251SAndrea Bittau 
577afe00251SAndrea Bittau 	/* find our preference list for this feature */
578a4bf3902SArnaldo Carvalho de Melo 	list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
579afe00251SAndrea Bittau 		if (opt->dccpop_type != t || opt->dccpop_feat != feature)
580afe00251SAndrea Bittau 			continue;
581afe00251SAndrea Bittau 
582afe00251SAndrea Bittau 		/* find the winner from the two preference lists */
583afe00251SAndrea Bittau 		rc = dccp_feat_reconcile(sk, opt, val, len);
584afe00251SAndrea Bittau 		break;
585afe00251SAndrea Bittau 	}
586afe00251SAndrea Bittau 
587afe00251SAndrea Bittau 	/* We didn't deal with the change.  This can happen if we have no
588afe00251SAndrea Bittau 	 * preference list for the feature.  In fact, it just shouldn't
589afe00251SAndrea Bittau 	 * happen---if we understand a feature, we should have a preference list
590afe00251SAndrea Bittau 	 * with at least the default value.
591afe00251SAndrea Bittau 	 */
592afe00251SAndrea Bittau 	BUG_ON(rc == 1);
593afe00251SAndrea Bittau 
594afe00251SAndrea Bittau 	return rc;
595afe00251SAndrea Bittau }
596afe00251SAndrea Bittau 
597afe00251SAndrea Bittau static int dccp_feat_nn(struct sock *sk, u8 type, u8 feature, u8 *val, u8 len)
598afe00251SAndrea Bittau {
599afe00251SAndrea Bittau 	struct dccp_opt_pend *opt;
600a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *dmsk = dccp_msk(sk);
601afe00251SAndrea Bittau 	u8 *copy;
602afe00251SAndrea Bittau 	int rc;
603afe00251SAndrea Bittau 
604c02fdc0eSGerrit Renker 	/* NN features must be Change L (sec. 6.3.2) */
605c02fdc0eSGerrit Renker 	if (type != DCCPO_CHANGE_L) {
606c02fdc0eSGerrit Renker 		dccp_pr_debug("received %s for NN feature %d\n",
607c02fdc0eSGerrit Renker 				dccp_feat_typename(type), feature);
608afe00251SAndrea Bittau 		return -EFAULT;
609afe00251SAndrea Bittau 	}
610afe00251SAndrea Bittau 
611afe00251SAndrea Bittau 	/* XXX sanity check opt val */
612afe00251SAndrea Bittau 
613afe00251SAndrea Bittau 	/* copy option so we can confirm it */
614afe00251SAndrea Bittau 	opt = kzalloc(sizeof(*opt), GFP_ATOMIC);
615afe00251SAndrea Bittau 	if (opt == NULL)
616afe00251SAndrea Bittau 		return -ENOMEM;
617afe00251SAndrea Bittau 
618eed73417SArnaldo Carvalho de Melo 	copy = kmemdup(val, len, GFP_ATOMIC);
619afe00251SAndrea Bittau 	if (copy == NULL) {
620afe00251SAndrea Bittau 		kfree(opt);
621afe00251SAndrea Bittau 		return -ENOMEM;
622afe00251SAndrea Bittau 	}
623afe00251SAndrea Bittau 
624afe00251SAndrea Bittau 	opt->dccpop_type = DCCPO_CONFIRM_R; /* NN can only confirm R */
625afe00251SAndrea Bittau 	opt->dccpop_feat = feature;
626afe00251SAndrea Bittau 	opt->dccpop_val	 = copy;
627afe00251SAndrea Bittau 	opt->dccpop_len	 = len;
628afe00251SAndrea Bittau 
629afe00251SAndrea Bittau 	/* change feature */
630afe00251SAndrea Bittau 	rc = dccp_feat_update(sk, type, feature, *val);
631afe00251SAndrea Bittau 	if (rc) {
632afe00251SAndrea Bittau 		kfree(opt->dccpop_val);
633afe00251SAndrea Bittau 		kfree(opt);
634afe00251SAndrea Bittau 		return rc;
635afe00251SAndrea Bittau 	}
636afe00251SAndrea Bittau 
637c02fdc0eSGerrit Renker 	dccp_feat_debug(type, feature, *copy);
638c02fdc0eSGerrit Renker 
639a4bf3902SArnaldo Carvalho de Melo 	list_add_tail(&opt->dccpop_node, &dmsk->dccpms_conf);
640afe00251SAndrea Bittau 
641afe00251SAndrea Bittau 	return 0;
642afe00251SAndrea Bittau }
643afe00251SAndrea Bittau 
6448ca0d17bSArnaldo Carvalho de Melo static void dccp_feat_empty_confirm(struct dccp_minisock *dmsk,
6458ca0d17bSArnaldo Carvalho de Melo 				    u8 type, u8 feature)
646afe00251SAndrea Bittau {
647afe00251SAndrea Bittau 	/* XXX check if other confirms for that are queued and recycle slot */
648afe00251SAndrea Bittau 	struct dccp_opt_pend *opt = kzalloc(sizeof(*opt), GFP_ATOMIC);
649afe00251SAndrea Bittau 
650afe00251SAndrea Bittau 	if (opt == NULL) {
651afe00251SAndrea Bittau 		/* XXX what do we do?  Ignoring should be fine.  It's a change
652afe00251SAndrea Bittau 		 * after all =P
653afe00251SAndrea Bittau 		 */
654afe00251SAndrea Bittau 		return;
655afe00251SAndrea Bittau 	}
656afe00251SAndrea Bittau 
657c02fdc0eSGerrit Renker 	switch (type) {
658e576de82SJesper Juhl 	case DCCPO_CHANGE_L:
659e576de82SJesper Juhl 		opt->dccpop_type = DCCPO_CONFIRM_R;
660e576de82SJesper Juhl 		break;
661e576de82SJesper Juhl 	case DCCPO_CHANGE_R:
662e576de82SJesper Juhl 		opt->dccpop_type = DCCPO_CONFIRM_L;
663e576de82SJesper Juhl 		break;
664e576de82SJesper Juhl 	default:
665e576de82SJesper Juhl 		DCCP_WARN("invalid type %d\n", type);
666e576de82SJesper Juhl 		kfree(opt);
667e576de82SJesper Juhl 		return;
668c02fdc0eSGerrit Renker 	}
669afe00251SAndrea Bittau 	opt->dccpop_feat = feature;
67068907dadSRandy Dunlap 	opt->dccpop_val	 = NULL;
671afe00251SAndrea Bittau 	opt->dccpop_len	 = 0;
672afe00251SAndrea Bittau 
673afe00251SAndrea Bittau 	/* change feature */
674c02fdc0eSGerrit Renker 	dccp_pr_debug("Empty %s(%d)\n", dccp_feat_typename(type), feature);
675c02fdc0eSGerrit Renker 
676a4bf3902SArnaldo Carvalho de Melo 	list_add_tail(&opt->dccpop_node, &dmsk->dccpms_conf);
677afe00251SAndrea Bittau }
678afe00251SAndrea Bittau 
679afe00251SAndrea Bittau static void dccp_feat_flush_confirm(struct sock *sk)
680afe00251SAndrea Bittau {
681a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *dmsk = dccp_msk(sk);
682afe00251SAndrea Bittau 	/* Check if there is anything to confirm in the first place */
683a4bf3902SArnaldo Carvalho de Melo 	int yes = !list_empty(&dmsk->dccpms_conf);
684afe00251SAndrea Bittau 
685afe00251SAndrea Bittau 	if (!yes) {
686afe00251SAndrea Bittau 		struct dccp_opt_pend *opt;
687afe00251SAndrea Bittau 
688a4bf3902SArnaldo Carvalho de Melo 		list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
689afe00251SAndrea Bittau 			if (opt->dccpop_conf) {
690afe00251SAndrea Bittau 				yes = 1;
691afe00251SAndrea Bittau 				break;
692afe00251SAndrea Bittau 			}
693afe00251SAndrea Bittau 		}
694afe00251SAndrea Bittau 	}
695afe00251SAndrea Bittau 
696afe00251SAndrea Bittau 	if (!yes)
697afe00251SAndrea Bittau 		return;
698afe00251SAndrea Bittau 
699afe00251SAndrea Bittau 	/* OK there is something to confirm... */
700afe00251SAndrea Bittau 	/* XXX check if packet is in flight?  Send delayed ack?? */
701afe00251SAndrea Bittau 	if (sk->sk_state == DCCP_OPEN)
702afe00251SAndrea Bittau 		dccp_send_ack(sk);
703afe00251SAndrea Bittau }
704afe00251SAndrea Bittau 
705afe00251SAndrea Bittau int dccp_feat_change_recv(struct sock *sk, u8 type, u8 feature, u8 *val, u8 len)
706afe00251SAndrea Bittau {
707afe00251SAndrea Bittau 	int rc;
708afe00251SAndrea Bittau 
709f74e91b6SGerrit Renker 	/* Ignore Change requests other than during connection setup */
710f74e91b6SGerrit Renker 	if (sk->sk_state != DCCP_LISTEN && sk->sk_state != DCCP_REQUESTING)
711f74e91b6SGerrit Renker 		return 0;
712c02fdc0eSGerrit Renker 	dccp_feat_debug(type, feature, *val);
713afe00251SAndrea Bittau 
714afe00251SAndrea Bittau 	/* figure out if it's SP or NN feature */
715afe00251SAndrea Bittau 	switch (feature) {
716afe00251SAndrea Bittau 	/* deal with SP features */
717afe00251SAndrea Bittau 	case DCCPF_CCID:
718afe00251SAndrea Bittau 		rc = dccp_feat_sp(sk, type, feature, val, len);
719afe00251SAndrea Bittau 		break;
720afe00251SAndrea Bittau 
721afe00251SAndrea Bittau 	/* deal with NN features */
722afe00251SAndrea Bittau 	case DCCPF_ACK_RATIO:
723afe00251SAndrea Bittau 		rc = dccp_feat_nn(sk, type, feature, val, len);
724afe00251SAndrea Bittau 		break;
725afe00251SAndrea Bittau 
726afe00251SAndrea Bittau 	/* XXX implement other features */
727afe00251SAndrea Bittau 	default:
728c02fdc0eSGerrit Renker 		dccp_pr_debug("UNIMPLEMENTED: not handling %s(%d, ...)\n",
729c02fdc0eSGerrit Renker 			      dccp_feat_typename(type), feature);
730afe00251SAndrea Bittau 		rc = -EFAULT;
731afe00251SAndrea Bittau 		break;
732afe00251SAndrea Bittau 	}
733afe00251SAndrea Bittau 
734afe00251SAndrea Bittau 	/* check if there were problems changing features */
735afe00251SAndrea Bittau 	if (rc) {
736afe00251SAndrea Bittau 		/* If we don't agree on SP, we sent a confirm for old value.
737afe00251SAndrea Bittau 		 * However we propagate rc to caller in case option was
738afe00251SAndrea Bittau 		 * mandatory
739afe00251SAndrea Bittau 		 */
740afe00251SAndrea Bittau 		if (rc != DCCP_FEAT_SP_NOAGREE)
7418ca0d17bSArnaldo Carvalho de Melo 			dccp_feat_empty_confirm(dccp_msk(sk), type, feature);
742afe00251SAndrea Bittau 	}
743afe00251SAndrea Bittau 
744afe00251SAndrea Bittau 	/* generate the confirm [if required] */
745afe00251SAndrea Bittau 	dccp_feat_flush_confirm(sk);
746afe00251SAndrea Bittau 
747afe00251SAndrea Bittau 	return rc;
748afe00251SAndrea Bittau }
749afe00251SAndrea Bittau 
750afe00251SAndrea Bittau EXPORT_SYMBOL_GPL(dccp_feat_change_recv);
751afe00251SAndrea Bittau 
752afe00251SAndrea Bittau int dccp_feat_confirm_recv(struct sock *sk, u8 type, u8 feature,
753afe00251SAndrea Bittau 			   u8 *val, u8 len)
754afe00251SAndrea Bittau {
755afe00251SAndrea Bittau 	u8 t;
756afe00251SAndrea Bittau 	struct dccp_opt_pend *opt;
757a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *dmsk = dccp_msk(sk);
758c02fdc0eSGerrit Renker 	int found = 0;
759afe00251SAndrea Bittau 	int all_confirmed = 1;
760afe00251SAndrea Bittau 
761f74e91b6SGerrit Renker 	/* Ignore Confirm options other than during connection setup */
762f74e91b6SGerrit Renker 	if (sk->sk_state != DCCP_LISTEN && sk->sk_state != DCCP_REQUESTING)
763f74e91b6SGerrit Renker 		return 0;
764c02fdc0eSGerrit Renker 	dccp_feat_debug(type, feature, *val);
765afe00251SAndrea Bittau 
766afe00251SAndrea Bittau 	/* locate our change request */
767c02fdc0eSGerrit Renker 	switch (type) {
768c02fdc0eSGerrit Renker 	case DCCPO_CONFIRM_L: t = DCCPO_CHANGE_R; break;
769c02fdc0eSGerrit Renker 	case DCCPO_CONFIRM_R: t = DCCPO_CHANGE_L; break;
77059348b19SGerrit Renker 	default:	      DCCP_WARN("invalid type %d\n", type);
771c02fdc0eSGerrit Renker 			      return 1;
772c02fdc0eSGerrit Renker 
773c02fdc0eSGerrit Renker 	}
774c02fdc0eSGerrit Renker 	/* XXX sanity check feature value */
775afe00251SAndrea Bittau 
776a4bf3902SArnaldo Carvalho de Melo 	list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
777afe00251SAndrea Bittau 		if (!opt->dccpop_conf && opt->dccpop_type == t &&
778afe00251SAndrea Bittau 		    opt->dccpop_feat == feature) {
779c02fdc0eSGerrit Renker 			found = 1;
780c02fdc0eSGerrit Renker 			dccp_pr_debug("feature %d found\n", opt->dccpop_feat);
781c02fdc0eSGerrit Renker 
782afe00251SAndrea Bittau 			/* XXX do sanity check */
783afe00251SAndrea Bittau 
784afe00251SAndrea Bittau 			opt->dccpop_conf = 1;
785afe00251SAndrea Bittau 
786afe00251SAndrea Bittau 			/* We got a confirmation---change the option */
787afe00251SAndrea Bittau 			dccp_feat_update(sk, opt->dccpop_type,
788afe00251SAndrea Bittau 					 opt->dccpop_feat, *val);
789afe00251SAndrea Bittau 
790c02fdc0eSGerrit Renker 			/* XXX check the return value of dccp_feat_update */
791afe00251SAndrea Bittau 			break;
792afe00251SAndrea Bittau 		}
793afe00251SAndrea Bittau 
794afe00251SAndrea Bittau 		if (!opt->dccpop_conf)
795afe00251SAndrea Bittau 			all_confirmed = 0;
796afe00251SAndrea Bittau 	}
797afe00251SAndrea Bittau 
798c02fdc0eSGerrit Renker 	if (!found)
799c02fdc0eSGerrit Renker 		dccp_pr_debug("%s(%d, ...) never requested\n",
800c02fdc0eSGerrit Renker 			      dccp_feat_typename(type), feature);
801afe00251SAndrea Bittau 	return 0;
802afe00251SAndrea Bittau }
803afe00251SAndrea Bittau 
804afe00251SAndrea Bittau EXPORT_SYMBOL_GPL(dccp_feat_confirm_recv);
805afe00251SAndrea Bittau 
8068ca0d17bSArnaldo Carvalho de Melo void dccp_feat_clean(struct dccp_minisock *dmsk)
807afe00251SAndrea Bittau {
808afe00251SAndrea Bittau 	struct dccp_opt_pend *opt, *next;
809afe00251SAndrea Bittau 
810a4bf3902SArnaldo Carvalho de Melo 	list_for_each_entry_safe(opt, next, &dmsk->dccpms_pending,
811afe00251SAndrea Bittau 				 dccpop_node) {
812afe00251SAndrea Bittau 		BUG_ON(opt->dccpop_val == NULL);
813afe00251SAndrea Bittau 		kfree(opt->dccpop_val);
814afe00251SAndrea Bittau 
815afe00251SAndrea Bittau 		if (opt->dccpop_sc != NULL) {
816afe00251SAndrea Bittau 			BUG_ON(opt->dccpop_sc->dccpoc_val == NULL);
817afe00251SAndrea Bittau 			kfree(opt->dccpop_sc->dccpoc_val);
818afe00251SAndrea Bittau 			kfree(opt->dccpop_sc);
819afe00251SAndrea Bittau 		}
820afe00251SAndrea Bittau 
821afe00251SAndrea Bittau 		kfree(opt);
822afe00251SAndrea Bittau 	}
823a4bf3902SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&dmsk->dccpms_pending);
824afe00251SAndrea Bittau 
825a4bf3902SArnaldo Carvalho de Melo 	list_for_each_entry_safe(opt, next, &dmsk->dccpms_conf, dccpop_node) {
826afe00251SAndrea Bittau 		BUG_ON(opt == NULL);
827afe00251SAndrea Bittau 		if (opt->dccpop_val != NULL)
828afe00251SAndrea Bittau 			kfree(opt->dccpop_val);
829afe00251SAndrea Bittau 		kfree(opt);
830afe00251SAndrea Bittau 	}
831a4bf3902SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&dmsk->dccpms_conf);
832afe00251SAndrea Bittau }
833afe00251SAndrea Bittau 
834afe00251SAndrea Bittau EXPORT_SYMBOL_GPL(dccp_feat_clean);
835afe00251SAndrea Bittau 
836afe00251SAndrea Bittau /* this is to be called only when a listening sock creates its child.  It is
837afe00251SAndrea Bittau  * assumed by the function---the confirm is not duplicated, but rather it is
838afe00251SAndrea Bittau  * "passed on".
839afe00251SAndrea Bittau  */
840afe00251SAndrea Bittau int dccp_feat_clone(struct sock *oldsk, struct sock *newsk)
841afe00251SAndrea Bittau {
842a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *olddmsk = dccp_msk(oldsk);
843a4bf3902SArnaldo Carvalho de Melo 	struct dccp_minisock *newdmsk = dccp_msk(newsk);
844afe00251SAndrea Bittau 	struct dccp_opt_pend *opt;
845afe00251SAndrea Bittau 	int rc = 0;
846afe00251SAndrea Bittau 
847a4bf3902SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&newdmsk->dccpms_pending);
848a4bf3902SArnaldo Carvalho de Melo 	INIT_LIST_HEAD(&newdmsk->dccpms_conf);
849afe00251SAndrea Bittau 
850a4bf3902SArnaldo Carvalho de Melo 	list_for_each_entry(opt, &olddmsk->dccpms_pending, dccpop_node) {
851afe00251SAndrea Bittau 		struct dccp_opt_pend *newopt;
852afe00251SAndrea Bittau 		/* copy the value of the option */
853eed73417SArnaldo Carvalho de Melo 		u8 *val = kmemdup(opt->dccpop_val, opt->dccpop_len, GFP_ATOMIC);
854afe00251SAndrea Bittau 
855afe00251SAndrea Bittau 		if (val == NULL)
856afe00251SAndrea Bittau 			goto out_clean;
857afe00251SAndrea Bittau 
858eed73417SArnaldo Carvalho de Melo 		newopt = kmemdup(opt, sizeof(*newopt), GFP_ATOMIC);
859afe00251SAndrea Bittau 		if (newopt == NULL) {
860afe00251SAndrea Bittau 			kfree(val);
861afe00251SAndrea Bittau 			goto out_clean;
862afe00251SAndrea Bittau 		}
863afe00251SAndrea Bittau 
864afe00251SAndrea Bittau 		/* insert the option */
865afe00251SAndrea Bittau 		newopt->dccpop_val = val;
866a4bf3902SArnaldo Carvalho de Melo 		list_add_tail(&newopt->dccpop_node, &newdmsk->dccpms_pending);
867afe00251SAndrea Bittau 
868afe00251SAndrea Bittau 		/* XXX what happens with backlogs and multiple connections at
869afe00251SAndrea Bittau 		 * once...
870afe00251SAndrea Bittau 		 */
871afe00251SAndrea Bittau 		/* the master socket no longer needs to worry about confirms */
87268907dadSRandy Dunlap 		opt->dccpop_sc = NULL; /* it's not a memleak---new socket has it */
873afe00251SAndrea Bittau 
874afe00251SAndrea Bittau 		/* reset state for a new socket */
875afe00251SAndrea Bittau 		opt->dccpop_conf = 0;
876afe00251SAndrea Bittau 	}
877afe00251SAndrea Bittau 
878afe00251SAndrea Bittau 	/* XXX not doing anything about the conf queue */
879afe00251SAndrea Bittau 
880afe00251SAndrea Bittau out:
881afe00251SAndrea Bittau 	return rc;
882afe00251SAndrea Bittau 
883afe00251SAndrea Bittau out_clean:
8848ca0d17bSArnaldo Carvalho de Melo 	dccp_feat_clean(newdmsk);
885afe00251SAndrea Bittau 	rc = -ENOMEM;
886afe00251SAndrea Bittau 	goto out;
887afe00251SAndrea Bittau }
888afe00251SAndrea Bittau 
889afe00251SAndrea Bittau EXPORT_SYMBOL_GPL(dccp_feat_clone);
890afe00251SAndrea Bittau 
891e8ef967aSGerrit Renker int dccp_feat_init(struct sock *sk)
892afe00251SAndrea Bittau {
893e8ef967aSGerrit Renker 	struct dccp_sock *dp = dccp_sk(sk);
894e8ef967aSGerrit Renker 	struct dccp_minisock *dmsk = dccp_msk(sk);
895afe00251SAndrea Bittau 	int rc;
896afe00251SAndrea Bittau 
897e8ef967aSGerrit Renker 	INIT_LIST_HEAD(&dmsk->dccpms_pending);	/* XXX no longer used */
898e8ef967aSGerrit Renker 	INIT_LIST_HEAD(&dmsk->dccpms_conf);	/* XXX no longer used */
899afe00251SAndrea Bittau 
900afe00251SAndrea Bittau 	/* CCID L */
901e8ef967aSGerrit Renker 	rc = __feat_register_sp(&dp->dccps_featneg, DCCPF_CCID, 1, 0,
902a4bf3902SArnaldo Carvalho de Melo 				&dmsk->dccpms_tx_ccid, 1);
903afe00251SAndrea Bittau 	if (rc)
904afe00251SAndrea Bittau 		goto out;
905afe00251SAndrea Bittau 
906afe00251SAndrea Bittau 	/* CCID R */
907e8ef967aSGerrit Renker 	rc = __feat_register_sp(&dp->dccps_featneg, DCCPF_CCID, 0, 0,
908a4bf3902SArnaldo Carvalho de Melo 				&dmsk->dccpms_rx_ccid, 1);
909afe00251SAndrea Bittau 	if (rc)
910afe00251SAndrea Bittau 		goto out;
911afe00251SAndrea Bittau 
912afe00251SAndrea Bittau 	/* Ack ratio */
913e8ef967aSGerrit Renker 	rc = __feat_register_nn(&dp->dccps_featneg, DCCPF_ACK_RATIO, 0,
914e8ef967aSGerrit Renker 				dmsk->dccpms_ack_ratio);
915afe00251SAndrea Bittau out:
916afe00251SAndrea Bittau 	return rc;
917afe00251SAndrea Bittau }
918afe00251SAndrea Bittau 
919afe00251SAndrea Bittau EXPORT_SYMBOL_GPL(dccp_feat_init);
920c02fdc0eSGerrit Renker 
921c02fdc0eSGerrit Renker #ifdef CONFIG_IP_DCCP_DEBUG
922c02fdc0eSGerrit Renker const char *dccp_feat_typename(const u8 type)
923c02fdc0eSGerrit Renker {
924c02fdc0eSGerrit Renker 	switch(type) {
925c02fdc0eSGerrit Renker 	case DCCPO_CHANGE_L:  return("ChangeL");
926c02fdc0eSGerrit Renker 	case DCCPO_CONFIRM_L: return("ConfirmL");
927c02fdc0eSGerrit Renker 	case DCCPO_CHANGE_R:  return("ChangeR");
928c02fdc0eSGerrit Renker 	case DCCPO_CONFIRM_R: return("ConfirmR");
929c02fdc0eSGerrit Renker 	/* the following case must not appear in feature negotation  */
930c02fdc0eSGerrit Renker 	default:	      dccp_pr_debug("unknown type %d [BUG!]\n", type);
931c02fdc0eSGerrit Renker 	}
932c02fdc0eSGerrit Renker 	return NULL;
933c02fdc0eSGerrit Renker }
934c02fdc0eSGerrit Renker 
935c02fdc0eSGerrit Renker EXPORT_SYMBOL_GPL(dccp_feat_typename);
936c02fdc0eSGerrit Renker 
937c02fdc0eSGerrit Renker const char *dccp_feat_name(const u8 feat)
938c02fdc0eSGerrit Renker {
939c02fdc0eSGerrit Renker 	static const char *feature_names[] = {
940c02fdc0eSGerrit Renker 		[DCCPF_RESERVED]	= "Reserved",
941c02fdc0eSGerrit Renker 		[DCCPF_CCID]		= "CCID",
942c02fdc0eSGerrit Renker 		[DCCPF_SHORT_SEQNOS]	= "Allow Short Seqnos",
943c02fdc0eSGerrit Renker 		[DCCPF_SEQUENCE_WINDOW]	= "Sequence Window",
944c02fdc0eSGerrit Renker 		[DCCPF_ECN_INCAPABLE]	= "ECN Incapable",
945c02fdc0eSGerrit Renker 		[DCCPF_ACK_RATIO]	= "Ack Ratio",
946c02fdc0eSGerrit Renker 		[DCCPF_SEND_ACK_VECTOR]	= "Send ACK Vector",
947c02fdc0eSGerrit Renker 		[DCCPF_SEND_NDP_COUNT]	= "Send NDP Count",
948c02fdc0eSGerrit Renker 		[DCCPF_MIN_CSUM_COVER]	= "Min. Csum Coverage",
949c02fdc0eSGerrit Renker 		[DCCPF_DATA_CHECKSUM]	= "Send Data Checksum",
950c02fdc0eSGerrit Renker 	};
951dd6303dfSGerrit Renker 	if (feat > DCCPF_DATA_CHECKSUM && feat < DCCPF_MIN_CCID_SPECIFIC)
952dd6303dfSGerrit Renker 		return feature_names[DCCPF_RESERVED];
953dd6303dfSGerrit Renker 
9547d43d1a0SGerrit Renker 	if (feat ==  DCCPF_SEND_LEV_RATE)
9557d43d1a0SGerrit Renker 		return "Send Loss Event Rate";
956c02fdc0eSGerrit Renker 	if (feat >= DCCPF_MIN_CCID_SPECIFIC)
957c02fdc0eSGerrit Renker 		return "CCID-specific";
958c02fdc0eSGerrit Renker 
959c02fdc0eSGerrit Renker 	return feature_names[feat];
960c02fdc0eSGerrit Renker }
961c02fdc0eSGerrit Renker 
962c02fdc0eSGerrit Renker EXPORT_SYMBOL_GPL(dccp_feat_name);
963c02fdc0eSGerrit Renker #endif /* CONFIG_IP_DCCP_DEBUG */
964