net/ipv4/netfilter/ipt_esp.c

   1 /* Kernel module to match ESP parameters. */
   2
   3 /* (C) 1999-2000 Yon Uriarte <yon@astaro.de>
   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/ip.h>
  13
  14 #include <linux/netfilter_ipv4/ipt_esp.h>
  15 #include <linux/netfilter_ipv4/ip_tables.h>
  16
  17 MODULE_LICENSE("GPL");
  18 MODULE_AUTHOR("Yon Uriarte <yon@astaro.de>");
  19 MODULE_DESCRIPTION("iptables ESP SPI match module");
  20
  21 #ifdef DEBUG_CONNTRACK
  22 #define duprintf(format, args...) printk(format , ## args)
  23 #else
  24 #define duprintf(format, args...)
  25 #endif
  26
  27 /* Returns 1 if the spi is matched by the range, 0 otherwise */
  28 static inline int
  29 spi_match(u_int32_t min, u_int32_t max, u_int32_t spi, int invert)
  30 {
  31         int r=0;
  32         duprintf("esp spi_match:%c 0x%x <= 0x%x <= 0x%x",invert? '!':' ',
  33                 min,spi,max);
  34         r=(spi >= min && spi <= max) ^ invert;
  35         duprintf(" result %s\n",r? "PASS" : "FAILED");
  36         return r;
  37 }
  38
  39 static int
  40 match(const struct sk_buff *skb,
  41       const struct net_device *in,
  42       const struct net_device *out,
  43       const void *matchinfo,
  44       int offset,
  45       int *hotdrop)
  46 {
  47         struct ip_esp_hdr esp;
  48         const struct ipt_esp *espinfo = matchinfo;
  49
  50         /* Must not be a fragment. */
  51         if (offset)
  52                 return 0;
  53
  54         if (skb_copy_bits(skb, skb->nh.iph->ihl*4, &esp, sizeof(esp)) < 0) {
  55                 /* We've been asked to examine this packet, and we
  56                    can't.  Hence, no choice but to drop. */
  57                 duprintf("Dropping evil ESP tinygram.\n");
  58                 *hotdrop = 1;
  59                 return 0;
  60         }
  61
  62         return spi_match(espinfo->spis[0], espinfo->spis[1],
  63                          ntohl(esp.spi),
  64                          !!(espinfo->invflags & IPT_ESP_INV_SPI));
  65 }
  66
  67 /* Called when user tries to insert an entry of this type. */
  68 static int
  69 checkentry(const char *tablename,
  70            const struct ipt_ip *ip,
  71            void *matchinfo,
  72            unsigned int matchinfosize,
  73            unsigned int hook_mask)
  74 {
  75         const struct ipt_esp *espinfo = matchinfo;
  76
  77         /* Must specify proto == ESP, and no unknown invflags */
  78         if (ip->proto != IPPROTO_ESP || (ip->invflags & IPT_INV_PROTO)) {
  79                 duprintf("ipt_esp: Protocol %u != %u\n", ip->proto,
  80                          IPPROTO_ESP);
  81                 return 0;
  82         }
  83         if (matchinfosize != IPT_ALIGN(sizeof(struct ipt_esp))) {
  84                 duprintf("ipt_esp: matchsize %u != %u\n",
  85                          matchinfosize, IPT_ALIGN(sizeof(struct ipt_esp)));
  86                 return 0;
  87         }
  88         if (espinfo->invflags & ~IPT_ESP_INV_MASK) {
  89                 duprintf("ipt_esp: unknown flags %X\n",
  90                          espinfo->invflags);
  91                 return 0;
  92         }
  93
  94         return 1;
  95 }
  96
  97 static struct ipt_match esp_match = {
  98         .name           = "esp",
  99         .match          = &match,
 100         .checkentry     = &checkentry,
 101         .me             = THIS_MODULE,
 102 };
 103
 104 static int __init init(void)
 105 {
 106         return ipt_register_match(&esp_match);
 107 }
 108
 109 static void __exit cleanup(void)
 110 {
 111         ipt_unregister_match(&esp_match);
 112 }
 113
 114 module_init(init);
 115 module_exit(cleanup);