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 #if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE)
  35 #include <net/netfilter/nf_conntrack_ecache.h>
  36 #endif
  37
  38 static unsigned int
  39 target(struct sk_buff **pskb,
  40        const struct net_device *in,
  41        const struct net_device *out,
  42        unsigned int hooknum,
  43        const struct xt_target *target,
  44        const void *targinfo)
  45 {
  46         const struct xt_connmark_target_info *markinfo = targinfo;
  47         u_int32_t diff;
  48         u_int32_t mark;
  49         u_int32_t newmark;
  50         u_int32_t ctinfo;
  51         u_int32_t *ctmark = nf_ct_get_mark(*pskb, &ctinfo);
  52
  53         if (ctmark) {
  54                 switch(markinfo->mode) {
  55                 case XT_CONNMARK_SET:
  56                         newmark = (*ctmark & ~markinfo->mask) | markinfo->mark;
  57                         if (newmark != *ctmark) {
  58                                 *ctmark = newmark;
  59 #if defined(CONFIG_IP_NF_CONNTRACK) || defined(CONFIG_IP_NF_CONNTRACK_MODULE)
  60                                 ip_conntrack_event_cache(IPCT_MARK, *pskb);
  61 #else
  62                                 nf_conntrack_event_cache(IPCT_MARK, *pskb);
  63 #endif
  64                 }
  65                         break;
  66                 case XT_CONNMARK_SAVE:
  67                         newmark = (*ctmark & ~markinfo->mask) |
  68                                   ((*pskb)->mark & markinfo->mask);
  69                         if (*ctmark != newmark) {
  70                                 *ctmark = newmark;
  71 #if defined(CONFIG_IP_NF_CONNTRACK) || defined(CONFIG_IP_NF_CONNTRACK_MODULE)
  72                                 ip_conntrack_event_cache(IPCT_MARK, *pskb);
  73 #else
  74                                 nf_conntrack_event_cache(IPCT_MARK, *pskb);
  75 #endif
  76                         }
  77                         break;
  78                 case XT_CONNMARK_RESTORE:
  79                         mark = (*pskb)->mark;
  80                         diff = (*ctmark ^ mark) & markinfo->mask;
  81                         if (diff != 0)
  82                                 (*pskb)->mark = mark ^ diff;
  83                         break;
  84                 }
  85         }
  86
  87         return XT_CONTINUE;
  88 }
  89
  90 static int
  91 checkentry(const char *tablename,
  92            const void *entry,
  93            const struct xt_target *target,
  94            void *targinfo,
  95            unsigned int hook_mask)
  96 {
  97         struct xt_connmark_target_info *matchinfo = targinfo;
  98
  99         if (matchinfo->mode == XT_CONNMARK_RESTORE) {
 100                 if (strcmp(tablename, "mangle") != 0) {
 101                         printk(KERN_WARNING "CONNMARK: restore can only be "
 102                                "called from \"mangle\" table, not \"%s\"\n",
 103                                tablename);
 104                         return 0;
 105                 }
 106         }
 107         if (matchinfo->mark > 0xffffffff || matchinfo->mask > 0xffffffff) {
 108                 printk(KERN_WARNING "CONNMARK: Only supports 32bit mark\n");
 109                 return 0;
 110         }
 111         return 1;
 112 }
 113
 114 #ifdef CONFIG_COMPAT
 115 struct compat_xt_connmark_target_info {
 116         compat_ulong_t  mark, mask;
 117         u_int8_t        mode;
 118         u_int8_t        __pad1;
 119         u_int16_t       __pad2;
 120 };
 121
 122 static void compat_from_user(void *dst, void *src)
 123 {
 124         struct compat_xt_connmark_target_info *cm = src;
 125         struct xt_connmark_target_info m = {
 126                 .mark   = cm->mark,
 127                 .mask   = cm->mask,
 128                 .mode   = cm->mode,
 129         };
 130         memcpy(dst, &m, sizeof(m));
 131 }
 132
 133 static int compat_to_user(void __user *dst, void *src)
 134 {
 135         struct xt_connmark_target_info *m = src;
 136         struct compat_xt_connmark_target_info cm = {
 137                 .mark   = m->mark,
 138                 .mask   = m->mask,
 139                 .mode   = m->mode,
 140         };
 141         return copy_to_user(dst, &cm, sizeof(cm)) ? -EFAULT : 0;
 142 }
 143 #endif /* CONFIG_COMPAT */
 144
 145 static struct xt_target xt_connmark_target[] = {
 146         {
 147                 .name           = "CONNMARK",
 148                 .family         = AF_INET,
 149                 .checkentry     = checkentry,
 150                 .target         = target,
 151                 .targetsize     = sizeof(struct xt_connmark_target_info),
 152 #ifdef CONFIG_COMPAT
 153                 .compatsize     = sizeof(struct compat_xt_connmark_target_info),
 154                 .compat_from_user = compat_from_user,
 155                 .compat_to_user = compat_to_user,
 156 #endif
 157                 .me             = THIS_MODULE
 158         },
 159         {
 160                 .name           = "CONNMARK",
 161                 .family         = AF_INET6,
 162                 .checkentry     = checkentry,
 163                 .target         = target,
 164                 .targetsize     = sizeof(struct xt_connmark_target_info),
 165                 .me             = THIS_MODULE
 166         },
 167 };
 168
 169 static int __init xt_connmark_init(void)
 170 {
 171         need_conntrack();
 172         return xt_register_targets(xt_connmark_target,
 173                                    ARRAY_SIZE(xt_connmark_target));
 174 }
 175
 176 static void __exit xt_connmark_fini(void)
 177 {
 178         xt_unregister_targets(xt_connmark_target,
 179                               ARRAY_SIZE(xt_connmark_target));
 180 }
 181
 182 module_init(xt_connmark_init);
 183 module_exit(xt_connmark_fini);