#ifdef _KERNEL
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: npf_alg.c,v 1.22 2020/05/30 14:16:56 rmind Exp $");
#include <sys/param.h>
#include <sys/types.h>
#include <sys/kmem.h>
#include <sys/module.h>
#endif
#include "npf_impl.h"
struct npf_alg {
const char * na_name;
unsigned na_slot;
};
struct npf_algset {
npf_alg_t alg_list[NPF_MAX_ALGS];
unsigned alg_count;
npfa_funcs_t alg_funcs[NPF_MAX_ALGS];
};
#define NPF_ALG_PREF "npf_alg_"
#define NPF_ALG_PREFLEN (sizeof(NPF_ALG_PREF) - 1)
void
npf_alg_init(npf_t *npf)
{
npf_algset_t *aset;
aset = kmem_zalloc(sizeof(npf_algset_t), KM_SLEEP);
npf->algset = aset;
}
void
npf_alg_fini(npf_t *npf)
{
npf_algset_t *aset = npf->algset;
kmem_free(aset, sizeof(npf_algset_t));
}
static npf_alg_t *
npf_alg_lookup(npf_t *npf, const char *name)
{
npf_algset_t *aset = npf->algset;
KASSERT(npf_config_locked_p(npf));
for (unsigned i = 0; i < aset->alg_count; i++) {
npf_alg_t *alg = &aset->alg_list[i];
const char *aname = alg->na_name;
if (aname && strcmp(aname, name) == 0)
return alg;
}
return NULL;
}
npf_alg_t *
npf_alg_construct(npf_t *npf, const char *name)
{
npf_alg_t *alg;
npf_config_enter(npf);
if ((alg = npf_alg_lookup(npf, name)) == NULL) {
char modname[NPF_ALG_PREFLEN + 64];
snprintf(modname, sizeof(modname), "%s%s", NPF_ALG_PREF, name);
npf_config_exit(npf);
if (module_autoload(modname, MODULE_CLASS_MISC) != 0) {
return NULL;
}
npf_config_enter(npf);
alg = npf_alg_lookup(npf, name);
}
npf_config_exit(npf);
return alg;
}
npf_alg_t *
npf_alg_register(npf_t *npf, const char *name, const npfa_funcs_t *funcs)
{
npf_algset_t *aset = npf->algset;
npfa_funcs_t *afuncs;
npf_alg_t *alg;
unsigned i;
npf_config_enter(npf);
if (npf_alg_lookup(npf, name) != NULL) {
npf_config_exit(npf);
return NULL;
}
for (i = 0; i < NPF_MAX_ALGS; i++) {
alg = &aset->alg_list[i];
if (alg->na_name == NULL) {
break;
}
}
if (i == NPF_MAX_ALGS) {
npf_config_exit(npf);
return NULL;
}
alg->na_name = name;
alg->na_slot = i;
afuncs = &aset->alg_funcs[i];
atomic_store_relaxed(&afuncs->destroy, funcs->destroy);
membar_producer();
atomic_store_relaxed(&afuncs->translate, funcs->translate);
atomic_store_relaxed(&afuncs->inspect, funcs->inspect);
atomic_store_relaxed(&afuncs->match, funcs->match);
membar_producer();
atomic_store_relaxed(&aset->alg_count, MAX(aset->alg_count, i + 1));
npf_config_exit(npf);
return alg;
}
int
npf_alg_unregister(npf_t *npf, npf_alg_t *alg)
{
npf_algset_t *aset = npf->algset;
unsigned i = alg->na_slot;
npfa_funcs_t *afuncs;
npf_config_enter(npf);
afuncs = &aset->alg_funcs[i];
atomic_store_relaxed(&afuncs->match, NULL);
atomic_store_relaxed(&afuncs->translate, NULL);
atomic_store_relaxed(&afuncs->inspect, NULL);
npf_config_sync(npf);
npf_ruleset_freealg(npf_config_natset(npf), alg);
atomic_store_relaxed(&afuncs->destroy, NULL);
alg->na_name = NULL;
npf_config_exit(npf);
return 0;
}
bool
npf_alg_match(npf_cache_t *npc, npf_nat_t *nt, int di)
{
npf_t *npf = npc->npc_ctx;
npf_algset_t *aset = npf->algset;
bool match = false;
unsigned count;
int s;
KASSERTMSG(npf_iscached(npc, NPC_IP46), "expecting protocol number");
s = npf_config_read_enter(npf);
count = atomic_load_relaxed(&aset->alg_count);
for (unsigned i = 0; i < count; i++) {
const npfa_funcs_t *f = &aset->alg_funcs[i];
bool (*match_func)(npf_cache_t *, npf_nat_t *, int);
match_func = atomic_load_relaxed(&f->match);
if (match_func && match_func(npc, nt, di)) {
match = true;
break;
}
}
npf_config_read_exit(npf, s);
return match;
}
void
npf_alg_exec(npf_cache_t *npc, npf_nat_t *nt, const npf_flow_t flow)
{
npf_t *npf = npc->npc_ctx;
npf_algset_t *aset = npf->algset;
unsigned count;
int s;
s = npf_config_read_enter(npf);
count = atomic_load_relaxed(&aset->alg_count);
for (unsigned i = 0; i < count; i++) {
const npfa_funcs_t *f = &aset->alg_funcs[i];
bool (*translate_func)(npf_cache_t *, npf_nat_t *, npf_flow_t);
translate_func = atomic_load_relaxed(&f->translate);
if (translate_func) {
translate_func(npc, nt, flow);
}
}
npf_config_read_exit(npf, s);
}
npf_conn_t *
npf_alg_conn(npf_cache_t *npc, int di)
{
npf_t *npf = npc->npc_ctx;
npf_algset_t *aset = npf->algset;
npf_conn_t *con = NULL;
unsigned count;
int s;
s = npf_config_read_enter(npf);
count = atomic_load_relaxed(&aset->alg_count);
for (unsigned i = 0; i < count; i++) {
const npfa_funcs_t *f = &aset->alg_funcs[i];
npf_conn_t *(*inspect_func)(npf_cache_t *, int);
inspect_func = atomic_load_relaxed(&f->inspect);
if (inspect_func && (con = inspect_func(npc, di)) != NULL) {
break;
}
}
npf_config_read_exit(npf, s);
return con;
}
void
npf_alg_destroy(npf_t *npf, npf_alg_t *alg, npf_nat_t *nat, npf_conn_t *con)
{
npf_algset_t *aset = npf->algset;
const npfa_funcs_t *f = &aset->alg_funcs[alg->na_slot];
void (*destroy_func)(npf_t *, npf_nat_t *, npf_conn_t *);
if ((destroy_func = atomic_load_relaxed(&f->destroy)) != NULL) {
destroy_func(npf, nat, con);
}
}
int
npf_alg_export(npf_t *npf, nvlist_t *nvl)
{
npf_algset_t *aset = npf->algset;
KASSERT(npf_config_locked_p(npf));
for (unsigned i = 0; i < aset->alg_count; i++) {
const npf_alg_t *alg = &aset->alg_list[i];
nvlist_t *algdict;
if (alg->na_name == NULL) {
continue;
}
algdict = nvlist_create(0);
nvlist_add_string(algdict, "name", alg->na_name);
nvlist_append_nvlist_array(nvl, "algs", algdict);
nvlist_destroy(algdict);
}
return 0;
}