2 /* $KAME: ipcomp_input.c,v 1.25 2001/03/01 09:12:09 itojun Exp $ */
5 * Copyright (C) 1999 WIDE Project.
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the name of the project nor the names of its contributors
17 * may be used to endorse or promote products derived from this software
18 * without specific prior written permission.
20 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34 * RFC2393 IP payload compression protocol (IPComp).
38 #include "opt_inet6.h"
40 #include <sys/param.h>
41 #include <sys/systm.h>
43 #include <sys/domain.h>
44 #include <sys/protosw.h>
45 #include <sys/socket.h>
46 #include <sys/errno.h>
48 #include <sys/syslog.h>
51 #include <net/route.h>
52 #include <net/netisr.h>
54 #include <machine/cpu.h>
56 #include <netinet/in.h>
57 #include <netinet/in_systm.h>
58 #include <netinet/in_var.h>
59 #include <netinet/ip.h>
60 #include <netinet/ip_var.h>
61 #include <netinet/ip_ecn.h>
64 #include <netinet/ip6.h>
65 #include <netinet6/ip6_var.h>
67 #include <netinet6/ipcomp.h>
69 #include <netinet6/ipcomp6.h>
72 #include <netinet6/ipsec.h>
74 #include <netinet6/ipsec6.h>
76 #include <netkey/key.h>
77 #include <netkey/keydb.h>
79 #include <machine/stdarg.h>
81 #include <net/net_osdep.h>
86 extern struct protosw inetsw[];
95 struct ipcomp *ipcomp;
96 const struct ipcomp_algorithm *algo;
97 u_int16_t cpi; /* host order */
102 struct secasvar *sav = NULL;
105 if (m->m_pkthdr.len < off + sizeof(struct ipcomp)) {
106 ipseclog((LOG_DEBUG, "IPv4 IPComp input: assumption failed "
107 "(packet too short)\n"));
108 ipsecstat.in_inval++;
112 md = m_pulldown(m, off, sizeof(*ipcomp), NULL);
114 m = NULL; /*already freed*/
115 ipseclog((LOG_DEBUG, "IPv4 IPComp input: assumption failed "
116 "(pulldown failure)\n"));
117 ipsecstat.in_inval++;
120 ipcomp = mtod(md, struct ipcomp *);
121 ip = mtod(m, struct ip *);
123 nxt = ipcomp->comp_nxt;
125 hlen = IP_VHL_HL(ip->ip_vhl) << 2;
127 hlen = ip->ip_hl << 2;
130 cpi = ntohs(ipcomp->comp_cpi);
132 if (cpi >= IPCOMP_CPI_NEGOTIATE_MIN) {
133 sav = key_allocsa(AF_INET, (caddr_t)&ip->ip_src,
134 (caddr_t)&ip->ip_dst, IPPROTO_IPCOMP, htonl(cpi));
136 && (sav->state == SADB_SASTATE_MATURE
137 || sav->state == SADB_SASTATE_DYING)) {
138 cpi = sav->alg_enc; /*XXX*/
139 /* other parameters to look at? */
142 algo = ipcomp_algorithm_lookup(cpi);
144 ipseclog((LOG_WARNING, "IPv4 IPComp input: unknown cpi %u\n",
150 /* chop ipcomp header */
152 md->m_data += sizeof(struct ipcomp);
153 md->m_len -= sizeof(struct ipcomp);
154 m->m_pkthdr.len -= sizeof(struct ipcomp);
156 ip->ip_len -= sizeof(struct ipcomp);
158 ip->ip_len = htons(ntohs(ip->ip_len) - sizeof(struct ipcomp));
161 olen = m->m_pkthdr.len;
162 newlen = m->m_pkthdr.len - off;
163 error = (*algo->decompress)(m, m->m_next, &newlen);
166 ipsecstat.in_inval++;
167 else if (error == ENOBUFS)
168 ipsecstat.in_nomem++;
172 ipsecstat.in_comphist[cpi]++;
175 * returning decompressed packet onto icmp is meaningless.
176 * mark it decrypted to prevent icmp from attaching original packet.
178 m->m_flags |= M_DECRYPTED;
180 m->m_pkthdr.len = off + newlen;
181 ip = mtod(m, struct ip *);
187 len = ntohs(ip->ip_len);
190 * be careful about underflow. also, do not assign exact value
191 * as ip_len is manipulated differently on *BSDs.
193 len += m->m_pkthdr.len;
196 /* packet too big after decompress */
197 ipsecstat.in_inval++;
201 ip->ip_len = len & 0xffff;
203 ip->ip_len = htons(len & 0xffff);
209 key_sa_recordxfer(sav, m);
210 if (ipsec_addhist(m, IPPROTO_IPCOMP, (u_int32_t)cpi) != 0) {
211 ipsecstat.in_nomem++;
218 if (nxt != IPPROTO_DONE) {
219 if ((inetsw[ip_protox[nxt]].pr_flags & PR_LASTHDR) != 0 &&
220 ipsec4_in_reject(m, NULL)) {
221 ipsecstat.in_polvio++;
224 (*inetsw[ip_protox[nxt]].pr_input)(m, off);
229 ipsecstat.in_success++;
243 ipcomp6_input(mp, offp, proto)
250 struct ipcomp *ipcomp;
251 const struct ipcomp_algorithm *algo;
252 u_int16_t cpi; /* host order */
256 struct secasvar *sav = NULL;
262 md = m_pulldown(m, off, sizeof(*ipcomp), NULL);
264 m = NULL; /*already freed*/
265 ipseclog((LOG_DEBUG, "IPv6 IPComp input: assumption failed "
266 "(pulldown failure)\n"));
267 ipsec6stat.in_inval++;
270 ipcomp = mtod(md, struct ipcomp *);
271 ip6 = mtod(m, struct ip6_hdr *);
272 nxt = ipcomp->comp_nxt;
274 cpi = ntohs(ipcomp->comp_cpi);
276 if (cpi >= IPCOMP_CPI_NEGOTIATE_MIN) {
277 sav = key_allocsa(AF_INET6, (caddr_t)&ip6->ip6_src,
278 (caddr_t)&ip6->ip6_dst, IPPROTO_IPCOMP, htonl(cpi));
280 && (sav->state == SADB_SASTATE_MATURE
281 || sav->state == SADB_SASTATE_DYING)) {
282 cpi = sav->alg_enc; /*XXX*/
283 /* other parameters to look at? */
286 algo = ipcomp_algorithm_lookup(cpi);
288 ipseclog((LOG_WARNING, "IPv6 IPComp input: unknown cpi %u; "
289 "dropping the packet for simplicity\n", cpi));
290 ipsec6stat.in_nosa++;
294 /* chop ipcomp header */
296 md->m_data += sizeof(struct ipcomp);
297 md->m_len -= sizeof(struct ipcomp);
298 m->m_pkthdr.len -= sizeof(struct ipcomp);
300 newlen = m->m_pkthdr.len - off;
301 error = (*algo->decompress)(m, md, &newlen);
304 ipsec6stat.in_inval++;
305 else if (error == ENOBUFS)
306 ipsec6stat.in_nomem++;
310 ipsec6stat.in_comphist[cpi]++;
311 m->m_pkthdr.len = off + newlen;
314 * returning decompressed packet onto icmp is meaningless.
315 * mark it decrypted to prevent icmp from attaching original packet.
317 m->m_flags |= M_DECRYPTED;
319 /* update next header field */
320 prvnxtp = ip6_get_prevhdr(m, off);
324 * no need to adjust payload length, as all the IPv6 protocols
325 * look at m->m_pkthdr.len
329 key_sa_recordxfer(sav, m);
330 if (ipsec_addhist(m, IPPROTO_IPCOMP, (u_int32_t)cpi) != 0) {
331 ipsec6stat.in_nomem++;
339 ipsec6stat.in_success++;