Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net-2.6
[linux-2.6] / net / netfilter / xt_dccp.c
1 /*
2  * iptables module for DCCP protocol header matching
3  *
4  * (C) 2005 by Harald Welte <laforge@netfilter.org>
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  */
10
11 #include <linux/module.h>
12 #include <linux/skbuff.h>
13 #include <linux/spinlock.h>
14 #include <net/ip.h>
15 #include <linux/dccp.h>
16
17 #include <linux/netfilter/x_tables.h>
18 #include <linux/netfilter/xt_dccp.h>
19
20 #include <linux/netfilter_ipv4/ip_tables.h>
21 #include <linux/netfilter_ipv6/ip6_tables.h>
22
23 MODULE_LICENSE("GPL");
24 MODULE_AUTHOR("Harald Welte <laforge@netfilter.org>");
25 MODULE_DESCRIPTION("Xtables: DCCP protocol packet match");
26 MODULE_ALIAS("ipt_dccp");
27 MODULE_ALIAS("ip6t_dccp");
28
29 #define DCCHECK(cond, option, flag, invflag) (!((flag) & (option)) \
30                                   || (!!((invflag) & (option)) ^ (cond)))
31
32 static unsigned char *dccp_optbuf;
33 static DEFINE_SPINLOCK(dccp_buflock);
34
35 static inline bool
36 dccp_find_option(u_int8_t option,
37                  const struct sk_buff *skb,
38                  unsigned int protoff,
39                  const struct dccp_hdr *dh,
40                  bool *hotdrop)
41 {
42         /* tcp.doff is only 4 bits, ie. max 15 * 4 bytes */
43         const unsigned char *op;
44         unsigned int optoff = __dccp_hdr_len(dh);
45         unsigned int optlen = dh->dccph_doff*4 - __dccp_hdr_len(dh);
46         unsigned int i;
47
48         if (dh->dccph_doff * 4 < __dccp_hdr_len(dh)) {
49                 *hotdrop = true;
50                 return false;
51         }
52
53         if (!optlen)
54                 return false;
55
56         spin_lock_bh(&dccp_buflock);
57         op = skb_header_pointer(skb, protoff + optoff, optlen, dccp_optbuf);
58         if (op == NULL) {
59                 /* If we don't have the whole header, drop packet. */
60                 spin_unlock_bh(&dccp_buflock);
61                 *hotdrop = true;
62                 return false;
63         }
64
65         for (i = 0; i < optlen; ) {
66                 if (op[i] == option) {
67                         spin_unlock_bh(&dccp_buflock);
68                         return true;
69                 }
70
71                 if (op[i] < 2)
72                         i++;
73                 else
74                         i += op[i+1]?:1;
75         }
76
77         spin_unlock_bh(&dccp_buflock);
78         return false;
79 }
80
81
82 static inline bool
83 match_types(const struct dccp_hdr *dh, u_int16_t typemask)
84 {
85         return typemask & (1 << dh->dccph_type);
86 }
87
88 static inline bool
89 match_option(u_int8_t option, const struct sk_buff *skb, unsigned int protoff,
90              const struct dccp_hdr *dh, bool *hotdrop)
91 {
92         return dccp_find_option(option, skb, protoff, dh, hotdrop);
93 }
94
95 static bool
96 dccp_mt(const struct sk_buff *skb, const struct net_device *in,
97         const struct net_device *out, const struct xt_match *match,
98         const void *matchinfo, int offset, unsigned int protoff, bool *hotdrop)
99 {
100         const struct xt_dccp_info *info = matchinfo;
101         const struct dccp_hdr *dh;
102         struct dccp_hdr _dh;
103
104         if (offset)
105                 return false;
106
107         dh = skb_header_pointer(skb, protoff, sizeof(_dh), &_dh);
108         if (dh == NULL) {
109                 *hotdrop = true;
110                 return false;
111         }
112
113         return  DCCHECK(ntohs(dh->dccph_sport) >= info->spts[0]
114                         && ntohs(dh->dccph_sport) <= info->spts[1],
115                         XT_DCCP_SRC_PORTS, info->flags, info->invflags)
116                 && DCCHECK(ntohs(dh->dccph_dport) >= info->dpts[0]
117                         && ntohs(dh->dccph_dport) <= info->dpts[1],
118                         XT_DCCP_DEST_PORTS, info->flags, info->invflags)
119                 && DCCHECK(match_types(dh, info->typemask),
120                            XT_DCCP_TYPE, info->flags, info->invflags)
121                 && DCCHECK(match_option(info->option, skb, protoff, dh,
122                                         hotdrop),
123                            XT_DCCP_OPTION, info->flags, info->invflags);
124 }
125
126 static bool
127 dccp_mt_check(const char *tablename, const void *inf,
128               const struct xt_match *match, void *matchinfo,
129               unsigned int hook_mask)
130 {
131         const struct xt_dccp_info *info = matchinfo;
132
133         return !(info->flags & ~XT_DCCP_VALID_FLAGS)
134                 && !(info->invflags & ~XT_DCCP_VALID_FLAGS)
135                 && !(info->invflags & ~info->flags);
136 }
137
138 static struct xt_match dccp_mt_reg[] __read_mostly = {
139         {
140                 .name           = "dccp",
141                 .family         = AF_INET,
142                 .checkentry     = dccp_mt_check,
143                 .match          = dccp_mt,
144                 .matchsize      = sizeof(struct xt_dccp_info),
145                 .proto          = IPPROTO_DCCP,
146                 .me             = THIS_MODULE,
147         },
148         {
149                 .name           = "dccp",
150                 .family         = AF_INET6,
151                 .checkentry     = dccp_mt_check,
152                 .match          = dccp_mt,
153                 .matchsize      = sizeof(struct xt_dccp_info),
154                 .proto          = IPPROTO_DCCP,
155                 .me             = THIS_MODULE,
156         },
157 };
158
159 static int __init dccp_mt_init(void)
160 {
161         int ret;
162
163         /* doff is 8 bits, so the maximum option size is (4*256).  Don't put
164          * this in BSS since DaveM is worried about locked TLB's for kernel
165          * BSS. */
166         dccp_optbuf = kmalloc(256 * 4, GFP_KERNEL);
167         if (!dccp_optbuf)
168                 return -ENOMEM;
169         ret = xt_register_matches(dccp_mt_reg, ARRAY_SIZE(dccp_mt_reg));
170         if (ret)
171                 goto out_kfree;
172         return ret;
173
174 out_kfree:
175         kfree(dccp_optbuf);
176         return ret;
177 }
178
179 static void __exit dccp_mt_exit(void)
180 {
181         xt_unregister_matches(dccp_mt_reg, ARRAY_SIZE(dccp_mt_reg));
182         kfree(dccp_optbuf);
183 }
184
185 module_init(dccp_mt_init);
186 module_exit(dccp_mt_exit);