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