added 2.6.29.6 aldebaran kernel
[nao-ulib.git] / kernel / 2.6.29.6-aldebaran-rt / net / ipv4 / netfilter / ipt_CLUSTERIP.c
blob2e4f98b85524ab6fa7baf8c945dc2017e90fcfff
1 /* Cluster IP hashmark target
2 * (C) 2003-2004 by Harald Welte <laforge@netfilter.org>
3 * based on ideas of Fabio Olive Leite <olive@unixforge.org>
5 * Development of this code funded by SuSE Linux AG, http://www.suse.com/
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
12 #include <linux/module.h>
13 #include <linux/proc_fs.h>
14 #include <linux/jhash.h>
15 #include <linux/bitops.h>
16 #include <linux/skbuff.h>
17 #include <linux/ip.h>
18 #include <linux/tcp.h>
19 #include <linux/udp.h>
20 #include <linux/icmp.h>
21 #include <linux/if_arp.h>
22 #include <linux/seq_file.h>
23 #include <linux/netfilter_arp.h>
24 #include <linux/netfilter/x_tables.h>
25 #include <linux/netfilter_ipv4/ip_tables.h>
26 #include <linux/netfilter_ipv4/ipt_CLUSTERIP.h>
27 #include <net/netfilter/nf_conntrack.h>
28 #include <net/net_namespace.h>
29 #include <net/checksum.h>
31 #define CLUSTERIP_VERSION "0.8"
33 MODULE_LICENSE("GPL");
34 MODULE_AUTHOR("Harald Welte <laforge@netfilter.org>");
35 MODULE_DESCRIPTION("Xtables: CLUSTERIP target");
37 struct clusterip_config {
38 struct list_head list; /* list of all configs */
39 atomic_t refcount; /* reference count */
40 atomic_t entries; /* number of entries/rules
41 * referencing us */
43 __be32 clusterip; /* the IP address */
44 u_int8_t clustermac[ETH_ALEN]; /* the MAC address */
45 struct net_device *dev; /* device */
46 u_int16_t num_total_nodes; /* total number of nodes */
47 unsigned long local_nodes; /* node number array */
49 #ifdef CONFIG_PROC_FS
50 struct proc_dir_entry *pde; /* proc dir entry */
51 #endif
52 enum clusterip_hashmode hash_mode; /* which hashing mode */
53 u_int32_t hash_initval; /* hash initialization */
56 static LIST_HEAD(clusterip_configs);
58 /* clusterip_lock protects the clusterip_configs list */
59 static DEFINE_RWLOCK(clusterip_lock);
61 #ifdef CONFIG_PROC_FS
62 static const struct file_operations clusterip_proc_fops;
63 static struct proc_dir_entry *clusterip_procdir;
64 #endif
66 static inline void
67 clusterip_config_get(struct clusterip_config *c)
69 atomic_inc(&c->refcount);
72 static inline void
73 clusterip_config_put(struct clusterip_config *c)
75 if (atomic_dec_and_test(&c->refcount))
76 kfree(c);
79 /* decrease the count of entries using/referencing this config. If last
80 * entry(rule) is removed, remove the config from lists, but don't free it
81 * yet, since proc-files could still be holding references */
82 static inline void
83 clusterip_config_entry_put(struct clusterip_config *c)
85 write_lock_bh(&clusterip_lock);
86 if (atomic_dec_and_test(&c->entries)) {
87 list_del(&c->list);
88 write_unlock_bh(&clusterip_lock);
90 dev_mc_delete(c->dev, c->clustermac, ETH_ALEN, 0);
91 dev_put(c->dev);
93 /* In case anyone still accesses the file, the open/close
94 * functions are also incrementing the refcount on their own,
95 * so it's safe to remove the entry even if it's in use. */
96 #ifdef CONFIG_PROC_FS
97 remove_proc_entry(c->pde->name, c->pde->parent);
98 #endif
99 return;
101 write_unlock_bh(&clusterip_lock);
104 static struct clusterip_config *
105 __clusterip_config_find(__be32 clusterip)
107 struct clusterip_config *c;
109 list_for_each_entry(c, &clusterip_configs, list) {
110 if (c->clusterip == clusterip)
111 return c;
114 return NULL;
117 static inline struct clusterip_config *
118 clusterip_config_find_get(__be32 clusterip, int entry)
120 struct clusterip_config *c;
122 read_lock_bh(&clusterip_lock);
123 c = __clusterip_config_find(clusterip);
124 if (!c) {
125 read_unlock_bh(&clusterip_lock);
126 return NULL;
128 atomic_inc(&c->refcount);
129 if (entry)
130 atomic_inc(&c->entries);
131 read_unlock_bh(&clusterip_lock);
133 return c;
136 static void
137 clusterip_config_init_nodelist(struct clusterip_config *c,
138 const struct ipt_clusterip_tgt_info *i)
140 int n;
142 for (n = 0; n < i->num_local_nodes; n++)
143 set_bit(i->local_nodes[n] - 1, &c->local_nodes);
146 static struct clusterip_config *
147 clusterip_config_init(const struct ipt_clusterip_tgt_info *i, __be32 ip,
148 struct net_device *dev)
150 struct clusterip_config *c;
152 c = kzalloc(sizeof(*c), GFP_ATOMIC);
153 if (!c)
154 return NULL;
156 c->dev = dev;
157 c->clusterip = ip;
158 memcpy(&c->clustermac, &i->clustermac, ETH_ALEN);
159 c->num_total_nodes = i->num_total_nodes;
160 clusterip_config_init_nodelist(c, i);
161 c->hash_mode = i->hash_mode;
162 c->hash_initval = i->hash_initval;
163 atomic_set(&c->refcount, 1);
164 atomic_set(&c->entries, 1);
166 #ifdef CONFIG_PROC_FS
168 char buffer[16];
170 /* create proc dir entry */
171 sprintf(buffer, "%pI4", &ip);
172 c->pde = proc_create_data(buffer, S_IWUSR|S_IRUSR,
173 clusterip_procdir,
174 &clusterip_proc_fops, c);
175 if (!c->pde) {
176 kfree(c);
177 return NULL;
180 #endif
182 write_lock_bh(&clusterip_lock);
183 list_add(&c->list, &clusterip_configs);
184 write_unlock_bh(&clusterip_lock);
186 return c;
189 #ifdef CONFIG_PROC_FS
190 static int
191 clusterip_add_node(struct clusterip_config *c, u_int16_t nodenum)
194 if (nodenum == 0 ||
195 nodenum > c->num_total_nodes)
196 return 1;
198 /* check if we already have this number in our bitfield */
199 if (test_and_set_bit(nodenum - 1, &c->local_nodes))
200 return 1;
202 return 0;
205 static bool
206 clusterip_del_node(struct clusterip_config *c, u_int16_t nodenum)
208 if (nodenum == 0 ||
209 nodenum > c->num_total_nodes)
210 return true;
212 if (test_and_clear_bit(nodenum - 1, &c->local_nodes))
213 return false;
215 return true;
217 #endif
219 static inline u_int32_t
220 clusterip_hashfn(const struct sk_buff *skb,
221 const struct clusterip_config *config)
223 const struct iphdr *iph = ip_hdr(skb);
224 unsigned long hashval;
225 u_int16_t sport, dport;
226 const u_int16_t *ports;
228 switch (iph->protocol) {
229 case IPPROTO_TCP:
230 case IPPROTO_UDP:
231 case IPPROTO_UDPLITE:
232 case IPPROTO_SCTP:
233 case IPPROTO_DCCP:
234 case IPPROTO_ICMP:
235 ports = (const void *)iph+iph->ihl*4;
236 sport = ports[0];
237 dport = ports[1];
238 break;
239 default:
240 if (net_ratelimit())
241 printk(KERN_NOTICE "CLUSTERIP: unknown protocol `%u'\n",
242 iph->protocol);
243 sport = dport = 0;
246 switch (config->hash_mode) {
247 case CLUSTERIP_HASHMODE_SIP:
248 hashval = jhash_1word(ntohl(iph->saddr),
249 config->hash_initval);
250 break;
251 case CLUSTERIP_HASHMODE_SIP_SPT:
252 hashval = jhash_2words(ntohl(iph->saddr), sport,
253 config->hash_initval);
254 break;
255 case CLUSTERIP_HASHMODE_SIP_SPT_DPT:
256 hashval = jhash_3words(ntohl(iph->saddr), sport, dport,
257 config->hash_initval);
258 break;
259 default:
260 /* to make gcc happy */
261 hashval = 0;
262 /* This cannot happen, unless the check function wasn't called
263 * at rule load time */
264 printk("CLUSTERIP: unknown mode `%u'\n", config->hash_mode);
265 BUG();
266 break;
269 /* node numbers are 1..n, not 0..n */
270 return (((u64)hashval * config->num_total_nodes) >> 32) + 1;
273 static inline int
274 clusterip_responsible(const struct clusterip_config *config, u_int32_t hash)
276 return test_bit(hash - 1, &config->local_nodes);
279 /***********************************************************************
280 * IPTABLES TARGET
281 ***********************************************************************/
283 static unsigned int
284 clusterip_tg(struct sk_buff *skb, const struct xt_target_param *par)
286 const struct ipt_clusterip_tgt_info *cipinfo = par->targinfo;
287 struct nf_conn *ct;
288 enum ip_conntrack_info ctinfo;
289 u_int32_t hash;
291 /* don't need to clusterip_config_get() here, since refcount
292 * is only decremented by destroy() - and ip_tables guarantees
293 * that the ->target() function isn't called after ->destroy() */
295 ct = nf_ct_get(skb, &ctinfo);
296 if (ct == NULL) {
297 printk(KERN_ERR "CLUSTERIP: no conntrack!\n");
298 /* FIXME: need to drop invalid ones, since replies
299 * to outgoing connections of other nodes will be
300 * marked as INVALID */
301 return NF_DROP;
304 /* special case: ICMP error handling. conntrack distinguishes between
305 * error messages (RELATED) and information requests (see below) */
306 if (ip_hdr(skb)->protocol == IPPROTO_ICMP
307 && (ctinfo == IP_CT_RELATED
308 || ctinfo == IP_CT_RELATED+IP_CT_IS_REPLY))
309 return XT_CONTINUE;
311 /* ip_conntrack_icmp guarantees us that we only have ICMP_ECHO,
312 * TIMESTAMP, INFO_REQUEST or ADDRESS type icmp packets from here
313 * on, which all have an ID field [relevant for hashing]. */
315 hash = clusterip_hashfn(skb, cipinfo->config);
317 switch (ctinfo) {
318 case IP_CT_NEW:
319 ct->mark = hash;
320 break;
321 case IP_CT_RELATED:
322 case IP_CT_RELATED+IP_CT_IS_REPLY:
323 /* FIXME: we don't handle expectations at the
324 * moment. they can arrive on a different node than
325 * the master connection (e.g. FTP passive mode) */
326 case IP_CT_ESTABLISHED:
327 case IP_CT_ESTABLISHED+IP_CT_IS_REPLY:
328 break;
329 default:
330 break;
333 #ifdef DEBUG
334 nf_ct_dump_tuple_ip(&ct->tuplehash[IP_CT_DIR_ORIGINAL].tuple);
335 #endif
336 pr_debug("hash=%u ct_hash=%u ", hash, ct->mark);
337 if (!clusterip_responsible(cipinfo->config, hash)) {
338 pr_debug("not responsible\n");
339 return NF_DROP;
341 pr_debug("responsible\n");
343 /* despite being received via linklayer multicast, this is
344 * actually a unicast IP packet. TCP doesn't like PACKET_MULTICAST */
345 skb->pkt_type = PACKET_HOST;
347 return XT_CONTINUE;
350 static bool clusterip_tg_check(const struct xt_tgchk_param *par)
352 struct ipt_clusterip_tgt_info *cipinfo = par->targinfo;
353 const struct ipt_entry *e = par->entryinfo;
355 struct clusterip_config *config;
357 if (cipinfo->hash_mode != CLUSTERIP_HASHMODE_SIP &&
358 cipinfo->hash_mode != CLUSTERIP_HASHMODE_SIP_SPT &&
359 cipinfo->hash_mode != CLUSTERIP_HASHMODE_SIP_SPT_DPT) {
360 printk(KERN_WARNING "CLUSTERIP: unknown mode `%u'\n",
361 cipinfo->hash_mode);
362 return false;
365 if (e->ip.dmsk.s_addr != htonl(0xffffffff)
366 || e->ip.dst.s_addr == 0) {
367 printk(KERN_ERR "CLUSTERIP: Please specify destination IP\n");
368 return false;
371 /* FIXME: further sanity checks */
373 config = clusterip_config_find_get(e->ip.dst.s_addr, 1);
374 if (!config) {
375 if (!(cipinfo->flags & CLUSTERIP_FLAG_NEW)) {
376 printk(KERN_WARNING "CLUSTERIP: no config found for %pI4, need 'new'\n", &e->ip.dst.s_addr);
377 return false;
378 } else {
379 struct net_device *dev;
381 if (e->ip.iniface[0] == '\0') {
382 printk(KERN_WARNING "CLUSTERIP: Please specify an interface name\n");
383 return false;
386 dev = dev_get_by_name(&init_net, e->ip.iniface);
387 if (!dev) {
388 printk(KERN_WARNING "CLUSTERIP: no such interface %s\n", e->ip.iniface);
389 return false;
392 config = clusterip_config_init(cipinfo,
393 e->ip.dst.s_addr, dev);
394 if (!config) {
395 printk(KERN_WARNING "CLUSTERIP: cannot allocate config\n");
396 dev_put(dev);
397 return false;
399 dev_mc_add(config->dev,config->clustermac, ETH_ALEN, 0);
402 cipinfo->config = config;
404 if (nf_ct_l3proto_try_module_get(par->target->family) < 0) {
405 printk(KERN_WARNING "can't load conntrack support for "
406 "proto=%u\n", par->target->family);
407 return false;
410 return true;
413 /* drop reference count of cluster config when rule is deleted */
414 static void clusterip_tg_destroy(const struct xt_tgdtor_param *par)
416 const struct ipt_clusterip_tgt_info *cipinfo = par->targinfo;
418 /* if no more entries are referencing the config, remove it
419 * from the list and destroy the proc entry */
420 clusterip_config_entry_put(cipinfo->config);
422 clusterip_config_put(cipinfo->config);
424 nf_ct_l3proto_module_put(par->target->family);
427 #ifdef CONFIG_COMPAT
428 struct compat_ipt_clusterip_tgt_info
430 u_int32_t flags;
431 u_int8_t clustermac[6];
432 u_int16_t num_total_nodes;
433 u_int16_t num_local_nodes;
434 u_int16_t local_nodes[CLUSTERIP_MAX_NODES];
435 u_int32_t hash_mode;
436 u_int32_t hash_initval;
437 compat_uptr_t config;
439 #endif /* CONFIG_COMPAT */
441 static struct xt_target clusterip_tg_reg __read_mostly = {
442 .name = "CLUSTERIP",
443 .family = NFPROTO_IPV4,
444 .target = clusterip_tg,
445 .checkentry = clusterip_tg_check,
446 .destroy = clusterip_tg_destroy,
447 .targetsize = sizeof(struct ipt_clusterip_tgt_info),
448 #ifdef CONFIG_COMPAT
449 .compatsize = sizeof(struct compat_ipt_clusterip_tgt_info),
450 #endif /* CONFIG_COMPAT */
451 .me = THIS_MODULE
455 /***********************************************************************
456 * ARP MANGLING CODE
457 ***********************************************************************/
459 /* hardcoded for 48bit ethernet and 32bit ipv4 addresses */
460 struct arp_payload {
461 u_int8_t src_hw[ETH_ALEN];
462 __be32 src_ip;
463 u_int8_t dst_hw[ETH_ALEN];
464 __be32 dst_ip;
465 } __attribute__ ((packed));
467 #ifdef DEBUG
468 static void arp_print(struct arp_payload *payload)
470 #define HBUFFERLEN 30
471 char hbuffer[HBUFFERLEN];
472 int j,k;
474 for (k=0, j=0; k < HBUFFERLEN-3 && j < ETH_ALEN; j++) {
475 hbuffer[k++] = hex_asc_hi(payload->src_hw[j]);
476 hbuffer[k++] = hex_asc_lo(payload->src_hw[j]);
477 hbuffer[k++]=':';
479 hbuffer[--k]='\0';
481 printk("src %pI4@%s, dst %pI4\n",
482 &payload->src_ip, hbuffer, &payload->dst_ip);
484 #endif
486 static unsigned int
487 arp_mangle(unsigned int hook,
488 struct sk_buff *skb,
489 const struct net_device *in,
490 const struct net_device *out,
491 int (*okfn)(struct sk_buff *))
493 struct arphdr *arp = arp_hdr(skb);
494 struct arp_payload *payload;
495 struct clusterip_config *c;
497 /* we don't care about non-ethernet and non-ipv4 ARP */
498 if (arp->ar_hrd != htons(ARPHRD_ETHER)
499 || arp->ar_pro != htons(ETH_P_IP)
500 || arp->ar_pln != 4 || arp->ar_hln != ETH_ALEN)
501 return NF_ACCEPT;
503 /* we only want to mangle arp requests and replies */
504 if (arp->ar_op != htons(ARPOP_REPLY)
505 && arp->ar_op != htons(ARPOP_REQUEST))
506 return NF_ACCEPT;
508 payload = (void *)(arp+1);
510 /* if there is no clusterip configuration for the arp reply's
511 * source ip, we don't want to mangle it */
512 c = clusterip_config_find_get(payload->src_ip, 0);
513 if (!c)
514 return NF_ACCEPT;
516 /* normally the linux kernel always replies to arp queries of
517 * addresses on different interfacs. However, in the CLUSTERIP case
518 * this wouldn't work, since we didn't subscribe the mcast group on
519 * other interfaces */
520 if (c->dev != out) {
521 pr_debug("CLUSTERIP: not mangling arp reply on different "
522 "interface: cip'%s'-skb'%s'\n",
523 c->dev->name, out->name);
524 clusterip_config_put(c);
525 return NF_ACCEPT;
528 /* mangle reply hardware address */
529 memcpy(payload->src_hw, c->clustermac, arp->ar_hln);
531 #ifdef DEBUG
532 pr_debug(KERN_DEBUG "CLUSTERIP mangled arp reply: ");
533 arp_print(payload);
534 #endif
536 clusterip_config_put(c);
538 return NF_ACCEPT;
541 static struct nf_hook_ops cip_arp_ops __read_mostly = {
542 .hook = arp_mangle,
543 .pf = NFPROTO_ARP,
544 .hooknum = NF_ARP_OUT,
545 .priority = -1
548 /***********************************************************************
549 * PROC DIR HANDLING
550 ***********************************************************************/
552 #ifdef CONFIG_PROC_FS
554 struct clusterip_seq_position {
555 unsigned int pos; /* position */
556 unsigned int weight; /* number of bits set == size */
557 unsigned int bit; /* current bit */
558 unsigned long val; /* current value */
561 static void *clusterip_seq_start(struct seq_file *s, loff_t *pos)
563 const struct proc_dir_entry *pde = s->private;
564 struct clusterip_config *c = pde->data;
565 unsigned int weight;
566 u_int32_t local_nodes;
567 struct clusterip_seq_position *idx;
569 /* FIXME: possible race */
570 local_nodes = c->local_nodes;
571 weight = hweight32(local_nodes);
572 if (*pos >= weight)
573 return NULL;
575 idx = kmalloc(sizeof(struct clusterip_seq_position), GFP_KERNEL);
576 if (!idx)
577 return ERR_PTR(-ENOMEM);
579 idx->pos = *pos;
580 idx->weight = weight;
581 idx->bit = ffs(local_nodes);
582 idx->val = local_nodes;
583 clear_bit(idx->bit - 1, &idx->val);
585 return idx;
588 static void *clusterip_seq_next(struct seq_file *s, void *v, loff_t *pos)
590 struct clusterip_seq_position *idx = v;
592 *pos = ++idx->pos;
593 if (*pos >= idx->weight) {
594 kfree(v);
595 return NULL;
597 idx->bit = ffs(idx->val);
598 clear_bit(idx->bit - 1, &idx->val);
599 return idx;
602 static void clusterip_seq_stop(struct seq_file *s, void *v)
604 kfree(v);
607 static int clusterip_seq_show(struct seq_file *s, void *v)
609 struct clusterip_seq_position *idx = v;
611 if (idx->pos != 0)
612 seq_putc(s, ',');
614 seq_printf(s, "%u", idx->bit);
616 if (idx->pos == idx->weight - 1)
617 seq_putc(s, '\n');
619 return 0;
622 static const struct seq_operations clusterip_seq_ops = {
623 .start = clusterip_seq_start,
624 .next = clusterip_seq_next,
625 .stop = clusterip_seq_stop,
626 .show = clusterip_seq_show,
629 static int clusterip_proc_open(struct inode *inode, struct file *file)
631 int ret = seq_open(file, &clusterip_seq_ops);
633 if (!ret) {
634 struct seq_file *sf = file->private_data;
635 struct proc_dir_entry *pde = PDE(inode);
636 struct clusterip_config *c = pde->data;
638 sf->private = pde;
640 clusterip_config_get(c);
643 return ret;
646 static int clusterip_proc_release(struct inode *inode, struct file *file)
648 struct proc_dir_entry *pde = PDE(inode);
649 struct clusterip_config *c = pde->data;
650 int ret;
652 ret = seq_release(inode, file);
654 if (!ret)
655 clusterip_config_put(c);
657 return ret;
660 static ssize_t clusterip_proc_write(struct file *file, const char __user *input,
661 size_t size, loff_t *ofs)
663 #define PROC_WRITELEN 10
664 char buffer[PROC_WRITELEN+1];
665 const struct proc_dir_entry *pde = PDE(file->f_path.dentry->d_inode);
666 struct clusterip_config *c = pde->data;
667 unsigned long nodenum;
669 if (copy_from_user(buffer, input, PROC_WRITELEN))
670 return -EFAULT;
672 if (*buffer == '+') {
673 nodenum = simple_strtoul(buffer+1, NULL, 10);
674 if (clusterip_add_node(c, nodenum))
675 return -ENOMEM;
676 } else if (*buffer == '-') {
677 nodenum = simple_strtoul(buffer+1, NULL,10);
678 if (clusterip_del_node(c, nodenum))
679 return -ENOENT;
680 } else
681 return -EIO;
683 return size;
686 static const struct file_operations clusterip_proc_fops = {
687 .owner = THIS_MODULE,
688 .open = clusterip_proc_open,
689 .read = seq_read,
690 .write = clusterip_proc_write,
691 .llseek = seq_lseek,
692 .release = clusterip_proc_release,
695 #endif /* CONFIG_PROC_FS */
697 static int __init clusterip_tg_init(void)
699 int ret;
701 ret = xt_register_target(&clusterip_tg_reg);
702 if (ret < 0)
703 return ret;
705 ret = nf_register_hook(&cip_arp_ops);
706 if (ret < 0)
707 goto cleanup_target;
709 #ifdef CONFIG_PROC_FS
710 clusterip_procdir = proc_mkdir("ipt_CLUSTERIP", init_net.proc_net);
711 if (!clusterip_procdir) {
712 printk(KERN_ERR "CLUSTERIP: Unable to proc dir entry\n");
713 ret = -ENOMEM;
714 goto cleanup_hook;
716 #endif /* CONFIG_PROC_FS */
718 printk(KERN_NOTICE "ClusterIP Version %s loaded successfully\n",
719 CLUSTERIP_VERSION);
720 return 0;
722 #ifdef CONFIG_PROC_FS
723 cleanup_hook:
724 nf_unregister_hook(&cip_arp_ops);
725 #endif /* CONFIG_PROC_FS */
726 cleanup_target:
727 xt_unregister_target(&clusterip_tg_reg);
728 return ret;
731 static void __exit clusterip_tg_exit(void)
733 printk(KERN_NOTICE "ClusterIP Version %s unloading\n",
734 CLUSTERIP_VERSION);
735 #ifdef CONFIG_PROC_FS
736 remove_proc_entry(clusterip_procdir->name, clusterip_procdir->parent);
737 #endif
738 nf_unregister_hook(&cip_arp_ops);
739 xt_unregister_target(&clusterip_tg_reg);
742 module_init(clusterip_tg_init);
743 module_exit(clusterip_tg_exit);