Blame view
net/netfilter/nft_exthdr.c
3.37 KB
96518518c
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 |
/* * Copyright (c) 2008 Patrick McHardy <kaber@trash.net> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * Development of this code funded by Astaro AG (http://www.astaro.com/) */ #include <linux/kernel.h> #include <linux/init.h> #include <linux/module.h> #include <linux/netlink.h> #include <linux/netfilter.h> #include <linux/netfilter/nf_tables.h> #include <net/netfilter/nf_tables.h> // FIXME: #include <net/ipv6.h> struct nft_exthdr { u8 type; u8 offset; u8 len; enum nft_registers dreg:8; }; static void nft_exthdr_eval(const struct nft_expr *expr, |
a55e22e92
|
29 |
struct nft_regs *regs, |
96518518c
|
30 31 32 |
const struct nft_pktinfo *pkt) { struct nft_exthdr *priv = nft_expr_priv(expr); |
49499c3e6
|
33 |
u32 *dest = ®s->data[priv->dreg]; |
540436c80
|
34 |
unsigned int offset = 0; |
96518518c
|
35 36 37 38 39 40 |
int err; err = ipv6_find_hdr(pkt->skb, &offset, priv->type, NULL, NULL); if (err < 0) goto err; offset += priv->offset; |
49499c3e6
|
41 |
dest[priv->len / NFT_REG32_SIZE] = 0; |
fad136ea0
|
42 |
if (skb_copy_bits(pkt->skb, offset, dest, priv->len) < 0) |
96518518c
|
43 44 45 |
goto err; return; err: |
a55e22e92
|
46 |
regs->verdict.code = NFT_BREAK; |
96518518c
|
47 48 49 50 51 52 53 54 55 56 57 58 59 60 |
} static const struct nla_policy nft_exthdr_policy[NFTA_EXTHDR_MAX + 1] = { [NFTA_EXTHDR_DREG] = { .type = NLA_U32 }, [NFTA_EXTHDR_TYPE] = { .type = NLA_U8 }, [NFTA_EXTHDR_OFFSET] = { .type = NLA_U32 }, [NFTA_EXTHDR_LEN] = { .type = NLA_U32 }, }; static int nft_exthdr_init(const struct nft_ctx *ctx, const struct nft_expr *expr, const struct nlattr * const tb[]) { struct nft_exthdr *priv = nft_expr_priv(expr); |
96518518c
|
61 62 63 64 65 66 67 68 69 70 |
if (tb[NFTA_EXTHDR_DREG] == NULL || tb[NFTA_EXTHDR_TYPE] == NULL || tb[NFTA_EXTHDR_OFFSET] == NULL || tb[NFTA_EXTHDR_LEN] == NULL) return -EINVAL; priv->type = nla_get_u8(tb[NFTA_EXTHDR_TYPE]); priv->offset = ntohl(nla_get_be32(tb[NFTA_EXTHDR_OFFSET])); priv->len = ntohl(nla_get_be32(tb[NFTA_EXTHDR_LEN])); |
b1c96ed37
|
71 |
priv->dreg = nft_parse_register(tb[NFTA_EXTHDR_DREG]); |
96518518c
|
72 |
|
1ec10212f
|
73 74 |
return nft_validate_register_store(ctx, priv->dreg, NULL, NFT_DATA_VALUE, priv->len); |
96518518c
|
75 76 77 78 79 |
} static int nft_exthdr_dump(struct sk_buff *skb, const struct nft_expr *expr) { const struct nft_exthdr *priv = nft_expr_priv(expr); |
b1c96ed37
|
80 |
if (nft_dump_register(skb, NFTA_EXTHDR_DREG, priv->dreg)) |
96518518c
|
81 82 83 84 85 86 87 88 89 90 91 92 |
goto nla_put_failure; if (nla_put_u8(skb, NFTA_EXTHDR_TYPE, priv->type)) goto nla_put_failure; if (nla_put_be32(skb, NFTA_EXTHDR_OFFSET, htonl(priv->offset))) goto nla_put_failure; if (nla_put_be32(skb, NFTA_EXTHDR_LEN, htonl(priv->len))) goto nla_put_failure; return 0; nla_put_failure: return -1; } |
ef1f7df91
|
93 94 95 |
static struct nft_expr_type nft_exthdr_type; static const struct nft_expr_ops nft_exthdr_ops = { .type = &nft_exthdr_type, |
96518518c
|
96 |
.size = NFT_EXPR_SIZE(sizeof(struct nft_exthdr)), |
96518518c
|
97 98 99 |
.eval = nft_exthdr_eval, .init = nft_exthdr_init, .dump = nft_exthdr_dump, |
ef1f7df91
|
100 101 102 103 104 |
}; static struct nft_expr_type nft_exthdr_type __read_mostly = { .name = "exthdr", .ops = &nft_exthdr_ops, |
96518518c
|
105 106 |
.policy = nft_exthdr_policy, .maxattr = NFTA_EXTHDR_MAX, |
ef1f7df91
|
107 |
.owner = THIS_MODULE, |
96518518c
|
108 109 110 111 |
}; static int __init nft_exthdr_module_init(void) { |
ef1f7df91
|
112 |
return nft_register_expr(&nft_exthdr_type); |
96518518c
|
113 114 115 116 |
} static void __exit nft_exthdr_module_exit(void) { |
ef1f7df91
|
117 |
nft_unregister_expr(&nft_exthdr_type); |
96518518c
|
118 119 120 121 122 123 124 125 |
} module_init(nft_exthdr_module_init); module_exit(nft_exthdr_module_exit); MODULE_LICENSE("GPL"); MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); MODULE_ALIAS_NFT_EXPR("exthdr"); |