net/ipv6/netfilter/ip6t_eui64.c

   1 /* Kernel module to match EUI64 address parameters. */
   2
   3 /* (C) 2001-2002 Andras Kis-Szabo <kisza@sch.bme.hu>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  */
   9
  10 #include <linux/module.h>
  11 #include <linux/skbuff.h>
  12 #include <linux/ipv6.h>
  13 #include <linux/if_ether.h>
  14
  15 #include <linux/netfilter_ipv6/ip6_tables.h>
  16
  17 MODULE_DESCRIPTION("IPv6 EUI64 address checking match");
  18 MODULE_LICENSE("GPL");
  19 MODULE_AUTHOR("Andras Kis-Szabo <kisza@sch.bme.hu>");
  20
  21 static int
  22 match(const struct sk_buff *skb,
  23       const struct net_device *in,
  24       const struct net_device *out,
  25       const void *matchinfo,
  26       int offset,
  27       unsigned int protoff,
  28       int *hotdrop)
  29 {
  30         unsigned char eui64[8];
  31         int i = 0;
  32
  33         if (!(skb->mac.raw >= skb->head &&
  34               (skb->mac.raw + ETH_HLEN) <= skb->data) &&
  35             offset != 0) {
  36                 *hotdrop = 1;
  37                 return 0;
  38         }
  39
  40         memset(eui64, 0, sizeof(eui64));
  41
  42         if (eth_hdr(skb)->h_proto == ntohs(ETH_P_IPV6)) {
  43                 if (skb->nh.ipv6h->version == 0x6) {
  44                         memcpy(eui64, eth_hdr(skb)->h_source, 3);
  45                         memcpy(eui64 + 5, eth_hdr(skb)->h_source + 3, 3);
  46                         eui64[3] = 0xff;
  47                         eui64[4] = 0xfe;
  48                         eui64[0] |= 0x02;
  49
  50                         i = 0;
  51                         while ((skb->nh.ipv6h->saddr.s6_addr[8+i] == eui64[i])
  52                                && (i < 8))
  53                                 i++;
  54
  55                         if (i == 8)
  56                                 return 1;
  57                 }
  58         }
  59
  60         return 0;
  61 }
  62
  63 static struct ip6t_match eui64_match = {
  64         .name           = "eui64",
  65         .match          = match,
  66         .matchsize      = sizeof(int),
  67         .hooks          = (1 << NF_IP6_PRE_ROUTING) | (1 << NF_IP6_LOCAL_IN) |
  68                           (1 << NF_IP6_FORWARD),
  69         .me             = THIS_MODULE,
  70 };
  71
  72 static int __init init(void)
  73 {
  74         return ip6t_register_match(&eui64_match);
  75 }
  76
  77 static void __exit fini(void)
  78 {
  79         ip6t_unregister_match(&eui64_match);
  80 }
  81
  82 module_init(init);
  83 module_exit(fini);