datapath/linux/compat/geneve.c

   1 /*
   2  * Geneve: Generic Network Virtualization Encapsulation
   3  *
   4  * Copyright (c) 2014 Nicira, Inc.
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License
   8  * as published by the Free Software Foundation; either version
   9  * 2 of the License, or (at your option) any later version.
  10  */
  11
  12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  13
  14 #include <linux/version.h>
  15 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0)
  16
  17 #include <linux/kernel.h>
  18 #include <linux/types.h>
  19 #include <linux/module.h>
  20 #include <linux/errno.h>
  21 #include <linux/slab.h>
  22 #include <linux/skbuff.h>
  23 #include <linux/list.h>
  24 #include <linux/netdevice.h>
  25 #include <linux/in.h>
  26 #include <linux/ip.h>
  27 #include <linux/udp.h>
  28 #include <linux/igmp.h>
  29 #include <linux/etherdevice.h>
  30 #include <linux/if_ether.h>
  31 #include <linux/if_vlan.h>
  32 #include <linux/ethtool.h>
  33 #include <linux/mutex.h>
  34 #include <net/arp.h>
  35 #include <net/ndisc.h>
  36 #include <net/ip.h>
  37 #include <net/ip_tunnels.h>
  38 #include <net/icmp.h>
  39 #include <net/udp.h>
  40 #include <net/rtnetlink.h>
  41 #include <net/route.h>
  42 #include <net/dsfield.h>
  43 #include <net/inet_ecn.h>
  44 #include <net/net_namespace.h>
  45 #include <net/netns/generic.h>
  46 #include <net/geneve.h>
  47 #include <net/protocol.h>
  48 #include <net/udp_tunnel.h>
  49 #if IS_ENABLED(CONFIG_IPV6)
  50 #include <net/ipv6.h>
  51 #include <net/addrconf.h>
  52 #include <net/ip6_tunnel.h>
  53 #include <net/ip6_checksum.h>
  54 #endif
  55
  56 #include "compat.h"
  57 #include "gso.h"
  58
  59 static inline struct genevehdr *geneve_hdr(const struct sk_buff *skb)
  60 {
  61         return (struct genevehdr *)(udp_hdr(skb) + 1);
  62 }
  63
  64 static void geneve_build_header(struct genevehdr *geneveh,
  65                                 __be16 tun_flags, u8 vni[3],
  66                                 u8 options_len, u8 *options)
  67 {
  68         geneveh->ver = GENEVE_VER;
  69         geneveh->opt_len = options_len / 4;
  70         geneveh->oam = !!(tun_flags & TUNNEL_OAM);
  71         geneveh->critical = !!(tun_flags & TUNNEL_CRIT_OPT);
  72         geneveh->rsvd1 = 0;
  73         memcpy(geneveh->vni, vni, 3);
  74         geneveh->proto_type = htons(ETH_P_TEB);
  75         geneveh->rsvd2 = 0;
  76
  77         memcpy(geneveh->options, options, options_len);
  78 }
  79
  80 /* Transmit a fully formatted Geneve frame.
  81  *
  82  * When calling this function. The skb->data should point
  83  * to the geneve header which is fully formed.
  84  *
  85  * This function will add other UDP tunnel headers.
  86  */
  87 int rpl_geneve_xmit_skb(struct geneve_sock *gs, struct rtable *rt,
  88                         struct sk_buff *skb, __be32 src, __be32 dst, __u8 tos,
  89                         __u8 ttl, __be16 df, __be16 src_port, __be16 dst_port,
  90                         __be16 tun_flags, u8 vni[3], u8 opt_len, u8 *opt,
  91                         bool csum, bool xnet)
  92 {
  93         struct genevehdr *gnvh;
  94         int min_headroom;
  95         int err;
  96
  97         min_headroom = LL_RESERVED_SPACE(rt_dst(rt).dev) + rt_dst(rt).header_len
  98                         + GENEVE_BASE_HLEN + opt_len + sizeof(struct iphdr)
  99                         + (skb_vlan_tag_present(skb) ? VLAN_HLEN : 0);
 100
 101         err = skb_cow_head(skb, min_headroom);
 102         if (unlikely(err)) {
 103                 kfree_skb(skb);
 104                 return err;
 105         }
 106
 107         skb = vlan_hwaccel_push_inside(skb);
 108         if (unlikely(!skb))
 109                 return -ENOMEM;
 110
 111         skb = udp_tunnel_handle_offloads(skb, csum, (opt_len == 0));
 112         if (IS_ERR(skb))
 113                 return PTR_ERR(skb);
 114
 115         gnvh = (struct genevehdr *)__skb_push(skb, sizeof(*gnvh) + opt_len);
 116         geneve_build_header(gnvh, tun_flags, vni, opt_len, opt);
 117
 118         ovs_skb_set_inner_protocol(skb, htons(ETH_P_TEB));
 119
 120         return udp_tunnel_xmit_skb(rt, gs->sock->sk, skb, src, dst,
 121                                    tos, ttl, df, src_port, dst_port, xnet,
 122                                    !csum);
 123 }
 124 EXPORT_SYMBOL_GPL(rpl_geneve_xmit_skb);
 125
 126 /* Callback from net/ipv4/udp.c to receive packets */
 127 static int geneve_udp_encap_recv(struct sock *sk, struct sk_buff *skb)
 128 {
 129         struct genevehdr *geneveh;
 130         struct geneve_sock *gs;
 131         int opts_len;
 132
 133         /* Need Geneve and inner Ethernet header to be present */
 134         if (unlikely(!pskb_may_pull(skb, GENEVE_BASE_HLEN)))
 135                 goto error;
 136
 137         /* Return packets with reserved bits set */
 138         geneveh = geneve_hdr(skb);
 139
 140         if (unlikely(geneveh->ver != GENEVE_VER))
 141                 goto error;
 142
 143         if (unlikely(geneveh->proto_type != htons(ETH_P_TEB)))
 144                 goto error;
 145
 146         opts_len = geneveh->opt_len * 4;
 147         if (iptunnel_pull_header(skb, GENEVE_BASE_HLEN + opts_len,
 148                                  htons(ETH_P_TEB)))
 149                 goto drop;
 150
 151         gs = rcu_dereference_sk_user_data(sk);
 152         if (!gs)
 153                 goto drop;
 154
 155         gs->rcv(gs, skb);
 156         return 0;
 157
 158 drop:
 159         /* Consume bad packet */
 160         kfree_skb(skb);
 161         return 0;
 162
 163 error:
 164         /* Let the UDP layer deal with the skb */
 165         return 1;
 166 }
 167
 168 static struct socket *geneve_create_sock(struct net *net, bool ipv6,
 169                                          __be16 port)
 170 {
 171         struct socket *sock;
 172         struct udp_port_cfg udp_conf;
 173         int err;
 174
 175         memset(&udp_conf, 0, sizeof(udp_conf));
 176
 177         if (ipv6) {
 178                 udp_conf.family = AF_INET6;
 179         } else {
 180                 udp_conf.family = AF_INET;
 181                 udp_conf.local_ip.s_addr = htonl(INADDR_ANY);
 182         }
 183
 184         udp_conf.local_udp_port = port;
 185
 186         /* Open UDP socket */
 187         err = udp_sock_create(net, &udp_conf, &sock);
 188         if (err < 0)
 189                 return ERR_PTR(err);
 190
 191         return sock;
 192 }
 193
 194 /* Create new listen socket if needed */
 195 static struct geneve_sock *geneve_socket_create(struct net *net, __be16 port,
 196                                                 geneve_rcv_t *rcv, void *data,
 197                                                 bool ipv6)
 198 {
 199         struct geneve_sock *gs;
 200         struct socket *sock;
 201         struct udp_tunnel_sock_cfg tunnel_cfg;
 202
 203         gs = kzalloc(sizeof(*gs), GFP_KERNEL);
 204         if (!gs)
 205                 return ERR_PTR(-ENOMEM);
 206
 207         sock = geneve_create_sock(net, ipv6, port);
 208         if (IS_ERR(sock)) {
 209                 kfree(gs);
 210                 return ERR_CAST(sock);
 211         }
 212
 213         gs->sock = sock;
 214         gs->rcv = rcv;
 215         gs->rcv_data = data;
 216
 217         /* Mark socket as an encapsulation socket */
 218         tunnel_cfg.sk_user_data = gs;
 219         tunnel_cfg.encap_type = 1;
 220         tunnel_cfg.encap_rcv = geneve_udp_encap_recv;
 221         tunnel_cfg.encap_destroy = NULL;
 222         setup_udp_tunnel_sock(net, sock, &tunnel_cfg);
 223
 224         return gs;
 225 }
 226
 227 struct geneve_sock *rpl_geneve_sock_add(struct net *net, __be16 port,
 228                                         geneve_rcv_t *rcv, void *data,
 229                                         bool no_share, bool ipv6)
 230 {
 231         return geneve_socket_create(net, port, rcv, data, ipv6);
 232 }
 233 EXPORT_SYMBOL_GPL(rpl_geneve_sock_add);
 234
 235 static void rcu_free_gs(struct rcu_head *rcu)
 236 {
 237         struct geneve_sock *gs = container_of(rcu, struct geneve_sock, rcu);
 238
 239         kfree(gs);
 240 }
 241
 242 void rpl_geneve_sock_release(struct geneve_sock *gs)
 243 {
 244         udp_tunnel_sock_release(gs->sock);
 245         call_rcu(&gs->rcu, rcu_free_gs);
 246 }
 247 EXPORT_SYMBOL_GPL(rpl_geneve_sock_release);
 248
 249 #endif /* kernel < 4.0 */