1*19c3b8c2SApple OSS Distributions /*
2*19c3b8c2SApple OSS Distributions * Copyright (c) 2000-2016 Apple Inc. All rights reserved.
3*19c3b8c2SApple OSS Distributions *
4*19c3b8c2SApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*19c3b8c2SApple OSS Distributions *
6*19c3b8c2SApple OSS Distributions * This file contains Original Code and/or Modifications of Original Code
7*19c3b8c2SApple OSS Distributions * as defined in and that are subject to the Apple Public Source License
8*19c3b8c2SApple OSS Distributions * Version 2.0 (the 'License'). You may not use this file except in
9*19c3b8c2SApple OSS Distributions * compliance with the License. The rights granted to you under the License
10*19c3b8c2SApple OSS Distributions * may not be used to create, or enable the creation or redistribution of,
11*19c3b8c2SApple OSS Distributions * unlawful or unlicensed copies of an Apple operating system, or to
12*19c3b8c2SApple OSS Distributions * circumvent, violate, or enable the circumvention or violation of, any
13*19c3b8c2SApple OSS Distributions * terms of an Apple operating system software license agreement.
14*19c3b8c2SApple OSS Distributions *
15*19c3b8c2SApple OSS Distributions * Please obtain a copy of the License at
16*19c3b8c2SApple OSS Distributions * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*19c3b8c2SApple OSS Distributions *
18*19c3b8c2SApple OSS Distributions * The Original Code and all software distributed under the License are
19*19c3b8c2SApple OSS Distributions * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*19c3b8c2SApple OSS Distributions * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*19c3b8c2SApple OSS Distributions * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*19c3b8c2SApple OSS Distributions * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*19c3b8c2SApple OSS Distributions * Please see the License for the specific language governing rights and
24*19c3b8c2SApple OSS Distributions * limitations under the License.
25*19c3b8c2SApple OSS Distributions *
26*19c3b8c2SApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*19c3b8c2SApple OSS Distributions */
28*19c3b8c2SApple OSS Distributions /*
29*19c3b8c2SApple OSS Distributions * Copyright (C) 1999 WIDE Project.
30*19c3b8c2SApple OSS Distributions * All rights reserved.
31*19c3b8c2SApple OSS Distributions *
32*19c3b8c2SApple OSS Distributions * Redistribution and use in source and binary forms, with or without
33*19c3b8c2SApple OSS Distributions * modification, are permitted provided that the following conditions
34*19c3b8c2SApple OSS Distributions * are met:
35*19c3b8c2SApple OSS Distributions * 1. Redistributions of source code must retain the above copyright
36*19c3b8c2SApple OSS Distributions * notice, this list of conditions and the following disclaimer.
37*19c3b8c2SApple OSS Distributions * 2. Redistributions in binary form must reproduce the above copyright
38*19c3b8c2SApple OSS Distributions * notice, this list of conditions and the following disclaimer in the
39*19c3b8c2SApple OSS Distributions * documentation and/or other materials provided with the distribution.
40*19c3b8c2SApple OSS Distributions * 3. Neither the name of the project nor the names of its contributors
41*19c3b8c2SApple OSS Distributions * may be used to endorse or promote products derived from this software
42*19c3b8c2SApple OSS Distributions * without specific prior written permission.
43*19c3b8c2SApple OSS Distributions *
44*19c3b8c2SApple OSS Distributions * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
45*19c3b8c2SApple OSS Distributions * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
46*19c3b8c2SApple OSS Distributions * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
47*19c3b8c2SApple OSS Distributions * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
48*19c3b8c2SApple OSS Distributions * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
49*19c3b8c2SApple OSS Distributions * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
50*19c3b8c2SApple OSS Distributions * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
51*19c3b8c2SApple OSS Distributions * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
52*19c3b8c2SApple OSS Distributions * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
53*19c3b8c2SApple OSS Distributions * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
54*19c3b8c2SApple OSS Distributions * SUCH DAMAGE.
55*19c3b8c2SApple OSS Distributions *
56*19c3b8c2SApple OSS Distributions */
57*19c3b8c2SApple OSS Distributions /*
58*19c3b8c2SApple OSS Distributions * ECN consideration on tunnel ingress/egress operation.
59*19c3b8c2SApple OSS Distributions * http://www.aciri.org/floyd/papers/draft-ipsec-ecn-00.txt
60*19c3b8c2SApple OSS Distributions */
61*19c3b8c2SApple OSS Distributions
62*19c3b8c2SApple OSS Distributions #include <sys/param.h>
63*19c3b8c2SApple OSS Distributions #include <sys/systm.h>
64*19c3b8c2SApple OSS Distributions #include <sys/malloc.h>
65*19c3b8c2SApple OSS Distributions #include <sys/mbuf.h>
66*19c3b8c2SApple OSS Distributions #include <sys/errno.h>
67*19c3b8c2SApple OSS Distributions
68*19c3b8c2SApple OSS Distributions #include <netinet/in.h>
69*19c3b8c2SApple OSS Distributions #include <netinet/in_systm.h>
70*19c3b8c2SApple OSS Distributions #include <netinet/ip.h>
71*19c3b8c2SApple OSS Distributions #include <netinet/ip6.h>
72*19c3b8c2SApple OSS Distributions
73*19c3b8c2SApple OSS Distributions #include <netinet/ip_ecn.h>
74*19c3b8c2SApple OSS Distributions #include <netinet6/ip6_ecn.h>
75*19c3b8c2SApple OSS Distributions
76*19c3b8c2SApple OSS Distributions /*
77*19c3b8c2SApple OSS Distributions * modify outer ECN (TOS) field on ingress operation (tunnel encapsulation).
78*19c3b8c2SApple OSS Distributions */
79*19c3b8c2SApple OSS Distributions void
ip_ecn_ingress(int mode,u_int8_t * outer,const u_int8_t * inner)80*19c3b8c2SApple OSS Distributions ip_ecn_ingress(int mode, u_int8_t *outer, const u_int8_t *inner)
81*19c3b8c2SApple OSS Distributions {
82*19c3b8c2SApple OSS Distributions if (!outer || !inner) {
83*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip_ecn_ingress");
84*19c3b8c2SApple OSS Distributions }
85*19c3b8c2SApple OSS Distributions
86*19c3b8c2SApple OSS Distributions *outer = *inner;
87*19c3b8c2SApple OSS Distributions switch (mode) {
88*19c3b8c2SApple OSS Distributions case ECN_NORMAL: /* ECN normal mode, copy flags */
89*19c3b8c2SApple OSS Distributions break;
90*19c3b8c2SApple OSS Distributions case ECN_COMPATIBILITY: /* ECN compatibility mode */
91*19c3b8c2SApple OSS Distributions *outer &= ~IPTOS_ECN_MASK;
92*19c3b8c2SApple OSS Distributions break;
93*19c3b8c2SApple OSS Distributions case ECN_NOCARE: /* no consideration to ECN */
94*19c3b8c2SApple OSS Distributions break;
95*19c3b8c2SApple OSS Distributions }
96*19c3b8c2SApple OSS Distributions }
97*19c3b8c2SApple OSS Distributions
98*19c3b8c2SApple OSS Distributions /*
99*19c3b8c2SApple OSS Distributions * modify inner ECN (TOS) field on egress operation (tunnel decapsulation).
100*19c3b8c2SApple OSS Distributions */
101*19c3b8c2SApple OSS Distributions int
ip_ecn_egress(int mode,const u_int8_t * outer,u_int8_t * inner)102*19c3b8c2SApple OSS Distributions ip_ecn_egress(int mode, const u_int8_t *outer, u_int8_t *inner)
103*19c3b8c2SApple OSS Distributions {
104*19c3b8c2SApple OSS Distributions if (!outer || !inner) {
105*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip_ecn_egress");
106*19c3b8c2SApple OSS Distributions }
107*19c3b8c2SApple OSS Distributions
108*19c3b8c2SApple OSS Distributions switch (mode) {
109*19c3b8c2SApple OSS Distributions /* Process ECN for both normal and compatibility modes */
110*19c3b8c2SApple OSS Distributions case ECN_NORMAL:
111*19c3b8c2SApple OSS Distributions case ECN_COMPATIBILITY:
112*19c3b8c2SApple OSS Distributions if (((*outer & IPTOS_ECN_MASK) == IPTOS_ECN_CE) &&
113*19c3b8c2SApple OSS Distributions ((*inner & IPTOS_ECN_MASK) != IPTOS_ECN_NOTECT)) {
114*19c3b8c2SApple OSS Distributions *inner |= IPTOS_ECN_CE;
115*19c3b8c2SApple OSS Distributions } else if ((*outer & IPTOS_ECN_MASK) == IPTOS_ECN_ECT1 &&
116*19c3b8c2SApple OSS Distributions (*inner & IPTOS_ECN_MASK) == IPTOS_ECN_ECT0) {
117*19c3b8c2SApple OSS Distributions *inner = *outer;
118*19c3b8c2SApple OSS Distributions }
119*19c3b8c2SApple OSS Distributions break;
120*19c3b8c2SApple OSS Distributions case ECN_NOCARE: /* no consideration to ECN */
121*19c3b8c2SApple OSS Distributions break;
122*19c3b8c2SApple OSS Distributions }
123*19c3b8c2SApple OSS Distributions return 1;
124*19c3b8c2SApple OSS Distributions }
125*19c3b8c2SApple OSS Distributions
126*19c3b8c2SApple OSS Distributions void
ip6_ecn_ingress(int mode,u_int32_t * outer,const u_int32_t * inner)127*19c3b8c2SApple OSS Distributions ip6_ecn_ingress(int mode, u_int32_t *outer, const u_int32_t *inner)
128*19c3b8c2SApple OSS Distributions {
129*19c3b8c2SApple OSS Distributions u_int8_t outer8, inner8;
130*19c3b8c2SApple OSS Distributions
131*19c3b8c2SApple OSS Distributions if (!outer || !inner) {
132*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip6_ecn_ingress");
133*19c3b8c2SApple OSS Distributions }
134*19c3b8c2SApple OSS Distributions
135*19c3b8c2SApple OSS Distributions inner8 = (ntohl(*inner) >> 20) & 0xff;
136*19c3b8c2SApple OSS Distributions ip_ecn_ingress(mode, &outer8, &inner8);
137*19c3b8c2SApple OSS Distributions *outer &= ~htonl(0xff << 20);
138*19c3b8c2SApple OSS Distributions *outer |= htonl((u_int32_t)outer8 << 20);
139*19c3b8c2SApple OSS Distributions }
140*19c3b8c2SApple OSS Distributions
141*19c3b8c2SApple OSS Distributions int
ip6_ecn_egress(int mode,const u_int32_t * outer,u_int32_t * inner)142*19c3b8c2SApple OSS Distributions ip6_ecn_egress(int mode, const u_int32_t *outer, u_int32_t *inner)
143*19c3b8c2SApple OSS Distributions {
144*19c3b8c2SApple OSS Distributions u_int8_t outer8, inner8;
145*19c3b8c2SApple OSS Distributions
146*19c3b8c2SApple OSS Distributions if (!outer || !inner) {
147*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip6_ecn_egress");
148*19c3b8c2SApple OSS Distributions }
149*19c3b8c2SApple OSS Distributions
150*19c3b8c2SApple OSS Distributions outer8 = (ntohl(*outer) >> 20) & 0xff;
151*19c3b8c2SApple OSS Distributions inner8 = (ntohl(*inner) >> 20) & 0xff;
152*19c3b8c2SApple OSS Distributions if (ip_ecn_egress(mode, &outer8, &inner8) == 0) {
153*19c3b8c2SApple OSS Distributions return 0;
154*19c3b8c2SApple OSS Distributions }
155*19c3b8c2SApple OSS Distributions *inner &= ~htonl(0xff << 20);
156*19c3b8c2SApple OSS Distributions *inner |= htonl((u_int32_t)inner8 << 20);
157*19c3b8c2SApple OSS Distributions return 1;
158*19c3b8c2SApple OSS Distributions }
159*19c3b8c2SApple OSS Distributions
160*19c3b8c2SApple OSS Distributions /*
161*19c3b8c2SApple OSS Distributions * Modify outer IPv6 ECN (Traffic Class) field according to inner IPv4 TOS field
162*19c3b8c2SApple OSS Distributions * on ingress operation (tunnel encapsulation).
163*19c3b8c2SApple OSS Distributions */
164*19c3b8c2SApple OSS Distributions void
ip46_ecn_ingress(int mode,u_int32_t * outer,const u_int8_t * tos)165*19c3b8c2SApple OSS Distributions ip46_ecn_ingress(int mode, u_int32_t *outer, const u_int8_t *tos)
166*19c3b8c2SApple OSS Distributions {
167*19c3b8c2SApple OSS Distributions u_int8_t outer8;
168*19c3b8c2SApple OSS Distributions
169*19c3b8c2SApple OSS Distributions if (!outer || !tos) {
170*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip46_ecn_ingress");
171*19c3b8c2SApple OSS Distributions }
172*19c3b8c2SApple OSS Distributions
173*19c3b8c2SApple OSS Distributions ip_ecn_ingress(mode, &outer8, tos);
174*19c3b8c2SApple OSS Distributions *outer &= ~htonl(0xff << 20);
175*19c3b8c2SApple OSS Distributions *outer |= htonl((u_int32_t)outer8 << 20);
176*19c3b8c2SApple OSS Distributions }
177*19c3b8c2SApple OSS Distributions
178*19c3b8c2SApple OSS Distributions /*
179*19c3b8c2SApple OSS Distributions * Modify inner IPv4 ECN (TOS) field according to output IPv6 ECN (Traffic Class)
180*19c3b8c2SApple OSS Distributions * on egress operation (tunnel decapsulation).
181*19c3b8c2SApple OSS Distributions */
182*19c3b8c2SApple OSS Distributions int
ip46_ecn_egress(int mode,const u_int32_t * outer,u_int8_t * tos)183*19c3b8c2SApple OSS Distributions ip46_ecn_egress(int mode, const u_int32_t *outer, u_int8_t *tos)
184*19c3b8c2SApple OSS Distributions {
185*19c3b8c2SApple OSS Distributions u_int8_t outer8;
186*19c3b8c2SApple OSS Distributions
187*19c3b8c2SApple OSS Distributions if (!outer || !tos) {
188*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip46_ecn_egress");
189*19c3b8c2SApple OSS Distributions }
190*19c3b8c2SApple OSS Distributions
191*19c3b8c2SApple OSS Distributions outer8 = (ntohl(*outer) >> 20) & 0xff;
192*19c3b8c2SApple OSS Distributions return ip_ecn_egress(mode, &outer8, tos);
193*19c3b8c2SApple OSS Distributions }
194*19c3b8c2SApple OSS Distributions
195*19c3b8c2SApple OSS Distributions /*
196*19c3b8c2SApple OSS Distributions * Modify outer IPv4 TOS field according to inner IPv6 ECN (Traffic Class)
197*19c3b8c2SApple OSS Distributions * on ingress operation (tunnel encapsulation).
198*19c3b8c2SApple OSS Distributions */
199*19c3b8c2SApple OSS Distributions void
ip64_ecn_ingress(int mode,u_int8_t * outer,const u_int32_t * inner)200*19c3b8c2SApple OSS Distributions ip64_ecn_ingress(int mode, u_int8_t *outer, const u_int32_t *inner)
201*19c3b8c2SApple OSS Distributions {
202*19c3b8c2SApple OSS Distributions u_int8_t inner8;
203*19c3b8c2SApple OSS Distributions
204*19c3b8c2SApple OSS Distributions if (!outer || !inner) {
205*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip64_ecn_ingress");
206*19c3b8c2SApple OSS Distributions }
207*19c3b8c2SApple OSS Distributions
208*19c3b8c2SApple OSS Distributions inner8 = (ntohl(*inner) >> 20) & 0xff;
209*19c3b8c2SApple OSS Distributions ip_ecn_ingress(mode, outer, &inner8);
210*19c3b8c2SApple OSS Distributions }
211*19c3b8c2SApple OSS Distributions
212*19c3b8c2SApple OSS Distributions /*
213*19c3b8c2SApple OSS Distributions * Modify inner IPv6 ECN (Traffic Class) according to outer IPv4 TOS field
214*19c3b8c2SApple OSS Distributions * on egress operation (tunnel decapsulation).
215*19c3b8c2SApple OSS Distributions */
216*19c3b8c2SApple OSS Distributions int
ip64_ecn_egress(int mode,const u_int8_t * outer,u_int32_t * inner)217*19c3b8c2SApple OSS Distributions ip64_ecn_egress(int mode, const u_int8_t *outer, u_int32_t *inner)
218*19c3b8c2SApple OSS Distributions {
219*19c3b8c2SApple OSS Distributions u_int8_t inner8;
220*19c3b8c2SApple OSS Distributions
221*19c3b8c2SApple OSS Distributions if (!outer || !inner) {
222*19c3b8c2SApple OSS Distributions panic("NULL pointer passed to ip64_ecn_egress");
223*19c3b8c2SApple OSS Distributions }
224*19c3b8c2SApple OSS Distributions
225*19c3b8c2SApple OSS Distributions inner8 = (ntohl(*inner) >> 20) & 0xff;
226*19c3b8c2SApple OSS Distributions if (ip_ecn_egress(mode, outer, &inner8) == 0) {
227*19c3b8c2SApple OSS Distributions return 0;
228*19c3b8c2SApple OSS Distributions }
229*19c3b8c2SApple OSS Distributions
230*19c3b8c2SApple OSS Distributions *inner &= ~htonl(0xff << 20);
231*19c3b8c2SApple OSS Distributions *inner |= htonl((u_int32_t)inner8 << 20);
232*19c3b8c2SApple OSS Distributions return 1;
233*19c3b8c2SApple OSS Distributions }
234