xref: /dragonfly/sys/net/ip6fw/ip6_fw.c (revision 28c7b939)
1 /*	$FreeBSD: src/sys/netinet6/ip6_fw.c,v 1.2.2.9 2002/04/28 05:40:27 suz Exp $	*/
2 /*	$DragonFly: src/sys/net/ip6fw/ip6_fw.c,v 1.6 2004/01/06 03:17:26 dillon Exp $	*/
3 /*	$KAME: ip6_fw.c,v 1.21 2001/01/24 01:25:32 itojun Exp $	*/
4 
5 /*
6  * Copyright (C) 1998, 1999, 2000 and 2001 WIDE Project.
7  * All rights reserved.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  * 3. Neither the name of the project nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  */
33 
34 /*
35  * Copyright (c) 1993 Daniel Boulet
36  * Copyright (c) 1994 Ugen J.S.Antsilevich
37  * Copyright (c) 1996 Alex Nash
38  *
39  * Redistribution and use in source forms, with and without modification,
40  * are permitted provided that this entire comment appears intact.
41  *
42  * Redistribution in binary form may occur without any restrictions.
43  * Obviously, it would be nice if you gave credit where credit is due
44  * but requiring it would be too onerous.
45  *
46  * This software is provided ``AS IS'' without any warranties of any kind.
47  */
48 
49 /*
50  * Implement IPv6 packet firewall
51  */
52 
53 #if !defined(KLD_MODULE)
54 #include "opt_ip6fw.h"
55 #include "opt_inet.h"
56 #include "opt_inet6.h"
57 #endif
58 
59 #ifdef IP6DIVERT
60 #error "NOT SUPPORTED IPV6 DIVERT"
61 #endif
62 #ifdef IP6FW_DIVERT_RESTART
63 #error "NOT SUPPORTED IPV6 DIVERT"
64 #endif
65 
66 #include <sys/param.h>
67 #include <sys/systm.h>
68 #include <sys/malloc.h>
69 #include <sys/mbuf.h>
70 #include <sys/queue.h>
71 #include <sys/kernel.h>
72 #include <sys/socket.h>
73 #include <sys/socketvar.h>
74 #include <sys/syslog.h>
75 #include <sys/time.h>
76 #include <net/if.h>
77 #include <net/route.h>
78 #include <netinet/in_systm.h>
79 #include <netinet/in.h>
80 #include <netinet/ip.h>
81 
82 #include <netinet/ip6.h>
83 #include <netinet6/ip6_var.h>
84 #include <netinet6/in6_var.h>
85 #include <netinet/icmp6.h>
86 
87 #include <netinet/in_pcb.h>
88 
89 #include "ip6_fw.h"
90 #include <netinet/ip_var.h>
91 #include <netinet/tcp.h>
92 #include <netinet/tcp_seq.h>
93 #include <netinet/tcp_timer.h>
94 #include <netinet/tcp_var.h>
95 #include <netinet/udp.h>
96 
97 #include <sys/sysctl.h>
98 
99 #include <net/net_osdep.h>
100 
101 MALLOC_DEFINE(M_IP6FW, "Ip6Fw/Ip6Acct", "Ip6Fw/Ip6Acct chain's");
102 
103 static int fw6_debug = 1;
104 #ifdef IPV6FIREWALL_VERBOSE
105 static int fw6_verbose = 1;
106 #else
107 static int fw6_verbose = 0;
108 #endif
109 #ifdef IPV6FIREWALL_VERBOSE_LIMIT
110 static int fw6_verbose_limit = IPV6FIREWALL_VERBOSE_LIMIT;
111 #else
112 static int fw6_verbose_limit = 0;
113 #endif
114 
115 LIST_HEAD (ip6_fw_head, ip6_fw_chain) ip6_fw_chain;
116 
117 #ifdef SYSCTL_NODE
118 SYSCTL_DECL(_net_inet6_ip6);
119 SYSCTL_NODE(_net_inet6_ip6, OID_AUTO, fw, CTLFLAG_RW, 0, "Firewall");
120 SYSCTL_INT(_net_inet6_ip6_fw, OID_AUTO, enable, CTLFLAG_RW,
121 	&ip6_fw_enable, 0, "Enable ip6fw");
122 SYSCTL_INT(_net_inet6_ip6_fw, OID_AUTO, debug, CTLFLAG_RW, &fw6_debug, 0, "");
123 SYSCTL_INT(_net_inet6_ip6_fw, OID_AUTO, verbose, CTLFLAG_RW, &fw6_verbose, 0, "");
124 SYSCTL_INT(_net_inet6_ip6_fw, OID_AUTO, verbose_limit, CTLFLAG_RW, &fw6_verbose_limit, 0, "");
125 #endif
126 
127 #define dprintf(a)	do {						\
128 				if (fw6_debug)				\
129 					printf a;			\
130 			} while (0)
131 #define SNPARGS(buf, len) buf + len, sizeof(buf) > len ? sizeof(buf) - len : 0
132 
133 static int	add_entry6 (struct ip6_fw_head *chainptr, struct ip6_fw *frwl);
134 static int	del_entry6 (struct ip6_fw_head *chainptr, u_short number);
135 static int	zero_entry6 (struct mbuf *m);
136 static struct ip6_fw *check_ip6fw_struct (struct ip6_fw *m);
137 static struct ip6_fw *check_ip6fw_mbuf (struct mbuf *fw);
138 static int	ip6opts_match (struct ip6_hdr **ip6, struct ip6_fw *f,
139 				   struct mbuf **m,
140 				   int *off, int *nxt, u_short *offset);
141 static int	port_match6 (u_short *portptr, int nports, u_short port,
142 				int range_flag);
143 static int	tcp6flg_match (struct tcphdr *tcp6, struct ip6_fw *f);
144 static int	icmp6type_match (struct icmp6_hdr *  icmp, struct ip6_fw * f);
145 static void	ip6fw_report (struct ip6_fw *f, struct ip6_hdr *ip6,
146 				struct ifnet *rif, struct ifnet *oif, int off, int nxt);
147 
148 static int	ip6_fw_chk (struct ip6_hdr **pip6,
149 			struct ifnet *oif, u_int16_t *cookie, struct mbuf **m);
150 static int	ip6_fw_ctl (int stage, struct mbuf **mm);
151 
152 static char err_prefix[] = "ip6_fw_ctl:";
153 
154 /*
155  * Returns 1 if the port is matched by the vector, 0 otherwise
156  */
157 static
158 __inline int
159 port_match6(u_short *portptr, int nports, u_short port, int range_flag)
160 {
161 	if (!nports)
162 		return 1;
163 	if (range_flag) {
164 		if (portptr[0] <= port && port <= portptr[1]) {
165 			return 1;
166 		}
167 		nports -= 2;
168 		portptr += 2;
169 	}
170 	while (nports-- > 0) {
171 		if (*portptr++ == port) {
172 			return 1;
173 		}
174 	}
175 	return 0;
176 }
177 
178 static int
179 tcp6flg_match(struct tcphdr *tcp6, struct ip6_fw *f)
180 {
181 	u_char		flg_set, flg_clr;
182 
183 	/*
184 	 * If an established connection is required, reject packets that
185 	 * have only SYN of RST|ACK|SYN set.  Otherwise, fall through to
186 	 * other flag requirements.
187 	 */
188 	if ((f->fw_ipflg & IPV6_FW_IF_TCPEST) &&
189 	    ((tcp6->th_flags & (IPV6_FW_TCPF_RST | IPV6_FW_TCPF_ACK |
190 	    IPV6_FW_TCPF_SYN)) == IPV6_FW_TCPF_SYN))
191 		return 0;
192 
193 	flg_set = tcp6->th_flags & f->fw_tcpf;
194 	flg_clr = tcp6->th_flags & f->fw_tcpnf;
195 
196 	if (flg_set != f->fw_tcpf)
197 		return 0;
198 	if (flg_clr)
199 		return 0;
200 
201 	return 1;
202 }
203 
204 static int
205 icmp6type_match(struct icmp6_hdr *icmp6, struct ip6_fw *f)
206 {
207 	int type;
208 
209 	if (!(f->fw_flg & IPV6_FW_F_ICMPBIT))
210 		return(1);
211 
212 	type = icmp6->icmp6_type;
213 
214 	/* check for matching type in the bitmap */
215 	if (type < IPV6_FW_ICMPTYPES_DIM * sizeof(unsigned) * 8 &&
216 		(f->fw_icmp6types[type / (sizeof(unsigned) * 8)] &
217 		(1U << (type % (8 * sizeof(unsigned))))))
218 		return(1);
219 
220 	return(0); /* no match */
221 }
222 
223 static int
224 is_icmp6_query(struct ip6_hdr *ip6, int off)
225 {
226 	const struct icmp6_hdr *icmp6;
227 	int icmp6_type;
228 
229 	icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off);
230 	icmp6_type = icmp6->icmp6_type;
231 
232 	if (icmp6_type == ICMP6_ECHO_REQUEST ||
233 	    icmp6_type == ICMP6_MEMBERSHIP_QUERY ||
234 	    icmp6_type == ICMP6_WRUREQUEST ||
235 	    icmp6_type == ICMP6_FQDN_QUERY ||
236 	    icmp6_type == ICMP6_NI_QUERY)
237 		return(1);
238 
239 	return(0);
240 }
241 
242 static int
243 ip6opts_match(struct ip6_hdr **pip6, struct ip6_fw *f, struct mbuf **m,
244 	      int *off, int *nxt, u_short *offset)
245 {
246 	int len;
247 	struct ip6_hdr *ip6 = *pip6;
248 	struct ip6_ext *ip6e;
249 	u_char	opts, nopts, nopts_sve;
250 
251 	opts = f->fw_ip6opt;
252 	nopts = nopts_sve = f->fw_ip6nopt;
253 
254 	*nxt = ip6->ip6_nxt;
255 	*off = sizeof(struct ip6_hdr);
256 	len = ntohs(ip6->ip6_plen) + sizeof(struct ip6_hdr);
257 	while (*off < len) {
258 		ip6e = (struct ip6_ext *)((caddr_t) ip6 + *off);
259 		if ((*m)->m_len < *off + sizeof(*ip6e))
260 			goto opts_check;	/* XXX */
261 
262 		switch(*nxt) {
263 		case IPPROTO_FRAGMENT:
264 			if ((*m)->m_len >= *off + sizeof(struct ip6_frag)) {
265 				struct ip6_frag *ip6f;
266 
267 				ip6f = (struct ip6_frag *) ((caddr_t)ip6 + *off);
268 				*offset = ip6f->ip6f_offlg & IP6F_OFF_MASK;
269 			}
270 			opts &= ~IPV6_FW_IP6OPT_FRAG;
271 			nopts &= ~IPV6_FW_IP6OPT_FRAG;
272 			*off += sizeof(struct ip6_frag);
273 			break;
274 		case IPPROTO_AH:
275 			opts &= ~IPV6_FW_IP6OPT_AH;
276 			nopts &= ~IPV6_FW_IP6OPT_AH;
277 			*off += (ip6e->ip6e_len + 2) << 2;
278 			break;
279 		default:
280 			switch (*nxt) {
281 			case IPPROTO_HOPOPTS:
282 				opts &= ~IPV6_FW_IP6OPT_HOPOPT;
283 				nopts &= ~IPV6_FW_IP6OPT_HOPOPT;
284 				break;
285 			case IPPROTO_ROUTING:
286 				opts &= ~IPV6_FW_IP6OPT_ROUTE;
287 				nopts &= ~IPV6_FW_IP6OPT_ROUTE;
288 				break;
289 			case IPPROTO_ESP:
290 				opts &= ~IPV6_FW_IP6OPT_ESP;
291 				nopts &= ~IPV6_FW_IP6OPT_ESP;
292 				break;
293 			case IPPROTO_NONE:
294 				opts &= ~IPV6_FW_IP6OPT_NONXT;
295 				nopts &= ~IPV6_FW_IP6OPT_NONXT;
296 				goto opts_check;
297 				break;
298 			case IPPROTO_DSTOPTS:
299 				opts &= ~IPV6_FW_IP6OPT_OPTS;
300 				nopts &= ~IPV6_FW_IP6OPT_OPTS;
301 				break;
302 			default:
303 				goto opts_check;
304 				break;
305 			}
306 			*off += (ip6e->ip6e_len + 1) << 3;
307 			break;
308 		}
309 		*nxt = ip6e->ip6e_nxt;
310 
311 	}
312  opts_check:
313 	if (f->fw_ip6opt == f->fw_ip6nopt)	/* XXX */
314 		return 1;
315 
316 	if (opts == 0 && nopts == nopts_sve)
317 		return 1;
318 	else
319 		return 0;
320 }
321 
322 static
323 __inline int
324 iface_match(struct ifnet *ifp, union ip6_fw_if *ifu, int byname)
325 {
326 	/* Check by name or by IP address */
327 	if (byname) {
328 		/* Check name */
329 		if (ifu->fu_via_if.glob) {
330 			if (fnmatch(ifu->fu_via_if.name, ifp->if_xname, 0)
331 			    == FNM_NOMATCH)
332 				return(0);
333 		} else {
334 			if (strncmp(ifp->if_xname, ifu->fu_via_if.name,
335 			    IP6FW_IFNLEN) != 0)
336 				return(0);
337 		}
338 		return(1);
339 	} else if (!IN6_IS_ADDR_UNSPECIFIED(&ifu->fu_via_ip6)) {	/* Zero == wildcard */
340 		struct ifaddr *ia;
341 
342 		for (ia = ifp->if_addrlist.tqh_first; ia; ia = ia->ifa_list.tqe_next)
343 		{
344 
345 			if (ia->ifa_addr == NULL)
346 				continue;
347 			if (ia->ifa_addr->sa_family != AF_INET6)
348 				continue;
349 			if (!IN6_ARE_ADDR_EQUAL(&ifu->fu_via_ip6,
350 			    &(((struct sockaddr_in6 *)
351 			    (ia->ifa_addr))->sin6_addr)))
352 				continue;
353 			return(1);
354 		}
355 		return(0);
356 	}
357 	return(1);
358 }
359 
360 static void
361 ip6fw_report(struct ip6_fw *f, struct ip6_hdr *ip6,
362 	struct ifnet *rif, struct ifnet *oif, int off, int nxt)
363 {
364 	static int counter;
365 	struct tcphdr *const tcp6 = (struct tcphdr *) ((caddr_t) ip6+ off);
366 	struct udphdr *const udp = (struct udphdr *) ((caddr_t) ip6+ off);
367 	struct icmp6_hdr *const icmp6 = (struct icmp6_hdr *) ((caddr_t) ip6+ off);
368 	int count;
369 	char *action;
370 	char action2[32], proto[102], name[18];
371 	int len;
372 
373 	count = f ? f->fw_pcnt : ++counter;
374 	if (fw6_verbose_limit != 0 && count > fw6_verbose_limit)
375 		return;
376 
377 	/* Print command name */
378 	snprintf(SNPARGS(name, 0), "ip6fw: %d", f ? f->fw_number : -1);
379 
380 	action = action2;
381 	if (!f)
382 		action = "Refuse";
383 	else {
384 		switch (f->fw_flg & IPV6_FW_F_COMMAND) {
385 		case IPV6_FW_F_DENY:
386 			action = "Deny";
387 			break;
388 		case IPV6_FW_F_REJECT:
389 			if (f->fw_reject_code == IPV6_FW_REJECT_RST)
390 				action = "Reset";
391 			else
392 				action = "Unreach";
393 			break;
394 		case IPV6_FW_F_ACCEPT:
395 			action = "Accept";
396 			break;
397 		case IPV6_FW_F_COUNT:
398 			action = "Count";
399 			break;
400 		case IPV6_FW_F_DIVERT:
401 			snprintf(SNPARGS(action2, 0), "Divert %d",
402 			    f->fw_divert_port);
403 			break;
404 		case IPV6_FW_F_TEE:
405 			snprintf(SNPARGS(action2, 0), "Tee %d",
406 			    f->fw_divert_port);
407 			break;
408 		case IPV6_FW_F_SKIPTO:
409 			snprintf(SNPARGS(action2, 0), "SkipTo %d",
410 			    f->fw_skipto_rule);
411 			break;
412 		default:
413 			action = "UNKNOWN";
414 			break;
415 		}
416 	}
417 
418 	switch (nxt) {
419 	case IPPROTO_TCP:
420 		len = snprintf(SNPARGS(proto, 0), "TCP [%s]",
421 		    ip6_sprintf(&ip6->ip6_src));
422 		if (off > 0)
423 			len += snprintf(SNPARGS(proto, len), ":%d ",
424 			    ntohs(tcp6->th_sport));
425 		else
426 			len += snprintf(SNPARGS(proto, len), " ");
427 		len += snprintf(SNPARGS(proto, len), "[%s]",
428 		    ip6_sprintf(&ip6->ip6_dst));
429 		if (off > 0)
430 			snprintf(SNPARGS(proto, len), ":%d",
431 			    ntohs(tcp6->th_dport));
432 		break;
433 	case IPPROTO_UDP:
434 		len = snprintf(SNPARGS(proto, 0), "UDP [%s]",
435 		    ip6_sprintf(&ip6->ip6_src));
436 		if (off > 0)
437 			len += snprintf(SNPARGS(proto, len), ":%d ",
438 			    ntohs(udp->uh_sport));
439 		else
440 		    len += snprintf(SNPARGS(proto, len), " ");
441 		len += snprintf(SNPARGS(proto, len), "[%s]",
442 		    ip6_sprintf(&ip6->ip6_dst));
443 		if (off > 0)
444 			snprintf(SNPARGS(proto, len), ":%d",
445 			    ntohs(udp->uh_dport));
446 		break;
447 	case IPPROTO_ICMPV6:
448 		if (off > 0)
449 			len = snprintf(SNPARGS(proto, 0), "IPV6-ICMP:%u.%u ",
450 			    icmp6->icmp6_type, icmp6->icmp6_code);
451 		else
452 			len = snprintf(SNPARGS(proto, 0), "IPV6-ICMP ");
453 		len += snprintf(SNPARGS(proto, len), "[%s]",
454 		    ip6_sprintf(&ip6->ip6_src));
455 		snprintf(SNPARGS(proto, len), " [%s]",
456 		    ip6_sprintf(&ip6->ip6_dst));
457 		break;
458 	default:
459 		len = snprintf(SNPARGS(proto, 0), "P:%d [%s]", nxt,
460 		    ip6_sprintf(&ip6->ip6_src));
461 		snprintf(SNPARGS(proto, len), " [%s]",
462 		    ip6_sprintf(&ip6->ip6_dst));
463 		break;
464 	}
465 
466 	if (oif)
467 		log(LOG_SECURITY | LOG_INFO, "%s %s %s out via %s\n",
468 		    name, action, proto, if_name(oif));
469 	else if (rif)
470 		log(LOG_SECURITY | LOG_INFO, "%s %s %s in via %s\n",
471 		    name, action, proto, if_name(rif));
472 	else
473 		log(LOG_SECURITY | LOG_INFO, "%s %s %s",
474 		    name, action, proto);
475 	if (fw6_verbose_limit != 0 && count == fw6_verbose_limit)
476 	    log(LOG_SECURITY | LOG_INFO, "ip6fw: limit reached on entry %d\n",
477 		f ? f->fw_number : -1);
478 }
479 
480 /*
481  * Parameters:
482  *
483  *	ip	Pointer to packet header (struct ip6_hdr *)
484  *	hlen	Packet header length
485  *	oif	Outgoing interface, or NULL if packet is incoming
486  * #ifndef IP6FW_DIVERT_RESTART
487  *	*cookie	Ignore all divert/tee rules to this port (if non-zero)
488  * #else
489  *	*cookie Skip up to the first rule past this rule number;
490  * #endif
491  *	*m	The packet; we set to NULL when/if we nuke it.
492  *
493  * Return value:
494  *
495  *	0	The packet is to be accepted and routed normally OR
496  *      	the packet was denied/rejected and has been dropped;
497  *		in the latter case, *m is equal to NULL upon return.
498  *	port	Divert the packet to port.
499  */
500 
501 static int
502 ip6_fw_chk(struct ip6_hdr **pip6,
503 	struct ifnet *oif, u_int16_t *cookie, struct mbuf **m)
504 {
505 	struct ip6_fw_chain *chain;
506 	struct ip6_fw *rule = NULL;
507 	struct ip6_hdr *ip6 = *pip6;
508 	struct ifnet *const rif = (*m)->m_pkthdr.rcvif;
509 	u_short offset = 0;
510 	int off = sizeof(struct ip6_hdr), nxt = ip6->ip6_nxt;
511 	u_short src_port, dst_port;
512 #ifdef	IP6FW_DIVERT_RESTART
513 	u_int16_t skipto = *cookie;
514 #else
515 	u_int16_t ignport = ntohs(*cookie);
516 #endif
517 
518 	*cookie = 0;
519 	/*
520 	 * Go down the chain, looking for enlightment
521 	 * #ifdef IP6FW_DIVERT_RESTART
522 	 * If we've been asked to start at a given rule immediatly, do so.
523 	 * #endif
524 	 */
525 	chain = LIST_FIRST(&ip6_fw_chain);
526 #ifdef IP6FW_DIVERT_RESTART
527 	if (skipto) {
528 		if (skipto >= 65535)
529 			goto dropit;
530 		while (chain && (chain->rule->fw_number <= skipto)) {
531 			chain = LIST_NEXT(chain, chain);
532 		}
533 		if (! chain) goto dropit;
534 	}
535 #endif /* IP6FW_DIVERT_RESTART */
536 	for (; chain; chain = LIST_NEXT(chain, chain)) {
537 		struct ip6_fw *const f = chain->rule;
538 
539 		if (oif) {
540 			/* Check direction outbound */
541 			if (!(f->fw_flg & IPV6_FW_F_OUT))
542 				continue;
543 		} else {
544 			/* Check direction inbound */
545 			if (!(f->fw_flg & IPV6_FW_F_IN))
546 				continue;
547 		}
548 
549 #define IN6_ARE_ADDR_MASKEQUAL(x,y,z) (\
550 	(((x)->s6_addr32[0] & (y)->s6_addr32[0]) == (z)->s6_addr32[0]) && \
551 	(((x)->s6_addr32[1] & (y)->s6_addr32[1]) == (z)->s6_addr32[1]) && \
552 	(((x)->s6_addr32[2] & (y)->s6_addr32[2]) == (z)->s6_addr32[2]) && \
553 	(((x)->s6_addr32[3] & (y)->s6_addr32[3]) == (z)->s6_addr32[3]))
554 
555 		/* If src-addr doesn't match, not this rule. */
556 		if (((f->fw_flg & IPV6_FW_F_INVSRC) != 0) ^
557 			(!IN6_ARE_ADDR_MASKEQUAL(&ip6->ip6_src,&f->fw_smsk,&f->fw_src)))
558 			continue;
559 
560 		/* If dest-addr doesn't match, not this rule. */
561 		if (((f->fw_flg & IPV6_FW_F_INVDST) != 0) ^
562 			(!IN6_ARE_ADDR_MASKEQUAL(&ip6->ip6_dst,&f->fw_dmsk,&f->fw_dst)))
563 			continue;
564 
565 #undef IN6_ARE_ADDR_MASKEQUAL
566 		/* Interface check */
567 		if ((f->fw_flg & IF6_FW_F_VIAHACK) == IF6_FW_F_VIAHACK) {
568 			struct ifnet *const iface = oif ? oif : rif;
569 
570 			/* Backwards compatibility hack for "via" */
571 			if (!iface || !iface_match(iface,
572 			    &f->fw_in_if, f->fw_flg & IPV6_FW_F_OIFNAME))
573 				continue;
574 		} else {
575 			/* Check receive interface */
576 			if ((f->fw_flg & IPV6_FW_F_IIFACE)
577 			    && (!rif || !iface_match(rif,
578 			      &f->fw_in_if, f->fw_flg & IPV6_FW_F_IIFNAME)))
579 				continue;
580 			/* Check outgoing interface */
581 			if ((f->fw_flg & IPV6_FW_F_OIFACE)
582 			    && (!oif || !iface_match(oif,
583 			      &f->fw_out_if, f->fw_flg & IPV6_FW_F_OIFNAME)))
584 				continue;
585 		}
586 
587 		/* Check IP options */
588 		if (!ip6opts_match(&ip6, f, m, &off, &nxt, &offset))
589 			continue;
590 
591 		/* Fragments */
592 		if ((f->fw_flg & IPV6_FW_F_FRAG) && !offset)
593 			continue;
594 
595 		/* Check protocol; if wildcard, match */
596 		if (f->fw_prot == IPPROTO_IPV6)
597 			goto got_match;
598 
599 		/* If different, don't match */
600 		if (nxt != f->fw_prot)
601 			continue;
602 
603 #define PULLUP_TO(len)	do {						\
604 			    if ((*m)->m_len < (len)			\
605 				&& (*m = m_pullup(*m, (len))) == 0) {	\
606 				    goto dropit;			\
607 			    }						\
608 			    *pip6 = ip6 = mtod(*m, struct ip6_hdr *);	\
609 			} while (0)
610 
611 		/* Protocol specific checks */
612 		switch (nxt) {
613 		case IPPROTO_TCP:
614 		    {
615 			struct tcphdr *tcp6;
616 
617 			if (offset == 1) {	/* cf. RFC 1858 */
618 				PULLUP_TO(off + 4); /* XXX ? */
619 				goto bogusfrag;
620 			}
621 			if (offset != 0) {
622 				/*
623 				 * TCP flags and ports aren't available in this
624 				 * packet -- if this rule specified either one,
625 				 * we consider the rule a non-match.
626 				 */
627 				if (f->fw_nports != 0 ||
628 				    f->fw_tcpf != f->fw_tcpnf)
629 					continue;
630 
631 				break;
632 			}
633 			PULLUP_TO(off + 14);
634 			tcp6 = (struct tcphdr *) ((caddr_t)ip6 + off);
635 			if (((f->fw_tcpf != f->fw_tcpnf) ||
636 			   (f->fw_ipflg & IPV6_FW_IF_TCPEST))  &&
637 			   !tcp6flg_match(tcp6, f))
638 				continue;
639 			src_port = ntohs(tcp6->th_sport);
640 			dst_port = ntohs(tcp6->th_dport);
641 			goto check_ports;
642 		    }
643 
644 		case IPPROTO_UDP:
645 		    {
646 			struct udphdr *udp;
647 
648 			if (offset != 0) {
649 				/*
650 				 * Port specification is unavailable -- if this
651 				 * rule specifies a port, we consider the rule
652 				 * a non-match.
653 				 */
654 				if (f->fw_nports != 0)
655 					continue;
656 
657 				break;
658 			}
659 			PULLUP_TO(off + 4);
660 			udp = (struct udphdr *) ((caddr_t)ip6 + off);
661 			src_port = ntohs(udp->uh_sport);
662 			dst_port = ntohs(udp->uh_dport);
663 check_ports:
664 			if (!port_match6(&f->fw_pts[0],
665 			    IPV6_FW_GETNSRCP(f), src_port,
666 			    f->fw_flg & IPV6_FW_F_SRNG))
667 				continue;
668 			if (!port_match6(&f->fw_pts[IPV6_FW_GETNSRCP(f)],
669 			    IPV6_FW_GETNDSTP(f), dst_port,
670 			    f->fw_flg & IPV6_FW_F_DRNG))
671 				continue;
672 			break;
673 		    }
674 
675 		case IPPROTO_ICMPV6:
676 		    {
677 			struct icmp6_hdr *icmp;
678 
679 			if (offset != 0)	/* Type isn't valid */
680 				break;
681 			PULLUP_TO(off + 2);
682 			icmp = (struct icmp6_hdr *) ((caddr_t)ip6 + off);
683 			if (!icmp6type_match(icmp, f))
684 				continue;
685 			break;
686 		    }
687 #undef PULLUP_TO
688 
689 bogusfrag:
690 			if (fw6_verbose)
691 				ip6fw_report(NULL, ip6, rif, oif, off, nxt);
692 			goto dropit;
693 		}
694 
695 got_match:
696 #ifndef IP6FW_DIVERT_RESTART
697 		/* Ignore divert/tee rule if socket port is "ignport" */
698 		switch (f->fw_flg & IPV6_FW_F_COMMAND) {
699 		case IPV6_FW_F_DIVERT:
700 		case IPV6_FW_F_TEE:
701 			if (f->fw_divert_port == ignport)
702 				continue;       /* ignore this rule */
703 			break;
704 		}
705 
706 #endif /* IP6FW_DIVERT_RESTART */
707 		/* Update statistics */
708 		f->fw_pcnt += 1;
709 		f->fw_bcnt += ntohs(ip6->ip6_plen);
710 		f->timestamp = time_second;
711 
712 		/* Log to console if desired */
713 		if ((f->fw_flg & IPV6_FW_F_PRN) && fw6_verbose)
714 			ip6fw_report(f, ip6, rif, oif, off, nxt);
715 
716 		/* Take appropriate action */
717 		switch (f->fw_flg & IPV6_FW_F_COMMAND) {
718 		case IPV6_FW_F_ACCEPT:
719 			return(0);
720 		case IPV6_FW_F_COUNT:
721 			continue;
722 		case IPV6_FW_F_DIVERT:
723 #ifdef IP6FW_DIVERT_RESTART
724 			*cookie = f->fw_number;
725 #else
726 			*cookie = htons(f->fw_divert_port);
727 #endif /* IP6FW_DIVERT_RESTART */
728 			return(f->fw_divert_port);
729 		case IPV6_FW_F_TEE:
730 			/*
731 			 * XXX someday tee packet here, but beware that you
732 			 * can't use m_copym() or m_copypacket() because
733 			 * the divert input routine modifies the mbuf
734 			 * (and these routines only increment reference
735 			 * counts in the case of mbuf clusters), so need
736 			 * to write custom routine.
737 			 */
738 			continue;
739 		case IPV6_FW_F_SKIPTO:
740 #ifdef DIAGNOSTIC
741 			while (chain->chain.le_next
742 			    && chain->chain.le_next->rule->fw_number
743 				< f->fw_skipto_rule)
744 #else
745 			while (chain->chain.le_next->rule->fw_number
746 			    < f->fw_skipto_rule)
747 #endif
748 				chain = chain->chain.le_next;
749 			continue;
750 		}
751 
752 		/* Deny/reject this packet using this rule */
753 		rule = f;
754 		break;
755 	}
756 
757 #ifdef DIAGNOSTIC
758 	/* Rule 65535 should always be there and should always match */
759 	if (!chain)
760 		panic("ip6_fw: chain");
761 #endif
762 
763 	/*
764 	 * At this point, we're going to drop the packet.
765 	 * Send a reject notice if all of the following are true:
766 	 *
767 	 * - The packet matched a reject rule
768 	 * - The packet is not an ICMP packet, or is an ICMP query packet
769 	 * - The packet is not a multicast or broadcast packet
770 	 */
771 	if ((rule->fw_flg & IPV6_FW_F_COMMAND) == IPV6_FW_F_REJECT
772 	    && (nxt != IPPROTO_ICMPV6 || is_icmp6_query(ip6, off))
773 	    && !((*m)->m_flags & (M_BCAST|M_MCAST))
774 	    && !IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
775 		switch (rule->fw_reject_code) {
776 		case IPV6_FW_REJECT_RST:
777 		  {
778 			struct tcphdr *const tcp =
779 				(struct tcphdr *) ((caddr_t)ip6 + off);
780 			struct {
781 				struct ip6_hdr ip6;
782 				struct tcphdr th;
783 			} ti;
784 			tcp_seq ack, seq;
785 			int flags;
786 
787 			if (offset != 0 || (tcp->th_flags & TH_RST))
788 				break;
789 
790 			ti.ip6 = *ip6;
791 			ti.th = *tcp;
792 			NTOHL(ti.th.th_seq);
793 			NTOHL(ti.th.th_ack);
794 			ti.ip6.ip6_nxt = IPPROTO_TCP;
795 			if (ti.th.th_flags & TH_ACK) {
796 				ack = 0;
797 				seq = ti.th.th_ack;
798 				flags = TH_RST;
799 			} else {
800 				ack = ti.th.th_seq;
801 				if (((*m)->m_flags & M_PKTHDR) != 0) {
802 					ack += (*m)->m_pkthdr.len - off
803 						- (ti.th.th_off << 2);
804 				} else if (ip6->ip6_plen) {
805 					ack += ntohs(ip6->ip6_plen) + sizeof(*ip6)
806 						- off - (ti.th.th_off << 2);
807 				} else {
808 					m_freem(*m);
809 					*m = 0;
810 					break;
811 				}
812 				seq = 0;
813 				flags = TH_RST|TH_ACK;
814 			}
815 			bcopy(&ti, ip6, sizeof(ti));
816 			tcp_respond(NULL, ip6, (struct tcphdr *)(ip6 + 1),
817 				*m, ack, seq, flags);
818 			*m = NULL;
819 			break;
820 		  }
821 		default:	/* Send an ICMP unreachable using code */
822 			if (oif)
823 				(*m)->m_pkthdr.rcvif = oif;
824 			icmp6_error(*m, ICMP6_DST_UNREACH,
825 			    rule->fw_reject_code, 0);
826 			*m = NULL;
827 			break;
828 		}
829 	}
830 
831 dropit:
832 	/*
833 	 * Finally, drop the packet.
834 	 */
835 	if (*m) {
836 		m_freem(*m);
837 		*m = NULL;
838 	}
839 	return(0);
840 }
841 
842 static int
843 add_entry6(struct ip6_fw_head *chainptr, struct ip6_fw *frwl)
844 {
845 	struct ip6_fw *ftmp = 0;
846 	struct ip6_fw_chain *fwc = 0, *fcp, *fcpl = 0;
847 	u_short nbr = 0;
848 	int s;
849 
850 	fwc = malloc(sizeof *fwc, M_IP6FW, M_NOWAIT);
851 	ftmp = malloc(sizeof *ftmp, M_IP6FW, M_NOWAIT);
852 	if (!fwc || !ftmp) {
853 		dprintf(("%s malloc said no\n", err_prefix));
854 		if (fwc)  free(fwc, M_IP6FW);
855 		if (ftmp) free(ftmp, M_IP6FW);
856 		return (ENOSPC);
857 	}
858 
859 	bcopy(frwl, ftmp, sizeof(struct ip6_fw));
860 	ftmp->fw_in_if.fu_via_if.name[IP6FW_IFNLEN - 1] = '\0';
861 	ftmp->fw_pcnt = 0L;
862 	ftmp->fw_bcnt = 0L;
863 	fwc->rule = ftmp;
864 
865 	s = splnet();
866 
867 	if (!chainptr->lh_first) {
868 		LIST_INSERT_HEAD(chainptr, fwc, chain);
869 		splx(s);
870 		return(0);
871         } else if (ftmp->fw_number == (u_short)-1) {
872 		if (fwc)  free(fwc, M_IP6FW);
873 		if (ftmp) free(ftmp, M_IP6FW);
874 		splx(s);
875 		dprintf(("%s bad rule number\n", err_prefix));
876 		return (EINVAL);
877         }
878 
879 	/* If entry number is 0, find highest numbered rule and add 100 */
880 	if (ftmp->fw_number == 0) {
881 		for (fcp = chainptr->lh_first; fcp; fcp = fcp->chain.le_next) {
882 			if (fcp->rule->fw_number != (u_short)-1)
883 				nbr = fcp->rule->fw_number;
884 			else
885 				break;
886 		}
887 		if (nbr < (u_short)-1 - 100)
888 			nbr += 100;
889 		ftmp->fw_number = nbr;
890 	}
891 
892 	/* Got a valid number; now insert it, keeping the list ordered */
893 	for (fcp = chainptr->lh_first; fcp; fcp = fcp->chain.le_next) {
894 		if (fcp->rule->fw_number > ftmp->fw_number) {
895 			if (fcpl) {
896 				LIST_INSERT_AFTER(fcpl, fwc, chain);
897 			} else {
898 				LIST_INSERT_HEAD(chainptr, fwc, chain);
899 			}
900 			break;
901 		} else {
902 			fcpl = fcp;
903 		}
904 	}
905 
906 	splx(s);
907 	return (0);
908 }
909 
910 static int
911 del_entry6(struct ip6_fw_head *chainptr, u_short number)
912 {
913 	struct ip6_fw_chain *fcp;
914 	int s;
915 
916 	s = splnet();
917 
918 	fcp = chainptr->lh_first;
919 	if (number != (u_short)-1) {
920 		for (; fcp; fcp = fcp->chain.le_next) {
921 			if (fcp->rule->fw_number == number) {
922 				LIST_REMOVE(fcp, chain);
923 				splx(s);
924 				free(fcp->rule, M_IP6FW);
925 				free(fcp, M_IP6FW);
926 				return 0;
927 			}
928 		}
929 	}
930 
931 	splx(s);
932 	return (EINVAL);
933 }
934 
935 static int
936 zero_entry6(struct mbuf *m)
937 {
938 	struct ip6_fw *frwl;
939 	struct ip6_fw_chain *fcp;
940 	int s;
941 
942 	if (m && m->m_len != 0) {
943 		if (m->m_len != sizeof(struct ip6_fw))
944 			return(EINVAL);
945 		frwl = mtod(m, struct ip6_fw *);
946 	}
947 	else
948 		frwl = NULL;
949 
950 	/*
951 	 *	It's possible to insert multiple chain entries with the
952 	 *	same number, so we don't stop after finding the first
953 	 *	match if zeroing a specific entry.
954 	 */
955 	s = splnet();
956 	for (fcp = ip6_fw_chain.lh_first; fcp; fcp = fcp->chain.le_next)
957 		if (!frwl || frwl->fw_number == fcp->rule->fw_number) {
958 			fcp->rule->fw_bcnt = fcp->rule->fw_pcnt = 0;
959 			fcp->rule->timestamp = 0;
960 		}
961 	splx(s);
962 
963 	if (fw6_verbose) {
964 		if (frwl)
965 			log(LOG_SECURITY | LOG_NOTICE,
966 			    "ip6fw: Entry %d cleared.\n", frwl->fw_number);
967 		else
968 			log(LOG_SECURITY | LOG_NOTICE,
969 			    "ip6fw: Accounting cleared.\n");
970 	}
971 
972 	return(0);
973 }
974 
975 static struct ip6_fw *
976 check_ip6fw_mbuf(struct mbuf *m)
977 {
978 	/* Check length */
979 	if (m->m_len != sizeof(struct ip6_fw)) {
980 		dprintf(("%s len=%d, want %d\n", err_prefix, m->m_len,
981 		    sizeof(struct ip6_fw)));
982 		return (NULL);
983 	}
984 	return(check_ip6fw_struct(mtod(m, struct ip6_fw *)));
985 }
986 
987 static struct ip6_fw *
988 check_ip6fw_struct(struct ip6_fw *frwl)
989 {
990 	/* Check for invalid flag bits */
991 	if ((frwl->fw_flg & ~IPV6_FW_F_MASK) != 0) {
992 		dprintf(("%s undefined flag bits set (flags=%x)\n",
993 		    err_prefix, frwl->fw_flg));
994 		return (NULL);
995 	}
996 	/* Must apply to incoming or outgoing (or both) */
997 	if (!(frwl->fw_flg & (IPV6_FW_F_IN | IPV6_FW_F_OUT))) {
998 		dprintf(("%s neither in nor out\n", err_prefix));
999 		return (NULL);
1000 	}
1001 	/* Empty interface name is no good */
1002 	if (((frwl->fw_flg & IPV6_FW_F_IIFNAME)
1003 	      && !*frwl->fw_in_if.fu_via_if.name)
1004 	    || ((frwl->fw_flg & IPV6_FW_F_OIFNAME)
1005 	      && !*frwl->fw_out_if.fu_via_if.name)) {
1006 		dprintf(("%s empty interface name\n", err_prefix));
1007 		return (NULL);
1008 	}
1009 	/* Sanity check interface matching */
1010 	if ((frwl->fw_flg & IF6_FW_F_VIAHACK) == IF6_FW_F_VIAHACK) {
1011 		;		/* allow "via" backwards compatibility */
1012 	} else if ((frwl->fw_flg & IPV6_FW_F_IN)
1013 	    && (frwl->fw_flg & IPV6_FW_F_OIFACE)) {
1014 		dprintf(("%s outgoing interface check on incoming\n",
1015 		    err_prefix));
1016 		return (NULL);
1017 	}
1018 	/* Sanity check port ranges */
1019 	if ((frwl->fw_flg & IPV6_FW_F_SRNG) && IPV6_FW_GETNSRCP(frwl) < 2) {
1020 		dprintf(("%s src range set but n_src_p=%d\n",
1021 		    err_prefix, IPV6_FW_GETNSRCP(frwl)));
1022 		return (NULL);
1023 	}
1024 	if ((frwl->fw_flg & IPV6_FW_F_DRNG) && IPV6_FW_GETNDSTP(frwl) < 2) {
1025 		dprintf(("%s dst range set but n_dst_p=%d\n",
1026 		    err_prefix, IPV6_FW_GETNDSTP(frwl)));
1027 		return (NULL);
1028 	}
1029 	if (IPV6_FW_GETNSRCP(frwl) + IPV6_FW_GETNDSTP(frwl) > IPV6_FW_MAX_PORTS) {
1030 		dprintf(("%s too many ports (%d+%d)\n",
1031 		    err_prefix, IPV6_FW_GETNSRCP(frwl), IPV6_FW_GETNDSTP(frwl)));
1032 		return (NULL);
1033 	}
1034 	/*
1035 	 *	Protocols other than TCP/UDP don't use port range
1036 	 */
1037 	if ((frwl->fw_prot != IPPROTO_TCP) &&
1038 	    (frwl->fw_prot != IPPROTO_UDP) &&
1039 	    (IPV6_FW_GETNSRCP(frwl) || IPV6_FW_GETNDSTP(frwl))) {
1040 		dprintf(("%s port(s) specified for non TCP/UDP rule\n",
1041 		    err_prefix));
1042 		return(NULL);
1043 	}
1044 
1045 	/*
1046 	 *	Rather than modify the entry to make such entries work,
1047 	 *	we reject this rule and require user level utilities
1048 	 *	to enforce whatever policy they deem appropriate.
1049 	 */
1050 	if ((frwl->fw_src.s6_addr32[0] & (~frwl->fw_smsk.s6_addr32[0])) ||
1051 		(frwl->fw_src.s6_addr32[1] & (~frwl->fw_smsk.s6_addr32[1])) ||
1052 		(frwl->fw_src.s6_addr32[2] & (~frwl->fw_smsk.s6_addr32[2])) ||
1053 		(frwl->fw_src.s6_addr32[3] & (~frwl->fw_smsk.s6_addr32[3])) ||
1054 		(frwl->fw_dst.s6_addr32[0] & (~frwl->fw_dmsk.s6_addr32[0])) ||
1055 		(frwl->fw_dst.s6_addr32[1] & (~frwl->fw_dmsk.s6_addr32[1])) ||
1056 		(frwl->fw_dst.s6_addr32[2] & (~frwl->fw_dmsk.s6_addr32[2])) ||
1057 		(frwl->fw_dst.s6_addr32[3] & (~frwl->fw_dmsk.s6_addr32[3]))) {
1058 		dprintf(("%s rule never matches\n", err_prefix));
1059 		return(NULL);
1060 	}
1061 
1062 	if ((frwl->fw_flg & IPV6_FW_F_FRAG) &&
1063 		(frwl->fw_prot == IPPROTO_UDP || frwl->fw_prot == IPPROTO_TCP)) {
1064 		if (frwl->fw_nports) {
1065 			dprintf(("%s cannot mix 'frag' and ports\n", err_prefix));
1066 			return(NULL);
1067 		}
1068 		if (frwl->fw_prot == IPPROTO_TCP &&
1069 			frwl->fw_tcpf != frwl->fw_tcpnf) {
1070 			dprintf(("%s cannot mix 'frag' with TCP flags\n", err_prefix));
1071 			return(NULL);
1072 		}
1073 	}
1074 
1075 	/* Check command specific stuff */
1076 	switch (frwl->fw_flg & IPV6_FW_F_COMMAND)
1077 	{
1078 	case IPV6_FW_F_REJECT:
1079 		if (frwl->fw_reject_code >= 0x100
1080 		    && !(frwl->fw_prot == IPPROTO_TCP
1081 		      && frwl->fw_reject_code == IPV6_FW_REJECT_RST)) {
1082 			dprintf(("%s unknown reject code\n", err_prefix));
1083 			return(NULL);
1084 		}
1085 		break;
1086 	case IPV6_FW_F_DIVERT:		/* Diverting to port zero is invalid */
1087 	case IPV6_FW_F_TEE:
1088 		if (frwl->fw_divert_port == 0) {
1089 			dprintf(("%s can't divert to port 0\n", err_prefix));
1090 			return (NULL);
1091 		}
1092 		break;
1093 	case IPV6_FW_F_DENY:
1094 	case IPV6_FW_F_ACCEPT:
1095 	case IPV6_FW_F_COUNT:
1096 	case IPV6_FW_F_SKIPTO:
1097 		break;
1098 	default:
1099 		dprintf(("%s invalid command\n", err_prefix));
1100 		return(NULL);
1101 	}
1102 
1103 	return frwl;
1104 }
1105 
1106 static int
1107 ip6_fw_ctl(int stage, struct mbuf **mm)
1108 {
1109 	int error;
1110 	struct mbuf *m;
1111 
1112 	if (stage == IPV6_FW_GET) {
1113 		struct ip6_fw_chain *fcp = ip6_fw_chain.lh_first;
1114 		*mm = m = m_get(M_WAIT, MT_DATA); /* XXX */
1115 		if (!m)
1116 			return(ENOBUFS);
1117 		if (sizeof *(fcp->rule) > MLEN) {
1118 			MCLGET(m, M_WAIT);
1119 			if ((m->m_flags & M_EXT) == 0) {
1120 				m_free(m);
1121 				return(ENOBUFS);
1122 			}
1123 		}
1124 		for (; fcp; fcp = fcp->chain.le_next) {
1125 			bcopy(fcp->rule, m->m_data, sizeof *(fcp->rule));
1126 			m->m_len = sizeof *(fcp->rule);
1127 			m->m_next = m_get(M_WAIT, MT_DATA); /* XXX */
1128 			if (!m->m_next) {
1129 				m_freem(*mm);
1130 				return(ENOBUFS);
1131 			}
1132 			m = m->m_next;
1133 			if (sizeof *(fcp->rule) > MLEN) {
1134 				MCLGET(m, M_WAIT);
1135 				if ((m->m_flags & M_EXT) == 0) {
1136 					m_freem(*mm);
1137 					return(ENOBUFS);
1138 				}
1139 			}
1140 			m->m_len = 0;
1141 		}
1142 		return (0);
1143 	}
1144 	m = *mm;
1145 	/* only allow get calls if secure mode > 2 */
1146 	if (securelevel > 2) {
1147 		if (m) {
1148 			(void)m_freem(m);
1149 			*mm = 0;
1150 		}
1151 		return(EPERM);
1152 	}
1153 	if (stage == IPV6_FW_FLUSH) {
1154 		while (ip6_fw_chain.lh_first != NULL &&
1155 		    ip6_fw_chain.lh_first->rule->fw_number != (u_short)-1) {
1156 			struct ip6_fw_chain *fcp = ip6_fw_chain.lh_first;
1157 			int s = splnet();
1158 			LIST_REMOVE(ip6_fw_chain.lh_first, chain);
1159 			splx(s);
1160 			free(fcp->rule, M_IP6FW);
1161 			free(fcp, M_IP6FW);
1162 		}
1163 		if (m) {
1164 			(void)m_freem(m);
1165 			*mm = 0;
1166 		}
1167 		return (0);
1168 	}
1169 	if (stage == IPV6_FW_ZERO) {
1170 		error = zero_entry6(m);
1171 		if (m) {
1172 			(void)m_freem(m);
1173 			*mm = 0;
1174 		}
1175 		return (error);
1176 	}
1177 	if (m == NULL) {
1178 		printf("%s NULL mbuf ptr\n", err_prefix);
1179 		return (EINVAL);
1180 	}
1181 
1182 	if (stage == IPV6_FW_ADD) {
1183 		struct ip6_fw *frwl = check_ip6fw_mbuf(m);
1184 
1185 		if (!frwl)
1186 			error = EINVAL;
1187 		else
1188 			error = add_entry6(&ip6_fw_chain, frwl);
1189 		if (m) {
1190 			(void)m_freem(m);
1191 			*mm = 0;
1192 		}
1193 		return error;
1194 	}
1195 	if (stage == IPV6_FW_DEL) {
1196 		if (m->m_len != sizeof(struct ip6_fw)) {
1197 			dprintf(("%s len=%d, want %d\n", err_prefix, m->m_len,
1198 			    sizeof(struct ip6_fw)));
1199 			error = EINVAL;
1200 		} else if (mtod(m, struct ip6_fw *)->fw_number == (u_short)-1) {
1201 			dprintf(("%s can't delete rule 65535\n", err_prefix));
1202 			error = EINVAL;
1203 		} else
1204 			error = del_entry6(&ip6_fw_chain,
1205 			    mtod(m, struct ip6_fw *)->fw_number);
1206 		if (m) {
1207 			(void)m_freem(m);
1208 			*mm = 0;
1209 		}
1210 		return error;
1211 	}
1212 
1213 	dprintf(("%s unknown request %d\n", err_prefix, stage));
1214 	if (m) {
1215 		(void)m_freem(m);
1216 		*mm = 0;
1217 	}
1218 	return (EINVAL);
1219 }
1220 
1221 void
1222 ip6_fw_init(void)
1223 {
1224 	struct ip6_fw default_rule;
1225 
1226 	ip6_fw_chk_ptr = ip6_fw_chk;
1227 	ip6_fw_ctl_ptr = ip6_fw_ctl;
1228 	LIST_INIT(&ip6_fw_chain);
1229 
1230 	bzero(&default_rule, sizeof default_rule);
1231 	default_rule.fw_prot = IPPROTO_IPV6;
1232 	default_rule.fw_number = (u_short)-1;
1233 #ifdef IPV6FIREWALL_DEFAULT_TO_ACCEPT
1234 	default_rule.fw_flg |= IPV6_FW_F_ACCEPT;
1235 #else
1236 	default_rule.fw_flg |= IPV6_FW_F_DENY;
1237 #endif
1238 	default_rule.fw_flg |= IPV6_FW_F_IN | IPV6_FW_F_OUT;
1239 	if (check_ip6fw_struct(&default_rule) == NULL ||
1240 		add_entry6(&ip6_fw_chain, &default_rule))
1241 		panic(__FUNCTION__);
1242 
1243 	printf("IPv6 packet filtering initialized, ");
1244 #ifdef IPV6FIREWALL_DEFAULT_TO_ACCEPT
1245 	printf("default to accept, ");
1246 #endif
1247 #ifndef IPV6FIREWALL_VERBOSE
1248 	printf("logging disabled\n");
1249 #else
1250 	if (fw6_verbose_limit == 0)
1251 		printf("unlimited logging\n");
1252 	else
1253 		printf("logging limited to %d packets/entry\n",
1254 		    fw6_verbose_limit);
1255 #endif
1256 }
1257 
1258 static ip6_fw_chk_t *old_chk_ptr;
1259 static ip6_fw_ctl_t *old_ctl_ptr;
1260 
1261 static int
1262 ip6fw_modevent(module_t mod, int type, void *unused)
1263 {
1264 	int s;
1265 
1266 	switch (type) {
1267 	case MOD_LOAD:
1268 		s = splnet();
1269 
1270 		old_chk_ptr = ip6_fw_chk_ptr;
1271 		old_ctl_ptr = ip6_fw_ctl_ptr;
1272 
1273 		ip6_fw_init();
1274 		splx(s);
1275 		return 0;
1276 	case MOD_UNLOAD:
1277 		s = splnet();
1278 		ip6_fw_chk_ptr =  old_chk_ptr;
1279 		ip6_fw_ctl_ptr =  old_ctl_ptr;
1280 		while (LIST_FIRST(&ip6_fw_chain) != NULL) {
1281 			struct ip6_fw_chain *fcp = LIST_FIRST(&ip6_fw_chain);
1282 			LIST_REMOVE(LIST_FIRST(&ip6_fw_chain), chain);
1283 			free(fcp->rule, M_IP6FW);
1284 			free(fcp, M_IP6FW);
1285 		}
1286 
1287 		splx(s);
1288 		printf("IPv6 firewall unloaded\n");
1289 		return 0;
1290 	default:
1291 		break;
1292 	}
1293 	return 0;
1294 }
1295 
1296 static moduledata_t ip6fwmod = {
1297 	"ip6fw",
1298 	ip6fw_modevent,
1299 	0
1300 };
1301 DECLARE_MODULE(ip6fw, ip6fwmod, SI_SUB_PSEUDO, SI_ORDER_ANY);
1302