WATCHDOG: use base address from platform resources and make 2430 boot again
[linux-ginger.git] / net / dccp / feat.c
blobcd845df5320dbe6bb74d6ee2dfcbad8244a7723e
1 /*
2 * net/dccp/feat.c
4 * An implementation of the DCCP protocol
5 * Andrea Bittau <a.bittau@cs.ucl.ac.uk>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version
10 * 2 of the License, or (at your option) any later version.
13 #include <linux/module.h>
15 #include "ccid.h"
16 #include "feat.h"
18 #define DCCP_FEAT_SP_NOAGREE (-123)
20 int dccp_feat_change(struct dccp_minisock *dmsk, u8 type, u8 feature,
21 u8 *val, u8 len, gfp_t gfp)
23 struct dccp_opt_pend *opt;
25 dccp_feat_debug(type, feature, *val);
27 if (!dccp_feat_is_valid_type(type)) {
28 DCCP_WARN("option type %d invalid in negotiation\n", type);
29 return 1;
31 if (!dccp_feat_is_valid_length(type, feature, len)) {
32 DCCP_WARN("invalid length %d\n", len);
33 return 1;
35 /* XXX add further sanity checks */
37 /* check if that feature is already being negotiated */
38 list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
39 /* ok we found a negotiation for this option already */
40 if (opt->dccpop_feat == feature && opt->dccpop_type == type) {
41 dccp_pr_debug("Replacing old\n");
42 /* replace */
43 BUG_ON(opt->dccpop_val == NULL);
44 kfree(opt->dccpop_val);
45 opt->dccpop_val = val;
46 opt->dccpop_len = len;
47 opt->dccpop_conf = 0;
48 return 0;
52 /* negotiation for a new feature */
53 opt = kmalloc(sizeof(*opt), gfp);
54 if (opt == NULL)
55 return -ENOMEM;
57 opt->dccpop_type = type;
58 opt->dccpop_feat = feature;
59 opt->dccpop_len = len;
60 opt->dccpop_val = val;
61 opt->dccpop_conf = 0;
62 opt->dccpop_sc = NULL;
64 BUG_ON(opt->dccpop_val == NULL);
66 list_add_tail(&opt->dccpop_node, &dmsk->dccpms_pending);
67 return 0;
70 EXPORT_SYMBOL_GPL(dccp_feat_change);
72 static int dccp_feat_update_ccid(struct sock *sk, u8 type, u8 new_ccid_nr)
74 struct dccp_sock *dp = dccp_sk(sk);
75 struct dccp_minisock *dmsk = dccp_msk(sk);
76 /* figure out if we are changing our CCID or the peer's */
77 const int rx = type == DCCPO_CHANGE_R;
78 const u8 ccid_nr = rx ? dmsk->dccpms_rx_ccid : dmsk->dccpms_tx_ccid;
79 struct ccid *new_ccid;
81 /* Check if nothing is being changed. */
82 if (ccid_nr == new_ccid_nr)
83 return 0;
85 new_ccid = ccid_new(new_ccid_nr, sk, rx, GFP_ATOMIC);
86 if (new_ccid == NULL)
87 return -ENOMEM;
89 if (rx) {
90 ccid_hc_rx_delete(dp->dccps_hc_rx_ccid, sk);
91 dp->dccps_hc_rx_ccid = new_ccid;
92 dmsk->dccpms_rx_ccid = new_ccid_nr;
93 } else {
94 ccid_hc_tx_delete(dp->dccps_hc_tx_ccid, sk);
95 dp->dccps_hc_tx_ccid = new_ccid;
96 dmsk->dccpms_tx_ccid = new_ccid_nr;
99 return 0;
102 /* XXX taking only u8 vals */
103 static int dccp_feat_update(struct sock *sk, u8 type, u8 feat, u8 val)
105 dccp_feat_debug(type, feat, val);
107 switch (feat) {
108 case DCCPF_CCID:
109 return dccp_feat_update_ccid(sk, type, val);
110 default:
111 dccp_pr_debug("UNIMPLEMENTED: %s(%d, ...)\n",
112 dccp_feat_typename(type), feat);
113 break;
115 return 0;
118 static int dccp_feat_reconcile(struct sock *sk, struct dccp_opt_pend *opt,
119 u8 *rpref, u8 rlen)
121 struct dccp_sock *dp = dccp_sk(sk);
122 u8 *spref, slen, *res = NULL;
123 int i, j, rc, agree = 1;
125 BUG_ON(rpref == NULL);
127 /* check if we are the black sheep */
128 if (dp->dccps_role == DCCP_ROLE_CLIENT) {
129 spref = rpref;
130 slen = rlen;
131 rpref = opt->dccpop_val;
132 rlen = opt->dccpop_len;
133 } else {
134 spref = opt->dccpop_val;
135 slen = opt->dccpop_len;
138 * Now we have server preference list in spref and client preference in
139 * rpref
141 BUG_ON(spref == NULL);
142 BUG_ON(rpref == NULL);
144 /* FIXME sanity check vals */
146 /* Are values in any order? XXX Lame "algorithm" here */
147 /* XXX assume values are 1 byte */
148 for (i = 0; i < slen; i++) {
149 for (j = 0; j < rlen; j++) {
150 if (spref[i] == rpref[j]) {
151 res = &spref[i];
152 break;
155 if (res)
156 break;
159 /* we didn't agree on anything */
160 if (res == NULL) {
161 /* confirm previous value */
162 switch (opt->dccpop_feat) {
163 case DCCPF_CCID:
164 /* XXX did i get this right? =P */
165 if (opt->dccpop_type == DCCPO_CHANGE_L)
166 res = &dccp_msk(sk)->dccpms_tx_ccid;
167 else
168 res = &dccp_msk(sk)->dccpms_rx_ccid;
169 break;
171 default:
172 DCCP_BUG("Fell through, feat=%d", opt->dccpop_feat);
173 /* XXX implement res */
174 return -EFAULT;
177 dccp_pr_debug("Don't agree... reconfirming %d\n", *res);
178 agree = 0; /* this is used for mandatory options... */
181 /* need to put result and our preference list */
182 /* XXX assume 1 byte vals */
183 rlen = 1 + opt->dccpop_len;
184 rpref = kmalloc(rlen, GFP_ATOMIC);
185 if (rpref == NULL)
186 return -ENOMEM;
188 *rpref = *res;
189 memcpy(&rpref[1], opt->dccpop_val, opt->dccpop_len);
191 /* put it in the "confirm queue" */
192 if (opt->dccpop_sc == NULL) {
193 opt->dccpop_sc = kmalloc(sizeof(*opt->dccpop_sc), GFP_ATOMIC);
194 if (opt->dccpop_sc == NULL) {
195 kfree(rpref);
196 return -ENOMEM;
198 } else {
199 /* recycle the confirm slot */
200 BUG_ON(opt->dccpop_sc->dccpoc_val == NULL);
201 kfree(opt->dccpop_sc->dccpoc_val);
202 dccp_pr_debug("recycling confirm slot\n");
204 memset(opt->dccpop_sc, 0, sizeof(*opt->dccpop_sc));
206 opt->dccpop_sc->dccpoc_val = rpref;
207 opt->dccpop_sc->dccpoc_len = rlen;
209 /* update the option on our side [we are about to send the confirm] */
210 rc = dccp_feat_update(sk, opt->dccpop_type, opt->dccpop_feat, *res);
211 if (rc) {
212 kfree(opt->dccpop_sc->dccpoc_val);
213 kfree(opt->dccpop_sc);
214 opt->dccpop_sc = NULL;
215 return rc;
218 dccp_pr_debug("Will confirm %d\n", *rpref);
220 /* say we want to change to X but we just got a confirm X, suppress our
221 * change
223 if (!opt->dccpop_conf) {
224 if (*opt->dccpop_val == *res)
225 opt->dccpop_conf = 1;
226 dccp_pr_debug("won't ask for change of same feature\n");
229 return agree ? 0 : DCCP_FEAT_SP_NOAGREE; /* used for mandatory opts */
232 static int dccp_feat_sp(struct sock *sk, u8 type, u8 feature, u8 *val, u8 len)
234 struct dccp_minisock *dmsk = dccp_msk(sk);
235 struct dccp_opt_pend *opt;
236 int rc = 1;
237 u8 t;
240 * We received a CHANGE. We gotta match it against our own preference
241 * list. If we got a CHANGE_R it means it's a change for us, so we need
242 * to compare our CHANGE_L list.
244 if (type == DCCPO_CHANGE_L)
245 t = DCCPO_CHANGE_R;
246 else
247 t = DCCPO_CHANGE_L;
249 /* find our preference list for this feature */
250 list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
251 if (opt->dccpop_type != t || opt->dccpop_feat != feature)
252 continue;
254 /* find the winner from the two preference lists */
255 rc = dccp_feat_reconcile(sk, opt, val, len);
256 break;
259 /* We didn't deal with the change. This can happen if we have no
260 * preference list for the feature. In fact, it just shouldn't
261 * happen---if we understand a feature, we should have a preference list
262 * with at least the default value.
264 BUG_ON(rc == 1);
266 return rc;
269 static int dccp_feat_nn(struct sock *sk, u8 type, u8 feature, u8 *val, u8 len)
271 struct dccp_opt_pend *opt;
272 struct dccp_minisock *dmsk = dccp_msk(sk);
273 u8 *copy;
274 int rc;
276 /* NN features must be Change L (sec. 6.3.2) */
277 if (type != DCCPO_CHANGE_L) {
278 dccp_pr_debug("received %s for NN feature %d\n",
279 dccp_feat_typename(type), feature);
280 return -EFAULT;
283 /* XXX sanity check opt val */
285 /* copy option so we can confirm it */
286 opt = kzalloc(sizeof(*opt), GFP_ATOMIC);
287 if (opt == NULL)
288 return -ENOMEM;
290 copy = kmemdup(val, len, GFP_ATOMIC);
291 if (copy == NULL) {
292 kfree(opt);
293 return -ENOMEM;
296 opt->dccpop_type = DCCPO_CONFIRM_R; /* NN can only confirm R */
297 opt->dccpop_feat = feature;
298 opt->dccpop_val = copy;
299 opt->dccpop_len = len;
301 /* change feature */
302 rc = dccp_feat_update(sk, type, feature, *val);
303 if (rc) {
304 kfree(opt->dccpop_val);
305 kfree(opt);
306 return rc;
309 dccp_feat_debug(type, feature, *copy);
311 list_add_tail(&opt->dccpop_node, &dmsk->dccpms_conf);
313 return 0;
316 static void dccp_feat_empty_confirm(struct dccp_minisock *dmsk,
317 u8 type, u8 feature)
319 /* XXX check if other confirms for that are queued and recycle slot */
320 struct dccp_opt_pend *opt = kzalloc(sizeof(*opt), GFP_ATOMIC);
322 if (opt == NULL) {
323 /* XXX what do we do? Ignoring should be fine. It's a change
324 * after all =P
326 return;
329 switch (type) {
330 case DCCPO_CHANGE_L: opt->dccpop_type = DCCPO_CONFIRM_R; break;
331 case DCCPO_CHANGE_R: opt->dccpop_type = DCCPO_CONFIRM_L; break;
332 default: DCCP_WARN("invalid type %d\n", type); return;
335 opt->dccpop_feat = feature;
336 opt->dccpop_val = NULL;
337 opt->dccpop_len = 0;
339 /* change feature */
340 dccp_pr_debug("Empty %s(%d)\n", dccp_feat_typename(type), feature);
342 list_add_tail(&opt->dccpop_node, &dmsk->dccpms_conf);
345 static void dccp_feat_flush_confirm(struct sock *sk)
347 struct dccp_minisock *dmsk = dccp_msk(sk);
348 /* Check if there is anything to confirm in the first place */
349 int yes = !list_empty(&dmsk->dccpms_conf);
351 if (!yes) {
352 struct dccp_opt_pend *opt;
354 list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
355 if (opt->dccpop_conf) {
356 yes = 1;
357 break;
362 if (!yes)
363 return;
365 /* OK there is something to confirm... */
366 /* XXX check if packet is in flight? Send delayed ack?? */
367 if (sk->sk_state == DCCP_OPEN)
368 dccp_send_ack(sk);
371 int dccp_feat_change_recv(struct sock *sk, u8 type, u8 feature, u8 *val, u8 len)
373 int rc;
375 dccp_feat_debug(type, feature, *val);
377 /* figure out if it's SP or NN feature */
378 switch (feature) {
379 /* deal with SP features */
380 case DCCPF_CCID:
381 rc = dccp_feat_sp(sk, type, feature, val, len);
382 break;
384 /* deal with NN features */
385 case DCCPF_ACK_RATIO:
386 rc = dccp_feat_nn(sk, type, feature, val, len);
387 break;
389 /* XXX implement other features */
390 default:
391 dccp_pr_debug("UNIMPLEMENTED: not handling %s(%d, ...)\n",
392 dccp_feat_typename(type), feature);
393 rc = -EFAULT;
394 break;
397 /* check if there were problems changing features */
398 if (rc) {
399 /* If we don't agree on SP, we sent a confirm for old value.
400 * However we propagate rc to caller in case option was
401 * mandatory
403 if (rc != DCCP_FEAT_SP_NOAGREE)
404 dccp_feat_empty_confirm(dccp_msk(sk), type, feature);
407 /* generate the confirm [if required] */
408 dccp_feat_flush_confirm(sk);
410 return rc;
413 EXPORT_SYMBOL_GPL(dccp_feat_change_recv);
415 int dccp_feat_confirm_recv(struct sock *sk, u8 type, u8 feature,
416 u8 *val, u8 len)
418 u8 t;
419 struct dccp_opt_pend *opt;
420 struct dccp_minisock *dmsk = dccp_msk(sk);
421 int found = 0;
422 int all_confirmed = 1;
424 dccp_feat_debug(type, feature, *val);
426 /* locate our change request */
427 switch (type) {
428 case DCCPO_CONFIRM_L: t = DCCPO_CHANGE_R; break;
429 case DCCPO_CONFIRM_R: t = DCCPO_CHANGE_L; break;
430 default: DCCP_WARN("invalid type %d\n", type);
431 return 1;
434 /* XXX sanity check feature value */
436 list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
437 if (!opt->dccpop_conf && opt->dccpop_type == t &&
438 opt->dccpop_feat == feature) {
439 found = 1;
440 dccp_pr_debug("feature %d found\n", opt->dccpop_feat);
442 /* XXX do sanity check */
444 opt->dccpop_conf = 1;
446 /* We got a confirmation---change the option */
447 dccp_feat_update(sk, opt->dccpop_type,
448 opt->dccpop_feat, *val);
450 /* XXX check the return value of dccp_feat_update */
451 break;
454 if (!opt->dccpop_conf)
455 all_confirmed = 0;
458 /* fix re-transmit timer */
459 /* XXX gotta make sure that no option negotiation occurs during
460 * connection shutdown. Consider that the CLOSEREQ is sent and timer is
461 * on. if all options are confirmed it might kill timer which should
462 * remain alive until close is received.
464 if (all_confirmed) {
465 dccp_pr_debug("clear feat negotiation timer %p\n", sk);
466 inet_csk_clear_xmit_timer(sk, ICSK_TIME_RETRANS);
469 if (!found)
470 dccp_pr_debug("%s(%d, ...) never requested\n",
471 dccp_feat_typename(type), feature);
472 return 0;
475 EXPORT_SYMBOL_GPL(dccp_feat_confirm_recv);
477 void dccp_feat_clean(struct dccp_minisock *dmsk)
479 struct dccp_opt_pend *opt, *next;
481 list_for_each_entry_safe(opt, next, &dmsk->dccpms_pending,
482 dccpop_node) {
483 BUG_ON(opt->dccpop_val == NULL);
484 kfree(opt->dccpop_val);
486 if (opt->dccpop_sc != NULL) {
487 BUG_ON(opt->dccpop_sc->dccpoc_val == NULL);
488 kfree(opt->dccpop_sc->dccpoc_val);
489 kfree(opt->dccpop_sc);
492 kfree(opt);
494 INIT_LIST_HEAD(&dmsk->dccpms_pending);
496 list_for_each_entry_safe(opt, next, &dmsk->dccpms_conf, dccpop_node) {
497 BUG_ON(opt == NULL);
498 if (opt->dccpop_val != NULL)
499 kfree(opt->dccpop_val);
500 kfree(opt);
502 INIT_LIST_HEAD(&dmsk->dccpms_conf);
505 EXPORT_SYMBOL_GPL(dccp_feat_clean);
507 /* this is to be called only when a listening sock creates its child. It is
508 * assumed by the function---the confirm is not duplicated, but rather it is
509 * "passed on".
511 int dccp_feat_clone(struct sock *oldsk, struct sock *newsk)
513 struct dccp_minisock *olddmsk = dccp_msk(oldsk);
514 struct dccp_minisock *newdmsk = dccp_msk(newsk);
515 struct dccp_opt_pend *opt;
516 int rc = 0;
518 INIT_LIST_HEAD(&newdmsk->dccpms_pending);
519 INIT_LIST_HEAD(&newdmsk->dccpms_conf);
521 list_for_each_entry(opt, &olddmsk->dccpms_pending, dccpop_node) {
522 struct dccp_opt_pend *newopt;
523 /* copy the value of the option */
524 u8 *val = kmemdup(opt->dccpop_val, opt->dccpop_len, GFP_ATOMIC);
526 if (val == NULL)
527 goto out_clean;
529 newopt = kmemdup(opt, sizeof(*newopt), GFP_ATOMIC);
530 if (newopt == NULL) {
531 kfree(val);
532 goto out_clean;
535 /* insert the option */
536 newopt->dccpop_val = val;
537 list_add_tail(&newopt->dccpop_node, &newdmsk->dccpms_pending);
539 /* XXX what happens with backlogs and multiple connections at
540 * once...
542 /* the master socket no longer needs to worry about confirms */
543 opt->dccpop_sc = NULL; /* it's not a memleak---new socket has it */
545 /* reset state for a new socket */
546 opt->dccpop_conf = 0;
549 /* XXX not doing anything about the conf queue */
551 out:
552 return rc;
554 out_clean:
555 dccp_feat_clean(newdmsk);
556 rc = -ENOMEM;
557 goto out;
560 EXPORT_SYMBOL_GPL(dccp_feat_clone);
562 static int __dccp_feat_init(struct dccp_minisock *dmsk, u8 type, u8 feat,
563 u8 *val, u8 len)
565 int rc = -ENOMEM;
566 u8 *copy = kmemdup(val, len, GFP_KERNEL);
568 if (copy != NULL) {
569 rc = dccp_feat_change(dmsk, type, feat, copy, len, GFP_KERNEL);
570 if (rc)
571 kfree(copy);
573 return rc;
576 int dccp_feat_init(struct dccp_minisock *dmsk)
578 int rc;
580 INIT_LIST_HEAD(&dmsk->dccpms_pending);
581 INIT_LIST_HEAD(&dmsk->dccpms_conf);
583 /* CCID L */
584 rc = __dccp_feat_init(dmsk, DCCPO_CHANGE_L, DCCPF_CCID,
585 &dmsk->dccpms_tx_ccid, 1);
586 if (rc)
587 goto out;
589 /* CCID R */
590 rc = __dccp_feat_init(dmsk, DCCPO_CHANGE_R, DCCPF_CCID,
591 &dmsk->dccpms_rx_ccid, 1);
592 if (rc)
593 goto out;
595 /* Ack ratio */
596 rc = __dccp_feat_init(dmsk, DCCPO_CHANGE_L, DCCPF_ACK_RATIO,
597 &dmsk->dccpms_ack_ratio, 1);
598 out:
599 return rc;
602 EXPORT_SYMBOL_GPL(dccp_feat_init);
604 #ifdef CONFIG_IP_DCCP_DEBUG
605 const char *dccp_feat_typename(const u8 type)
607 switch(type) {
608 case DCCPO_CHANGE_L: return("ChangeL");
609 case DCCPO_CONFIRM_L: return("ConfirmL");
610 case DCCPO_CHANGE_R: return("ChangeR");
611 case DCCPO_CONFIRM_R: return("ConfirmR");
612 /* the following case must not appear in feature negotation */
613 default: dccp_pr_debug("unknown type %d [BUG!]\n", type);
615 return NULL;
618 EXPORT_SYMBOL_GPL(dccp_feat_typename);
620 const char *dccp_feat_name(const u8 feat)
622 static const char *feature_names[] = {
623 [DCCPF_RESERVED] = "Reserved",
624 [DCCPF_CCID] = "CCID",
625 [DCCPF_SHORT_SEQNOS] = "Allow Short Seqnos",
626 [DCCPF_SEQUENCE_WINDOW] = "Sequence Window",
627 [DCCPF_ECN_INCAPABLE] = "ECN Incapable",
628 [DCCPF_ACK_RATIO] = "Ack Ratio",
629 [DCCPF_SEND_ACK_VECTOR] = "Send ACK Vector",
630 [DCCPF_SEND_NDP_COUNT] = "Send NDP Count",
631 [DCCPF_MIN_CSUM_COVER] = "Min. Csum Coverage",
632 [DCCPF_DATA_CHECKSUM] = "Send Data Checksum",
634 if (feat >= DCCPF_MIN_CCID_SPECIFIC)
635 return "CCID-specific";
637 if (dccp_feat_is_reserved(feat))
638 return feature_names[DCCPF_RESERVED];
640 return feature_names[feat];
643 EXPORT_SYMBOL_GPL(dccp_feat_name);
644 #endif /* CONFIG_IP_DCCP_DEBUG */