2 * Copyright (c) 2015-2016 Yandex LLC
3 * Copyright (c) 2015-2016 Andrey V. Elsukov <ae@FreeBSD.org>
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD$");
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/counter.h>
34 #include <sys/kernel.h>
37 #include <sys/module.h>
38 #include <sys/rmlock.h>
39 #include <sys/rwlock.h>
40 #include <sys/socket.h>
41 #include <sys/sysctl.h>
44 #include <net/if_var.h>
45 #include <net/if_pflog.h>
48 #include <netinet/in.h>
49 #include <netinet/ip.h>
50 #include <netinet/ip_icmp.h>
51 #include <netinet/ip_var.h>
52 #include <netinet/ip_fw.h>
53 #include <netinet/ip6.h>
54 #include <netinet/icmp6.h>
55 #include <netinet6/ip_fw_nat64.h>
57 #include <netpfil/ipfw/ip_fw_private.h>
58 #include <netpfil/ipfw/nat64/ip_fw_nat64.h>
59 #include <netpfil/ipfw/nat64/nat64_translate.h>
60 #include <netpfil/ipfw/nat64/nat64stl.h>
61 #include <netpfil/pf/pf.h>
63 #define NAT64_LOOKUP(chain, cmd) \
64 (struct nat64stl_cfg *)SRV_OBJECT((chain), (cmd)->arg1)
67 nat64stl_log(struct pfloghdr *plog, struct mbuf *m, sa_family_t family,
70 static uint32_t pktid = 0;
72 memset(plog, 0, sizeof(*plog));
73 plog->length = PFLOG_REAL_HDRLEN;
75 plog->action = PF_NAT;
77 plog->rulenr = htonl(kidx);
79 plog->subrulenr = htonl(pktid);
80 plog->ruleset[0] = '\0';
81 strlcpy(plog->ifname, "NAT64STL", sizeof(plog->ifname));
82 ipfw_bpf_mtap2(plog, PFLOG_HDRLEN, m);
86 nat64stl_handle_ip4(struct ip_fw_chain *chain, struct nat64stl_cfg *cfg,
87 struct mbuf *m, uint32_t tablearg)
89 struct pfloghdr loghdr, *logdata;
90 struct in6_addr saddr, daddr;
93 ip = mtod(m, struct ip*);
94 if (nat64_check_ip4(ip->ip_src.s_addr) != 0 ||
95 nat64_check_ip4(ip->ip_dst.s_addr) != 0 ||
96 nat64_check_private_ip4(ip->ip_src.s_addr) != 0 ||
97 nat64_check_private_ip4(ip->ip_dst.s_addr) != 0)
100 daddr = TARG_VAL(chain, tablearg, nh6);
101 if (nat64_check_ip6(&daddr) != 0)
103 saddr = cfg->prefix6;
104 nat64_set_ip4(&saddr, ip->ip_src.s_addr);
106 if (cfg->flags & NAT64_LOG) {
108 nat64stl_log(logdata, m, AF_INET, cfg->no.kidx);
111 return (nat64_do_handle_ip4(m, &saddr, &daddr, 0, &cfg->stats,
116 nat64stl_handle_ip6(struct ip_fw_chain *chain, struct nat64stl_cfg *cfg,
117 struct mbuf *m, uint32_t tablearg)
119 struct pfloghdr loghdr, *logdata;
123 aaddr = htonl(TARG_VAL(chain, tablearg, nh4));
126 * NOTE: we expect ipfw_chk() did m_pullup() up to upper level
127 * protocol's headers. Also we skip some checks, that ip6_input(),
128 * ip6_forward(), ip6_fastfwd() and ipfw_chk() already did.
130 ip6 = mtod(m, struct ip6_hdr *);
131 /* Check ip6_dst matches configured prefix */
132 if (bcmp(&ip6->ip6_dst, &cfg->prefix6, cfg->plen6 / 8) != 0)
135 if (cfg->flags & NAT64_LOG) {
137 nat64stl_log(logdata, m, AF_INET6, cfg->no.kidx);
140 return (nat64_do_handle_ip6(m, aaddr, 0, &cfg->stats, logdata));
144 nat64stl_handle_icmp6(struct ip_fw_chain *chain, struct nat64stl_cfg *cfg,
147 struct pfloghdr loghdr, *logdata;
148 nat64_stats_block *stats;
149 struct ip6_hdr *ip6i;
150 struct icmp6_hdr *icmp6;
156 proto = nat64_getlasthdr(m, &hlen);
157 if (proto != IPPROTO_ICMPV6) {
158 NAT64STAT_INC(stats, dropped);
161 icmp6 = mtodo(m, hlen);
162 switch (icmp6->icmp6_type) {
163 case ICMP6_DST_UNREACH:
164 case ICMP6_PACKET_TOO_BIG:
165 case ICMP6_TIME_EXCEED_TRANSIT:
166 case ICMP6_PARAM_PROB:
169 NAT64STAT_INC(stats, dropped);
172 hlen += sizeof(struct icmp6_hdr);
173 if (m->m_pkthdr.len < hlen + sizeof(struct ip6_hdr) + ICMP_MINLEN) {
174 NAT64STAT_INC(stats, dropped);
177 if (m->m_len < hlen + sizeof(struct ip6_hdr) + ICMP_MINLEN)
178 m = m_pullup(m, hlen + sizeof(struct ip6_hdr) + ICMP_MINLEN);
180 NAT64STAT_INC(stats, nomem);
181 return (NAT64RETURN);
184 * Use destination address from inner IPv6 header to determine
185 * IPv4 mapped address.
187 ip6i = mtodo(m, hlen);
188 if (ipfw_lookup_table(chain, cfg->map64,
189 sizeof(struct in6_addr), &ip6i->ip6_dst, &tablearg) == 0) {
191 return (NAT64RETURN);
193 if (cfg->flags & NAT64_LOG) {
195 nat64stl_log(logdata, m, AF_INET6, cfg->no.kidx);
198 return (nat64_handle_icmp6(m, 0,
199 htonl(TARG_VAL(chain, tablearg, nh4)), 0, stats, logdata));
203 ipfw_nat64stl(struct ip_fw_chain *chain, struct ip_fw_args *args,
204 ipfw_insn *cmd, int *done)
207 struct nat64stl_cfg *cfg;
212 IPFW_RLOCK_ASSERT(chain);
214 *done = 0; /* try next rule if not matched */
216 if (cmd->opcode != O_EXTERNAL_ACTION ||
217 cmd->arg1 != V_nat64stl_eid ||
218 icmd->opcode != O_EXTERNAL_INSTANCE ||
219 (cfg = NAT64_LOOKUP(chain, icmd)) == NULL)
222 switch (args->f_id.addr_type) {
224 dst4 = htonl(args->f_id.dst_ip);
225 ret = ipfw_lookup_table(chain, cfg->map46, sizeof(in_addr_t),
229 ret = ipfw_lookup_table(chain, cfg->map64,
230 sizeof(struct in6_addr), &args->f_id.src_ip6, &tablearg);
237 * In case when packet is ICMPv6 message from an intermediate
238 * router, the source address of message will not match the
239 * addresses from our map64 table.
241 if (args->f_id.proto != IPPROTO_ICMPV6)
244 ret = nat64stl_handle_icmp6(chain, cfg, args->m);
246 if (args->f_id.addr_type == 4)
247 ret = nat64stl_handle_ip4(chain, cfg, args->m,
250 ret = nat64stl_handle_ip6(chain, cfg, args->m,
253 if (ret == NAT64SKIP)
256 *done = 1; /* terminate the search */
257 if (ret == NAT64MFREE)