ip_ecn.c revision 1.4 1 1.4 itojun /* $NetBSD: ip_ecn.c,v 1.4 1999/07/06 12:23:20 itojun Exp $ */
2 1.3 thorpej
3 1.2 itojun /*
4 1.2 itojun * Copyright (C) 1999 WIDE Project.
5 1.2 itojun * All rights reserved.
6 1.2 itojun *
7 1.2 itojun * Redistribution and use in source and binary forms, with or without
8 1.2 itojun * modification, are permitted provided that the following conditions
9 1.2 itojun * are met:
10 1.2 itojun * 1. Redistributions of source code must retain the above copyright
11 1.2 itojun * notice, this list of conditions and the following disclaimer.
12 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
13 1.2 itojun * notice, this list of conditions and the following disclaimer in the
14 1.2 itojun * documentation and/or other materials provided with the distribution.
15 1.2 itojun * 3. Neither the name of the project nor the names of its contributors
16 1.2 itojun * may be used to endorse or promote products derived from this software
17 1.2 itojun * without specific prior written permission.
18 1.2 itojun *
19 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
20 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
23 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 1.2 itojun * SUCH DAMAGE.
30 1.2 itojun *
31 1.4 itojun * KAME Id: ip_ecn.c,v 1.1.4.1 1999/05/07 15:59:14 itojun Exp
32 1.2 itojun */
33 1.2 itojun /*
34 1.2 itojun * ECN consideration on tunnel ingress/egress operation.
35 1.2 itojun * http://www.aciri.org/floyd/papers/draft-ipsec-ecn-00.txt
36 1.2 itojun */
37 1.2 itojun
38 1.2 itojun #if (defined(__FreeBSD__) && __FreeBSD__ >= 3) || defined(__NetBSD__)
39 1.2 itojun #include "opt_inet.h"
40 1.2 itojun #endif
41 1.2 itojun
42 1.2 itojun #include <sys/param.h>
43 1.2 itojun #include <sys/systm.h>
44 1.2 itojun #include <sys/malloc.h>
45 1.2 itojun #include <sys/mbuf.h>
46 1.2 itojun #include <sys/errno.h>
47 1.2 itojun
48 1.2 itojun #ifdef INET
49 1.2 itojun #include <netinet/in.h>
50 1.2 itojun #include <netinet/in_systm.h>
51 1.2 itojun #include <netinet/ip.h>
52 1.2 itojun #endif
53 1.2 itojun
54 1.2 itojun #ifdef INET6
55 1.2 itojun #ifndef INET
56 1.2 itojun #include <netinet/in.h>
57 1.2 itojun #endif
58 1.2 itojun #include <netinet6/in6_systm.h>
59 1.2 itojun #include <netinet/ip6.h>
60 1.2 itojun #endif
61 1.2 itojun
62 1.2 itojun #include <netinet/ip_ecn.h>
63 1.2 itojun
64 1.2 itojun /*
65 1.2 itojun * modify outer ECN (TOS) field on ingress operation (tunnel encapsulation).
66 1.2 itojun * call it after you've done the default initialization/copy for the outer.
67 1.2 itojun */
68 1.2 itojun void
69 1.2 itojun ip_ecn_ingress(mode, outer, inner)
70 1.2 itojun int mode;
71 1.2 itojun u_int8_t *outer;
72 1.2 itojun u_int8_t *inner;
73 1.2 itojun {
74 1.2 itojun if (!outer || !inner)
75 1.2 itojun panic("NULL pointer passed to ip_ecn_ingress");
76 1.2 itojun
77 1.2 itojun switch (mode) {
78 1.2 itojun case ECN_ALLOWED: /* ECN allowed */
79 1.2 itojun *outer &= ~IPTOS_CE;
80 1.2 itojun break;
81 1.2 itojun case ECN_FORBIDDEN: /* ECN forbidden */
82 1.2 itojun *outer &= ~(IPTOS_ECT | IPTOS_CE);
83 1.2 itojun break;
84 1.2 itojun case ECN_NOCARE: /* no consideration to ECN */
85 1.2 itojun break;
86 1.2 itojun }
87 1.2 itojun }
88 1.2 itojun
89 1.2 itojun /*
90 1.2 itojun * modify inner ECN (TOS) field on egress operation (tunnel decapsulation).
91 1.2 itojun * call it after you've done the default initialization/copy for the inner.
92 1.2 itojun */
93 1.2 itojun void
94 1.2 itojun ip_ecn_egress(mode, outer, inner)
95 1.2 itojun int mode;
96 1.2 itojun u_int8_t *outer;
97 1.2 itojun u_int8_t *inner;
98 1.2 itojun {
99 1.2 itojun if (!outer || !inner)
100 1.2 itojun panic("NULL pointer passed to ip_ecn_egress");
101 1.2 itojun
102 1.2 itojun switch (mode) {
103 1.2 itojun case ECN_ALLOWED:
104 1.2 itojun if (*outer & IPTOS_CE)
105 1.2 itojun *inner |= IPTOS_CE;
106 1.2 itojun break;
107 1.2 itojun case ECN_FORBIDDEN: /* ECN forbidden */
108 1.2 itojun case ECN_NOCARE: /* no consideration to ECN */
109 1.2 itojun break;
110 1.2 itojun }
111 1.2 itojun }
112 1.2 itojun
113 1.2 itojun #ifdef INET6
114 1.2 itojun void
115 1.2 itojun ip6_ecn_ingress(mode, outer, inner)
116 1.2 itojun int mode;
117 1.2 itojun u_int32_t *outer;
118 1.2 itojun u_int32_t *inner;
119 1.2 itojun {
120 1.2 itojun u_int8_t outer8, inner8;
121 1.2 itojun
122 1.2 itojun if (!outer || !inner)
123 1.2 itojun panic("NULL pointer passed to ip6_ecn_ingress");
124 1.2 itojun
125 1.2 itojun outer8 = (ntohl(*outer) >> 20) & 0xff;
126 1.2 itojun inner8 = (ntohl(*inner) >> 20) & 0xff;
127 1.2 itojun ip_ecn_ingress(mode, &outer8, &inner8);
128 1.2 itojun *outer &= ~htonl(0xff << 20);
129 1.2 itojun *outer |= htonl((u_int32_t)outer8 << 20);
130 1.2 itojun }
131 1.2 itojun
132 1.2 itojun void
133 1.2 itojun ip6_ecn_egress(mode, outer, inner)
134 1.2 itojun int mode;
135 1.2 itojun u_int32_t *outer;
136 1.2 itojun u_int32_t *inner;
137 1.2 itojun {
138 1.2 itojun u_int8_t outer8, inner8;
139 1.2 itojun
140 1.2 itojun if (!outer || !inner)
141 1.2 itojun panic("NULL pointer passed to ip6_ecn_egress");
142 1.2 itojun
143 1.2 itojun outer8 = (ntohl(*outer) >> 20) & 0xff;
144 1.2 itojun inner8 = (ntohl(*inner) >> 20) & 0xff;
145 1.2 itojun ip_ecn_egress(mode, &outer8, &inner8);
146 1.2 itojun *inner &= ~htonl(0xff << 20);
147 1.2 itojun *inner |= htonl((u_int32_t)inner8 << 20);
148 1.2 itojun }
149 1.2 itojun #endif
150