1 /* 2 * Copyright (c) 2016, Mellanox Technologies, Ltd. All rights reserved. 3 * 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: 9 * 10 * Redistribution and use in source and binary forms, with or 11 * without modification, are permitted provided that the following 12 * conditions are met: 13 * 14 * - Redistributions of source code must retain the above 15 * copyright notice, this list of conditions and the following 16 * disclaimer. 17 * 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. 22 * 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 30 * SOFTWARE. 31 */ 32 33 #include <linux/kernel.h> 34 #include <linux/module.h> 35 #include <linux/refcount.h> 36 #include <linux/mlx5/driver.h> 37 #include <net/vxlan.h> 38 #include "mlx5_core.h" 39 #include "vxlan.h" 40 41 struct mlx5_vxlan { 42 struct mlx5_core_dev *mdev; 43 /* max_num_ports is usuallly 4, 16 buckets is more than enough */ 44 DECLARE_HASHTABLE(htable, 4); 45 struct mutex sync_lock; /* sync add/del port HW operations */ 46 }; 47 48 struct mlx5_vxlan_port { 49 struct hlist_node hlist; 50 u16 udp_port; 51 }; 52 53 static int mlx5_vxlan_core_add_port_cmd(struct mlx5_core_dev *mdev, u16 port) 54 { 55 u32 in[MLX5_ST_SZ_DW(add_vxlan_udp_dport_in)] = {}; 56 57 MLX5_SET(add_vxlan_udp_dport_in, in, opcode, 58 MLX5_CMD_OP_ADD_VXLAN_UDP_DPORT); 59 MLX5_SET(add_vxlan_udp_dport_in, in, vxlan_udp_port, port); 60 return mlx5_cmd_exec_in(mdev, add_vxlan_udp_dport, in); 61 } 62 63 static int mlx5_vxlan_core_del_port_cmd(struct mlx5_core_dev *mdev, u16 port) 64 { 65 u32 in[MLX5_ST_SZ_DW(delete_vxlan_udp_dport_in)] = {}; 66 67 MLX5_SET(delete_vxlan_udp_dport_in, in, opcode, 68 MLX5_CMD_OP_DELETE_VXLAN_UDP_DPORT); 69 MLX5_SET(delete_vxlan_udp_dport_in, in, vxlan_udp_port, port); 70 return mlx5_cmd_exec_in(mdev, delete_vxlan_udp_dport, in); 71 } 72 73 bool mlx5_vxlan_lookup_port(struct mlx5_vxlan *vxlan, u16 port) 74 { 75 struct mlx5_vxlan_port *vxlanp; 76 bool found = false; 77 78 if (!mlx5_vxlan_allowed(vxlan)) 79 return NULL; 80 81 rcu_read_lock(); 82 hash_for_each_possible_rcu(vxlan->htable, vxlanp, hlist, port) 83 if (vxlanp->udp_port == port) { 84 found = true; 85 break; 86 } 87 rcu_read_unlock(); 88 89 return found; 90 } 91 92 static struct mlx5_vxlan_port *vxlan_lookup_port(struct mlx5_vxlan *vxlan, u16 port) 93 { 94 struct mlx5_vxlan_port *vxlanp; 95 96 hash_for_each_possible(vxlan->htable, vxlanp, hlist, port) 97 if (vxlanp->udp_port == port) 98 return vxlanp; 99 return NULL; 100 } 101 102 int mlx5_vxlan_add_port(struct mlx5_vxlan *vxlan, u16 port) 103 { 104 struct mlx5_vxlan_port *vxlanp; 105 int ret; 106 107 vxlanp = kzalloc(sizeof(*vxlanp), GFP_KERNEL); 108 if (!vxlanp) 109 return -ENOMEM; 110 vxlanp->udp_port = port; 111 112 ret = mlx5_vxlan_core_add_port_cmd(vxlan->mdev, port); 113 if (ret) { 114 kfree(vxlanp); 115 return ret; 116 } 117 118 mutex_lock(&vxlan->sync_lock); 119 hash_add_rcu(vxlan->htable, &vxlanp->hlist, port); 120 mutex_unlock(&vxlan->sync_lock); 121 122 return 0; 123 } 124 125 int mlx5_vxlan_del_port(struct mlx5_vxlan *vxlan, u16 port) 126 { 127 struct mlx5_vxlan_port *vxlanp; 128 int ret = 0; 129 130 mutex_lock(&vxlan->sync_lock); 131 132 vxlanp = vxlan_lookup_port(vxlan, port); 133 if (WARN_ON(!vxlanp)) { 134 ret = -ENOENT; 135 goto out_unlock; 136 } 137 138 hash_del_rcu(&vxlanp->hlist); 139 synchronize_rcu(); 140 mlx5_vxlan_core_del_port_cmd(vxlan->mdev, port); 141 kfree(vxlanp); 142 143 out_unlock: 144 mutex_unlock(&vxlan->sync_lock); 145 return ret; 146 } 147 148 struct mlx5_vxlan *mlx5_vxlan_create(struct mlx5_core_dev *mdev) 149 { 150 struct mlx5_vxlan *vxlan; 151 152 if (!MLX5_CAP_ETH(mdev, tunnel_stateless_vxlan) || !mlx5_core_is_pf(mdev)) 153 return ERR_PTR(-ENOTSUPP); 154 155 vxlan = kzalloc(sizeof(*vxlan), GFP_KERNEL); 156 if (!vxlan) 157 return ERR_PTR(-ENOMEM); 158 159 vxlan->mdev = mdev; 160 mutex_init(&vxlan->sync_lock); 161 hash_init(vxlan->htable); 162 163 /* Hardware adds 4789 (IANA_VXLAN_UDP_PORT) by default */ 164 mlx5_vxlan_add_port(vxlan, IANA_VXLAN_UDP_PORT); 165 166 return vxlan; 167 } 168 169 void mlx5_vxlan_destroy(struct mlx5_vxlan *vxlan) 170 { 171 if (!mlx5_vxlan_allowed(vxlan)) 172 return; 173 174 mlx5_vxlan_del_port(vxlan, IANA_VXLAN_UDP_PORT); 175 WARN_ON(!hash_empty(vxlan->htable)); 176 177 kfree(vxlan); 178 } 179 180 void mlx5_vxlan_reset_to_default(struct mlx5_vxlan *vxlan) 181 { 182 struct mlx5_vxlan_port *vxlanp; 183 struct hlist_node *tmp; 184 int bkt; 185 186 if (!mlx5_vxlan_allowed(vxlan)) 187 return; 188 189 hash_for_each_safe(vxlan->htable, bkt, tmp, vxlanp, hlist) { 190 /* Don't delete default UDP port added by the HW. 191 * Remove only user configured ports 192 */ 193 if (vxlanp->udp_port == IANA_VXLAN_UDP_PORT) 194 continue; 195 mlx5_vxlan_del_port(vxlan, vxlanp->udp_port); 196 } 197 } 198