2 * Copyright (c) 2014 Nicira, Inc.
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
10 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
12 #include <linux/version.h>
16 #include <linux/net.h>
17 #include <linux/rculist.h>
18 #include <linux/udp.h>
19 #include <linux/if_vlan.h>
21 #include <net/geneve.h>
24 #include <net/route.h>
32 * struct geneve_port - Keeps track of open UDP ports
33 * @gs: The socket created for this port number.
37 struct geneve_sock *gs;
41 static LIST_HEAD(geneve_ports);
43 static inline struct geneve_port *geneve_vport(const struct vport *vport)
45 return vport_priv(vport);
48 static inline struct genevehdr *geneve_hdr(const struct sk_buff *skb)
50 return (struct genevehdr *)(udp_hdr(skb) + 1);
53 /* Convert 64 bit tunnel ID to 24 bit VNI. */
54 static void tunnel_id_to_vni(__be64 tun_id, __u8 *vni)
57 vni[0] = (__force __u8)(tun_id >> 16);
58 vni[1] = (__force __u8)(tun_id >> 8);
59 vni[2] = (__force __u8)tun_id;
61 vni[0] = (__force __u8)((__force u64)tun_id >> 40);
62 vni[1] = (__force __u8)((__force u64)tun_id >> 48);
63 vni[2] = (__force __u8)((__force u64)tun_id >> 56);
67 /* Convert 24 bit VNI to 64 bit tunnel ID. */
68 static __be64 vni_to_tunnel_id(__u8 *vni)
71 return (vni[0] << 16) | (vni[1] << 8) | vni[2];
73 return (__force __be64)(((__force u64)vni[0] << 40) |
74 ((__force u64)vni[1] << 48) |
75 ((__force u64)vni[2] << 56));
79 static void geneve_rcv(struct geneve_sock *gs, struct sk_buff *skb)
81 struct vport *vport = gs->rcv_data;
82 struct genevehdr *geneveh = geneve_hdr(skb);
84 struct ovs_tunnel_info tun_info;
88 opts_len = geneveh->opt_len * 4;
90 flags = TUNNEL_KEY | TUNNEL_OPTIONS_PRESENT |
91 (udp_hdr(skb)->check != 0 ? TUNNEL_CSUM : 0) |
92 (geneveh->oam ? TUNNEL_OAM : 0) |
93 (geneveh->critical ? TUNNEL_CRIT_OPT : 0);
95 key = vni_to_tunnel_id(geneveh->vni);
97 ovs_flow_tun_info_init(&tun_info, ip_hdr(skb), key, flags,
98 geneveh->options, opts_len);
100 ovs_vport_receive(vport, skb, &tun_info);
103 static int geneve_get_options(const struct vport *vport,
106 struct geneve_port *geneve_port = geneve_vport(vport);
107 struct inet_sock *sk = inet_sk(geneve_port->gs->sock->sk);
109 if (nla_put_u16(skb, OVS_TUNNEL_ATTR_DST_PORT, ntohs(sk->inet_sport)))
114 static void geneve_tnl_destroy(struct vport *vport)
116 struct geneve_port *geneve_port = geneve_vport(vport);
118 geneve_sock_release(geneve_port->gs);
120 ovs_vport_deferred_free(vport);
123 static struct vport *geneve_tnl_create(const struct vport_parms *parms)
125 struct net *net = ovs_dp_get_net(parms->dp);
126 struct nlattr *options = parms->options;
127 struct geneve_port *geneve_port;
128 struct geneve_sock *gs;
139 a = nla_find_nested(options, OVS_TUNNEL_ATTR_DST_PORT);
140 if (a && nla_len(a) == sizeof(u16)) {
141 dst_port = nla_get_u16(a);
143 /* Require destination port from userspace. */
148 vport = ovs_vport_alloc(sizeof(struct geneve_port),
149 &ovs_geneve_vport_ops, parms);
153 geneve_port = geneve_vport(vport);
154 strncpy(geneve_port->name, parms->name, IFNAMSIZ);
156 gs = geneve_sock_add(net, htons(dst_port), geneve_rcv, vport, true, 0);
158 ovs_vport_free(vport);
161 geneve_port->gs = gs;
168 static int geneve_tnl_send(struct vport *vport, struct sk_buff *skb)
170 struct ovs_key_ipv4_tunnel *tun_key;
171 struct ovs_tunnel_info *tun_info;
172 struct net *net = ovs_dp_get_net(vport->dp);
173 struct geneve_port *geneve_port = geneve_vport(vport);
174 __be16 dport = inet_sk(geneve_port->gs->sock->sk)->inet_sport;
182 tun_info = OVS_CB(skb)->egress_tun_info;
183 if (unlikely(!tun_info)) {
188 tun_key = &tun_info->tunnel;
191 memset(&fl, 0, sizeof(fl));
192 fl.daddr = tun_key->ipv4_dst;
193 fl.saddr = tun_key->ipv4_src;
194 fl.flowi4_tos = RT_TOS(tun_key->ipv4_tos);
195 fl.flowi4_mark = skb->mark;
196 fl.flowi4_proto = IPPROTO_UDP;
198 rt = ip_route_output_key(net, &fl);
204 df = tun_key->tun_flags & TUNNEL_DONT_FRAGMENT ? htons(IP_DF) : 0;
205 sport = udp_flow_src_port(net, skb, 1, USHRT_MAX, true);
206 tunnel_id_to_vni(tun_key->tun_id, vni);
209 err = geneve_xmit_skb(geneve_port->gs, rt, skb, fl.saddr,
210 tun_key->ipv4_dst, tun_key->ipv4_tos,
211 tun_key->ipv4_ttl, df, sport, dport,
212 tun_key->tun_flags, vni,
213 tun_info->options_len, (u8 *)tun_info->options,
221 static const char *geneve_get_name(const struct vport *vport)
223 struct geneve_port *geneve_port = geneve_vport(vport);
225 return geneve_port->name;
228 const struct vport_ops ovs_geneve_vport_ops = {
229 .type = OVS_VPORT_TYPE_GENEVE,
230 .create = geneve_tnl_create,
231 .destroy = geneve_tnl_destroy,
232 .get_name = geneve_get_name,
233 .get_options = geneve_get_options,
234 .send = geneve_tnl_send,