2 * Copyright (c) 2016, Mellanox Technologies, Ltd. All rights reserved.
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
33 #include <linux/kernel.h>
34 #include <linux/module.h>
35 #include <linux/mlx5/driver.h>
36 #include "mlx5_core.h"
39 void mlx5e_vxlan_init(struct mlx5e_priv
*priv
)
41 struct mlx5e_vxlan_db
*vxlan_db
= &priv
->vxlan
;
43 spin_lock_init(&vxlan_db
->lock
);
44 INIT_RADIX_TREE(&vxlan_db
->tree
, GFP_ATOMIC
);
47 static int mlx5e_vxlan_core_add_port_cmd(struct mlx5_core_dev
*mdev
, u16 port
)
49 struct mlx5_outbox_hdr
*hdr
;
52 u32 in
[MLX5_ST_SZ_DW(add_vxlan_udp_dport_in
)];
53 u32 out
[MLX5_ST_SZ_DW(add_vxlan_udp_dport_out
)];
55 memset(in
, 0, sizeof(in
));
56 memset(out
, 0, sizeof(out
));
58 MLX5_SET(add_vxlan_udp_dport_in
, in
, opcode
,
59 MLX5_CMD_OP_ADD_VXLAN_UDP_DPORT
);
60 MLX5_SET(add_vxlan_udp_dport_in
, in
, vxlan_udp_port
, port
);
62 err
= mlx5_cmd_exec(mdev
, in
, sizeof(in
), out
, sizeof(out
));
66 hdr
= (struct mlx5_outbox_hdr
*)out
;
67 return hdr
->status
? -ENOMEM
: 0;
70 static int mlx5e_vxlan_core_del_port_cmd(struct mlx5_core_dev
*mdev
, u16 port
)
72 u32 in
[MLX5_ST_SZ_DW(delete_vxlan_udp_dport_in
)];
73 u32 out
[MLX5_ST_SZ_DW(delete_vxlan_udp_dport_out
)];
75 memset(&in
, 0, sizeof(in
));
76 memset(&out
, 0, sizeof(out
));
78 MLX5_SET(delete_vxlan_udp_dport_in
, in
, opcode
,
79 MLX5_CMD_OP_DELETE_VXLAN_UDP_DPORT
);
80 MLX5_SET(delete_vxlan_udp_dport_in
, in
, vxlan_udp_port
, port
);
82 return mlx5_cmd_exec_check_status(mdev
, in
, sizeof(in
), out
,
86 struct mlx5e_vxlan
*mlx5e_vxlan_lookup_port(struct mlx5e_priv
*priv
, u16 port
)
88 struct mlx5e_vxlan_db
*vxlan_db
= &priv
->vxlan
;
89 struct mlx5e_vxlan
*vxlan
;
91 spin_lock(&vxlan_db
->lock
);
92 vxlan
= radix_tree_lookup(&vxlan_db
->tree
, port
);
93 spin_unlock(&vxlan_db
->lock
);
98 static void mlx5e_vxlan_add_port(struct work_struct
*work
)
100 struct mlx5e_vxlan_work
*vxlan_work
=
101 container_of(work
, struct mlx5e_vxlan_work
, work
);
102 struct mlx5e_priv
*priv
= vxlan_work
->priv
;
103 struct mlx5e_vxlan_db
*vxlan_db
= &priv
->vxlan
;
104 u16 port
= vxlan_work
->port
;
105 struct mlx5e_vxlan
*vxlan
;
108 if (mlx5e_vxlan_lookup_port(priv
, port
))
111 if (mlx5e_vxlan_core_add_port_cmd(priv
->mdev
, port
))
114 vxlan
= kzalloc(sizeof(*vxlan
), GFP_KERNEL
);
116 goto err_delete_port
;
118 vxlan
->udp_port
= port
;
120 spin_lock_irq(&vxlan_db
->lock
);
121 err
= radix_tree_insert(&vxlan_db
->tree
, vxlan
->udp_port
, vxlan
);
122 spin_unlock_irq(&vxlan_db
->lock
);
131 mlx5e_vxlan_core_del_port_cmd(priv
->mdev
, port
);
136 static void __mlx5e_vxlan_core_del_port(struct mlx5e_priv
*priv
, u16 port
)
138 struct mlx5e_vxlan_db
*vxlan_db
= &priv
->vxlan
;
139 struct mlx5e_vxlan
*vxlan
;
141 spin_lock_irq(&vxlan_db
->lock
);
142 vxlan
= radix_tree_delete(&vxlan_db
->tree
, port
);
143 spin_unlock_irq(&vxlan_db
->lock
);
148 mlx5e_vxlan_core_del_port_cmd(priv
->mdev
, vxlan
->udp_port
);
153 static void mlx5e_vxlan_del_port(struct work_struct
*work
)
155 struct mlx5e_vxlan_work
*vxlan_work
=
156 container_of(work
, struct mlx5e_vxlan_work
, work
);
157 struct mlx5e_priv
*priv
= vxlan_work
->priv
;
158 u16 port
= vxlan_work
->port
;
160 __mlx5e_vxlan_core_del_port(priv
, port
);
165 void mlx5e_vxlan_queue_work(struct mlx5e_priv
*priv
, sa_family_t sa_family
,
168 struct mlx5e_vxlan_work
*vxlan_work
;
170 vxlan_work
= kmalloc(sizeof(*vxlan_work
), GFP_ATOMIC
);
175 INIT_WORK(&vxlan_work
->work
, mlx5e_vxlan_add_port
);
177 INIT_WORK(&vxlan_work
->work
, mlx5e_vxlan_del_port
);
179 vxlan_work
->priv
= priv
;
180 vxlan_work
->port
= port
;
181 vxlan_work
->sa_family
= sa_family
;
182 queue_work(priv
->wq
, &vxlan_work
->work
);
185 void mlx5e_vxlan_cleanup(struct mlx5e_priv
*priv
)
187 struct mlx5e_vxlan_db
*vxlan_db
= &priv
->vxlan
;
188 struct mlx5e_vxlan
*vxlan
;
189 unsigned int port
= 0;
191 spin_lock_irq(&vxlan_db
->lock
);
192 while (radix_tree_gang_lookup(&vxlan_db
->tree
, (void **)&vxlan
, port
, 1)) {
193 port
= vxlan
->udp_port
;
194 spin_unlock_irq(&vxlan_db
->lock
);
195 __mlx5e_vxlan_core_del_port(priv
, (u16
)port
);
196 spin_lock_irq(&vxlan_db
->lock
);
198 spin_unlock_irq(&vxlan_db
->lock
);