xref: /freebsd/sys/netpfil/pf/pf_lb.c (revision d10de21f2f7df59344f8611546989b36e4fd867c)
1d8aa10ccSGleb Smirnoff /*-
2fe267a55SPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause
3fe267a55SPedro F. Giffuni  *
43b3a8eb9SGleb Smirnoff  * Copyright (c) 2001 Daniel Hartmeier
53b3a8eb9SGleb Smirnoff  * Copyright (c) 2002 - 2008 Henning Brauer
63b3a8eb9SGleb Smirnoff  * All rights reserved.
73b3a8eb9SGleb Smirnoff  *
83b3a8eb9SGleb Smirnoff  * Redistribution and use in source and binary forms, with or without
93b3a8eb9SGleb Smirnoff  * modification, are permitted provided that the following conditions
103b3a8eb9SGleb Smirnoff  * are met:
113b3a8eb9SGleb Smirnoff  *
123b3a8eb9SGleb Smirnoff  *    - Redistributions of source code must retain the above copyright
133b3a8eb9SGleb Smirnoff  *      notice, this list of conditions and the following disclaimer.
143b3a8eb9SGleb Smirnoff  *    - Redistributions in binary form must reproduce the above
153b3a8eb9SGleb Smirnoff  *      copyright notice, this list of conditions and the following
163b3a8eb9SGleb Smirnoff  *      disclaimer in the documentation and/or other materials provided
173b3a8eb9SGleb Smirnoff  *      with the distribution.
183b3a8eb9SGleb Smirnoff  *
193b3a8eb9SGleb Smirnoff  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
203b3a8eb9SGleb Smirnoff  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
213b3a8eb9SGleb Smirnoff  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
223b3a8eb9SGleb Smirnoff  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
233b3a8eb9SGleb Smirnoff  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
243b3a8eb9SGleb Smirnoff  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
253b3a8eb9SGleb Smirnoff  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
263b3a8eb9SGleb Smirnoff  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
273b3a8eb9SGleb Smirnoff  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
283b3a8eb9SGleb Smirnoff  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
293b3a8eb9SGleb Smirnoff  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
303b3a8eb9SGleb Smirnoff  * POSSIBILITY OF SUCH DAMAGE.
313b3a8eb9SGleb Smirnoff  *
323b3a8eb9SGleb Smirnoff  * Effort sponsored in part by the Defense Advanced Research Projects
333b3a8eb9SGleb Smirnoff  * Agency (DARPA) and Air Force Research Laboratory, Air Force
343b3a8eb9SGleb Smirnoff  * Materiel Command, USAF, under agreement number F30602-01-2-0537.
353b3a8eb9SGleb Smirnoff  *
36d8aa10ccSGleb Smirnoff  *	$OpenBSD: pf_lb.c,v 1.2 2009/02/12 02:13:15 sthen Exp $
373b3a8eb9SGleb Smirnoff  */
383b3a8eb9SGleb Smirnoff 
393b3a8eb9SGleb Smirnoff #include <sys/cdefs.h>
403b3a8eb9SGleb Smirnoff #include "opt_pf.h"
413b3a8eb9SGleb Smirnoff #include "opt_inet.h"
423b3a8eb9SGleb Smirnoff #include "opt_inet6.h"
433b3a8eb9SGleb Smirnoff 
443b3a8eb9SGleb Smirnoff #include <sys/param.h>
4576039bc8SGleb Smirnoff #include <sys/lock.h>
4676039bc8SGleb Smirnoff #include <sys/mbuf.h>
473b3a8eb9SGleb Smirnoff #include <sys/socket.h>
483b3a8eb9SGleb Smirnoff #include <sys/sysctl.h>
493b3a8eb9SGleb Smirnoff 
503b3a8eb9SGleb Smirnoff #include <net/if.h>
5176039bc8SGleb Smirnoff #include <net/vnet.h>
523b3a8eb9SGleb Smirnoff #include <net/pfvar.h>
533b3a8eb9SGleb Smirnoff #include <net/if_pflog.h>
543b3a8eb9SGleb Smirnoff 
553b3a8eb9SGleb Smirnoff #define DPFPRINTF(n, x)	if (V_pf_status.debug >= (n)) printf x
563b3a8eb9SGleb Smirnoff 
573b3a8eb9SGleb Smirnoff static void		 pf_hash(struct pf_addr *, struct pf_addr *,
583b3a8eb9SGleb Smirnoff 			    struct pf_poolhashkey *, sa_family_t);
59e86bddeaSKristof Provost static struct pf_krule	*pf_match_translation(struct pf_pdesc *, struct mbuf *,
60f2064dd1SKajetan Staszkiewicz 			    int, struct pfi_kkif *,
613b3a8eb9SGleb Smirnoff 			    struct pf_addr *, u_int16_t, struct pf_addr *,
62e86bddeaSKristof Provost 			    uint16_t, int, struct pf_kanchor_stackframe *);
63e86bddeaSKristof Provost static int pf_get_sport(sa_family_t, uint8_t, struct pf_krule *,
648fc6e19cSGleb Smirnoff     struct pf_addr *, uint16_t, struct pf_addr *, uint16_t, struct pf_addr *,
6517ad7334SKristof Provost     uint16_t *, uint16_t, uint16_t, struct pf_ksrc_node **);
663b3a8eb9SGleb Smirnoff 
673b3a8eb9SGleb Smirnoff #define mix(a,b,c) \
683b3a8eb9SGleb Smirnoff 	do {					\
693b3a8eb9SGleb Smirnoff 		a -= b; a -= c; a ^= (c >> 13);	\
703b3a8eb9SGleb Smirnoff 		b -= c; b -= a; b ^= (a << 8);	\
713b3a8eb9SGleb Smirnoff 		c -= a; c -= b; c ^= (b >> 13);	\
723b3a8eb9SGleb Smirnoff 		a -= b; a -= c; a ^= (c >> 12);	\
733b3a8eb9SGleb Smirnoff 		b -= c; b -= a; b ^= (a << 16);	\
743b3a8eb9SGleb Smirnoff 		c -= a; c -= b; c ^= (b >> 5);	\
753b3a8eb9SGleb Smirnoff 		a -= b; a -= c; a ^= (c >> 3);	\
763b3a8eb9SGleb Smirnoff 		b -= c; b -= a; b ^= (a << 10);	\
773b3a8eb9SGleb Smirnoff 		c -= a; c -= b; c ^= (b >> 15);	\
783b3a8eb9SGleb Smirnoff 	} while (0)
793b3a8eb9SGleb Smirnoff 
803b3a8eb9SGleb Smirnoff /*
813b3a8eb9SGleb Smirnoff  * hash function based on bridge_hash in if_bridge.c
823b3a8eb9SGleb Smirnoff  */
833b3a8eb9SGleb Smirnoff static void
843b3a8eb9SGleb Smirnoff pf_hash(struct pf_addr *inaddr, struct pf_addr *hash,
853b3a8eb9SGleb Smirnoff     struct pf_poolhashkey *key, sa_family_t af)
863b3a8eb9SGleb Smirnoff {
873b3a8eb9SGleb Smirnoff 	u_int32_t	a = 0x9e3779b9, b = 0x9e3779b9, c = key->key32[0];
883b3a8eb9SGleb Smirnoff 
893b3a8eb9SGleb Smirnoff 	switch (af) {
903b3a8eb9SGleb Smirnoff #ifdef INET
913b3a8eb9SGleb Smirnoff 	case AF_INET:
923b3a8eb9SGleb Smirnoff 		a += inaddr->addr32[0];
933b3a8eb9SGleb Smirnoff 		b += key->key32[1];
943b3a8eb9SGleb Smirnoff 		mix(a, b, c);
953b3a8eb9SGleb Smirnoff 		hash->addr32[0] = c + key->key32[2];
963b3a8eb9SGleb Smirnoff 		break;
973b3a8eb9SGleb Smirnoff #endif /* INET */
983b3a8eb9SGleb Smirnoff #ifdef INET6
993b3a8eb9SGleb Smirnoff 	case AF_INET6:
1003b3a8eb9SGleb Smirnoff 		a += inaddr->addr32[0];
1013b3a8eb9SGleb Smirnoff 		b += inaddr->addr32[2];
1023b3a8eb9SGleb Smirnoff 		mix(a, b, c);
1033b3a8eb9SGleb Smirnoff 		hash->addr32[0] = c;
1043b3a8eb9SGleb Smirnoff 		a += inaddr->addr32[1];
1053b3a8eb9SGleb Smirnoff 		b += inaddr->addr32[3];
1063b3a8eb9SGleb Smirnoff 		c += key->key32[1];
1073b3a8eb9SGleb Smirnoff 		mix(a, b, c);
1083b3a8eb9SGleb Smirnoff 		hash->addr32[1] = c;
1093b3a8eb9SGleb Smirnoff 		a += inaddr->addr32[2];
1103b3a8eb9SGleb Smirnoff 		b += inaddr->addr32[1];
1113b3a8eb9SGleb Smirnoff 		c += key->key32[2];
1123b3a8eb9SGleb Smirnoff 		mix(a, b, c);
1133b3a8eb9SGleb Smirnoff 		hash->addr32[2] = c;
1143b3a8eb9SGleb Smirnoff 		a += inaddr->addr32[3];
1153b3a8eb9SGleb Smirnoff 		b += inaddr->addr32[0];
1163b3a8eb9SGleb Smirnoff 		c += key->key32[3];
1173b3a8eb9SGleb Smirnoff 		mix(a, b, c);
1183b3a8eb9SGleb Smirnoff 		hash->addr32[3] = c;
1193b3a8eb9SGleb Smirnoff 		break;
1203b3a8eb9SGleb Smirnoff #endif /* INET6 */
1213b3a8eb9SGleb Smirnoff 	}
1223b3a8eb9SGleb Smirnoff }
1233b3a8eb9SGleb Smirnoff 
124e86bddeaSKristof Provost static struct pf_krule *
1253b3a8eb9SGleb Smirnoff pf_match_translation(struct pf_pdesc *pd, struct mbuf *m, int off,
126f2064dd1SKajetan Staszkiewicz     struct pfi_kkif *kif, struct pf_addr *saddr, u_int16_t sport,
1271d6139c0SGleb Smirnoff     struct pf_addr *daddr, uint16_t dport, int rs_num,
128e86bddeaSKristof Provost     struct pf_kanchor_stackframe *anchor_stack)
1293b3a8eb9SGleb Smirnoff {
130e86bddeaSKristof Provost 	struct pf_krule		*r, *rm = NULL;
131e86bddeaSKristof Provost 	struct pf_kruleset	*ruleset = NULL;
1323b3a8eb9SGleb Smirnoff 	int			 tag = -1;
1333b3a8eb9SGleb Smirnoff 	int			 rtableid = -1;
1343b3a8eb9SGleb Smirnoff 	int			 asd = 0;
1353b3a8eb9SGleb Smirnoff 
1363b3a8eb9SGleb Smirnoff 	r = TAILQ_FIRST(pf_main_ruleset.rules[rs_num].active.ptr);
1376b94546aSMateusz Guzik 	while (r != NULL) {
1383b3a8eb9SGleb Smirnoff 		struct pf_rule_addr	*src = NULL, *dst = NULL;
1393b3a8eb9SGleb Smirnoff 		struct pf_addr_wrap	*xdst = NULL;
1403b3a8eb9SGleb Smirnoff 
141f2064dd1SKajetan Staszkiewicz 		if (r->action == PF_BINAT && pd->dir == PF_IN) {
1423b3a8eb9SGleb Smirnoff 			src = &r->dst;
1433b3a8eb9SGleb Smirnoff 			if (r->rpool.cur != NULL)
1443b3a8eb9SGleb Smirnoff 				xdst = &r->rpool.cur->addr;
1453b3a8eb9SGleb Smirnoff 		} else {
1463b3a8eb9SGleb Smirnoff 			src = &r->src;
1473b3a8eb9SGleb Smirnoff 			dst = &r->dst;
1483b3a8eb9SGleb Smirnoff 		}
1493b3a8eb9SGleb Smirnoff 
15002cf67ccSMateusz Guzik 		pf_counter_u64_add(&r->evaluations, 1);
151320c1116SKristof Provost 		if (pfi_kkif_match(r->kif, kif) == r->ifnot)
1523b3a8eb9SGleb Smirnoff 			r = r->skip[PF_SKIP_IFP].ptr;
153f2064dd1SKajetan Staszkiewicz 		else if (r->direction && r->direction != pd->dir)
1543b3a8eb9SGleb Smirnoff 			r = r->skip[PF_SKIP_DIR].ptr;
1553b3a8eb9SGleb Smirnoff 		else if (r->af && r->af != pd->af)
1563b3a8eb9SGleb Smirnoff 			r = r->skip[PF_SKIP_AF].ptr;
1573b3a8eb9SGleb Smirnoff 		else if (r->proto && r->proto != pd->proto)
1583b3a8eb9SGleb Smirnoff 			r = r->skip[PF_SKIP_PROTO].ptr;
1593b3a8eb9SGleb Smirnoff 		else if (PF_MISMATCHAW(&src->addr, saddr, pd->af,
1603b3a8eb9SGleb Smirnoff 		    src->neg, kif, M_GETFIB(m)))
1613b3a8eb9SGleb Smirnoff 			r = r->skip[src == &r->src ? PF_SKIP_SRC_ADDR :
1623b3a8eb9SGleb Smirnoff 			    PF_SKIP_DST_ADDR].ptr;
1633b3a8eb9SGleb Smirnoff 		else if (src->port_op && !pf_match_port(src->port_op,
1643b3a8eb9SGleb Smirnoff 		    src->port[0], src->port[1], sport))
1653b3a8eb9SGleb Smirnoff 			r = r->skip[src == &r->src ? PF_SKIP_SRC_PORT :
1663b3a8eb9SGleb Smirnoff 			    PF_SKIP_DST_PORT].ptr;
1673b3a8eb9SGleb Smirnoff 		else if (dst != NULL &&
1683b3a8eb9SGleb Smirnoff 		    PF_MISMATCHAW(&dst->addr, daddr, pd->af, dst->neg, NULL,
1693b3a8eb9SGleb Smirnoff 		    M_GETFIB(m)))
1703b3a8eb9SGleb Smirnoff 			r = r->skip[PF_SKIP_DST_ADDR].ptr;
1713b3a8eb9SGleb Smirnoff 		else if (xdst != NULL && PF_MISMATCHAW(xdst, daddr, pd->af,
1723b3a8eb9SGleb Smirnoff 		    0, NULL, M_GETFIB(m)))
1733b3a8eb9SGleb Smirnoff 			r = TAILQ_NEXT(r, entries);
1743b3a8eb9SGleb Smirnoff 		else if (dst != NULL && dst->port_op &&
1753b3a8eb9SGleb Smirnoff 		    !pf_match_port(dst->port_op, dst->port[0],
1763b3a8eb9SGleb Smirnoff 		    dst->port[1], dport))
1773b3a8eb9SGleb Smirnoff 			r = r->skip[PF_SKIP_DST_PORT].ptr;
1783b3a8eb9SGleb Smirnoff 		else if (r->match_tag && !pf_match_tag(m, r, &tag,
1793b3a8eb9SGleb Smirnoff 		    pd->pf_mtag ? pd->pf_mtag->tag : 0))
1803b3a8eb9SGleb Smirnoff 			r = TAILQ_NEXT(r, entries);
1813b3a8eb9SGleb Smirnoff 		else if (r->os_fingerprint != PF_OSFP_ANY && (pd->proto !=
1823b3a8eb9SGleb Smirnoff 		    IPPROTO_TCP || !pf_osfp_match(pf_osfp_fingerprint(pd, m,
183d38630f6SKristof Provost 		    off, &pd->hdr.tcp), r->os_fingerprint)))
1843b3a8eb9SGleb Smirnoff 			r = TAILQ_NEXT(r, entries);
1853b3a8eb9SGleb Smirnoff 		else {
1863b3a8eb9SGleb Smirnoff 			if (r->tag)
1873b3a8eb9SGleb Smirnoff 				tag = r->tag;
1883b3a8eb9SGleb Smirnoff 			if (r->rtableid >= 0)
1893b3a8eb9SGleb Smirnoff 				rtableid = r->rtableid;
1903b3a8eb9SGleb Smirnoff 			if (r->anchor == NULL) {
1913b3a8eb9SGleb Smirnoff 				rm = r;
1926b94546aSMateusz Guzik 				if (rm->action == PF_NONAT ||
1936b94546aSMateusz Guzik 				    rm->action == PF_NORDR ||
1946b94546aSMateusz Guzik 				    rm->action == PF_NOBINAT) {
1956b94546aSMateusz Guzik 					rm = NULL;
1966b94546aSMateusz Guzik 				}
1976b94546aSMateusz Guzik 				break;
1983b3a8eb9SGleb Smirnoff 			} else
1991d6139c0SGleb Smirnoff 				pf_step_into_anchor(anchor_stack, &asd,
2001d6139c0SGleb Smirnoff 				    &ruleset, rs_num, &r, NULL, NULL);
2013b3a8eb9SGleb Smirnoff 		}
2023b3a8eb9SGleb Smirnoff 		if (r == NULL)
2031d6139c0SGleb Smirnoff 			pf_step_out_of_anchor(anchor_stack, &asd, &ruleset,
2041d6139c0SGleb Smirnoff 			    rs_num, &r, NULL, NULL);
2053b3a8eb9SGleb Smirnoff 	}
2063b3a8eb9SGleb Smirnoff 
2073b3a8eb9SGleb Smirnoff 	if (tag > 0 && pf_tag_packet(m, pd, tag))
2083b3a8eb9SGleb Smirnoff 		return (NULL);
2093b3a8eb9SGleb Smirnoff 	if (rtableid >= 0)
2103b3a8eb9SGleb Smirnoff 		M_SETFIB(m, rtableid);
2113b3a8eb9SGleb Smirnoff 
2123b3a8eb9SGleb Smirnoff 	return (rm);
2133b3a8eb9SGleb Smirnoff }
2143b3a8eb9SGleb Smirnoff 
2153b3a8eb9SGleb Smirnoff static int
216e86bddeaSKristof Provost pf_get_sport(sa_family_t af, u_int8_t proto, struct pf_krule *r,
2178fc6e19cSGleb Smirnoff     struct pf_addr *saddr, uint16_t sport, struct pf_addr *daddr,
2188fc6e19cSGleb Smirnoff     uint16_t dport, struct pf_addr *naddr, uint16_t *nport, uint16_t low,
21917ad7334SKristof Provost     uint16_t high, struct pf_ksrc_node **sn)
2203b3a8eb9SGleb Smirnoff {
2213b3a8eb9SGleb Smirnoff 	struct pf_state_key_cmp	key;
2223b3a8eb9SGleb Smirnoff 	struct pf_addr		init_addr;
2233b3a8eb9SGleb Smirnoff 
2243b3a8eb9SGleb Smirnoff 	bzero(&init_addr, sizeof(init_addr));
225*d10de21fSKajetan Staszkiewicz 	if (pf_map_addr(af, r, saddr, naddr, NULL, &init_addr, sn))
2263b3a8eb9SGleb Smirnoff 		return (1);
2273b3a8eb9SGleb Smirnoff 
2288fc6e19cSGleb Smirnoff 	bzero(&key, sizeof(key));
2293b3a8eb9SGleb Smirnoff 	key.af = af;
2303b3a8eb9SGleb Smirnoff 	key.proto = proto;
2318fc6e19cSGleb Smirnoff 	key.port[0] = dport;
2328fc6e19cSGleb Smirnoff 	PF_ACPY(&key.addr[0], daddr, key.af);
2338fc6e19cSGleb Smirnoff 
2348fc6e19cSGleb Smirnoff 	do {
2358fc6e19cSGleb Smirnoff 		PF_ACPY(&key.addr[1], naddr, key.af);
2363b3a8eb9SGleb Smirnoff 
2373b3a8eb9SGleb Smirnoff 		/*
2383b3a8eb9SGleb Smirnoff 		 * port search; start random, step;
2393b3a8eb9SGleb Smirnoff 		 * similar 2 portloop in in_pcbbind
2403b3a8eb9SGleb Smirnoff 		 */
2416053adafSKristof Provost 		if (proto == IPPROTO_SCTP) {
2426053adafSKristof Provost 			key.port[1] = sport;
2436053adafSKristof Provost 			if (!pf_find_state_all_exists(&key, PF_IN)) {
2446053adafSKristof Provost 				*nport = sport;
2456053adafSKristof Provost 				return (0);
2466053adafSKristof Provost 			} else {
2476053adafSKristof Provost 				return (1); /* Fail mapping. */
2486053adafSKristof Provost 			}
2496053adafSKristof Provost 		} else if (!(proto == IPPROTO_TCP || proto == IPPROTO_UDP ||
2508fc6e19cSGleb Smirnoff 		    proto == IPPROTO_ICMP) || (low == 0 && high == 0)) {
2518fc6e19cSGleb Smirnoff 			/*
2528fc6e19cSGleb Smirnoff 			 * XXX bug: icmp states don't use the id on both sides.
2538fc6e19cSGleb Smirnoff 			 * (traceroute -I through nat)
2548fc6e19cSGleb Smirnoff 			 */
2558fc6e19cSGleb Smirnoff 			key.port[1] = sport;
25619d6e29bSMateusz Guzik 			if (!pf_find_state_all_exists(&key, PF_IN)) {
2578fc6e19cSGleb Smirnoff 				*nport = sport;
2583b3a8eb9SGleb Smirnoff 				return (0);
2598fc6e19cSGleb Smirnoff 			}
2603b3a8eb9SGleb Smirnoff 		} else if (low == high) {
2618fc6e19cSGleb Smirnoff 			key.port[1] = htons(low);
26219d6e29bSMateusz Guzik 			if (!pf_find_state_all_exists(&key, PF_IN)) {
2633b3a8eb9SGleb Smirnoff 				*nport = htons(low);
2643b3a8eb9SGleb Smirnoff 				return (0);
2653b3a8eb9SGleb Smirnoff 			}
2663b3a8eb9SGleb Smirnoff 		} else {
2677f3ad018SKristof Provost 			uint32_t tmp;
2687f3ad018SKristof Provost 			uint16_t cut;
2693b3a8eb9SGleb Smirnoff 
2703b3a8eb9SGleb Smirnoff 			if (low > high) {
2713b3a8eb9SGleb Smirnoff 				tmp = low;
2723b3a8eb9SGleb Smirnoff 				low = high;
2733b3a8eb9SGleb Smirnoff 				high = tmp;
2743b3a8eb9SGleb Smirnoff 			}
2753b3a8eb9SGleb Smirnoff 			/* low < high */
276e4e01d9cSGleb Smirnoff 			cut = arc4random() % (1 + high - low) + low;
2773b3a8eb9SGleb Smirnoff 			/* low <= cut <= high */
2787f3ad018SKristof Provost 			for (tmp = cut; tmp <= high && tmp <= 0xffff; ++tmp) {
2798fc6e19cSGleb Smirnoff 				key.port[1] = htons(tmp);
28019d6e29bSMateusz Guzik 				if (!pf_find_state_all_exists(&key, PF_IN)) {
2813b3a8eb9SGleb Smirnoff 					*nport = htons(tmp);
2823b3a8eb9SGleb Smirnoff 					return (0);
2833b3a8eb9SGleb Smirnoff 				}
2843b3a8eb9SGleb Smirnoff 			}
2857f3ad018SKristof Provost 			tmp = cut;
2867f3ad018SKristof Provost 			for (tmp -= 1; tmp >= low && tmp <= 0xffff; --tmp) {
2878fc6e19cSGleb Smirnoff 				key.port[1] = htons(tmp);
28819d6e29bSMateusz Guzik 				if (!pf_find_state_all_exists(&key, PF_IN)) {
2893b3a8eb9SGleb Smirnoff 					*nport = htons(tmp);
2903b3a8eb9SGleb Smirnoff 					return (0);
2913b3a8eb9SGleb Smirnoff 				}
2923b3a8eb9SGleb Smirnoff 			}
2933b3a8eb9SGleb Smirnoff 		}
2943b3a8eb9SGleb Smirnoff 
2953b3a8eb9SGleb Smirnoff 		switch (r->rpool.opts & PF_POOL_TYPEMASK) {
2963b3a8eb9SGleb Smirnoff 		case PF_POOL_RANDOM:
2973b3a8eb9SGleb Smirnoff 		case PF_POOL_ROUNDROBIN:
2982b0a4ffaSKristof Provost 			/*
2992b0a4ffaSKristof Provost 			 * pick a different source address since we're out
3002b0a4ffaSKristof Provost 			 * of free port choices for the current one.
3012b0a4ffaSKristof Provost 			 */
302*d10de21fSKajetan Staszkiewicz 			if (pf_map_addr(af, r, saddr, naddr, NULL, &init_addr, sn))
3033b3a8eb9SGleb Smirnoff 				return (1);
3043b3a8eb9SGleb Smirnoff 			break;
3053b3a8eb9SGleb Smirnoff 		case PF_POOL_NONE:
3063b3a8eb9SGleb Smirnoff 		case PF_POOL_SRCHASH:
3073b3a8eb9SGleb Smirnoff 		case PF_POOL_BITMASK:
3083b3a8eb9SGleb Smirnoff 		default:
3093b3a8eb9SGleb Smirnoff 			return (1);
3103b3a8eb9SGleb Smirnoff 		}
3113b3a8eb9SGleb Smirnoff 	} while (! PF_AEQ(&init_addr, naddr, af) );
3123b3a8eb9SGleb Smirnoff 	return (1);					/* none available */
3133b3a8eb9SGleb Smirnoff }
3143b3a8eb9SGleb Smirnoff 
3152aa21096SKurosawa Takahiro static int
3162aa21096SKurosawa Takahiro pf_get_mape_sport(sa_family_t af, u_int8_t proto, struct pf_krule *r,
3172aa21096SKurosawa Takahiro     struct pf_addr *saddr, uint16_t sport, struct pf_addr *daddr,
3182aa21096SKurosawa Takahiro     uint16_t dport, struct pf_addr *naddr, uint16_t *nport,
3192aa21096SKurosawa Takahiro     struct pf_ksrc_node **sn)
3202aa21096SKurosawa Takahiro {
3212aa21096SKurosawa Takahiro 	uint16_t psmask, low, highmask;
3222aa21096SKurosawa Takahiro 	uint16_t i, ahigh, cut;
3232aa21096SKurosawa Takahiro 	int ashift, psidshift;
3242aa21096SKurosawa Takahiro 
3252aa21096SKurosawa Takahiro 	ashift = 16 - r->rpool.mape.offset;
3262aa21096SKurosawa Takahiro 	psidshift = ashift - r->rpool.mape.psidlen;
3272aa21096SKurosawa Takahiro 	psmask = r->rpool.mape.psid & ((1U << r->rpool.mape.psidlen) - 1);
3282aa21096SKurosawa Takahiro 	psmask = psmask << psidshift;
3292aa21096SKurosawa Takahiro 	highmask = (1U << psidshift) - 1;
3302aa21096SKurosawa Takahiro 
3312aa21096SKurosawa Takahiro 	ahigh = (1U << r->rpool.mape.offset) - 1;
3322aa21096SKurosawa Takahiro 	cut = arc4random() & ahigh;
3332aa21096SKurosawa Takahiro 	if (cut == 0)
3342aa21096SKurosawa Takahiro 		cut = 1;
3352aa21096SKurosawa Takahiro 
3362aa21096SKurosawa Takahiro 	for (i = cut; i <= ahigh; i++) {
3372aa21096SKurosawa Takahiro 		low = (i << ashift) | psmask;
3382aa21096SKurosawa Takahiro 		if (!pf_get_sport(af, proto, r, saddr, sport, daddr, dport,
3392aa21096SKurosawa Takahiro 		    naddr, nport, low, low | highmask, sn))
3402aa21096SKurosawa Takahiro 			return (0);
3412aa21096SKurosawa Takahiro 	}
3422aa21096SKurosawa Takahiro 	for (i = cut - 1; i > 0; i--) {
3432aa21096SKurosawa Takahiro 		low = (i << ashift) | psmask;
3442aa21096SKurosawa Takahiro 		if (!pf_get_sport(af, proto, r, saddr, sport, daddr, dport,
3452aa21096SKurosawa Takahiro 		    naddr, nport, low, low | highmask, sn))
3462aa21096SKurosawa Takahiro 			return (0);
3472aa21096SKurosawa Takahiro 	}
3482aa21096SKurosawa Takahiro 	return (1);
3492aa21096SKurosawa Takahiro }
3502aa21096SKurosawa Takahiro 
35116303d2bSKajetan Staszkiewicz u_short
352e86bddeaSKristof Provost pf_map_addr(sa_family_t af, struct pf_krule *r, struct pf_addr *saddr,
353*d10de21fSKajetan Staszkiewicz     struct pf_addr *naddr, struct pfi_kkif **nkif, struct pf_addr *init_addr,
354*d10de21fSKajetan Staszkiewicz     struct pf_ksrc_node **sn)
3553b3a8eb9SGleb Smirnoff {
35616303d2bSKajetan Staszkiewicz 	u_short			 reason = 0;
357320c1116SKristof Provost 	struct pf_kpool		*rpool = &r->rpool;
3583b3a8eb9SGleb Smirnoff 	struct pf_addr		*raddr = NULL, *rmask = NULL;
359db0a2bfdSKajetan Staszkiewicz 	struct pf_srchash	*sh = NULL;
3603b3a8eb9SGleb Smirnoff 
361e85343b1SGleb Smirnoff 	/* Try to find a src_node if none was given and this
362e85343b1SGleb Smirnoff 	   is a sticky-address rule. */
3633b3a8eb9SGleb Smirnoff 	if (*sn == NULL && r->rpool.opts & PF_POOL_STICKYADDR &&
364e85343b1SGleb Smirnoff 	    (r->rpool.opts & PF_POOL_TYPEMASK) != PF_POOL_NONE)
365db0a2bfdSKajetan Staszkiewicz 		*sn = pf_find_src_node(saddr, r, af, &sh, false);
366e85343b1SGleb Smirnoff 
367e85343b1SGleb Smirnoff 	/* If a src_node was found or explicitly given and it has a non-zero
368e85343b1SGleb Smirnoff 	   route address, use this address. A zeroed address is found if the
369e85343b1SGleb Smirnoff 	   src node was created just a moment ago in pf_create_state and it
370e85343b1SGleb Smirnoff 	   needs to be filled in with routing decision calculated here. */
3713b3a8eb9SGleb Smirnoff 	if (*sn != NULL && !PF_AZERO(&(*sn)->raddr, af)) {
372336683f2SKristof Provost 		/* If the supplied address is the same as the current one we've
373336683f2SKristof Provost 		 * been asked before, so tell the caller that there's no other
374336683f2SKristof Provost 		 * address to be had. */
37516303d2bSKajetan Staszkiewicz 		if (PF_AEQ(naddr, &(*sn)->raddr, af)) {
37616303d2bSKajetan Staszkiewicz 			reason = PFRES_MAPFAILED;
37716303d2bSKajetan Staszkiewicz 			goto done;
37816303d2bSKajetan Staszkiewicz 		}
379336683f2SKristof Provost 
3803b3a8eb9SGleb Smirnoff 		PF_ACPY(naddr, &(*sn)->raddr, af);
381*d10de21fSKajetan Staszkiewicz 		if (nkif)
382*d10de21fSKajetan Staszkiewicz 			*nkif = (*sn)->rkif;
383498cca14SKristof Provost 		if (V_pf_status.debug >= PF_DEBUG_NOISY) {
3843b3a8eb9SGleb Smirnoff 			printf("pf_map_addr: src tracking maps ");
3853b3a8eb9SGleb Smirnoff 			pf_print_host(saddr, 0, af);
3863b3a8eb9SGleb Smirnoff 			printf(" to ");
3873b3a8eb9SGleb Smirnoff 			pf_print_host(naddr, 0, af);
388*d10de21fSKajetan Staszkiewicz 			if (nkif)
389*d10de21fSKajetan Staszkiewicz 				printf("@%s", (*nkif)->pfik_name);
3903b3a8eb9SGleb Smirnoff 			printf("\n");
3913b3a8eb9SGleb Smirnoff 		}
39216303d2bSKajetan Staszkiewicz 		goto done;
3933b3a8eb9SGleb Smirnoff 	}
3943b3a8eb9SGleb Smirnoff 
3955f5e32f1SKristof Provost 	mtx_lock(&rpool->mtx);
396e85343b1SGleb Smirnoff 	/* Find the route using chosen algorithm. Store the found route
397e85343b1SGleb Smirnoff 	   in src_node if it was given or found. */
3985f5e32f1SKristof Provost 	if (rpool->cur->addr.type == PF_ADDR_NOROUTE) {
39916303d2bSKajetan Staszkiewicz 		reason = PFRES_MAPFAILED;
40016303d2bSKajetan Staszkiewicz 		goto done_pool_mtx;
4015f5e32f1SKristof Provost 	}
4023b3a8eb9SGleb Smirnoff 	if (rpool->cur->addr.type == PF_ADDR_DYNIFTL) {
4033b3a8eb9SGleb Smirnoff 		switch (af) {
4043b3a8eb9SGleb Smirnoff #ifdef INET
4053b3a8eb9SGleb Smirnoff 		case AF_INET:
4063b3a8eb9SGleb Smirnoff 			if (rpool->cur->addr.p.dyn->pfid_acnt4 < 1 &&
4073b3a8eb9SGleb Smirnoff 			    (rpool->opts & PF_POOL_TYPEMASK) !=
4085f5e32f1SKristof Provost 			    PF_POOL_ROUNDROBIN) {
40916303d2bSKajetan Staszkiewicz 				reason = PFRES_MAPFAILED;
41016303d2bSKajetan Staszkiewicz 				goto done_pool_mtx;
4115f5e32f1SKristof Provost 			}
4123b3a8eb9SGleb Smirnoff 			raddr = &rpool->cur->addr.p.dyn->pfid_addr4;
4133b3a8eb9SGleb Smirnoff 			rmask = &rpool->cur->addr.p.dyn->pfid_mask4;
4143b3a8eb9SGleb Smirnoff 			break;
4153b3a8eb9SGleb Smirnoff #endif /* INET */
4163b3a8eb9SGleb Smirnoff #ifdef INET6
4173b3a8eb9SGleb Smirnoff 		case AF_INET6:
4183b3a8eb9SGleb Smirnoff 			if (rpool->cur->addr.p.dyn->pfid_acnt6 < 1 &&
4193b3a8eb9SGleb Smirnoff 			    (rpool->opts & PF_POOL_TYPEMASK) !=
4205f5e32f1SKristof Provost 			    PF_POOL_ROUNDROBIN) {
42116303d2bSKajetan Staszkiewicz 				reason = PFRES_MAPFAILED;
42216303d2bSKajetan Staszkiewicz 				goto done_pool_mtx;
4235f5e32f1SKristof Provost 			}
4243b3a8eb9SGleb Smirnoff 			raddr = &rpool->cur->addr.p.dyn->pfid_addr6;
4253b3a8eb9SGleb Smirnoff 			rmask = &rpool->cur->addr.p.dyn->pfid_mask6;
4263b3a8eb9SGleb Smirnoff 			break;
4273b3a8eb9SGleb Smirnoff #endif /* INET6 */
4283b3a8eb9SGleb Smirnoff 		}
4293b3a8eb9SGleb Smirnoff 	} else if (rpool->cur->addr.type == PF_ADDR_TABLE) {
4305f5e32f1SKristof Provost 		if ((rpool->opts & PF_POOL_TYPEMASK) != PF_POOL_ROUNDROBIN) {
43116303d2bSKajetan Staszkiewicz 			reason = PFRES_MAPFAILED;
43216303d2bSKajetan Staszkiewicz 			goto done_pool_mtx; /* unsupported */
4335f5e32f1SKristof Provost 		}
4343b3a8eb9SGleb Smirnoff 	} else {
4353b3a8eb9SGleb Smirnoff 		raddr = &rpool->cur->addr.v.a.addr;
4363b3a8eb9SGleb Smirnoff 		rmask = &rpool->cur->addr.v.a.mask;
4373b3a8eb9SGleb Smirnoff 	}
4383b3a8eb9SGleb Smirnoff 
4393b3a8eb9SGleb Smirnoff 	switch (rpool->opts & PF_POOL_TYPEMASK) {
4403b3a8eb9SGleb Smirnoff 	case PF_POOL_NONE:
4413b3a8eb9SGleb Smirnoff 		PF_ACPY(naddr, raddr, af);
4423b3a8eb9SGleb Smirnoff 		break;
4433b3a8eb9SGleb Smirnoff 	case PF_POOL_BITMASK:
4443b3a8eb9SGleb Smirnoff 		PF_POOLMASK(naddr, raddr, rmask, saddr, af);
4453b3a8eb9SGleb Smirnoff 		break;
4463b3a8eb9SGleb Smirnoff 	case PF_POOL_RANDOM:
4473b3a8eb9SGleb Smirnoff 		if (init_addr != NULL && PF_AZERO(init_addr, af)) {
4483b3a8eb9SGleb Smirnoff 			switch (af) {
4493b3a8eb9SGleb Smirnoff #ifdef INET
4503b3a8eb9SGleb Smirnoff 			case AF_INET:
4513b3a8eb9SGleb Smirnoff 				rpool->counter.addr32[0] = htonl(arc4random());
4523b3a8eb9SGleb Smirnoff 				break;
4533b3a8eb9SGleb Smirnoff #endif /* INET */
4543b3a8eb9SGleb Smirnoff #ifdef INET6
4553b3a8eb9SGleb Smirnoff 			case AF_INET6:
4563b3a8eb9SGleb Smirnoff 				if (rmask->addr32[3] != 0xffffffff)
4573b3a8eb9SGleb Smirnoff 					rpool->counter.addr32[3] =
4583b3a8eb9SGleb Smirnoff 					    htonl(arc4random());
4593b3a8eb9SGleb Smirnoff 				else
4603b3a8eb9SGleb Smirnoff 					break;
4613b3a8eb9SGleb Smirnoff 				if (rmask->addr32[2] != 0xffffffff)
4623b3a8eb9SGleb Smirnoff 					rpool->counter.addr32[2] =
4633b3a8eb9SGleb Smirnoff 					    htonl(arc4random());
4643b3a8eb9SGleb Smirnoff 				else
4653b3a8eb9SGleb Smirnoff 					break;
4663b3a8eb9SGleb Smirnoff 				if (rmask->addr32[1] != 0xffffffff)
4673b3a8eb9SGleb Smirnoff 					rpool->counter.addr32[1] =
4683b3a8eb9SGleb Smirnoff 					    htonl(arc4random());
4693b3a8eb9SGleb Smirnoff 				else
4703b3a8eb9SGleb Smirnoff 					break;
4713b3a8eb9SGleb Smirnoff 				if (rmask->addr32[0] != 0xffffffff)
4723b3a8eb9SGleb Smirnoff 					rpool->counter.addr32[0] =
4733b3a8eb9SGleb Smirnoff 					    htonl(arc4random());
4743b3a8eb9SGleb Smirnoff 				break;
4753b3a8eb9SGleb Smirnoff #endif /* INET6 */
4763b3a8eb9SGleb Smirnoff 			}
4773b3a8eb9SGleb Smirnoff 			PF_POOLMASK(naddr, raddr, rmask, &rpool->counter, af);
4783b3a8eb9SGleb Smirnoff 			PF_ACPY(init_addr, naddr, af);
4793b3a8eb9SGleb Smirnoff 
4803b3a8eb9SGleb Smirnoff 		} else {
4813b3a8eb9SGleb Smirnoff 			PF_AINC(&rpool->counter, af);
4823b3a8eb9SGleb Smirnoff 			PF_POOLMASK(naddr, raddr, rmask, &rpool->counter, af);
4833b3a8eb9SGleb Smirnoff 		}
4843b3a8eb9SGleb Smirnoff 		break;
4853b3a8eb9SGleb Smirnoff 	case PF_POOL_SRCHASH:
4863b3a8eb9SGleb Smirnoff 	    {
4873b3a8eb9SGleb Smirnoff 		unsigned char hash[16];
4883b3a8eb9SGleb Smirnoff 
4893b3a8eb9SGleb Smirnoff 		pf_hash(saddr, (struct pf_addr *)&hash, &rpool->key, af);
4903b3a8eb9SGleb Smirnoff 		PF_POOLMASK(naddr, raddr, rmask, (struct pf_addr *)&hash, af);
4913b3a8eb9SGleb Smirnoff 		break;
4923b3a8eb9SGleb Smirnoff 	    }
4933b3a8eb9SGleb Smirnoff 	case PF_POOL_ROUNDROBIN:
4943b3a8eb9SGleb Smirnoff 	    {
495320c1116SKristof Provost 		struct pf_kpooladdr *acur = rpool->cur;
4963b3a8eb9SGleb Smirnoff 
4973b3a8eb9SGleb Smirnoff 		if (rpool->cur->addr.type == PF_ADDR_TABLE) {
4983b3a8eb9SGleb Smirnoff 			if (!pfr_pool_get(rpool->cur->addr.p.tbl,
4993b3a8eb9SGleb Smirnoff 			    &rpool->tblidx, &rpool->counter, af))
5003b3a8eb9SGleb Smirnoff 				goto get_addr;
5013b3a8eb9SGleb Smirnoff 		} else if (rpool->cur->addr.type == PF_ADDR_DYNIFTL) {
5023b3a8eb9SGleb Smirnoff 			if (!pfr_pool_get(rpool->cur->addr.p.dyn->pfid_kt,
5033b3a8eb9SGleb Smirnoff 			    &rpool->tblidx, &rpool->counter, af))
5043b3a8eb9SGleb Smirnoff 				goto get_addr;
5053b3a8eb9SGleb Smirnoff 		} else if (pf_match_addr(0, raddr, rmask, &rpool->counter, af))
5063b3a8eb9SGleb Smirnoff 			goto get_addr;
5073b3a8eb9SGleb Smirnoff 
5083b3a8eb9SGleb Smirnoff 	try_next:
5093b3a8eb9SGleb Smirnoff 		if (TAILQ_NEXT(rpool->cur, entries) == NULL)
5103b3a8eb9SGleb Smirnoff 			rpool->cur = TAILQ_FIRST(&rpool->list);
5113b3a8eb9SGleb Smirnoff 		else
5123b3a8eb9SGleb Smirnoff 			rpool->cur = TAILQ_NEXT(rpool->cur, entries);
5133b3a8eb9SGleb Smirnoff 		if (rpool->cur->addr.type == PF_ADDR_TABLE) {
5143b3a8eb9SGleb Smirnoff 			rpool->tblidx = -1;
5153b3a8eb9SGleb Smirnoff 			if (pfr_pool_get(rpool->cur->addr.p.tbl,
5163b3a8eb9SGleb Smirnoff 			    &rpool->tblidx, &rpool->counter, af)) {
5173b3a8eb9SGleb Smirnoff 				/* table contains no address of type 'af' */
5183b3a8eb9SGleb Smirnoff 				if (rpool->cur != acur)
5193b3a8eb9SGleb Smirnoff 					goto try_next;
52016303d2bSKajetan Staszkiewicz 				reason = PFRES_MAPFAILED;
52116303d2bSKajetan Staszkiewicz 				goto done_pool_mtx;
5223b3a8eb9SGleb Smirnoff 			}
5233b3a8eb9SGleb Smirnoff 		} else if (rpool->cur->addr.type == PF_ADDR_DYNIFTL) {
5243b3a8eb9SGleb Smirnoff 			rpool->tblidx = -1;
5253b3a8eb9SGleb Smirnoff 			if (pfr_pool_get(rpool->cur->addr.p.dyn->pfid_kt,
5263b3a8eb9SGleb Smirnoff 			    &rpool->tblidx, &rpool->counter, af)) {
5273b3a8eb9SGleb Smirnoff 				/* table contains no address of type 'af' */
5283b3a8eb9SGleb Smirnoff 				if (rpool->cur != acur)
5293b3a8eb9SGleb Smirnoff 					goto try_next;
53016303d2bSKajetan Staszkiewicz 				reason = PFRES_MAPFAILED;
53116303d2bSKajetan Staszkiewicz 				goto done_pool_mtx;
5323b3a8eb9SGleb Smirnoff 			}
5333b3a8eb9SGleb Smirnoff 		} else {
5343b3a8eb9SGleb Smirnoff 			raddr = &rpool->cur->addr.v.a.addr;
5353b3a8eb9SGleb Smirnoff 			rmask = &rpool->cur->addr.v.a.mask;
5363b3a8eb9SGleb Smirnoff 			PF_ACPY(&rpool->counter, raddr, af);
5373b3a8eb9SGleb Smirnoff 		}
5383b3a8eb9SGleb Smirnoff 
5393b3a8eb9SGleb Smirnoff 	get_addr:
5403b3a8eb9SGleb Smirnoff 		PF_ACPY(naddr, &rpool->counter, af);
5413b3a8eb9SGleb Smirnoff 		if (init_addr != NULL && PF_AZERO(init_addr, af))
5423b3a8eb9SGleb Smirnoff 			PF_ACPY(init_addr, naddr, af);
5433b3a8eb9SGleb Smirnoff 		PF_AINC(&rpool->counter, af);
5443b3a8eb9SGleb Smirnoff 		break;
5453b3a8eb9SGleb Smirnoff 	    }
5463b3a8eb9SGleb Smirnoff 	}
547*d10de21fSKajetan Staszkiewicz 
548*d10de21fSKajetan Staszkiewicz 	if (nkif)
549*d10de21fSKajetan Staszkiewicz 		*nkif = rpool->cur->kif;
550*d10de21fSKajetan Staszkiewicz 
551*d10de21fSKajetan Staszkiewicz 	if (*sn != NULL) {
5523b3a8eb9SGleb Smirnoff 		PF_ACPY(&(*sn)->raddr, naddr, af);
553*d10de21fSKajetan Staszkiewicz 		if (nkif)
554*d10de21fSKajetan Staszkiewicz 			(*sn)->rkif = *nkif;
555*d10de21fSKajetan Staszkiewicz 	}
5563b3a8eb9SGleb Smirnoff 
557498cca14SKristof Provost 	if (V_pf_status.debug >= PF_DEBUG_NOISY &&
5583b3a8eb9SGleb Smirnoff 	    (rpool->opts & PF_POOL_TYPEMASK) != PF_POOL_NONE) {
5593b3a8eb9SGleb Smirnoff 		printf("pf_map_addr: selected address ");
5603b3a8eb9SGleb Smirnoff 		pf_print_host(naddr, 0, af);
561*d10de21fSKajetan Staszkiewicz 		if (nkif)
562*d10de21fSKajetan Staszkiewicz 			printf("@%s", (*nkif)->pfik_name);
5633b3a8eb9SGleb Smirnoff 		printf("\n");
5643b3a8eb9SGleb Smirnoff 	}
5653b3a8eb9SGleb Smirnoff 
56616303d2bSKajetan Staszkiewicz done_pool_mtx:
56716303d2bSKajetan Staszkiewicz 	mtx_unlock(&rpool->mtx);
56816303d2bSKajetan Staszkiewicz 
56916303d2bSKajetan Staszkiewicz done:
57016303d2bSKajetan Staszkiewicz 	if (reason) {
57116303d2bSKajetan Staszkiewicz 		counter_u64_add(V_pf_status.counters[reason], 1);
57216303d2bSKajetan Staszkiewicz 	}
57316303d2bSKajetan Staszkiewicz 
57416303d2bSKajetan Staszkiewicz 	return (reason);
5753b3a8eb9SGleb Smirnoff }
5763b3a8eb9SGleb Smirnoff 
577e86bddeaSKristof Provost struct pf_krule *
578f2064dd1SKajetan Staszkiewicz pf_get_translation(struct pf_pdesc *pd, struct mbuf *m, int off,
579320c1116SKristof Provost     struct pfi_kkif *kif, struct pf_ksrc_node **sn,
5803b3a8eb9SGleb Smirnoff     struct pf_state_key **skp, struct pf_state_key **nkp,
5813b3a8eb9SGleb Smirnoff     struct pf_addr *saddr, struct pf_addr *daddr,
582e86bddeaSKristof Provost     uint16_t sport, uint16_t dport, struct pf_kanchor_stackframe *anchor_stack)
5833b3a8eb9SGleb Smirnoff {
584e86bddeaSKristof Provost 	struct pf_krule	*r = NULL;
5853b3a8eb9SGleb Smirnoff 	struct pf_addr	*naddr;
5863b3a8eb9SGleb Smirnoff 	uint16_t	*nport;
5872aa21096SKurosawa Takahiro 	uint16_t	 low, high;
5883b3a8eb9SGleb Smirnoff 
5893b3a8eb9SGleb Smirnoff 	PF_RULES_RASSERT();
5903b3a8eb9SGleb Smirnoff 	KASSERT(*skp == NULL, ("*skp not NULL"));
5913b3a8eb9SGleb Smirnoff 	KASSERT(*nkp == NULL, ("*nkp not NULL"));
5923b3a8eb9SGleb Smirnoff 
593f2064dd1SKajetan Staszkiewicz 	if (pd->dir == PF_OUT) {
594f2064dd1SKajetan Staszkiewicz 		r = pf_match_translation(pd, m, off, kif, saddr,
5951d6139c0SGleb Smirnoff 		    sport, daddr, dport, PF_RULESET_BINAT, anchor_stack);
5963b3a8eb9SGleb Smirnoff 		if (r == NULL)
597f2064dd1SKajetan Staszkiewicz 			r = pf_match_translation(pd, m, off, kif,
5981d6139c0SGleb Smirnoff 			    saddr, sport, daddr, dport, PF_RULESET_NAT,
5991d6139c0SGleb Smirnoff 			    anchor_stack);
6003b3a8eb9SGleb Smirnoff 	} else {
601f2064dd1SKajetan Staszkiewicz 		r = pf_match_translation(pd, m, off, kif, saddr,
6021d6139c0SGleb Smirnoff 		    sport, daddr, dport, PF_RULESET_RDR, anchor_stack);
6033b3a8eb9SGleb Smirnoff 		if (r == NULL)
604f2064dd1SKajetan Staszkiewicz 			r = pf_match_translation(pd, m, off, kif,
6051d6139c0SGleb Smirnoff 			    saddr, sport, daddr, dport, PF_RULESET_BINAT,
6061d6139c0SGleb Smirnoff 			    anchor_stack);
6073b3a8eb9SGleb Smirnoff 	}
6083b3a8eb9SGleb Smirnoff 
6093b3a8eb9SGleb Smirnoff 	if (r == NULL)
6103b3a8eb9SGleb Smirnoff 		return (NULL);
6113b3a8eb9SGleb Smirnoff 
6123b3a8eb9SGleb Smirnoff 	switch (r->action) {
6133b3a8eb9SGleb Smirnoff 	case PF_NONAT:
6143b3a8eb9SGleb Smirnoff 	case PF_NOBINAT:
6153b3a8eb9SGleb Smirnoff 	case PF_NORDR:
6163b3a8eb9SGleb Smirnoff 		return (NULL);
6173b3a8eb9SGleb Smirnoff 	}
6183b3a8eb9SGleb Smirnoff 
6193b3a8eb9SGleb Smirnoff 	*skp = pf_state_key_setup(pd, saddr, daddr, sport, dport);
6203b3a8eb9SGleb Smirnoff 	if (*skp == NULL)
6213b3a8eb9SGleb Smirnoff 		return (NULL);
6223b3a8eb9SGleb Smirnoff 	*nkp = pf_state_key_clone(*skp);
6233b3a8eb9SGleb Smirnoff 	if (*nkp == NULL) {
62498a9874fSKristof Provost 		uma_zfree(V_pf_state_key_z, *skp);
6253b3a8eb9SGleb Smirnoff 		*skp = NULL;
6263b3a8eb9SGleb Smirnoff 		return (NULL);
6273b3a8eb9SGleb Smirnoff 	}
6283b3a8eb9SGleb Smirnoff 
6293b3a8eb9SGleb Smirnoff 	/* XXX We only modify one side for now. */
6303b3a8eb9SGleb Smirnoff 	naddr = &(*nkp)->addr[1];
6313b3a8eb9SGleb Smirnoff 	nport = &(*nkp)->port[1];
6323b3a8eb9SGleb Smirnoff 
6333b3a8eb9SGleb Smirnoff 	switch (r->action) {
6343b3a8eb9SGleb Smirnoff 	case PF_NAT:
6352aa21096SKurosawa Takahiro 		if (pd->proto == IPPROTO_ICMP) {
6362aa21096SKurosawa Takahiro 			low  = 1;
6372aa21096SKurosawa Takahiro 			high = 65535;
6382aa21096SKurosawa Takahiro 		} else {
6392aa21096SKurosawa Takahiro 			low  = r->rpool.proxy_port[0];
6402aa21096SKurosawa Takahiro 			high = r->rpool.proxy_port[1];
6412aa21096SKurosawa Takahiro 		}
6422aa21096SKurosawa Takahiro 		if (r->rpool.mape.offset > 0) {
6432aa21096SKurosawa Takahiro 			if (pf_get_mape_sport(pd->af, pd->proto, r, saddr,
6442aa21096SKurosawa Takahiro 			    sport, daddr, dport, naddr, nport, sn)) {
6452aa21096SKurosawa Takahiro 				DPFPRINTF(PF_DEBUG_MISC,
6462aa21096SKurosawa Takahiro 				    ("pf: MAP-E port allocation (%u/%u/%u)"
6472aa21096SKurosawa Takahiro 				    " failed\n",
6482aa21096SKurosawa Takahiro 				    r->rpool.mape.offset,
6492aa21096SKurosawa Takahiro 				    r->rpool.mape.psidlen,
6502aa21096SKurosawa Takahiro 				    r->rpool.mape.psid));
6512aa21096SKurosawa Takahiro 				goto notrans;
6522aa21096SKurosawa Takahiro 			}
6532aa21096SKurosawa Takahiro 		} else if (pf_get_sport(pd->af, pd->proto, r, saddr, sport,
6542aa21096SKurosawa Takahiro 		    daddr, dport, naddr, nport, low, high, sn)) {
6553b3a8eb9SGleb Smirnoff 			DPFPRINTF(PF_DEBUG_MISC,
6563b3a8eb9SGleb Smirnoff 			    ("pf: NAT proxy port allocation (%u-%u) failed\n",
6573b3a8eb9SGleb Smirnoff 			    r->rpool.proxy_port[0], r->rpool.proxy_port[1]));
6583b3a8eb9SGleb Smirnoff 			goto notrans;
6593b3a8eb9SGleb Smirnoff 		}
6603b3a8eb9SGleb Smirnoff 		break;
6613b3a8eb9SGleb Smirnoff 	case PF_BINAT:
662f2064dd1SKajetan Staszkiewicz 		switch (pd->dir) {
6633b3a8eb9SGleb Smirnoff 		case PF_OUT:
6643b3a8eb9SGleb Smirnoff 			if (r->rpool.cur->addr.type == PF_ADDR_DYNIFTL){
6653b3a8eb9SGleb Smirnoff 				switch (pd->af) {
6663b3a8eb9SGleb Smirnoff #ifdef INET
6673b3a8eb9SGleb Smirnoff 				case AF_INET:
6683b3a8eb9SGleb Smirnoff 					if (r->rpool.cur->addr.p.dyn->
6693b3a8eb9SGleb Smirnoff 					    pfid_acnt4 < 1)
6703b3a8eb9SGleb Smirnoff 						goto notrans;
6713b3a8eb9SGleb Smirnoff 					PF_POOLMASK(naddr,
6723b3a8eb9SGleb Smirnoff 					    &r->rpool.cur->addr.p.dyn->
6733b3a8eb9SGleb Smirnoff 					    pfid_addr4,
6743b3a8eb9SGleb Smirnoff 					    &r->rpool.cur->addr.p.dyn->
6753b3a8eb9SGleb Smirnoff 					    pfid_mask4, saddr, AF_INET);
6763b3a8eb9SGleb Smirnoff 					break;
6773b3a8eb9SGleb Smirnoff #endif /* INET */
6783b3a8eb9SGleb Smirnoff #ifdef INET6
6793b3a8eb9SGleb Smirnoff 				case AF_INET6:
6803b3a8eb9SGleb Smirnoff 					if (r->rpool.cur->addr.p.dyn->
6813b3a8eb9SGleb Smirnoff 					    pfid_acnt6 < 1)
6823b3a8eb9SGleb Smirnoff 						goto notrans;
6833b3a8eb9SGleb Smirnoff 					PF_POOLMASK(naddr,
6843b3a8eb9SGleb Smirnoff 					    &r->rpool.cur->addr.p.dyn->
6853b3a8eb9SGleb Smirnoff 					    pfid_addr6,
6863b3a8eb9SGleb Smirnoff 					    &r->rpool.cur->addr.p.dyn->
6873b3a8eb9SGleb Smirnoff 					    pfid_mask6, saddr, AF_INET6);
6883b3a8eb9SGleb Smirnoff 					break;
6893b3a8eb9SGleb Smirnoff #endif /* INET6 */
6903b3a8eb9SGleb Smirnoff 				}
6913b3a8eb9SGleb Smirnoff 			} else
6923b3a8eb9SGleb Smirnoff 				PF_POOLMASK(naddr,
6933b3a8eb9SGleb Smirnoff 				    &r->rpool.cur->addr.v.a.addr,
6943b3a8eb9SGleb Smirnoff 				    &r->rpool.cur->addr.v.a.mask, saddr,
6953b3a8eb9SGleb Smirnoff 				    pd->af);
6963b3a8eb9SGleb Smirnoff 			break;
6973b3a8eb9SGleb Smirnoff 		case PF_IN:
6983b3a8eb9SGleb Smirnoff 			if (r->src.addr.type == PF_ADDR_DYNIFTL) {
6993b3a8eb9SGleb Smirnoff 				switch (pd->af) {
7003b3a8eb9SGleb Smirnoff #ifdef INET
7013b3a8eb9SGleb Smirnoff 				case AF_INET:
7023b3a8eb9SGleb Smirnoff 					if (r->src.addr.p.dyn-> pfid_acnt4 < 1)
7033b3a8eb9SGleb Smirnoff 						goto notrans;
7043b3a8eb9SGleb Smirnoff 					PF_POOLMASK(naddr,
7053b3a8eb9SGleb Smirnoff 					    &r->src.addr.p.dyn->pfid_addr4,
7063b3a8eb9SGleb Smirnoff 					    &r->src.addr.p.dyn->pfid_mask4,
7073b3a8eb9SGleb Smirnoff 					    daddr, AF_INET);
7083b3a8eb9SGleb Smirnoff 					break;
7093b3a8eb9SGleb Smirnoff #endif /* INET */
7103b3a8eb9SGleb Smirnoff #ifdef INET6
7113b3a8eb9SGleb Smirnoff 				case AF_INET6:
7123b3a8eb9SGleb Smirnoff 					if (r->src.addr.p.dyn->pfid_acnt6 < 1)
7133b3a8eb9SGleb Smirnoff 						goto notrans;
7143b3a8eb9SGleb Smirnoff 					PF_POOLMASK(naddr,
7153b3a8eb9SGleb Smirnoff 					    &r->src.addr.p.dyn->pfid_addr6,
7163b3a8eb9SGleb Smirnoff 					    &r->src.addr.p.dyn->pfid_mask6,
7173b3a8eb9SGleb Smirnoff 					    daddr, AF_INET6);
7183b3a8eb9SGleb Smirnoff 					break;
7193b3a8eb9SGleb Smirnoff #endif /* INET6 */
7203b3a8eb9SGleb Smirnoff 				}
7213b3a8eb9SGleb Smirnoff 			} else
7223b3a8eb9SGleb Smirnoff 				PF_POOLMASK(naddr, &r->src.addr.v.a.addr,
7233b3a8eb9SGleb Smirnoff 				    &r->src.addr.v.a.mask, daddr, pd->af);
7243b3a8eb9SGleb Smirnoff 			break;
7253b3a8eb9SGleb Smirnoff 		}
7263b3a8eb9SGleb Smirnoff 		break;
7273b3a8eb9SGleb Smirnoff 	case PF_RDR: {
728*d10de21fSKajetan Staszkiewicz 		if (pf_map_addr(pd->af, r, saddr, naddr, NULL, NULL, sn))
7293b3a8eb9SGleb Smirnoff 			goto notrans;
7303b3a8eb9SGleb Smirnoff 		if ((r->rpool.opts & PF_POOL_TYPEMASK) == PF_POOL_BITMASK)
7313b3a8eb9SGleb Smirnoff 			PF_POOLMASK(naddr, naddr, &r->rpool.cur->addr.v.a.mask,
7323b3a8eb9SGleb Smirnoff 			    daddr, pd->af);
7333b3a8eb9SGleb Smirnoff 
7346053adafSKristof Provost 		/* Do not change SCTP ports. */
7356053adafSKristof Provost 		if (pd->proto == IPPROTO_SCTP)
7366053adafSKristof Provost 			break;
7376053adafSKristof Provost 
7383b3a8eb9SGleb Smirnoff 		if (r->rpool.proxy_port[1]) {
7393b3a8eb9SGleb Smirnoff 			uint32_t	tmp_nport;
7403b3a8eb9SGleb Smirnoff 
7413b3a8eb9SGleb Smirnoff 			tmp_nport = ((ntohs(dport) - ntohs(r->dst.port[0])) %
7423b3a8eb9SGleb Smirnoff 			    (r->rpool.proxy_port[1] - r->rpool.proxy_port[0] +
7433b3a8eb9SGleb Smirnoff 			    1)) + r->rpool.proxy_port[0];
7443b3a8eb9SGleb Smirnoff 
7453b3a8eb9SGleb Smirnoff 			/* Wrap around if necessary. */
7463b3a8eb9SGleb Smirnoff 			if (tmp_nport > 65535)
7473b3a8eb9SGleb Smirnoff 				tmp_nport -= 65535;
7483b3a8eb9SGleb Smirnoff 			*nport = htons((uint16_t)tmp_nport);
7493b3a8eb9SGleb Smirnoff 		} else if (r->rpool.proxy_port[0])
7503b3a8eb9SGleb Smirnoff 			*nport = htons(r->rpool.proxy_port[0]);
7513b3a8eb9SGleb Smirnoff 		break;
7523b3a8eb9SGleb Smirnoff 	}
7533b3a8eb9SGleb Smirnoff 	default:
7543b3a8eb9SGleb Smirnoff 		panic("%s: unknown action %u", __func__, r->action);
7553b3a8eb9SGleb Smirnoff 	}
7563b3a8eb9SGleb Smirnoff 
7573b3a8eb9SGleb Smirnoff 	/* Return success only if translation really happened. */
7583b3a8eb9SGleb Smirnoff 	if (bcmp(*skp, *nkp, sizeof(struct pf_state_key_cmp)))
7593b3a8eb9SGleb Smirnoff 		return (r);
7603b3a8eb9SGleb Smirnoff 
7613b3a8eb9SGleb Smirnoff notrans:
7623b3a8eb9SGleb Smirnoff 	uma_zfree(V_pf_state_key_z, *nkp);
7633b3a8eb9SGleb Smirnoff 	uma_zfree(V_pf_state_key_z, *skp);
7643b3a8eb9SGleb Smirnoff 	*skp = *nkp = NULL;
765a830c452SGleb Smirnoff 	*sn = NULL;
7663b3a8eb9SGleb Smirnoff 
7673b3a8eb9SGleb Smirnoff 	return (NULL);
7683b3a8eb9SGleb Smirnoff }
769