ip_tunnel_core.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118
  1. /*
  2. * Copyright (c) 2013 Nicira, Inc.
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of version 2 of the GNU General Public
  6. * License as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope that it will be useful, but
  9. * WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  11. * General Public License for more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program; if not, write to the Free Software
  15. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  16. * 02110-1301, USA
  17. */
  18. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  19. #include <linux/types.h>
  20. #include <linux/kernel.h>
  21. #include <linux/skbuff.h>
  22. #include <linux/netdevice.h>
  23. #include <linux/in.h>
  24. #include <linux/if_arp.h>
  25. #include <linux/mroute.h>
  26. #include <linux/init.h>
  27. #include <linux/in6.h>
  28. #include <linux/inetdevice.h>
  29. #include <linux/netfilter_ipv4.h>
  30. #include <linux/etherdevice.h>
  31. #include <linux/if_ether.h>
  32. #include <linux/if_vlan.h>
  33. #include <net/ip.h>
  34. #include <net/icmp.h>
  35. #include <net/protocol.h>
  36. #include <net/ip_tunnels.h>
  37. #include <net/arp.h>
  38. #include <net/checksum.h>
  39. #include <net/dsfield.h>
  40. #include <net/inet_ecn.h>
  41. #include <net/xfrm.h>
  42. #include <net/net_namespace.h>
  43. #include <net/netns/generic.h>
  44. #include <net/rtnetlink.h>
  45. int iptunnel_xmit(struct rtable *rt, struct sk_buff *skb,
  46. __be32 src, __be32 dst, __u8 proto,
  47. __u8 tos, __u8 ttl, __be16 df, bool xnet)
  48. {
  49. int pkt_len = skb->len;
  50. struct iphdr *iph;
  51. int err;
  52. skb_scrub_packet(skb, xnet);
  53. skb->rxhash = 0;
  54. skb_dst_set(skb, &rt->dst);
  55. memset(IPCB(skb), 0, sizeof(*IPCB(skb)));
  56. /* Push down and install the IP header. */
  57. skb_push(skb, sizeof(struct iphdr));
  58. skb_reset_network_header(skb);
  59. iph = ip_hdr(skb);
  60. iph->version = 4;
  61. iph->ihl = sizeof(struct iphdr) >> 2;
  62. iph->frag_off = df;
  63. iph->protocol = proto;
  64. iph->tos = tos;
  65. iph->daddr = dst;
  66. iph->saddr = src;
  67. iph->ttl = ttl;
  68. __ip_select_ident(iph, &rt->dst, (skb_shinfo(skb)->gso_segs ?: 1) - 1);
  69. err = ip_local_out(skb);
  70. if (unlikely(net_xmit_eval(err)))
  71. pkt_len = 0;
  72. return pkt_len;
  73. }
  74. EXPORT_SYMBOL_GPL(iptunnel_xmit);
  75. int iptunnel_pull_header(struct sk_buff *skb, int hdr_len, __be16 inner_proto)
  76. {
  77. if (unlikely(!pskb_may_pull(skb, hdr_len)))
  78. return -ENOMEM;
  79. skb_pull_rcsum(skb, hdr_len);
  80. if (inner_proto == htons(ETH_P_TEB)) {
  81. struct ethhdr *eh = (struct ethhdr *)skb->data;
  82. if (unlikely(!pskb_may_pull(skb, ETH_HLEN)))
  83. return -ENOMEM;
  84. if (likely(ntohs(eh->h_proto) >= ETH_P_802_3_MIN))
  85. skb->protocol = eh->h_proto;
  86. else
  87. skb->protocol = htons(ETH_P_802_2);
  88. } else {
  89. skb->protocol = inner_proto;
  90. }
  91. nf_reset(skb);
  92. secpath_reset(skb);
  93. if (!skb->l4_rxhash)
  94. skb->rxhash = 0;
  95. skb_dst_drop(skb);
  96. skb->vlan_tci = 0;
  97. skb_set_queue_mapping(skb, 0);
  98. skb->pkt_type = PACKET_HOST;
  99. return 0;
  100. }
  101. EXPORT_SYMBOL_GPL(iptunnel_pull_header);