2 * Geneve: Generic Network Virtualization Encapsulation
4 * Copyright (c) 2014 Nicira, Inc.
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.
12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14 #include <linux/version.h>
15 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0)
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>
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>
35 #include <net/ndisc.h>
37 #include <net/ip_tunnels.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)
51 #include <net/addrconf.h>
52 #include <net/ip6_tunnel.h>
53 #include <net/ip6_checksum.h>
59 static inline struct genevehdr *geneve_hdr(const struct sk_buff *skb)
61 return (struct genevehdr *)(udp_hdr(skb) + 1);
64 static void geneve_build_header(struct genevehdr *geneveh,
65 __be16 tun_flags, u8 vni[3],
66 u8 options_len, u8 *options)
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);
73 memcpy(geneveh->vni, vni, 3);
74 geneveh->proto_type = htons(ETH_P_TEB);
77 memcpy(geneveh->options, options, options_len);
80 /* Transmit a fully formatted Geneve frame.
82 * When calling this function. The skb->data should point
83 * to the geneve header which is fully formed.
85 * This function will add other UDP tunnel headers.
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,
93 struct genevehdr *gnvh;
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);
101 err = skb_cow_head(skb, min_headroom);
107 skb = vlan_hwaccel_push_inside(skb);
111 skb = udp_tunnel_handle_offloads(skb, csum, (opt_len == 0));
115 gnvh = (struct genevehdr *)__skb_push(skb, sizeof(*gnvh) + opt_len);
116 geneve_build_header(gnvh, tun_flags, vni, opt_len, opt);
118 ovs_skb_set_inner_protocol(skb, htons(ETH_P_TEB));
120 return udp_tunnel_xmit_skb(rt, skb, src, dst,
121 tos, ttl, df, src_port, dst_port, xnet,
124 EXPORT_SYMBOL_GPL(rpl_geneve_xmit_skb);
126 /* Callback from net/ipv4/udp.c to receive packets */
127 static int geneve_udp_encap_recv(struct sock *sk, struct sk_buff *skb)
129 struct genevehdr *geneveh;
130 struct geneve_sock *gs;
133 /* Need Geneve and inner Ethernet header to be present */
134 if (unlikely(!pskb_may_pull(skb, GENEVE_BASE_HLEN)))
137 /* Return packets with reserved bits set */
138 geneveh = geneve_hdr(skb);
140 if (unlikely(geneveh->ver != GENEVE_VER))
143 if (unlikely(geneveh->proto_type != htons(ETH_P_TEB)))
146 opts_len = geneveh->opt_len * 4;
147 if (iptunnel_pull_header(skb, GENEVE_BASE_HLEN + opts_len,
151 gs = rcu_dereference_sk_user_data(sk);
159 /* Consume bad packet */
164 /* Let the UDP layer deal with the skb */
168 static struct socket *geneve_create_sock(struct net *net, bool ipv6,
172 struct udp_port_cfg udp_conf;
175 memset(&udp_conf, 0, sizeof(udp_conf));
178 udp_conf.family = AF_INET6;
180 udp_conf.family = AF_INET;
181 udp_conf.local_ip.s_addr = htonl(INADDR_ANY);
184 udp_conf.local_udp_port = port;
186 /* Open UDP socket */
187 err = udp_sock_create(net, &udp_conf, &sock);
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,
199 struct geneve_sock *gs;
201 struct udp_tunnel_sock_cfg tunnel_cfg;
203 gs = kzalloc(sizeof(*gs), GFP_KERNEL);
205 return ERR_PTR(-ENOMEM);
207 sock = geneve_create_sock(net, ipv6, port);
210 return ERR_CAST(sock);
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);
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)
231 return geneve_socket_create(net, port, rcv, data, ipv6);
233 EXPORT_SYMBOL_GPL(rpl_geneve_sock_add);
235 static void rcu_free_gs(struct rcu_head *rcu)
237 struct geneve_sock *gs = container_of(rcu, struct geneve_sock, rcu);
242 void rpl_geneve_sock_release(struct geneve_sock *gs)
244 udp_tunnel_sock_release(gs->sock);
245 call_rcu(&gs->rcu, rcu_free_gs);
247 EXPORT_SYMBOL_GPL(rpl_geneve_sock_release);
249 #endif /* kernel < 4.0 */