kernel/2.6.29.6-aldebaran-rt/net/ipv4/netfilter/nf_nat_proto_sctp.c

   1 /*
   2  * Copyright (c) 2008 Patrick McHardy <kaber@trash.net>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  */
   8
   9 #include <linux/types.h>
  10 #include <linux/init.h>
  11 #include <linux/ip.h>
  12 #include <linux/sctp.h>
  13 #include <net/sctp/checksum.h>
  14
  15 #include <net/netfilter/nf_nat_protocol.h>
  16
  17 static u_int16_t nf_sctp_port_rover;
  18
  19 static bool
  20 sctp_unique_tuple(struct nf_conntrack_tuple *tuple,
  21                   const struct nf_nat_range *range,
  22                   enum nf_nat_manip_type maniptype,
  23                   const struct nf_conn *ct)
  24 {
  25         return nf_nat_proto_unique_tuple(tuple, range, maniptype, ct,
  26                                          &nf_sctp_port_rover);
  27 }
  28
  29 static bool
  30 sctp_manip_pkt(struct sk_buff *skb,
  31                unsigned int iphdroff,
  32                const struct nf_conntrack_tuple *tuple,
  33                enum nf_nat_manip_type maniptype)
  34 {
  35         const struct iphdr *iph = (struct iphdr *)(skb->data + iphdroff);
  36         sctp_sctphdr_t *hdr;
  37         unsigned int hdroff = iphdroff + iph->ihl*4;
  38         __be32 oldip, newip;
  39         __be32 crc32;
  40
  41         if (!skb_make_writable(skb, hdroff + sizeof(*hdr)))
  42                 return false;
  43
  44         iph = (struct iphdr *)(skb->data + iphdroff);
  45         hdr = (struct sctphdr *)(skb->data + hdroff);
  46
  47         if (maniptype == IP_NAT_MANIP_SRC) {
  48                 /* Get rid of src ip and src pt */
  49                 oldip = iph->saddr;
  50                 newip = tuple->src.u3.ip;
  51                 hdr->source = tuple->src.u.sctp.port;
  52         } else {
  53                 /* Get rid of dst ip and dst pt */
  54                 oldip = iph->daddr;
  55                 newip = tuple->dst.u3.ip;
  56                 hdr->dest = tuple->dst.u.sctp.port;
  57         }
  58
  59         crc32 = sctp_start_cksum((u8 *)hdr, skb_headlen(skb) - hdroff);
  60         for (skb = skb_shinfo(skb)->frag_list; skb; skb = skb->next)
  61                 crc32 = sctp_update_cksum((u8 *)skb->data, skb_headlen(skb),
  62                                           crc32);
  63         crc32 = sctp_end_cksum(crc32);
  64         hdr->checksum = crc32;
  65
  66         return true;
  67 }
  68
  69 static const struct nf_nat_protocol nf_nat_protocol_sctp = {
  70         .protonum               = IPPROTO_SCTP,
  71         .me                     = THIS_MODULE,
  72         .manip_pkt              = sctp_manip_pkt,
  73         .in_range               = nf_nat_proto_in_range,
  74         .unique_tuple           = sctp_unique_tuple,
  75 #if defined(CONFIG_NF_CT_NETLINK) || defined(CONFIG_NF_CT_NETLINK_MODULE)
  76         .range_to_nlattr        = nf_nat_proto_range_to_nlattr,
  77         .nlattr_to_range        = nf_nat_proto_nlattr_to_range,
  78 #endif
  79 };
  80
  81 static int __init nf_nat_proto_sctp_init(void)
  82 {
  83         return nf_nat_protocol_register(&nf_nat_protocol_sctp);
  84 }
  85
  86 static void __exit nf_nat_proto_sctp_exit(void)
  87 {
  88         nf_nat_protocol_unregister(&nf_nat_protocol_sctp);
  89 }
  90
  91 module_init(nf_nat_proto_sctp_init);
  92 module_exit(nf_nat_proto_sctp_exit);
  93
  94 MODULE_LICENSE("GPL");
  95 MODULE_DESCRIPTION("SCTP NAT protocol helper");
  96 MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");