Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[linux-drm-fsl-dcu.git] / net / ipv6 / netfilter / ip6t_REJECT.c
1 /*
2  * IP6 tables REJECT target module
3  * Linux INET6 implementation
4  *
5  * Copyright (C)2003 USAGI/WIDE Project
6  *
7  * Authors:
8  *      Yasuyuki Kozakai        <yasuyuki.kozakai@toshiba.co.jp>
9  *
10  * Based on net/ipv4/netfilter/ipt_REJECT.c
11  *
12  * This program is free software; you can redistribute it and/or
13  * modify it under the terms of the GNU General Public License
14  * as published by the Free Software Foundation; either version
15  * 2 of the License, or (at your option) any later version.
16  */
17
18 #include <linux/module.h>
19 #include <linux/skbuff.h>
20 #include <linux/icmpv6.h>
21 #include <linux/netdevice.h>
22 #include <net/ipv6.h>
23 #include <net/tcp.h>
24 #include <net/icmp.h>
25 #include <net/ip6_checksum.h>
26 #include <net/ip6_fib.h>
27 #include <net/ip6_route.h>
28 #include <net/flow.h>
29 #include <linux/netfilter/x_tables.h>
30 #include <linux/netfilter_ipv6/ip6_tables.h>
31 #include <linux/netfilter_ipv6/ip6t_REJECT.h>
32
33 MODULE_AUTHOR("Yasuyuki KOZAKAI <yasuyuki.kozakai@toshiba.co.jp>");
34 MODULE_DESCRIPTION("IP6 tables REJECT target module");
35 MODULE_LICENSE("GPL");
36
37 #if 0
38 #define DEBUGP printk
39 #else
40 #define DEBUGP(format, args...)
41 #endif
42
43 /* Send RST reply */
44 static void send_reset(struct sk_buff *oldskb)
45 {
46         struct sk_buff *nskb;
47         struct tcphdr otcph, *tcph;
48         unsigned int otcplen, hh_len;
49         int tcphoff, needs_ack;
50         struct ipv6hdr *oip6h = oldskb->nh.ipv6h, *ip6h;
51         struct dst_entry *dst = NULL;
52         u8 proto;
53         struct flowi fl;
54
55         if ((!(ipv6_addr_type(&oip6h->saddr) & IPV6_ADDR_UNICAST)) ||
56             (!(ipv6_addr_type(&oip6h->daddr) & IPV6_ADDR_UNICAST))) {
57                 DEBUGP("ip6t_REJECT: addr is not unicast.\n");
58                 return;
59         }
60
61         proto = oip6h->nexthdr;
62         tcphoff = ipv6_skip_exthdr(oldskb, ((u8*)(oip6h+1) - oldskb->data), &proto);
63
64         if ((tcphoff < 0) || (tcphoff > oldskb->len)) {
65                 DEBUGP("ip6t_REJECT: Can't get TCP header.\n");
66                 return;
67         }
68
69         otcplen = oldskb->len - tcphoff;
70
71         /* IP header checks: fragment, too short. */
72         if ((proto != IPPROTO_TCP) || (otcplen < sizeof(struct tcphdr))) {
73                 DEBUGP("ip6t_REJECT: proto(%d) != IPPROTO_TCP, or too short. otcplen = %d\n",
74                         proto, otcplen);
75                 return;
76         }
77
78         if (skb_copy_bits(oldskb, tcphoff, &otcph, sizeof(struct tcphdr)))
79                 BUG();
80
81         /* No RST for RST. */
82         if (otcph.rst) {
83                 DEBUGP("ip6t_REJECT: RST is set\n");
84                 return;
85         }
86
87         /* Check checksum. */
88         if (csum_ipv6_magic(&oip6h->saddr, &oip6h->daddr, otcplen, IPPROTO_TCP,
89                             skb_checksum(oldskb, tcphoff, otcplen, 0))) {
90                 DEBUGP("ip6t_REJECT: TCP checksum is invalid\n");
91                 return;
92         }
93
94         memset(&fl, 0, sizeof(fl));
95         fl.proto = IPPROTO_TCP;
96         ipv6_addr_copy(&fl.fl6_src, &oip6h->daddr);
97         ipv6_addr_copy(&fl.fl6_dst, &oip6h->saddr);
98         fl.fl_ip_sport = otcph.dest;
99         fl.fl_ip_dport = otcph.source;
100         security_skb_classify_flow(oldskb, &fl);
101         dst = ip6_route_output(NULL, &fl);
102         if (dst == NULL)
103                 return;
104         if (dst->error || xfrm_lookup(&dst, &fl, NULL, 0))
105                 return;
106
107         hh_len = (dst->dev->hard_header_len + 15)&~15;
108         nskb = alloc_skb(hh_len + 15 + dst->header_len + sizeof(struct ipv6hdr)
109                          + sizeof(struct tcphdr) + dst->trailer_len,
110                          GFP_ATOMIC);
111
112         if (!nskb) {
113                 if (net_ratelimit())
114                         printk("ip6t_REJECT: Can't alloc skb\n");
115                 dst_release(dst);
116                 return;
117         }
118
119         nskb->dst = dst;
120
121         skb_reserve(nskb, hh_len + dst->header_len);
122
123         ip6h = nskb->nh.ipv6h = (struct ipv6hdr *)
124                                         skb_put(nskb, sizeof(struct ipv6hdr));
125         ip6h->version = 6;
126         ip6h->hop_limit = dst_metric(dst, RTAX_HOPLIMIT);
127         ip6h->nexthdr = IPPROTO_TCP;
128         ip6h->payload_len = htons(sizeof(struct tcphdr));
129         ipv6_addr_copy(&ip6h->saddr, &oip6h->daddr);
130         ipv6_addr_copy(&ip6h->daddr, &oip6h->saddr);
131
132         tcph = (struct tcphdr *)skb_put(nskb, sizeof(struct tcphdr));
133         /* Truncate to length (no data) */
134         tcph->doff = sizeof(struct tcphdr)/4;
135         tcph->source = otcph.dest;
136         tcph->dest = otcph.source;
137
138         if (otcph.ack) {
139                 needs_ack = 0;
140                 tcph->seq = otcph.ack_seq;
141                 tcph->ack_seq = 0;
142         } else {
143                 needs_ack = 1;
144                 tcph->ack_seq = htonl(ntohl(otcph.seq) + otcph.syn + otcph.fin
145                                       + otcplen - (otcph.doff<<2));
146                 tcph->seq = 0;
147         }
148
149         /* Reset flags */
150         ((u_int8_t *)tcph)[13] = 0;
151         tcph->rst = 1;
152         tcph->ack = needs_ack;
153         tcph->window = 0;
154         tcph->urg_ptr = 0;
155         tcph->check = 0;
156
157         /* Adjust TCP checksum */
158         tcph->check = csum_ipv6_magic(&nskb->nh.ipv6h->saddr,
159                                       &nskb->nh.ipv6h->daddr,
160                                       sizeof(struct tcphdr), IPPROTO_TCP,
161                                       csum_partial((char *)tcph,
162                                                    sizeof(struct tcphdr), 0));
163
164         nf_ct_attach(nskb, oldskb);
165
166         NF_HOOK(PF_INET6, NF_IP6_LOCAL_OUT, nskb, NULL, nskb->dst->dev,
167                 dst_output);
168 }
169
170 static inline void
171 send_unreach(struct sk_buff *skb_in, unsigned char code, unsigned int hooknum)
172 {
173         if (hooknum == NF_IP6_LOCAL_OUT && skb_in->dev == NULL)
174                 skb_in->dev = &loopback_dev;
175
176         icmpv6_send(skb_in, ICMPV6_DEST_UNREACH, code, 0, NULL);
177 }
178
179 static unsigned int reject6_target(struct sk_buff **pskb,
180                            const struct net_device *in,
181                            const struct net_device *out,
182                            unsigned int hooknum,
183                            const struct xt_target *target,
184                            const void *targinfo)
185 {
186         const struct ip6t_reject_info *reject = targinfo;
187
188         DEBUGP(KERN_DEBUG "%s: medium point\n", __FUNCTION__);
189         /* WARNING: This code causes reentry within ip6tables.
190            This means that the ip6tables jump stack is now crap.  We
191            must return an absolute verdict. --RR */
192         switch (reject->with) {
193         case IP6T_ICMP6_NO_ROUTE:
194                 send_unreach(*pskb, ICMPV6_NOROUTE, hooknum);
195                 break;
196         case IP6T_ICMP6_ADM_PROHIBITED:
197                 send_unreach(*pskb, ICMPV6_ADM_PROHIBITED, hooknum);
198                 break;
199         case IP6T_ICMP6_NOT_NEIGHBOUR:
200                 send_unreach(*pskb, ICMPV6_NOT_NEIGHBOUR, hooknum);
201                 break;
202         case IP6T_ICMP6_ADDR_UNREACH:
203                 send_unreach(*pskb, ICMPV6_ADDR_UNREACH, hooknum);
204                 break;
205         case IP6T_ICMP6_PORT_UNREACH:
206                 send_unreach(*pskb, ICMPV6_PORT_UNREACH, hooknum);
207                 break;
208         case IP6T_ICMP6_ECHOREPLY:
209                 /* Do nothing */
210                 break;
211         case IP6T_TCP_RESET:
212                 send_reset(*pskb);
213                 break;
214         default:
215                 if (net_ratelimit())
216                         printk(KERN_WARNING "ip6t_REJECT: case %u not handled yet\n", reject->with);
217                 break;
218         }
219
220         return NF_DROP;
221 }
222
223 static int check(const char *tablename,
224                  const void *entry,
225                  const struct xt_target *target,
226                  void *targinfo,
227                  unsigned int hook_mask)
228 {
229         const struct ip6t_reject_info *rejinfo = targinfo;
230         const struct ip6t_entry *e = entry;
231
232         if (rejinfo->with == IP6T_ICMP6_ECHOREPLY) {
233                 printk("ip6t_REJECT: ECHOREPLY is not supported.\n");
234                 return 0;
235         } else if (rejinfo->with == IP6T_TCP_RESET) {
236                 /* Must specify that it's a TCP packet */
237                 if (e->ipv6.proto != IPPROTO_TCP
238                     || (e->ipv6.invflags & XT_INV_PROTO)) {
239                         DEBUGP("ip6t_REJECT: TCP_RESET illegal for non-tcp\n");
240                         return 0;
241                 }
242         }
243         return 1;
244 }
245
246 static struct xt_target ip6t_reject_reg = {
247         .name           = "REJECT",
248         .family         = AF_INET6,
249         .target         = reject6_target,
250         .targetsize     = sizeof(struct ip6t_reject_info),
251         .table          = "filter",
252         .hooks          = (1 << NF_IP6_LOCAL_IN) | (1 << NF_IP6_FORWARD) |
253                           (1 << NF_IP6_LOCAL_OUT),
254         .checkentry     = check,
255         .me             = THIS_MODULE
256 };
257
258 static int __init ip6t_reject_init(void)
259 {
260         return xt_register_target(&ip6t_reject_reg);
261 }
262
263 static void __exit ip6t_reject_fini(void)
264 {
265         xt_unregister_target(&ip6t_reject_reg);
266 }
267
268 module_init(ip6t_reject_init);
269 module_exit(ip6t_reject_fini);