Commit | Line | Data |
---|---|---|
1d3de414 HW |
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> | |
5a0e3ad6 | 13 | #include <linux/slab.h> |
1d3de414 HW |
14 | #include <linux/spinlock.h> |
15 | #include <net/ip.h> | |
16 | #include <linux/dccp.h> | |
17 | ||
2e4e6a17 HW |
18 | #include <linux/netfilter/x_tables.h> |
19 | #include <linux/netfilter/xt_dccp.h> | |
20 | ||
1d3de414 | 21 | #include <linux/netfilter_ipv4/ip_tables.h> |
2e4e6a17 HW |
22 | #include <linux/netfilter_ipv6/ip6_tables.h> |
23 | ||
24 | MODULE_LICENSE("GPL"); | |
25 | MODULE_AUTHOR("Harald Welte <laforge@netfilter.org>"); | |
2ae15b64 | 26 | MODULE_DESCRIPTION("Xtables: DCCP protocol packet match"); |
2e4e6a17 | 27 | MODULE_ALIAS("ipt_dccp"); |
73aaf935 | 28 | MODULE_ALIAS("ip6t_dccp"); |
1d3de414 HW |
29 | |
30 | #define DCCHECK(cond, option, flag, invflag) (!((flag) & (option)) \ | |
601e68e1 | 31 | || (!!((invflag) & (option)) ^ (cond))) |
1d3de414 HW |
32 | |
33 | static unsigned char *dccp_optbuf; | |
34 | static DEFINE_SPINLOCK(dccp_buflock); | |
35 | ||
1d93a9cb | 36 | static inline bool |
1d3de414 HW |
37 | dccp_find_option(u_int8_t option, |
38 | const struct sk_buff *skb, | |
2e4e6a17 | 39 | unsigned int protoff, |
1d3de414 | 40 | const struct dccp_hdr *dh, |
cff533ac | 41 | bool *hotdrop) |
1d3de414 HW |
42 | { |
43 | /* tcp.doff is only 4 bits, ie. max 15 * 4 bytes */ | |
a47362a2 | 44 | const unsigned char *op; |
1d3de414 HW |
45 | unsigned int optoff = __dccp_hdr_len(dh); |
46 | unsigned int optlen = dh->dccph_doff*4 - __dccp_hdr_len(dh); | |
47 | unsigned int i; | |
48 | ||
79f55f11 IJ |
49 | if (dh->dccph_doff * 4 < __dccp_hdr_len(dh)) |
50 | goto invalid; | |
1d3de414 HW |
51 | |
52 | if (!optlen) | |
1d93a9cb | 53 | return false; |
1d3de414 HW |
54 | |
55 | spin_lock_bh(&dccp_buflock); | |
2e4e6a17 | 56 | op = skb_header_pointer(skb, protoff + optoff, optlen, dccp_optbuf); |
1d3de414 HW |
57 | if (op == NULL) { |
58 | /* If we don't have the whole header, drop packet. */ | |
79f55f11 | 59 | goto partial; |
1d3de414 HW |
60 | } |
61 | ||
62 | for (i = 0; i < optlen; ) { | |
63 | if (op[i] == option) { | |
64 | spin_unlock_bh(&dccp_buflock); | |
1d93a9cb | 65 | return true; |
1d3de414 HW |
66 | } |
67 | ||
601e68e1 | 68 | if (op[i] < 2) |
1d3de414 | 69 | i++; |
601e68e1 | 70 | else |
1d3de414 HW |
71 | i += op[i+1]?:1; |
72 | } | |
73 | ||
74 | spin_unlock_bh(&dccp_buflock); | |
1d93a9cb | 75 | return false; |
79f55f11 IJ |
76 | |
77 | partial: | |
78 | spin_unlock_bh(&dccp_buflock); | |
79 | invalid: | |
80 | *hotdrop = true; | |
81 | return false; | |
1d3de414 HW |
82 | } |
83 | ||
84 | ||
1d93a9cb | 85 | static inline bool |
1d3de414 HW |
86 | match_types(const struct dccp_hdr *dh, u_int16_t typemask) |
87 | { | |
7c4e36bc | 88 | return typemask & (1 << dh->dccph_type); |
1d3de414 HW |
89 | } |
90 | ||
1d93a9cb | 91 | static inline bool |
2e4e6a17 | 92 | match_option(u_int8_t option, const struct sk_buff *skb, unsigned int protoff, |
cff533ac | 93 | const struct dccp_hdr *dh, bool *hotdrop) |
1d3de414 | 94 | { |
2e4e6a17 | 95 | return dccp_find_option(option, skb, protoff, dh, hotdrop); |
1d3de414 HW |
96 | } |
97 | ||
1d93a9cb | 98 | static bool |
62fc8051 | 99 | dccp_mt(const struct sk_buff *skb, struct xt_action_param *par) |
1d3de414 | 100 | { |
f7108a20 | 101 | const struct xt_dccp_info *info = par->matchinfo; |
3cf93c96 JE |
102 | const struct dccp_hdr *dh; |
103 | struct dccp_hdr _dh; | |
1d3de414 | 104 | |
f7108a20 | 105 | if (par->fragoff != 0) |
1d93a9cb | 106 | return false; |
601e68e1 | 107 | |
f7108a20 | 108 | dh = skb_header_pointer(skb, par->thoff, sizeof(_dh), &_dh); |
1d3de414 | 109 | if (dh == NULL) { |
f7108a20 | 110 | *par->hotdrop = true; |
1d93a9cb | 111 | return false; |
601e68e1 | 112 | } |
1d3de414 | 113 | |
7c4e36bc JE |
114 | return DCCHECK(ntohs(dh->dccph_sport) >= info->spts[0] |
115 | && ntohs(dh->dccph_sport) <= info->spts[1], | |
601e68e1 | 116 | XT_DCCP_SRC_PORTS, info->flags, info->invflags) |
7c4e36bc JE |
117 | && DCCHECK(ntohs(dh->dccph_dport) >= info->dpts[0] |
118 | && ntohs(dh->dccph_dport) <= info->dpts[1], | |
2e4e6a17 | 119 | XT_DCCP_DEST_PORTS, info->flags, info->invflags) |
1d3de414 | 120 | && DCCHECK(match_types(dh, info->typemask), |
2e4e6a17 | 121 | XT_DCCP_TYPE, info->flags, info->invflags) |
f7108a20 JE |
122 | && DCCHECK(match_option(info->option, skb, par->thoff, dh, |
123 | par->hotdrop), | |
2e4e6a17 | 124 | XT_DCCP_OPTION, info->flags, info->invflags); |
1d3de414 HW |
125 | } |
126 | ||
b0f38452 | 127 | static int dccp_mt_check(const struct xt_mtchk_param *par) |
1d3de414 | 128 | { |
9b4fce7a | 129 | const struct xt_dccp_info *info = par->matchinfo; |
1d3de414 | 130 | |
9f567317 | 131 | if (info->flags & ~XT_DCCP_VALID_FLAGS) |
bd414ee6 | 132 | return -EINVAL; |
9f567317 | 133 | if (info->invflags & ~XT_DCCP_VALID_FLAGS) |
bd414ee6 | 134 | return -EINVAL; |
9f567317 | 135 | if (info->invflags & ~info->flags) |
bd414ee6 JE |
136 | return -EINVAL; |
137 | return 0; | |
2e4e6a17 HW |
138 | } |
139 | ||
d3c5ee6d | 140 | static struct xt_match dccp_mt_reg[] __read_mostly = { |
4470bbc7 PM |
141 | { |
142 | .name = "dccp", | |
ee999d8b | 143 | .family = NFPROTO_IPV4, |
d3c5ee6d JE |
144 | .checkentry = dccp_mt_check, |
145 | .match = dccp_mt, | |
4470bbc7 PM |
146 | .matchsize = sizeof(struct xt_dccp_info), |
147 | .proto = IPPROTO_DCCP, | |
148 | .me = THIS_MODULE, | |
149 | }, | |
150 | { | |
151 | .name = "dccp", | |
ee999d8b | 152 | .family = NFPROTO_IPV6, |
d3c5ee6d JE |
153 | .checkentry = dccp_mt_check, |
154 | .match = dccp_mt, | |
4470bbc7 PM |
155 | .matchsize = sizeof(struct xt_dccp_info), |
156 | .proto = IPPROTO_DCCP, | |
157 | .me = THIS_MODULE, | |
158 | }, | |
1d3de414 HW |
159 | }; |
160 | ||
d3c5ee6d | 161 | static int __init dccp_mt_init(void) |
1d3de414 HW |
162 | { |
163 | int ret; | |
164 | ||
165 | /* doff is 8 bits, so the maximum option size is (4*256). Don't put | |
166 | * this in BSS since DaveM is worried about locked TLB's for kernel | |
167 | * BSS. */ | |
168 | dccp_optbuf = kmalloc(256 * 4, GFP_KERNEL); | |
169 | if (!dccp_optbuf) | |
170 | return -ENOMEM; | |
d3c5ee6d | 171 | ret = xt_register_matches(dccp_mt_reg, ARRAY_SIZE(dccp_mt_reg)); |
1d3de414 | 172 | if (ret) |
2e4e6a17 | 173 | goto out_kfree; |
2e4e6a17 HW |
174 | return ret; |
175 | ||
2e4e6a17 HW |
176 | out_kfree: |
177 | kfree(dccp_optbuf); | |
1d3de414 HW |
178 | return ret; |
179 | } | |
180 | ||
d3c5ee6d | 181 | static void __exit dccp_mt_exit(void) |
1d3de414 | 182 | { |
d3c5ee6d | 183 | xt_unregister_matches(dccp_mt_reg, ARRAY_SIZE(dccp_mt_reg)); |
1d3de414 HW |
184 | kfree(dccp_optbuf); |
185 | } | |
186 | ||
d3c5ee6d JE |
187 | module_init(dccp_mt_init); |
188 | module_exit(dccp_mt_exit); |