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 void geneve_build_header(struct genevehdr *geneveh,
  60                                 __be16 tun_flags, u8 vni[3],
  61                                 u8 options_len, u8 *options)
  62 {
  63         geneveh->ver = GENEVE_VER;
  64         geneveh->opt_len = options_len / 4;
  65         geneveh->oam = !!(tun_flags & TUNNEL_OAM);
  66         geneveh->critical = !!(tun_flags & TUNNEL_CRIT_OPT);
  67         geneveh->rsvd1 = 0;
  68         memcpy(geneveh->vni, vni, 3);
  69         geneveh->proto_type = htons(ETH_P_TEB);
  70         geneveh->rsvd2 = 0;
  71
  72         memcpy(geneveh->options, options, options_len);
  73 }
  74
  75 /* Transmit a fully formatted Geneve frame.
  76  *
  77  * When calling this function. The skb->data should point
  78  * to the geneve header which is fully formed.
  79  *
  80  * This function will add other UDP tunnel headers.
  81  */
  82 int rpl_geneve_xmit_skb(struct geneve_sock *gs, struct rtable *rt,
  83                         struct sk_buff *skb, __be32 src, __be32 dst, __u8 tos,
  84                         __u8 ttl, __be16 df, __be16 src_port, __be16 dst_port,
  85                         __be16 tun_flags, u8 vni[3], u8 opt_len, u8 *opt,
  86                         bool csum, bool xnet)
  87 {
  88         struct genevehdr *gnvh;
  89         int min_headroom;
  90         int err;
  91
  92         min_headroom = LL_RESERVED_SPACE(rt_dst(rt).dev) + rt_dst(rt).header_len
  93                         + GENEVE_BASE_HLEN + opt_len + sizeof(struct iphdr)
  94                         + (skb_vlan_tag_present(skb) ? VLAN_HLEN : 0);
  95
  96         err = skb_cow_head(skb, min_headroom);
  97         if (unlikely(err)) {
  98                 kfree_skb(skb);
  99                 return err;
 100         }
 101
 102         skb = vlan_hwaccel_push_inside(skb);
 103         if (unlikely(!skb))
 104                 return -ENOMEM;
 105
 106         skb = udp_tunnel_handle_offloads(skb, csum, (opt_len == 0));
 107         if (IS_ERR(skb))
 108                 return PTR_ERR(skb);
 109
 110         gnvh = (struct genevehdr *)__skb_push(skb, sizeof(*gnvh) + opt_len);
 111         geneve_build_header(gnvh, tun_flags, vni, opt_len, opt);
 112
 113         ovs_skb_set_inner_protocol(skb, htons(ETH_P_TEB));
 114
 115         return udp_tunnel_xmit_skb(rt, gs->sock->sk, skb, src, dst,
 116                                    tos, ttl, df, src_port, dst_port, xnet,
 117                                    !csum);
 118 }
 119 EXPORT_SYMBOL_GPL(rpl_geneve_xmit_skb);
 120
 121 /* Callback from net/ipv4/udp.c to receive packets */
 122 static int geneve_udp_encap_recv(struct sock *sk, struct sk_buff *skb)
 123 {
 124         struct genevehdr *geneveh;
 125         struct geneve_sock *gs;
 126         int opts_len;
 127
 128         /* Need Geneve and inner Ethernet header to be present */
 129         if (unlikely(!pskb_may_pull(skb, GENEVE_BASE_HLEN)))
 130                 goto error;
 131
 132         /* Return packets with reserved bits set */
 133         geneveh = geneve_hdr(skb);
 134
 135         if (unlikely(geneveh->ver != GENEVE_VER))
 136                 goto error;
 137
 138         if (unlikely(geneveh->proto_type != htons(ETH_P_TEB)))
 139                 goto error;
 140
 141         opts_len = geneveh->opt_len * 4;
 142         if (iptunnel_pull_header(skb, GENEVE_BASE_HLEN + opts_len,
 143                                  htons(ETH_P_TEB)))
 144                 goto drop;
 145
 146         gs = rcu_dereference_sk_user_data(sk);
 147         if (!gs)
 148                 goto drop;
 149
 150         gs->rcv(gs, skb);
 151         return 0;
 152
 153 drop:
 154         /* Consume bad packet */
 155         kfree_skb(skb);
 156         return 0;
 157
 158 error:
 159         /* Let the UDP layer deal with the skb */
 160         return 1;
 161 }
 162
 163 static struct socket *geneve_create_sock(struct net *net, bool ipv6,
 164                                          __be16 port)
 165 {
 166         struct socket *sock;
 167         struct udp_port_cfg udp_conf;
 168         int err;
 169
 170         memset(&udp_conf, 0, sizeof(udp_conf));
 171
 172         if (ipv6) {
 173                 udp_conf.family = AF_INET6;
 174         } else {
 175                 udp_conf.family = AF_INET;
 176                 udp_conf.local_ip.s_addr = htonl(INADDR_ANY);
 177         }
 178
 179         udp_conf.local_udp_port = port;
 180
 181         /* Open UDP socket */
 182         err = udp_sock_create(net, &udp_conf, &sock);
 183         if (err < 0)
 184                 return ERR_PTR(err);
 185
 186         return sock;
 187 }
 188
 189 /* Create new listen socket if needed */
 190 static struct geneve_sock *geneve_socket_create(struct net *net, __be16 port,
 191                                                 geneve_rcv_t *rcv, void *data,
 192                                                 bool ipv6)
 193 {
 194         struct geneve_sock *gs;
 195         struct socket *sock;
 196         struct udp_tunnel_sock_cfg tunnel_cfg;
 197
 198         gs = kzalloc(sizeof(*gs), GFP_KERNEL);
 199         if (!gs)
 200                 return ERR_PTR(-ENOMEM);
 201
 202         sock = geneve_create_sock(net, ipv6, port);
 203         if (IS_ERR(sock)) {
 204                 kfree(gs);
 205                 return ERR_CAST(sock);
 206         }
 207
 208         gs->sock = sock;
 209         gs->rcv = rcv;
 210         gs->rcv_data = data;
 211
 212         /* Mark socket as an encapsulation socket */
 213         tunnel_cfg.sk_user_data = gs;
 214         tunnel_cfg.encap_type = 1;
 215         tunnel_cfg.encap_rcv = geneve_udp_encap_recv;
 216         tunnel_cfg.encap_destroy = NULL;
 217         setup_udp_tunnel_sock(net, sock, &tunnel_cfg);
 218
 219         return gs;
 220 }
 221
 222 struct geneve_sock *rpl_geneve_sock_add(struct net *net, __be16 port,
 223                                         geneve_rcv_t *rcv, void *data,
 224                                         bool no_share, bool ipv6)
 225 {
 226         return geneve_socket_create(net, port, rcv, data, ipv6);
 227 }
 228 EXPORT_SYMBOL_GPL(rpl_geneve_sock_add);
 229
 230 static void rcu_free_gs(struct rcu_head *rcu)
 231 {
 232         struct geneve_sock *gs = container_of(rcu, struct geneve_sock, rcu);
 233
 234         kfree(gs);
 235 }
 236
 237 void rpl_geneve_sock_release(struct geneve_sock *gs)
 238 {
 239         udp_tunnel_sock_release(gs->sock);
 240         call_rcu(&gs->rcu, rcu_free_gs);
 241 }
 242 EXPORT_SYMBOL_GPL(rpl_geneve_sock_release);
 243
 244 #endif /* kernel < 4.0 */