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