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
14 #include <linux/net.h>
15 #include <linux/rculist.h>
16 #include <linux/udp.h>
17 #include <linux/if_vlan.h>
18 #include <linux/module.h>
20 #include <net/geneve.h>
23 #include <net/route.h>
30 static struct vport_ops ovs_geneve_vport_ops
;
33 * struct geneve_port - Keeps track of open UDP ports
34 * @gs: The socket created for this port number.
38 struct geneve_sock
*gs
;
42 static LIST_HEAD(geneve_ports
);
44 static inline struct geneve_port
*geneve_vport(const struct vport
*vport
)
46 return vport_priv(vport
);
49 /* Convert 64 bit tunnel ID to 24 bit VNI. */
50 static void tunnel_id_to_vni(__be64 tun_id
, __u8
*vni
)
53 vni
[0] = (__force __u8
)(tun_id
>> 16);
54 vni
[1] = (__force __u8
)(tun_id
>> 8);
55 vni
[2] = (__force __u8
)tun_id
;
57 vni
[0] = (__force __u8
)((__force u64
)tun_id
>> 40);
58 vni
[1] = (__force __u8
)((__force u64
)tun_id
>> 48);
59 vni
[2] = (__force __u8
)((__force u64
)tun_id
>> 56);
63 /* Convert 24 bit VNI to 64 bit tunnel ID. */
64 static __be64
vni_to_tunnel_id(const __u8
*vni
)
67 return (vni
[0] << 16) | (vni
[1] << 8) | vni
[2];
69 return (__force __be64
)(((__force u64
)vni
[0] << 40) |
70 ((__force u64
)vni
[1] << 48) |
71 ((__force u64
)vni
[2] << 56));
75 static void geneve_rcv(struct geneve_sock
*gs
, struct sk_buff
*skb
)
77 struct vport
*vport
= gs
->rcv_data
;
78 struct genevehdr
*geneveh
= geneve_hdr(skb
);
80 struct ip_tunnel_info tun_info
;
84 opts_len
= geneveh
->opt_len
* 4;
86 flags
= TUNNEL_KEY
| TUNNEL_GENEVE_OPT
|
87 (udp_hdr(skb
)->check
!= 0 ? TUNNEL_CSUM
: 0) |
88 (geneveh
->oam
? TUNNEL_OAM
: 0) |
89 (geneveh
->critical
? TUNNEL_CRIT_OPT
: 0);
91 key
= vni_to_tunnel_id(geneveh
->vni
);
93 ip_tunnel_info_init(&tun_info
, ip_hdr(skb
),
94 udp_hdr(skb
)->source
, udp_hdr(skb
)->dest
,
95 key
, flags
, geneveh
->options
, opts_len
);
97 ovs_vport_receive(vport
, skb
, &tun_info
);
100 static int geneve_get_options(const struct vport
*vport
,
103 struct geneve_port
*geneve_port
= geneve_vport(vport
);
104 struct inet_sock
*sk
= inet_sk(geneve_port
->gs
->sock
->sk
);
106 if (nla_put_u16(skb
, OVS_TUNNEL_ATTR_DST_PORT
, ntohs(sk
->inet_sport
)))
111 static void geneve_tnl_destroy(struct vport
*vport
)
113 struct geneve_port
*geneve_port
= geneve_vport(vport
);
115 geneve_sock_release(geneve_port
->gs
);
117 ovs_vport_deferred_free(vport
);
120 static struct vport
*geneve_tnl_create(const struct vport_parms
*parms
)
122 struct net
*net
= ovs_dp_get_net(parms
->dp
);
123 struct nlattr
*options
= parms
->options
;
124 struct geneve_port
*geneve_port
;
125 struct geneve_sock
*gs
;
136 a
= nla_find_nested(options
, OVS_TUNNEL_ATTR_DST_PORT
);
137 if (a
&& nla_len(a
) == sizeof(u16
)) {
138 dst_port
= nla_get_u16(a
);
140 /* Require destination port from userspace. */
145 vport
= ovs_vport_alloc(sizeof(struct geneve_port
),
146 &ovs_geneve_vport_ops
, parms
);
150 geneve_port
= geneve_vport(vport
);
151 strncpy(geneve_port
->name
, parms
->name
, IFNAMSIZ
);
153 gs
= geneve_sock_add(net
, htons(dst_port
), geneve_rcv
, vport
, true, 0);
155 ovs_vport_free(vport
);
158 geneve_port
->gs
= gs
;
165 static int geneve_tnl_send(struct vport
*vport
, struct sk_buff
*skb
)
167 const struct ip_tunnel_key
*tun_key
;
168 struct ip_tunnel_info
*tun_info
;
169 struct net
*net
= ovs_dp_get_net(vport
->dp
);
170 struct geneve_port
*geneve_port
= geneve_vport(vport
);
171 __be16 dport
= inet_sk(geneve_port
->gs
->sock
->sk
)->inet_sport
;
175 u8 vni
[3], opts_len
, *opts
;
179 tun_info
= OVS_CB(skb
)->egress_tun_info
;
180 if (unlikely(!tun_info
)) {
185 tun_key
= &tun_info
->key
;
186 rt
= ovs_tunnel_route_lookup(net
, tun_key
, skb
->mark
, &fl
, IPPROTO_UDP
);
192 df
= tun_key
->tun_flags
& TUNNEL_DONT_FRAGMENT
? htons(IP_DF
) : 0;
193 sport
= udp_flow_src_port(net
, skb
, 1, USHRT_MAX
, true);
194 tunnel_id_to_vni(tun_key
->tun_id
, vni
);
197 if (tun_key
->tun_flags
& TUNNEL_GENEVE_OPT
) {
198 opts
= (u8
*)tun_info
->options
;
199 opts_len
= tun_info
->options_len
;
205 err
= geneve_xmit_skb(geneve_port
->gs
, rt
, skb
, fl
.saddr
,
206 tun_key
->u
.ipv4
.dst
, tun_key
->ipv4_tos
,
207 tun_key
->ipv4_ttl
, df
, sport
, dport
,
208 tun_key
->tun_flags
, vni
, opts_len
, opts
,
209 !!(tun_key
->tun_flags
& TUNNEL_CSUM
), false);
219 static const char *geneve_get_name(const struct vport
*vport
)
221 struct geneve_port
*geneve_port
= geneve_vport(vport
);
223 return geneve_port
->name
;
226 static int geneve_get_egress_tun_info(struct vport
*vport
, struct sk_buff
*skb
,
227 struct ip_tunnel_info
*egress_tun_info
)
229 struct geneve_port
*geneve_port
= geneve_vport(vport
);
230 struct net
*net
= ovs_dp_get_net(vport
->dp
);
231 __be16 dport
= inet_sk(geneve_port
->gs
->sock
->sk
)->inet_sport
;
232 __be16 sport
= udp_flow_src_port(net
, skb
, 1, USHRT_MAX
, true);
234 /* Get tp_src and tp_dst, refert to geneve_build_header().
236 return ovs_tunnel_get_egress_info(egress_tun_info
,
237 ovs_dp_get_net(vport
->dp
),
238 OVS_CB(skb
)->egress_tun_info
,
239 IPPROTO_UDP
, skb
->mark
, sport
, dport
);
242 static struct vport_ops ovs_geneve_vport_ops
= {
243 .type
= OVS_VPORT_TYPE_GENEVE
,
244 .create
= geneve_tnl_create
,
245 .destroy
= geneve_tnl_destroy
,
246 .get_name
= geneve_get_name
,
247 .get_options
= geneve_get_options
,
248 .send
= geneve_tnl_send
,
249 .owner
= THIS_MODULE
,
250 .get_egress_tun_info
= geneve_get_egress_tun_info
,
253 static int __init
ovs_geneve_tnl_init(void)
255 return ovs_vport_ops_register(&ovs_geneve_vport_ops
);
258 static void __exit
ovs_geneve_tnl_exit(void)
260 ovs_vport_ops_unregister(&ovs_geneve_vport_ops
);
263 module_init(ovs_geneve_tnl_init
);
264 module_exit(ovs_geneve_tnl_exit
);
266 MODULE_DESCRIPTION("OVS: Geneve swiching port");
267 MODULE_LICENSE("GPL");
268 MODULE_ALIAS("vport-type-5");