Changeset View
Changeset View
Standalone View
Standalone View
sbin/ipfw/nat64stl.c
- This file was added.
/*- | |||||
* Copyright (c) 2015-2016 Yandex LLC | |||||
* Copyright (c) 2015-2016 Andrey V. Elsukov <ae@FreeBSD.org> | |||||
* All rights reserved. | |||||
* | |||||
* Redistribution and use in source and binary forms, with or without | |||||
* modification, are permitted provided that the following conditions | |||||
* are met: | |||||
* | |||||
* 1. Redistributions of source code must retain the above copyright | |||||
* notice, this list of conditions and the following disclaimer. | |||||
* 2. Redistributions in binary form must reproduce the above copyright | |||||
* notice, this list of conditions and the following disclaimer in the | |||||
* documentation and/or other materials provided with the distribution. | |||||
* | |||||
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR | |||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES | |||||
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. | |||||
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, | |||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | |||||
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |||||
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |||||
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | |||||
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |||||
*/ | |||||
#include <sys/cdefs.h> | |||||
__FBSDID("$FreeBSD$"); | |||||
#include <sys/types.h> | |||||
#include <sys/socket.h> | |||||
#include "ipfw2.h" | |||||
#include <ctype.h> | |||||
#include <err.h> | |||||
#include <errno.h> | |||||
#include <netdb.h> | |||||
#include <stdio.h> | |||||
#include <stdlib.h> | |||||
#include <string.h> | |||||
#include <sysexits.h> | |||||
#include <net/if.h> | |||||
#include <netinet/in.h> | |||||
#include <netinet/ip_fw.h> | |||||
#include <netinet6/ip_fw_nat64.h> | |||||
#include <arpa/inet.h> | |||||
static int nat64stl_check_prefix(struct in6_addr *prefix, int length); | |||||
typedef int (nat64stl_cb_t)(ipfw_nat64stl_cfg *i, const char *name, | |||||
uint8_t set); | |||||
static int nat64stl_foreach(nat64stl_cb_t *f, const char *name, uint8_t set, | |||||
int sort); | |||||
static void nat64stl_create(const char *name, uint8_t set, int ac, char **av); | |||||
static void nat64stl_destroy(const char *name, uint8_t set); | |||||
static void nat64stl_stats(const char *name, uint8_t set); | |||||
static int nat64stl_show_cb(ipfw_nat64stl_cfg *cfg, const char *name, | |||||
uint8_t set); | |||||
static int nat64stl_destroy_cb(ipfw_nat64stl_cfg *cfg, const char *name, | |||||
uint8_t set); | |||||
static struct _s_x nat64cmds[] = { | |||||
{ "create", TOK_CREATE }, | |||||
{ "destroy", TOK_DESTROY }, | |||||
{ "list", TOK_LIST }, | |||||
{ "show", TOK_LIST }, | |||||
{ "stats", TOK_STATS }, | |||||
{ NULL, 0 } | |||||
}; | |||||
#define IPV6_ADDR_INT32_WKPFX htonl(0x64ff9b) | |||||
#define IN6_IS_ADDR_WKPFX(a) \ | |||||
((a)->__u6_addr.__u6_addr32[0] == IPV6_ADDR_INT32_WKPFX && \ | |||||
(a)->__u6_addr.__u6_addr32[1] == 0 && \ | |||||
(a)->__u6_addr.__u6_addr32[2] == 0) | |||||
static int | |||||
nat64stl_check_prefix(struct in6_addr *prefix, int length) | |||||
{ | |||||
if (IN6_IS_ADDR_WKPFX(prefix) && length == 96) | |||||
return (0); | |||||
#if 0 | |||||
switch (length) { | |||||
case 32: | |||||
case 40: | |||||
case 48: | |||||
case 56: | |||||
case 64: | |||||
/* Well-known prefix has 96 prefix length */ | |||||
if (IN6_IS_ADDR_WKPFX(prefix)) | |||||
return (1); | |||||
/* FALLTHROUGH */ | |||||
case 96: | |||||
/* Bits 64 to 71 must be set to zero */ | |||||
if (prefix->__u6_addr.__u6_addr8[8] != 0) | |||||
return (1); | |||||
/* XXX: looks incorrect */ | |||||
if (IN6_IS_ADDR_MULTICAST(prefix) || | |||||
IN6_IS_ADDR_UNSPECIFIED(prefix) || | |||||
IN6_IS_ADDR_LOOPBACK(prefix)) | |||||
return (1); | |||||
return (0); | |||||
} | |||||
#endif | |||||
return (1); | |||||
} | |||||
/* | |||||
* This one handles all nat64stl-related commands | |||||
* ipfw [set N] nat64stl NAME {create | config} ... | |||||
* ipfw [set N] nat64stl NAME stats | |||||
* ipfw [set N] nat64stl {NAME | all} destroy | |||||
* ipfw [set N] nat64stl {NAME | all} {list | show} | |||||
*/ | |||||
#define nat64stl_check_name table_check_name | |||||
void | |||||
ipfw_nat64stl_handler(int ac, char *av[]) | |||||
{ | |||||
const char *name; | |||||
int tcmd; | |||||
uint8_t set; | |||||
if (co.use_set != 0) | |||||
set = co.use_set - 1; | |||||
else | |||||
set = 0; | |||||
ac--; av++; | |||||
NEED1("nat64stl needs instance name"); | |||||
name = *av; | |||||
if (nat64stl_check_name(name) != 0) { | |||||
if (strcmp(name, "all") == 0) | |||||
name = NULL; | |||||
else | |||||
errx(EX_USAGE, "nat64stl instance name %s is invalid", | |||||
name); | |||||
} | |||||
ac--; av++; | |||||
NEED1("nat64stl needs command"); | |||||
tcmd = get_token(nat64cmds, *av, "nat64stl command"); | |||||
if (name == NULL && tcmd != TOK_DESTROY && tcmd != TOK_LIST) | |||||
errx(EX_USAGE, "nat64stl instance name required"); | |||||
switch (tcmd) { | |||||
case TOK_CREATE: | |||||
ac--; av++; | |||||
nat64stl_create(name, set, ac, av); | |||||
break; | |||||
case TOK_LIST: | |||||
nat64stl_foreach(nat64stl_show_cb, name, set, 1); | |||||
break; | |||||
case TOK_DESTROY: | |||||
if (name == NULL) | |||||
nat64stl_foreach(nat64stl_destroy_cb, NULL, set, 0); | |||||
else | |||||
nat64stl_destroy(name, set); | |||||
break; | |||||
case TOK_STATS: | |||||
nat64stl_stats(name, set); | |||||
} | |||||
} | |||||
static void | |||||
nat64stl_fill_ntlv(ipfw_obj_ntlv *ntlv, const char *name, uint8_t set) | |||||
{ | |||||
ntlv->head.type = IPFW_TLV_EACTION_NAME(1); /* it doesn't matter */ | |||||
ntlv->head.length = sizeof(ipfw_obj_ntlv); | |||||
ntlv->idx = 1; | |||||
ntlv->set = set; | |||||
strlcpy(ntlv->name, name, sizeof(ntlv->name)); | |||||
} | |||||
static struct _s_x nat64newcmds[] = { | |||||
{ "table4", TOK_TABLE4 }, | |||||
{ "table6", TOK_TABLE6 }, | |||||
{ "prefix", TOK_PREFIX }, | |||||
{ NULL, 0 } | |||||
}; | |||||
/* | |||||
* Creates new nat64stl instance | |||||
* ipfw nat64stl <NAME> create table4 <name> table6 <name> prefix <prefix> | |||||
* Request: [ ipfw_obj_lheader ipfw_nat64stl_cfg ] | |||||
*/ | |||||
#define NAT64STL_HAS_TABLE4 0x01 | |||||
#define NAT64STL_HAS_TABLE6 0x02 | |||||
#define NAT64STL_HAS_PREFIX 0x04 | |||||
static void | |||||
nat64stl_create(const char *name, uint8_t set, int ac, char *av[]) | |||||
{ | |||||
char buf[sizeof(ipfw_obj_lheader) + sizeof(ipfw_nat64stl_cfg)]; | |||||
ipfw_nat64stl_cfg *cfg; | |||||
ipfw_obj_lheader *olh; | |||||
int tcmd, flags; | |||||
char *p; | |||||
memset(buf, 0, sizeof(buf)); | |||||
olh = (ipfw_obj_lheader *)buf; | |||||
cfg = (ipfw_nat64stl_cfg *)(olh + 1); | |||||
cfg->set = set; | |||||
flags = 0; | |||||
while (ac > 0) { | |||||
tcmd = get_token(nat64newcmds, *av, "option"); | |||||
ac--; av++; | |||||
switch (tcmd) { | |||||
case TOK_TABLE4: | |||||
NEED1("table name required"); | |||||
table_fill_ntlv(&cfg->ntlv4, *av, set, 4); | |||||
flags |= NAT64STL_HAS_TABLE4; | |||||
ac--; av++; | |||||
break; | |||||
case TOK_TABLE6: | |||||
NEED1("table name required"); | |||||
table_fill_ntlv(&cfg->ntlv6, *av, set, 6); | |||||
flags |= NAT64STL_HAS_TABLE6; | |||||
ac--; av++; | |||||
break; | |||||
case TOK_PREFIX: | |||||
NEED1("IPv6 prefix required"); | |||||
/* Type may have suboptions after ':' */ | |||||
if ((p = strchr(*av, '/')) != NULL) | |||||
*p++ = '\0'; | |||||
if (inet_pton(AF_INET6, *av, &cfg->prefix) != 1) | |||||
errx(EX_USAGE, | |||||
"Bad prefix: %s", *av); | |||||
cfg->plen = strtol(p, NULL, 10); | |||||
if (nat64stl_check_prefix(&cfg->prefix, cfg->plen) != 0) | |||||
errx(EX_USAGE, | |||||
"Bad prefix length: %s", p); | |||||
flags |= NAT64STL_HAS_PREFIX; | |||||
ac--; av++; | |||||
break; | |||||
} | |||||
} | |||||
/* Check validness */ | |||||
if ((flags & NAT64STL_HAS_TABLE4) != NAT64STL_HAS_TABLE4) | |||||
errx(EX_USAGE, "table4 required"); | |||||
if ((flags & NAT64STL_HAS_TABLE6) != NAT64STL_HAS_TABLE6) | |||||
errx(EX_USAGE, "table6 required"); | |||||
if ((flags & NAT64STL_HAS_PREFIX) != NAT64STL_HAS_PREFIX) | |||||
errx(EX_USAGE, "prefix required"); | |||||
olh->count = 1; | |||||
olh->objsize = sizeof(*cfg); | |||||
olh->size = sizeof(buf); | |||||
strlcpy(cfg->name, name, sizeof(cfg->name)); | |||||
if (do_set3(IP_FW_NAT64STL_CREATE, &olh->opheader, sizeof(buf)) != 0) | |||||
err(EX_OSERR, "nat64stl instance creation failed"); | |||||
} | |||||
/* | |||||
* Destroys nat64stl instance. | |||||
* Request: [ ipfw_obj_header ] | |||||
*/ | |||||
static void | |||||
nat64stl_destroy(const char *name, uint8_t set) | |||||
{ | |||||
ipfw_obj_header oh; | |||||
memset(&oh, 0, sizeof(oh)); | |||||
nat64stl_fill_ntlv(&oh.ntlv, name, set); | |||||
if (do_set3(IP_FW_NAT64STL_DESTROY, &oh.opheader, sizeof(oh)) != 0) | |||||
err(EX_OSERR, "failed to destroy nat instance %s", name); | |||||
} | |||||
/* | |||||
* Get nat64stl instance statistics. | |||||
* Request: [ ipfw_obj_header ] | |||||
* Reply: [ ipfw_obj_header ipfw_obj_ctlv [ uint64_t x N ] ] | |||||
*/ | |||||
static int | |||||
nat64stl_get_stats(const char *name, uint8_t set, | |||||
struct ipfw_nat64stl_stats *stats) | |||||
{ | |||||
ipfw_obj_header *oh; | |||||
ipfw_obj_ctlv *oc; | |||||
size_t sz; | |||||
sz = sizeof(*oh) + sizeof(*oc) + sizeof(*stats); | |||||
oh = calloc(1, sz); | |||||
nat64stl_fill_ntlv(&oh->ntlv, name, set); | |||||
if (do_get3(IP_FW_NAT64STL_STATS, &oh->opheader, &sz) == 0) { | |||||
oc = (ipfw_obj_ctlv *)(oh + 1); | |||||
memcpy(stats, oc + 1, sizeof(*stats)); | |||||
free(oh); | |||||
return (0); | |||||
} | |||||
free(oh); | |||||
return (-1); | |||||
} | |||||
#define _P_STAT(_s, _f) printf("%8s:\t%lu\n", #_f, _s._f) | |||||
static void | |||||
nat64stl_stats(const char *name, uint8_t set) | |||||
{ | |||||
struct ipfw_nat64stl_stats stats; | |||||
if (nat64stl_get_stats(name, set, &stats) != 0) | |||||
err(EX_OSERR, "Error retrieving stats"); | |||||
_P_STAT(stats, opcnt64); | |||||
_P_STAT(stats, opcnt46); | |||||
_P_STAT(stats, ofrags); | |||||
_P_STAT(stats, ifrags); | |||||
_P_STAT(stats, oerrors); | |||||
_P_STAT(stats, noroute4); | |||||
_P_STAT(stats, noroute6); | |||||
_P_STAT(stats, noproto); | |||||
_P_STAT(stats, nomem); | |||||
_P_STAT(stats, dropped); | |||||
} | |||||
static int | |||||
nat64stl_show_cb(ipfw_nat64stl_cfg *cfg, const char *name, uint8_t set) | |||||
{ | |||||
char abuf[INET6_ADDRSTRLEN]; | |||||
if (name != NULL && strcmp(cfg->name, name) != 0) | |||||
return (ESRCH); | |||||
if (co.use_set != 0 && cfg->set != set) | |||||
return (ESRCH); | |||||
if (co.use_set != 0 || cfg->set != 0) | |||||
printf("set %u ", cfg->set); | |||||
inet_ntop(AF_INET6, &cfg->prefix, abuf, sizeof(abuf)); | |||||
printf("nat64stl %s table4 %s table6 %s prefix %s/%u\n", | |||||
cfg->name, cfg->ntlv4.name, cfg->ntlv6.name, | |||||
abuf, cfg->plen); | |||||
return (0); | |||||
} | |||||
static int | |||||
nat64stl_destroy_cb(ipfw_nat64stl_cfg *cfg, const char *name, uint8_t set) | |||||
{ | |||||
if (co.use_set != 0 && cfg->set != set) | |||||
return (ESRCH); | |||||
nat64stl_destroy(cfg->name, cfg->set); | |||||
return (0); | |||||
} | |||||
/* | |||||
* Compare nat64stl instances names. | |||||
* Honor number comparison. | |||||
*/ | |||||
static int | |||||
nat64name_cmp(const void *a, const void *b) | |||||
{ | |||||
ipfw_nat64stl_cfg *ca, *cb; | |||||
ca = (ipfw_nat64stl_cfg *)a; | |||||
cb = (ipfw_nat64stl_cfg *)b; | |||||
if (ca->set > cb->set) | |||||
return (1); | |||||
else if (ca->set < cb->set) | |||||
return (-1); | |||||
return (stringnum_cmp(ca->name, cb->name)); | |||||
} | |||||
/* | |||||
* Retrieves nat64stl instance list from kernel, | |||||
* optionally sorts it and calls requested function for each instance. | |||||
* | |||||
* Request: [ ipfw_obj_lheader ] | |||||
* Reply: [ ipfw_obj_lheader ipfw_nat64stl_cfg x N ] | |||||
*/ | |||||
static int | |||||
nat64stl_foreach(nat64stl_cb_t *f, const char *name, uint8_t set, int sort) | |||||
{ | |||||
ipfw_obj_lheader *olh; | |||||
ipfw_nat64stl_cfg *cfg; | |||||
size_t sz; | |||||
int i, error; | |||||
/* Start with reasonable default */ | |||||
sz = sizeof(*olh) + 16 * sizeof(*cfg); | |||||
for (;;) { | |||||
if ((olh = calloc(1, sz)) == NULL) | |||||
return (ENOMEM); | |||||
olh->size = sz; | |||||
if (do_get3(IP_FW_NAT64STL_LIST, &olh->opheader, &sz) != 0) { | |||||
sz = olh->size; | |||||
free(olh); | |||||
if (errno != ENOMEM) | |||||
return (errno); | |||||
continue; | |||||
} | |||||
if (sort != 0) | |||||
qsort(olh + 1, olh->count, olh->objsize, | |||||
nat64name_cmp); | |||||
cfg = (ipfw_nat64stl_cfg *)(olh + 1); | |||||
for (i = 0; i < olh->count; i++) { | |||||
error = f(cfg, name, set); /* Ignore errors for now */ | |||||
cfg = (ipfw_nat64stl_cfg *)((caddr_t)cfg + | |||||
olh->objsize); | |||||
} | |||||
free(olh); | |||||
break; | |||||
} | |||||
return (0); | |||||
} | |||||