[NETFILTER]: Convert x_tables matches/targets to centralized error checking
[linux-2.6.git] / net / netfilter / xt_CONNMARK.c
1 /* This kernel module is used to modify the connection mark values, or
2  * to optionally restore the skb nfmark from the connection mark
3  *
4  * Copyright (C) 2002,2004 MARA Systems AB <http://www.marasystems.com>
5  * by Henrik Nordstrom <hno@marasystems.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20  */
21 #include <linux/module.h>
22 #include <linux/skbuff.h>
23 #include <linux/ip.h>
24 #include <net/checksum.h>
25
26 MODULE_AUTHOR("Henrik Nordstrom <hno@marasytems.com>");
27 MODULE_DESCRIPTION("IP tables CONNMARK matching module");
28 MODULE_LICENSE("GPL");
29 MODULE_ALIAS("ipt_CONNMARK");
30
31 #include <linux/netfilter/x_tables.h>
32 #include <linux/netfilter/xt_CONNMARK.h>
33 #include <net/netfilter/nf_conntrack_compat.h>
34
35 static unsigned int
36 target(struct sk_buff **pskb,
37        const struct net_device *in,
38        const struct net_device *out,
39        unsigned int hooknum,
40        const void *targinfo,
41        void *userinfo)
42 {
43         const struct xt_connmark_target_info *markinfo = targinfo;
44         u_int32_t diff;
45         u_int32_t nfmark;
46         u_int32_t newmark;
47         u_int32_t ctinfo;
48         u_int32_t *ctmark = nf_ct_get_mark(*pskb, &ctinfo);
49
50         if (ctmark) {
51             switch(markinfo->mode) {
52             case XT_CONNMARK_SET:
53                 newmark = (*ctmark & ~markinfo->mask) | markinfo->mark;
54                 if (newmark != *ctmark)
55                     *ctmark = newmark;
56                 break;
57             case XT_CONNMARK_SAVE:
58                 newmark = (*ctmark & ~markinfo->mask) | ((*pskb)->nfmark & markinfo->mask);
59                 if (*ctmark != newmark)
60                     *ctmark = newmark;
61                 break;
62             case XT_CONNMARK_RESTORE:
63                 nfmark = (*pskb)->nfmark;
64                 diff = (*ctmark ^ nfmark) & markinfo->mask;
65                 if (diff != 0)
66                     (*pskb)->nfmark = nfmark ^ diff;
67                 break;
68             }
69         }
70
71         return XT_CONTINUE;
72 }
73
74 static int
75 checkentry(const char *tablename,
76            const void *entry,
77            void *targinfo,
78            unsigned int targinfosize,
79            unsigned int hook_mask)
80 {
81         struct xt_connmark_target_info *matchinfo = targinfo;
82
83         if (matchinfo->mode == XT_CONNMARK_RESTORE) {
84             if (strcmp(tablename, "mangle") != 0) {
85                     printk(KERN_WARNING "CONNMARK: restore can only be called from \"mangle\" table, not \"%s\"\n", tablename);
86                     return 0;
87             }
88         }
89
90         if (matchinfo->mark > 0xffffffff || matchinfo->mask > 0xffffffff) {
91                 printk(KERN_WARNING "CONNMARK: Only supports 32bit mark\n");
92                 return 0;
93         }
94
95         return 1;
96 }
97
98 static struct xt_target connmark_reg = {
99         .name           = "CONNMARK",
100         .target         = target,
101         .targetsize     = sizeof(struct xt_connmark_target_info),
102         .checkentry     = checkentry,
103         .me             = THIS_MODULE
104 };
105
106 static struct xt_target connmark6_reg = {
107         .name           = "CONNMARK",
108         .target         = target,
109         .targetsize     = sizeof(struct xt_connmark_target_info),
110         .checkentry     = checkentry,
111         .me             = THIS_MODULE
112 };
113
114 static int __init init(void)
115 {
116         int ret;
117
118         need_conntrack();
119
120         ret = xt_register_target(AF_INET, &connmark_reg);
121         if (ret)
122                 return ret;
123
124         ret = xt_register_target(AF_INET6, &connmark6_reg);
125         if (ret)
126                 xt_unregister_target(AF_INET, &connmark_reg);
127
128         return ret;
129 }
130
131 static void __exit fini(void)
132 {
133         xt_unregister_target(AF_INET, &connmark_reg);
134         xt_unregister_target(AF_INET6, &connmark6_reg);
135 }
136
137 module_init(init);
138 module_exit(fini);