2 * Copyright (c) 2015 Yandex LLC
3 * Copyright (c) 2015 Alexander V. Chernikov <melifaro@FreeBSD.org>
4 * Copyright (c) 2016 Andrey V. Elsukov <ae@FreeBSD.org>
7 * Redistribution and use in source and binary forms, with or without
8 * 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.
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
32 #include <sys/param.h>
33 #include <sys/systm.h>
34 #include <sys/counter.h>
35 #include <sys/errno.h>
36 #include <sys/kernel.h>
38 #include <sys/malloc.h>
40 #include <sys/module.h>
41 #include <sys/rmlock.h>
42 #include <sys/rwlock.h>
43 #include <sys/socket.h>
44 #include <sys/sockopt.h>
45 #include <sys/queue.h>
50 #include <netinet/in.h>
51 #include <netinet/ip.h>
52 #include <netinet/ip_var.h>
53 #include <netinet/ip_fw.h>
55 #include <netpfil/ipfw/ip_fw_private.h>
56 #include <netpfil/ipfw/nat64/ip_fw_nat64.h>
57 #include <netpfil/ipfw/nat64/nat64lsn.h>
58 #include <netinet6/ip_fw_nat64.h>
60 VNET_DEFINE(uint16_t, nat64lsn_eid) = 0;
62 static struct nat64lsn_cfg *
63 nat64lsn_find(struct namedobj_instance *ni, const char *name, uint8_t set)
65 struct nat64lsn_cfg *cfg;
67 cfg = (struct nat64lsn_cfg *)ipfw_objhash_lookup_name_type(ni, set,
68 IPFW_TLV_NAT64LSN_NAME, name);
74 nat64lsn_default_config(ipfw_nat64lsn_cfg *uc)
77 if (uc->max_ports == 0)
78 uc->max_ports = NAT64LSN_MAX_PORTS;
80 uc->max_ports = roundup(uc->max_ports, NAT64_CHUNK_SIZE);
81 if (uc->max_ports > NAT64_CHUNK_SIZE * NAT64LSN_MAXPGPTR)
82 uc->max_ports = NAT64_CHUNK_SIZE * NAT64LSN_MAXPGPTR;
84 uc->jmaxlen = NAT64LSN_JMAXLEN;
85 if (uc->jmaxlen > 65536)
87 if (uc->nh_delete_delay == 0)
88 uc->nh_delete_delay = NAT64LSN_HOST_AGE;
89 if (uc->pg_delete_delay == 0)
90 uc->pg_delete_delay = NAT64LSN_PG_AGE;
91 if (uc->st_syn_ttl == 0)
92 uc->st_syn_ttl = NAT64LSN_TCP_SYN_AGE;
93 if (uc->st_close_ttl == 0)
94 uc->st_close_ttl = NAT64LSN_TCP_FIN_AGE;
95 if (uc->st_estab_ttl == 0)
96 uc->st_estab_ttl = NAT64LSN_TCP_EST_AGE;
97 if (uc->st_udp_ttl == 0)
98 uc->st_udp_ttl = NAT64LSN_UDP_AGE;
99 if (uc->st_icmp_ttl == 0)
100 uc->st_icmp_ttl = NAT64LSN_ICMP_AGE;
104 * Creates new nat64lsn instance.
105 * Data layout (v0)(current):
106 * Request: [ ipfw_obj_lheader ipfw_nat64lsn_cfg ]
108 * Returns 0 on success
111 nat64lsn_create(struct ip_fw_chain *ch, ip_fw3_opheader *op3,
112 struct sockopt_data *sd)
114 ipfw_obj_lheader *olh;
115 ipfw_nat64lsn_cfg *uc;
116 struct nat64lsn_cfg *cfg;
117 struct namedobj_instance *ni;
118 uint32_t addr4, mask4;
120 if (sd->valsize != sizeof(*olh) + sizeof(*uc))
123 olh = (ipfw_obj_lheader *)sd->kbuf;
124 uc = (ipfw_nat64lsn_cfg *)(olh + 1);
126 if (ipfw_check_object_name_generic(uc->name) != 0)
129 if (uc->agg_prefix_len > 127 || uc->set >= IPFW_MAX_SETS)
134 if (uc->plen6 > 128 || ((uc->plen6 % 8) != 0))
137 /* XXX: Check prefix4 to be global */
138 addr4 = ntohl(uc->prefix4.s_addr);
139 mask4 = ~((1 << (32 - uc->plen4)) - 1);
140 if ((addr4 & mask4) != addr4)
143 /* XXX: Check prefix6 */
144 if (uc->min_port == 0)
145 uc->min_port = NAT64_MIN_PORT;
146 if (uc->max_port == 0)
147 uc->max_port = 65535;
148 if (uc->min_port > uc->max_port)
150 uc->min_port = roundup(uc->min_port, NAT64_CHUNK_SIZE);
151 uc->max_port = roundup(uc->max_port, NAT64_CHUNK_SIZE);
153 nat64lsn_default_config(uc);
155 ni = CHAIN_TO_SRV(ch);
157 if (nat64lsn_find(ni, uc->name, uc->set) != NULL) {
163 cfg = nat64lsn_init_instance(ch, 1 << (32 - uc->plen4));
164 strlcpy(cfg->name, uc->name, sizeof(cfg->name));
165 cfg->no.name = cfg->name;
166 cfg->no.etlv = IPFW_TLV_NAT64LSN_NAME;
167 cfg->no.set = uc->set;
169 cfg->prefix4 = addr4;
170 cfg->pmask4 = addr4 | ~mask4;
171 /* XXX: Copy 96 bits */
173 memcpy(&cfg->prefix6, &uc->prefix6, cfg->plen6 / 8);
174 cfg->plen4 = uc->plen4;
175 cfg->flags = uc->flags & NAT64LSN_FLAGSMASK;
176 cfg->max_chunks = uc->max_ports / NAT64_CHUNK_SIZE;
177 cfg->agg_prefix_len = uc->agg_prefix_len;
178 cfg->agg_prefix_max = uc->agg_prefix_max;
180 cfg->min_chunk = uc->min_port / NAT64_CHUNK_SIZE;
181 cfg->max_chunk = uc->max_port / NAT64_CHUNK_SIZE;
183 cfg->jmaxlen = uc->jmaxlen;
184 cfg->nh_delete_delay = uc->nh_delete_delay;
185 cfg->pg_delete_delay = uc->pg_delete_delay;
186 cfg->st_syn_ttl = uc->st_syn_ttl;
187 cfg->st_close_ttl = uc->st_close_ttl;
188 cfg->st_estab_ttl = uc->st_estab_ttl;
189 cfg->st_udp_ttl = uc->st_udp_ttl;
190 cfg->st_icmp_ttl = uc->st_icmp_ttl;
192 cfg->nomatch_verdict = IP_FW_DENY;
193 cfg->nomatch_final = 1; /* Exit outer loop by default */
197 if (nat64lsn_find(ni, uc->name, uc->set) != NULL) {
199 nat64lsn_destroy_instance(cfg);
203 if (ipfw_objhash_alloc_idx(CHAIN_TO_SRV(ch), &cfg->no.kidx) != 0) {
205 nat64lsn_destroy_instance(cfg);
208 ipfw_objhash_add(CHAIN_TO_SRV(ch), &cfg->no);
210 /* Okay, let's link data */
212 SRV_OBJECT(ch, cfg->no.kidx) = cfg;
215 nat64lsn_start_instance(cfg);
222 nat64lsn_detach_config(struct ip_fw_chain *ch, struct nat64lsn_cfg *cfg)
225 IPFW_UH_WLOCK_ASSERT(ch);
227 ipfw_objhash_del(CHAIN_TO_SRV(ch), &cfg->no);
228 ipfw_objhash_free_idx(CHAIN_TO_SRV(ch), cfg->no.kidx);
232 * Destroys nat64 instance.
233 * Data layout (v0)(current):
234 * Request: [ ipfw_obj_header ]
236 * Returns 0 on success
239 nat64lsn_destroy(struct ip_fw_chain *ch, ip_fw3_opheader *op3,
240 struct sockopt_data *sd)
242 struct nat64lsn_cfg *cfg;
245 if (sd->valsize != sizeof(*oh))
248 oh = (ipfw_obj_header *)op3;
251 cfg = nat64lsn_find(CHAIN_TO_SRV(ch), oh->ntlv.name, oh->ntlv.set);
257 if (cfg->no.refcnt > 0) {
263 SRV_OBJECT(ch, cfg->no.kidx) = NULL;
266 nat64lsn_detach_config(ch, cfg);
269 nat64lsn_destroy_instance(cfg);
273 #define __COPY_STAT_FIELD(_cfg, _stats, _field) \
274 (_stats)->_field = NAT64STAT_FETCH(&(_cfg)->stats, _field)
276 export_stats(struct ip_fw_chain *ch, struct nat64lsn_cfg *cfg,
277 struct ipfw_nat64lsn_stats *stats)
280 __COPY_STAT_FIELD(cfg, stats, opcnt64);
281 __COPY_STAT_FIELD(cfg, stats, opcnt46);
282 __COPY_STAT_FIELD(cfg, stats, ofrags);
283 __COPY_STAT_FIELD(cfg, stats, ifrags);
284 __COPY_STAT_FIELD(cfg, stats, oerrors);
285 __COPY_STAT_FIELD(cfg, stats, noroute4);
286 __COPY_STAT_FIELD(cfg, stats, noroute6);
287 __COPY_STAT_FIELD(cfg, stats, nomatch4);
288 __COPY_STAT_FIELD(cfg, stats, noproto);
289 __COPY_STAT_FIELD(cfg, stats, nomem);
290 __COPY_STAT_FIELD(cfg, stats, dropped);
292 __COPY_STAT_FIELD(cfg, stats, jcalls);
293 __COPY_STAT_FIELD(cfg, stats, jrequests);
294 __COPY_STAT_FIELD(cfg, stats, jhostsreq);
295 __COPY_STAT_FIELD(cfg, stats, jportreq);
296 __COPY_STAT_FIELD(cfg, stats, jhostfails);
297 __COPY_STAT_FIELD(cfg, stats, jportfails);
298 __COPY_STAT_FIELD(cfg, stats, jmaxlen);
299 __COPY_STAT_FIELD(cfg, stats, jnomem);
300 __COPY_STAT_FIELD(cfg, stats, jreinjected);
301 __COPY_STAT_FIELD(cfg, stats, screated);
302 __COPY_STAT_FIELD(cfg, stats, sdeleted);
303 __COPY_STAT_FIELD(cfg, stats, spgcreated);
304 __COPY_STAT_FIELD(cfg, stats, spgdeleted);
306 stats->hostcount = cfg->ihcount;
307 stats->tcpchunks = cfg->protochunks[NAT_PROTO_TCP];
308 stats->udpchunks = cfg->protochunks[NAT_PROTO_UDP];
309 stats->icmpchunks = cfg->protochunks[NAT_PROTO_ICMP];
311 #undef __COPY_STAT_FIELD
314 nat64lsn_export_config(struct ip_fw_chain *ch, struct nat64lsn_cfg *cfg,
315 ipfw_nat64lsn_cfg *uc)
318 uc->flags = cfg->flags & NAT64LSN_FLAGSMASK;
319 uc->max_ports = cfg->max_chunks * NAT64_CHUNK_SIZE;
320 uc->agg_prefix_len = cfg->agg_prefix_len;
321 uc->agg_prefix_max = cfg->agg_prefix_max;
323 uc->jmaxlen = cfg->jmaxlen;
324 uc->nh_delete_delay = cfg->nh_delete_delay;
325 uc->pg_delete_delay = cfg->pg_delete_delay;
326 uc->st_syn_ttl = cfg->st_syn_ttl;
327 uc->st_close_ttl = cfg->st_close_ttl;
328 uc->st_estab_ttl = cfg->st_estab_ttl;
329 uc->st_udp_ttl = cfg->st_udp_ttl;
330 uc->st_icmp_ttl = cfg->st_icmp_ttl;
331 uc->prefix4.s_addr = htonl(cfg->prefix4);
332 uc->prefix6 = cfg->prefix6;
333 uc->plen4 = cfg->plen4;
334 uc->plen6 = cfg->plen6;
335 uc->set = cfg->no.set;
336 strlcpy(uc->name, cfg->no.name, sizeof(uc->name));
339 struct nat64_dump_arg {
340 struct ip_fw_chain *ch;
341 struct sockopt_data *sd;
345 export_config_cb(struct namedobj_instance *ni, struct named_object *no,
348 struct nat64_dump_arg *da = (struct nat64_dump_arg *)arg;
349 ipfw_nat64lsn_cfg *uc;
351 uc = (struct _ipfw_nat64lsn_cfg *)ipfw_get_sopt_space(da->sd,
353 nat64lsn_export_config(da->ch, (struct nat64lsn_cfg *)no, uc);
358 * Lists all nat64 lsn instances currently available in kernel.
359 * Data layout (v0)(current):
360 * Request: [ ipfw_obj_lheader ]
361 * Reply: [ ipfw_obj_lheader ipfw_nat64lsn_cfg x N ]
363 * Returns 0 on success
366 nat64lsn_list(struct ip_fw_chain *ch, ip_fw3_opheader *op3,
367 struct sockopt_data *sd)
369 ipfw_obj_lheader *olh;
370 struct nat64_dump_arg da;
372 /* Check minimum header size */
373 if (sd->valsize < sizeof(ipfw_obj_lheader))
376 olh = (ipfw_obj_lheader *)ipfw_get_sopt_header(sd, sizeof(*olh));
379 olh->count = ipfw_objhash_count_type(CHAIN_TO_SRV(ch),
380 IPFW_TLV_NAT64LSN_NAME);
381 olh->objsize = sizeof(ipfw_nat64lsn_cfg);
382 olh->size = sizeof(*olh) + olh->count * olh->objsize;
384 if (sd->valsize < olh->size) {
388 memset(&da, 0, sizeof(da));
391 ipfw_objhash_foreach_type(CHAIN_TO_SRV(ch), export_config_cb, &da,
392 IPFW_TLV_NAT64LSN_NAME);
399 * Change existing nat64lsn instance configuration.
400 * Data layout (v0)(current):
401 * Request: [ ipfw_obj_header ipfw_nat64lsn_cfg ]
402 * Reply: [ ipfw_obj_header ipfw_nat64lsn_cfg ]
404 * Returns 0 on success
407 nat64lsn_config(struct ip_fw_chain *ch, ip_fw3_opheader *op,
408 struct sockopt_data *sd)
411 ipfw_nat64lsn_cfg *uc;
412 struct nat64lsn_cfg *cfg;
413 struct namedobj_instance *ni;
415 if (sd->valsize != sizeof(*oh) + sizeof(*uc))
418 oh = (ipfw_obj_header *)ipfw_get_sopt_space(sd,
419 sizeof(*oh) + sizeof(*uc));
420 uc = (ipfw_nat64lsn_cfg *)(oh + 1);
422 if (ipfw_check_object_name_generic(oh->ntlv.name) != 0 ||
423 oh->ntlv.set >= IPFW_MAX_SETS)
426 ni = CHAIN_TO_SRV(ch);
427 if (sd->sopt->sopt_dir == SOPT_GET) {
429 cfg = nat64lsn_find(ni, oh->ntlv.name, oh->ntlv.set);
434 nat64lsn_export_config(ch, cfg, uc);
439 nat64lsn_default_config(uc);
442 cfg = nat64lsn_find(ni, oh->ntlv.name, oh->ntlv.set);
449 * For now allow to change only following values:
450 * jmaxlen, nh_del_age, pg_del_age, tcp_syn_age, tcp_close_age,
451 * tcp_est_age, udp_age, icmp_age, flags, max_ports.
454 cfg->max_chunks = uc->max_ports / NAT64_CHUNK_SIZE;
455 cfg->jmaxlen = uc->jmaxlen;
456 cfg->nh_delete_delay = uc->nh_delete_delay;
457 cfg->pg_delete_delay = uc->pg_delete_delay;
458 cfg->st_syn_ttl = uc->st_syn_ttl;
459 cfg->st_close_ttl = uc->st_close_ttl;
460 cfg->st_estab_ttl = uc->st_estab_ttl;
461 cfg->st_udp_ttl = uc->st_udp_ttl;
462 cfg->st_icmp_ttl = uc->st_icmp_ttl;
463 cfg->flags = uc->flags & NAT64LSN_FLAGSMASK;
471 * Get nat64lsn statistics.
472 * Data layout (v0)(current):
473 * Request: [ ipfw_obj_header ]
474 * Reply: [ ipfw_obj_header ipfw_counter_tlv ]
476 * Returns 0 on success
479 nat64lsn_stats(struct ip_fw_chain *ch, ip_fw3_opheader *op,
480 struct sockopt_data *sd)
482 struct ipfw_nat64lsn_stats stats;
483 struct nat64lsn_cfg *cfg;
488 sz = sizeof(ipfw_obj_header) + sizeof(ipfw_obj_ctlv) + sizeof(stats);
489 if (sd->valsize % sizeof(uint64_t))
491 if (sd->valsize < sz)
493 oh = (ipfw_obj_header *)ipfw_get_sopt_header(sd, sz);
496 memset(&stats, 0, sizeof(stats));
499 cfg = nat64lsn_find(CHAIN_TO_SRV(ch), oh->ntlv.name, oh->ntlv.set);
505 export_stats(ch, cfg, &stats);
508 ctlv = (ipfw_obj_ctlv *)(oh + 1);
509 memset(ctlv, 0, sizeof(*ctlv));
510 ctlv->head.type = IPFW_TLV_COUNTERS;
511 ctlv->head.length = sz - sizeof(ipfw_obj_header);
512 ctlv->count = sizeof(stats) / sizeof(uint64_t);
513 ctlv->objsize = sizeof(uint64_t);
514 ctlv->version = IPFW_NAT64_VERSION;
515 memcpy(ctlv + 1, &stats, sizeof(stats));
520 * Reset nat64lsn statistics.
521 * Data layout (v0)(current):
522 * Request: [ ipfw_obj_header ]
524 * Returns 0 on success
527 nat64lsn_reset_stats(struct ip_fw_chain *ch, ip_fw3_opheader *op,
528 struct sockopt_data *sd)
530 struct nat64lsn_cfg *cfg;
533 if (sd->valsize != sizeof(*oh))
535 oh = (ipfw_obj_header *)sd->kbuf;
536 if (ipfw_check_object_name_generic(oh->ntlv.name) != 0 ||
537 oh->ntlv.set >= IPFW_MAX_SETS)
541 cfg = nat64lsn_find(CHAIN_TO_SRV(ch), oh->ntlv.name, oh->ntlv.set);
546 COUNTER_ARRAY_ZERO(cfg->stats.stats, NAT64STATS);
552 * Reply: [ ipfw_obj_header ipfw_obj_data [ ipfw_nat64lsn_stg
553 * ipfw_nat64lsn_state x count, ... ] ]
556 export_pg_states(struct nat64lsn_cfg *cfg, struct nat64lsn_portgroup *pg,
557 ipfw_nat64lsn_stg *stg, struct sockopt_data *sd)
559 ipfw_nat64lsn_state *ste;
560 struct nat64lsn_state *st;
563 NAT64_LOCK(pg->host);
565 for (i = 0; i < 64; i++) {
566 if (PG_IS_BUSY_IDX(pg, i))
569 DPRINTF(DP_STATE, "EXPORT PG %d, count %d", pg->idx, count);
573 NAT64_UNLOCK(pg->host);
576 ste = (ipfw_nat64lsn_state *)ipfw_get_sopt_space(sd,
577 count * sizeof(ipfw_nat64lsn_state));
579 NAT64_UNLOCK(pg->host);
583 stg->alias4.s_addr = pg->aaddr;
584 stg->proto = nat64lsn_rproto_map[pg->nat_proto];
586 stg->host6 = pg->host->addr;
588 for (i = 0; i < 64; i++) {
589 if (PG_IS_FREE_IDX(pg, i))
592 ste->daddr.s_addr = st->u.s.faddr;
593 ste->dport = st->u.s.fport;
594 ste->aport = pg->aport + i;
595 ste->sport = st->u.s.lport;
596 ste->flags = st->flags; /* XXX filter flags */
597 ste->idle = GET_AGE(st->timestamp);
600 NAT64_UNLOCK(pg->host);
606 get_next_idx(struct nat64lsn_cfg *cfg, uint32_t *addr, uint8_t *nat_proto,
610 if (*port < 65536 - NAT64_CHUNK_SIZE) {
611 *port += NAT64_CHUNK_SIZE;
616 if (*nat_proto < NAT_MAX_PROTO - 1) {
622 if (*addr < cfg->pmask4) {
631 #define PACK_IDX(addr, proto, port) \
632 ((uint64_t)addr << 32) | ((uint32_t)port << 16) | (proto << 8)
633 #define UNPACK_IDX(idx, addr, proto, port) \
634 (addr) = (uint32_t)((idx) >> 32); \
635 (port) = (uint16_t)(((idx) >> 16) & 0xFFFF); \
636 (proto) = (uint8_t)(((idx) >> 8) & 0xFF)
638 static struct nat64lsn_portgroup *
639 get_next_pg(struct nat64lsn_cfg *cfg, uint32_t *addr, uint8_t *nat_proto,
642 struct nat64lsn_portgroup *pg;
643 uint64_t pre_pack, post_pack;
646 pre_pack = PACK_IDX(*addr, *nat_proto, *port);
648 if (get_next_idx(cfg, addr, nat_proto, port) != 0) {
653 pg = GET_PORTGROUP(cfg, *addr, *nat_proto, *port);
658 post_pack = PACK_IDX(*addr, *nat_proto, *port);
659 if (pre_pack == post_pack)
660 DPRINTF(DP_STATE, "XXX: PACK_IDX %u %d %d",
661 *addr, *nat_proto, *port);
665 static NAT64NOINLINE struct nat64lsn_portgroup *
666 get_first_pg(struct nat64lsn_cfg *cfg, uint32_t *addr, uint8_t *nat_proto,
669 struct nat64lsn_portgroup *pg;
671 pg = GET_PORTGROUP(cfg, *addr, *nat_proto, *port);
673 pg = get_next_pg(cfg, addr, nat_proto, port);
679 * Lists nat64lsn states.
680 * Data layout (v0)(current):
681 * Request: [ ipfw_obj_header ipfw_obj_data [ uint64_t ]]
682 * Reply: [ ipfw_obj_header ipfw_obj_data [
683 * ipfw_nat64lsn_stg ipfw_nat64lsn_state x N] ]
685 * Returns 0 on success
688 nat64lsn_states(struct ip_fw_chain *ch, ip_fw3_opheader *op3,
689 struct sockopt_data *sd)
693 ipfw_nat64lsn_stg *stg;
694 struct nat64lsn_cfg *cfg;
695 struct nat64lsn_portgroup *pg, *pg_next;
698 uint32_t addr, states;
702 sz = sizeof(ipfw_obj_header) + sizeof(ipfw_obj_data) +
704 /* Check minimum header size */
705 if (sd->valsize < sz)
708 oh = (ipfw_obj_header *)sd->kbuf;
709 od = (ipfw_obj_data *)(oh + 1);
710 if (od->head.type != IPFW_TLV_OBJDATA ||
711 od->head.length != sz - sizeof(ipfw_obj_header))
714 next_idx = *(uint64_t *)(od + 1);
715 /* Translate index to the request position to start from */
716 UNPACK_IDX(next_idx, addr, nat_proto, port);
717 if (nat_proto >= NAT_MAX_PROTO)
719 if (nat_proto == 0 && addr != 0)
723 cfg = nat64lsn_find(CHAIN_TO_SRV(ch), oh->ntlv.name, oh->ntlv.set);
728 /* Fill in starting point */
734 if (addr < cfg->prefix4 || addr > cfg->pmask4) {
736 DPRINTF(DP_GENERIC | DP_STATE, "XXX: %ju %u %u",
737 (uintmax_t)next_idx, addr, cfg->pmask4);
741 sz = sizeof(ipfw_obj_header) + sizeof(ipfw_obj_data) +
742 sizeof(ipfw_nat64lsn_stg);
743 if (sd->valsize < sz)
745 oh = (ipfw_obj_header *)ipfw_get_sopt_space(sd, sz);
746 od = (ipfw_obj_data *)(oh + 1);
747 od->head.type = IPFW_TLV_OBJDATA;
748 od->head.length = sz - sizeof(ipfw_obj_header);
749 stg = (ipfw_nat64lsn_stg *)(od + 1);
751 pg = get_first_pg(cfg, &addr, &nat_proto, &port);
754 stg->next_idx = 0xFF;
762 pg_next = get_next_pg(cfg, &addr, &nat_proto, &port);
764 stg->next_idx = 0xFF;
766 stg->next_idx = PACK_IDX(addr, nat_proto, port);
768 if (export_pg_states(cfg, pg, stg, sd) != 0) {
770 return (states == 0 ? ENOMEM: 0);
772 states += stg->count;
773 od->head.length += stg->count * sizeof(ipfw_nat64lsn_state);
774 sz += stg->count * sizeof(ipfw_nat64lsn_state);
775 if (pg_next != NULL) {
776 sz += sizeof(ipfw_nat64lsn_stg);
777 if (sd->valsize < sz)
779 stg = (ipfw_nat64lsn_stg *)ipfw_get_sopt_space(sd,
780 sizeof(ipfw_nat64lsn_stg));
788 static struct ipfw_sopt_handler scodes[] = {
789 { IP_FW_NAT64LSN_CREATE, 0, HDIR_BOTH, nat64lsn_create },
790 { IP_FW_NAT64LSN_DESTROY,0, HDIR_SET, nat64lsn_destroy },
791 { IP_FW_NAT64LSN_CONFIG, 0, HDIR_BOTH, nat64lsn_config },
792 { IP_FW_NAT64LSN_LIST, 0, HDIR_GET, nat64lsn_list },
793 { IP_FW_NAT64LSN_STATS, 0, HDIR_GET, nat64lsn_stats },
794 { IP_FW_NAT64LSN_RESET_STATS,0, HDIR_SET, nat64lsn_reset_stats },
795 { IP_FW_NAT64LSN_LIST_STATES,0, HDIR_GET, nat64lsn_states },
799 nat64lsn_classify(ipfw_insn *cmd, uint16_t *puidx, uint8_t *ptype)
804 if (icmd->opcode != O_EXTERNAL_ACTION ||
805 icmd->arg1 != V_nat64lsn_eid)
814 nat64lsn_update_arg1(ipfw_insn *cmd, uint16_t idx)
821 nat64lsn_findbyname(struct ip_fw_chain *ch, struct tid_info *ti,
822 struct named_object **pno)
826 err = ipfw_objhash_find_type(CHAIN_TO_SRV(ch), ti,
827 IPFW_TLV_NAT64LSN_NAME, pno);
831 static struct named_object *
832 nat64lsn_findbykidx(struct ip_fw_chain *ch, uint16_t idx)
834 struct namedobj_instance *ni;
835 struct named_object *no;
837 IPFW_UH_WLOCK_ASSERT(ch);
838 ni = CHAIN_TO_SRV(ch);
839 no = ipfw_objhash_lookup_kidx(ni, idx);
840 KASSERT(no != NULL, ("NAT64LSN with index %d not found", idx));
846 nat64lsn_manage_sets(struct ip_fw_chain *ch, uint16_t set, uint8_t new_set,
847 enum ipfw_sets_cmd cmd)
850 return (ipfw_obj_manage_sets(CHAIN_TO_SRV(ch), IPFW_TLV_NAT64LSN_NAME,
854 static struct opcode_obj_rewrite opcodes[] = {
856 .opcode = O_EXTERNAL_INSTANCE,
857 .etlv = IPFW_TLV_EACTION /* just show it isn't table */,
858 .classifier = nat64lsn_classify,
859 .update = nat64lsn_update_arg1,
860 .find_byname = nat64lsn_findbyname,
861 .find_bykidx = nat64lsn_findbykidx,
862 .manage_sets = nat64lsn_manage_sets,
867 destroy_config_cb(struct namedobj_instance *ni, struct named_object *no,
870 struct nat64lsn_cfg *cfg;
871 struct ip_fw_chain *ch;
873 ch = (struct ip_fw_chain *)arg;
874 cfg = (struct nat64lsn_cfg *)SRV_OBJECT(ch, no->kidx);
875 SRV_OBJECT(ch, no->kidx) = NULL;
876 nat64lsn_detach_config(ch, cfg);
877 nat64lsn_destroy_instance(cfg);
882 nat64lsn_init(struct ip_fw_chain *ch, int first)
886 nat64lsn_init_internal();
887 V_nat64lsn_eid = ipfw_add_eaction(ch, ipfw_nat64lsn, "nat64lsn");
888 if (V_nat64lsn_eid == 0)
890 IPFW_ADD_SOPT_HANDLER(first, scodes);
891 IPFW_ADD_OBJ_REWRITER(first, opcodes);
896 nat64lsn_uninit(struct ip_fw_chain *ch, int last)
899 IPFW_DEL_OBJ_REWRITER(last, opcodes);
900 IPFW_DEL_SOPT_HANDLER(last, scodes);
901 ipfw_del_eaction(ch, V_nat64lsn_eid);
903 * Since we already have deregistered external action,
904 * our named objects become unaccessible via rules, because
905 * all rules were truncated by ipfw_del_eaction().
906 * So, we can unlink and destroy our named objects without holding
910 ipfw_objhash_foreach_type(CHAIN_TO_SRV(ch), destroy_config_cb, ch,
911 IPFW_TLV_NAT64LSN_NAME);
915 nat64lsn_uninit_internal();