1 /*
2  * Copyright (c) 2016, Mellanox Technologies. 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/debugfs.h>
34 #include <linux/mlx5/fs.h>
35 #include <net/switchdev.h>
36 #include <net/pkt_cls.h>
37 #include <net/act_api.h>
38 #include <net/devlink.h>
39 #include <net/ipv6_stubs.h>
40 
41 #include "eswitch.h"
42 #include "en.h"
43 #include "en_rep.h"
44 #include "en/params.h"
45 #include "en/txrx.h"
46 #include "en_tc.h"
47 #include "en/rep/tc.h"
48 #include "en/rep/neigh.h"
49 #include "en/rep/bridge.h"
50 #include "en/devlink.h"
51 #include "fs_core.h"
52 #include "lib/mlx5.h"
53 #include "lib/devcom.h"
54 #include "lib/vxlan.h"
55 #define CREATE_TRACE_POINTS
56 #include "diag/en_rep_tracepoint.h"
57 #include "diag/reporter_vnic.h"
58 #include "en_accel/ipsec.h"
59 #include "en/tc/int_port.h"
60 #include "en/ptp.h"
61 #include "en/fs_ethtool.h"
62 
63 #define MLX5E_REP_PARAMS_DEF_LOG_SQ_SIZE \
64 	max(0x7, MLX5E_PARAMS_MINIMUM_LOG_SQ_SIZE)
65 #define MLX5E_REP_PARAMS_DEF_NUM_CHANNELS 1
66 
67 static const char mlx5e_rep_driver_name[] = "mlx5e_rep";
68 
mlx5e_rep_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * drvinfo)69 static void mlx5e_rep_get_drvinfo(struct net_device *dev,
70 				  struct ethtool_drvinfo *drvinfo)
71 {
72 	struct mlx5e_priv *priv = netdev_priv(dev);
73 	struct mlx5_core_dev *mdev = priv->mdev;
74 
75 	strscpy(drvinfo->driver, mlx5e_rep_driver_name,
76 		sizeof(drvinfo->driver));
77 	snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
78 		 "%d.%d.%04d (%.16s)",
79 		 fw_rev_maj(mdev), fw_rev_min(mdev),
80 		 fw_rev_sub(mdev), mdev->board_id);
81 }
82 
83 static const struct counter_desc sw_rep_stats_desc[] = {
84 	{ MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, rx_packets) },
85 	{ MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, rx_bytes) },
86 	{ MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, tx_packets) },
87 	{ MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, tx_bytes) },
88 };
89 
90 static const struct counter_desc vport_rep_stats_desc[] = {
91 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats, vport_rx_packets) },
92 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats, vport_rx_bytes) },
93 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats, vport_tx_packets) },
94 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats, vport_tx_bytes) },
95 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats,
96 			     rx_vport_rdma_unicast_packets) },
97 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats, rx_vport_rdma_unicast_bytes) },
98 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats,
99 			     tx_vport_rdma_unicast_packets) },
100 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats, tx_vport_rdma_unicast_bytes) },
101 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats,
102 			     rx_vport_rdma_multicast_packets) },
103 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats,
104 			     rx_vport_rdma_multicast_bytes) },
105 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats,
106 			     tx_vport_rdma_multicast_packets) },
107 	{ MLX5E_DECLARE_STAT(struct mlx5e_rep_stats,
108 			     tx_vport_rdma_multicast_bytes) },
109 };
110 
111 #define NUM_VPORT_REP_SW_COUNTERS ARRAY_SIZE(sw_rep_stats_desc)
112 #define NUM_VPORT_REP_HW_COUNTERS ARRAY_SIZE(vport_rep_stats_desc)
113 
MLX5E_DECLARE_STATS_GRP_OP_NUM_STATS(sw_rep)114 static MLX5E_DECLARE_STATS_GRP_OP_NUM_STATS(sw_rep)
115 {
116 	return NUM_VPORT_REP_SW_COUNTERS;
117 }
118 
MLX5E_DECLARE_STATS_GRP_OP_FILL_STRS(sw_rep)119 static MLX5E_DECLARE_STATS_GRP_OP_FILL_STRS(sw_rep)
120 {
121 	int i;
122 
123 	for (i = 0; i < NUM_VPORT_REP_SW_COUNTERS; i++)
124 		strcpy(data + (idx++) * ETH_GSTRING_LEN,
125 		       sw_rep_stats_desc[i].format);
126 	return idx;
127 }
128 
MLX5E_DECLARE_STATS_GRP_OP_FILL_STATS(sw_rep)129 static MLX5E_DECLARE_STATS_GRP_OP_FILL_STATS(sw_rep)
130 {
131 	int i;
132 
133 	for (i = 0; i < NUM_VPORT_REP_SW_COUNTERS; i++)
134 		data[idx++] = MLX5E_READ_CTR64_CPU(&priv->stats.sw,
135 						   sw_rep_stats_desc, i);
136 	return idx;
137 }
138 
MLX5E_DECLARE_STATS_GRP_OP_UPDATE_STATS(sw_rep)139 static MLX5E_DECLARE_STATS_GRP_OP_UPDATE_STATS(sw_rep)
140 {
141 	struct mlx5e_sw_stats *s = &priv->stats.sw;
142 	struct rtnl_link_stats64 stats64 = {};
143 
144 	memset(s, 0, sizeof(*s));
145 	mlx5e_fold_sw_stats64(priv, &stats64);
146 
147 	s->rx_packets = stats64.rx_packets;
148 	s->rx_bytes   = stats64.rx_bytes;
149 	s->tx_packets = stats64.tx_packets;
150 	s->tx_bytes   = stats64.tx_bytes;
151 	s->tx_queue_dropped = stats64.tx_dropped;
152 }
153 
MLX5E_DECLARE_STATS_GRP_OP_NUM_STATS(vport_rep)154 static MLX5E_DECLARE_STATS_GRP_OP_NUM_STATS(vport_rep)
155 {
156 	return NUM_VPORT_REP_HW_COUNTERS;
157 }
158 
MLX5E_DECLARE_STATS_GRP_OP_FILL_STRS(vport_rep)159 static MLX5E_DECLARE_STATS_GRP_OP_FILL_STRS(vport_rep)
160 {
161 	int i;
162 
163 	for (i = 0; i < NUM_VPORT_REP_HW_COUNTERS; i++)
164 		strcpy(data + (idx++) * ETH_GSTRING_LEN, vport_rep_stats_desc[i].format);
165 	return idx;
166 }
167 
MLX5E_DECLARE_STATS_GRP_OP_FILL_STATS(vport_rep)168 static MLX5E_DECLARE_STATS_GRP_OP_FILL_STATS(vport_rep)
169 {
170 	int i;
171 
172 	for (i = 0; i < NUM_VPORT_REP_HW_COUNTERS; i++)
173 		data[idx++] = MLX5E_READ_CTR64_CPU(&priv->stats.rep_stats,
174 						   vport_rep_stats_desc, i);
175 	return idx;
176 }
177 
MLX5E_DECLARE_STATS_GRP_OP_UPDATE_STATS(vport_rep)178 static MLX5E_DECLARE_STATS_GRP_OP_UPDATE_STATS(vport_rep)
179 {
180 	struct mlx5e_rep_stats *rep_stats = &priv->stats.rep_stats;
181 	int outlen = MLX5_ST_SZ_BYTES(query_vport_counter_out);
182 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
183 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
184 	struct mlx5_eswitch_rep *rep = rpriv->rep;
185 	u32 *out;
186 	int err;
187 
188 	out = kvzalloc(outlen, GFP_KERNEL);
189 	if (!out)
190 		return;
191 
192 	err = mlx5_core_query_vport_counter(esw->dev, 1, rep->vport - 1, 0, out);
193 	if (err) {
194 		netdev_warn(priv->netdev, "vport %d error %d reading stats\n",
195 			    rep->vport, err);
196 		goto out;
197 	}
198 
199 	#define MLX5_GET_CTR(p, x) \
200 		MLX5_GET64(query_vport_counter_out, p, x)
201 	/* flip tx/rx as we are reporting the counters for the switch vport */
202 	rep_stats->vport_rx_packets =
203 		MLX5_GET_CTR(out, transmitted_ib_unicast.packets) +
204 		MLX5_GET_CTR(out, transmitted_eth_unicast.packets) +
205 		MLX5_GET_CTR(out, transmitted_ib_multicast.packets) +
206 		MLX5_GET_CTR(out, transmitted_eth_multicast.packets) +
207 		MLX5_GET_CTR(out, transmitted_eth_broadcast.packets);
208 
209 	rep_stats->vport_tx_packets =
210 		MLX5_GET_CTR(out, received_ib_unicast.packets) +
211 		MLX5_GET_CTR(out, received_eth_unicast.packets) +
212 		MLX5_GET_CTR(out, received_ib_multicast.packets) +
213 		MLX5_GET_CTR(out, received_eth_multicast.packets) +
214 		MLX5_GET_CTR(out, received_eth_broadcast.packets);
215 
216 	rep_stats->vport_rx_bytes =
217 		MLX5_GET_CTR(out, transmitted_ib_unicast.octets) +
218 		MLX5_GET_CTR(out, transmitted_eth_unicast.octets) +
219 		MLX5_GET_CTR(out, transmitted_ib_multicast.octets) +
220 		MLX5_GET_CTR(out, transmitted_eth_broadcast.octets);
221 
222 	rep_stats->vport_tx_bytes =
223 		MLX5_GET_CTR(out, received_ib_unicast.octets) +
224 		MLX5_GET_CTR(out, received_eth_unicast.octets) +
225 		MLX5_GET_CTR(out, received_ib_multicast.octets) +
226 		MLX5_GET_CTR(out, received_eth_multicast.octets) +
227 		MLX5_GET_CTR(out, received_eth_broadcast.octets);
228 
229 	rep_stats->rx_vport_rdma_unicast_packets =
230 		MLX5_GET_CTR(out, transmitted_ib_unicast.packets);
231 	rep_stats->tx_vport_rdma_unicast_packets =
232 		MLX5_GET_CTR(out, received_ib_unicast.packets);
233 	rep_stats->rx_vport_rdma_unicast_bytes =
234 		MLX5_GET_CTR(out, transmitted_ib_unicast.octets);
235 	rep_stats->tx_vport_rdma_unicast_bytes =
236 		MLX5_GET_CTR(out, received_ib_unicast.octets);
237 	rep_stats->rx_vport_rdma_multicast_packets =
238 		MLX5_GET_CTR(out, transmitted_ib_multicast.packets);
239 	rep_stats->tx_vport_rdma_multicast_packets =
240 		MLX5_GET_CTR(out, received_ib_multicast.packets);
241 	rep_stats->rx_vport_rdma_multicast_bytes =
242 		MLX5_GET_CTR(out, transmitted_ib_multicast.octets);
243 	rep_stats->tx_vport_rdma_multicast_bytes =
244 		MLX5_GET_CTR(out, received_ib_multicast.octets);
245 
246 out:
247 	kvfree(out);
248 }
249 
mlx5e_rep_get_strings(struct net_device * dev,u32 stringset,uint8_t * data)250 static void mlx5e_rep_get_strings(struct net_device *dev,
251 				  u32 stringset, uint8_t *data)
252 {
253 	struct mlx5e_priv *priv = netdev_priv(dev);
254 
255 	switch (stringset) {
256 	case ETH_SS_STATS:
257 		mlx5e_stats_fill_strings(priv, data);
258 		break;
259 	}
260 }
261 
mlx5e_rep_get_ethtool_stats(struct net_device * dev,struct ethtool_stats * stats,u64 * data)262 static void mlx5e_rep_get_ethtool_stats(struct net_device *dev,
263 					struct ethtool_stats *stats, u64 *data)
264 {
265 	struct mlx5e_priv *priv = netdev_priv(dev);
266 
267 	mlx5e_ethtool_get_ethtool_stats(priv, stats, data);
268 }
269 
mlx5e_rep_get_sset_count(struct net_device * dev,int sset)270 static int mlx5e_rep_get_sset_count(struct net_device *dev, int sset)
271 {
272 	struct mlx5e_priv *priv = netdev_priv(dev);
273 
274 	switch (sset) {
275 	case ETH_SS_STATS:
276 		return mlx5e_stats_total_num(priv);
277 	default:
278 		return -EOPNOTSUPP;
279 	}
280 }
281 
282 static void
mlx5e_rep_get_ringparam(struct net_device * dev,struct ethtool_ringparam * param,struct kernel_ethtool_ringparam * kernel_param,struct netlink_ext_ack * extack)283 mlx5e_rep_get_ringparam(struct net_device *dev,
284 			struct ethtool_ringparam *param,
285 			struct kernel_ethtool_ringparam *kernel_param,
286 			struct netlink_ext_ack *extack)
287 {
288 	struct mlx5e_priv *priv = netdev_priv(dev);
289 
290 	mlx5e_ethtool_get_ringparam(priv, param, kernel_param);
291 }
292 
293 static int
mlx5e_rep_set_ringparam(struct net_device * dev,struct ethtool_ringparam * param,struct kernel_ethtool_ringparam * kernel_param,struct netlink_ext_ack * extack)294 mlx5e_rep_set_ringparam(struct net_device *dev,
295 			struct ethtool_ringparam *param,
296 			struct kernel_ethtool_ringparam *kernel_param,
297 			struct netlink_ext_ack *extack)
298 {
299 	struct mlx5e_priv *priv = netdev_priv(dev);
300 
301 	return mlx5e_ethtool_set_ringparam(priv, param);
302 }
303 
mlx5e_rep_get_channels(struct net_device * dev,struct ethtool_channels * ch)304 static void mlx5e_rep_get_channels(struct net_device *dev,
305 				   struct ethtool_channels *ch)
306 {
307 	struct mlx5e_priv *priv = netdev_priv(dev);
308 
309 	mlx5e_ethtool_get_channels(priv, ch);
310 }
311 
mlx5e_rep_set_channels(struct net_device * dev,struct ethtool_channels * ch)312 static int mlx5e_rep_set_channels(struct net_device *dev,
313 				  struct ethtool_channels *ch)
314 {
315 	struct mlx5e_priv *priv = netdev_priv(dev);
316 
317 	return mlx5e_ethtool_set_channels(priv, ch);
318 }
319 
mlx5e_rep_get_coalesce(struct net_device * netdev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)320 static int mlx5e_rep_get_coalesce(struct net_device *netdev,
321 				  struct ethtool_coalesce *coal,
322 				  struct kernel_ethtool_coalesce *kernel_coal,
323 				  struct netlink_ext_ack *extack)
324 {
325 	struct mlx5e_priv *priv = netdev_priv(netdev);
326 
327 	return mlx5e_ethtool_get_coalesce(priv, coal, kernel_coal);
328 }
329 
mlx5e_rep_set_coalesce(struct net_device * netdev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)330 static int mlx5e_rep_set_coalesce(struct net_device *netdev,
331 				  struct ethtool_coalesce *coal,
332 				  struct kernel_ethtool_coalesce *kernel_coal,
333 				  struct netlink_ext_ack *extack)
334 {
335 	struct mlx5e_priv *priv = netdev_priv(netdev);
336 
337 	return mlx5e_ethtool_set_coalesce(priv, coal, kernel_coal, extack);
338 }
339 
mlx5e_rep_get_rxfh_key_size(struct net_device * netdev)340 static u32 mlx5e_rep_get_rxfh_key_size(struct net_device *netdev)
341 {
342 	struct mlx5e_priv *priv = netdev_priv(netdev);
343 
344 	return mlx5e_ethtool_get_rxfh_key_size(priv);
345 }
346 
mlx5e_rep_get_rxfh_indir_size(struct net_device * netdev)347 static u32 mlx5e_rep_get_rxfh_indir_size(struct net_device *netdev)
348 {
349 	struct mlx5e_priv *priv = netdev_priv(netdev);
350 
351 	return mlx5e_ethtool_get_rxfh_indir_size(priv);
352 }
353 
354 static const struct ethtool_ops mlx5e_rep_ethtool_ops = {
355 	.supported_coalesce_params = ETHTOOL_COALESCE_USECS |
356 				     ETHTOOL_COALESCE_MAX_FRAMES |
357 				     ETHTOOL_COALESCE_USE_ADAPTIVE,
358 	.get_drvinfo	   = mlx5e_rep_get_drvinfo,
359 	.get_link	   = ethtool_op_get_link,
360 	.get_strings       = mlx5e_rep_get_strings,
361 	.get_sset_count    = mlx5e_rep_get_sset_count,
362 	.get_ethtool_stats = mlx5e_rep_get_ethtool_stats,
363 	.get_ringparam     = mlx5e_rep_get_ringparam,
364 	.set_ringparam     = mlx5e_rep_set_ringparam,
365 	.get_channels      = mlx5e_rep_get_channels,
366 	.set_channels      = mlx5e_rep_set_channels,
367 	.get_coalesce      = mlx5e_rep_get_coalesce,
368 	.set_coalesce      = mlx5e_rep_set_coalesce,
369 	.get_rxfh_key_size   = mlx5e_rep_get_rxfh_key_size,
370 	.get_rxfh_indir_size = mlx5e_rep_get_rxfh_indir_size,
371 };
372 
mlx5e_sqs2vport_stop(struct mlx5_eswitch * esw,struct mlx5_eswitch_rep * rep)373 static void mlx5e_sqs2vport_stop(struct mlx5_eswitch *esw,
374 				 struct mlx5_eswitch_rep *rep)
375 {
376 	struct mlx5e_rep_sq *rep_sq, *tmp;
377 	struct mlx5e_rep_sq_peer *sq_peer;
378 	struct mlx5e_rep_priv *rpriv;
379 	unsigned long i;
380 
381 	if (esw->mode != MLX5_ESWITCH_OFFLOADS)
382 		return;
383 
384 	rpriv = mlx5e_rep_to_rep_priv(rep);
385 	list_for_each_entry_safe(rep_sq, tmp, &rpriv->vport_sqs_list, list) {
386 		mlx5_eswitch_del_send_to_vport_rule(rep_sq->send_to_vport_rule);
387 		xa_for_each(&rep_sq->sq_peer, i, sq_peer) {
388 			if (sq_peer->rule)
389 				mlx5_eswitch_del_send_to_vport_rule(sq_peer->rule);
390 
391 			xa_erase(&rep_sq->sq_peer, i);
392 			kfree(sq_peer);
393 		}
394 
395 		xa_destroy(&rep_sq->sq_peer);
396 		list_del(&rep_sq->list);
397 		kfree(rep_sq);
398 	}
399 }
400 
mlx5e_sqs2vport_add_peers_rules(struct mlx5_eswitch * esw,struct mlx5_eswitch_rep * rep,struct mlx5e_rep_sq * rep_sq,int i)401 static int mlx5e_sqs2vport_add_peers_rules(struct mlx5_eswitch *esw, struct mlx5_eswitch_rep *rep,
402 					   struct mlx5e_rep_sq *rep_sq, int i)
403 {
404 	struct mlx5_flow_handle *flow_rule;
405 	struct mlx5_devcom_comp_dev *tmp;
406 	struct mlx5_eswitch *peer_esw;
407 
408 	mlx5_devcom_for_each_peer_entry(esw->devcom, peer_esw, tmp) {
409 		u16 peer_rule_idx = MLX5_CAP_GEN(peer_esw->dev, vhca_id);
410 		struct mlx5e_rep_sq_peer *sq_peer;
411 		int err;
412 
413 		sq_peer = kzalloc(sizeof(*sq_peer), GFP_KERNEL);
414 		if (!sq_peer)
415 			return -ENOMEM;
416 
417 		flow_rule = mlx5_eswitch_add_send_to_vport_rule(peer_esw, esw,
418 								rep, rep_sq->sqn);
419 		if (IS_ERR(flow_rule)) {
420 			kfree(sq_peer);
421 			return PTR_ERR(flow_rule);
422 		}
423 
424 		sq_peer->rule = flow_rule;
425 		sq_peer->peer = peer_esw;
426 		err = xa_insert(&rep_sq->sq_peer, peer_rule_idx, sq_peer, GFP_KERNEL);
427 		if (err) {
428 			kfree(sq_peer);
429 			mlx5_eswitch_del_send_to_vport_rule(flow_rule);
430 			return err;
431 		}
432 	}
433 
434 	return 0;
435 }
436 
mlx5e_sqs2vport_start(struct mlx5_eswitch * esw,struct mlx5_eswitch_rep * rep,u32 * sqns_array,int sqns_num)437 static int mlx5e_sqs2vport_start(struct mlx5_eswitch *esw,
438 				 struct mlx5_eswitch_rep *rep,
439 				 u32 *sqns_array, int sqns_num)
440 {
441 	struct mlx5_flow_handle *flow_rule;
442 	struct mlx5e_rep_priv *rpriv;
443 	struct mlx5e_rep_sq *rep_sq;
444 	bool devcom_locked = false;
445 	int err;
446 	int i;
447 
448 	if (esw->mode != MLX5_ESWITCH_OFFLOADS)
449 		return 0;
450 
451 	rpriv = mlx5e_rep_to_rep_priv(rep);
452 
453 	if (mlx5_devcom_comp_is_ready(esw->devcom) &&
454 	    mlx5_devcom_for_each_peer_begin(esw->devcom))
455 		devcom_locked = true;
456 
457 	for (i = 0; i < sqns_num; i++) {
458 		rep_sq = kzalloc(sizeof(*rep_sq), GFP_KERNEL);
459 		if (!rep_sq) {
460 			err = -ENOMEM;
461 			goto out_err;
462 		}
463 
464 		/* Add re-inject rule to the PF/representor sqs */
465 		flow_rule = mlx5_eswitch_add_send_to_vport_rule(esw, esw, rep,
466 								sqns_array[i]);
467 		if (IS_ERR(flow_rule)) {
468 			err = PTR_ERR(flow_rule);
469 			kfree(rep_sq);
470 			goto out_err;
471 		}
472 		rep_sq->send_to_vport_rule = flow_rule;
473 		rep_sq->sqn = sqns_array[i];
474 
475 		xa_init(&rep_sq->sq_peer);
476 		if (devcom_locked) {
477 			err = mlx5e_sqs2vport_add_peers_rules(esw, rep, rep_sq, i);
478 			if (err) {
479 				mlx5_eswitch_del_send_to_vport_rule(rep_sq->send_to_vport_rule);
480 				xa_destroy(&rep_sq->sq_peer);
481 				kfree(rep_sq);
482 				goto out_err;
483 			}
484 		}
485 
486 		list_add(&rep_sq->list, &rpriv->vport_sqs_list);
487 	}
488 
489 	if (devcom_locked)
490 		mlx5_devcom_for_each_peer_end(esw->devcom);
491 
492 	return 0;
493 
494 out_err:
495 	mlx5e_sqs2vport_stop(esw, rep);
496 
497 	if (devcom_locked)
498 		mlx5_devcom_for_each_peer_end(esw->devcom);
499 
500 	return err;
501 }
502 
503 static int
mlx5e_add_sqs_fwd_rules(struct mlx5e_priv * priv)504 mlx5e_add_sqs_fwd_rules(struct mlx5e_priv *priv)
505 {
506 	int sqs_per_channel = mlx5e_get_dcb_num_tc(&priv->channels.params);
507 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
508 	bool is_uplink_rep = mlx5e_is_uplink_rep(priv);
509 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
510 	struct mlx5_eswitch_rep *rep = rpriv->rep;
511 	int n, tc, nch, num_sqs = 0;
512 	struct mlx5e_channel *c;
513 	int err = -ENOMEM;
514 	bool ptp_sq;
515 	u32 *sqs;
516 
517 	ptp_sq = !!(priv->channels.ptp &&
518 		    MLX5E_GET_PFLAG(&priv->channels.params, MLX5E_PFLAG_TX_PORT_TS));
519 	nch = priv->channels.num + ptp_sq;
520 	/* +2 for xdpsqs, they don't exist on the ptp channel but will not be
521 	 * counted for by num_sqs.
522 	 */
523 	if (is_uplink_rep)
524 		sqs_per_channel += 2;
525 
526 	sqs = kvcalloc(nch * sqs_per_channel, sizeof(*sqs), GFP_KERNEL);
527 	if (!sqs)
528 		goto out;
529 
530 	for (n = 0; n < priv->channels.num; n++) {
531 		c = priv->channels.c[n];
532 		for (tc = 0; tc < c->num_tc; tc++)
533 			sqs[num_sqs++] = c->sq[tc].sqn;
534 
535 		if (is_uplink_rep) {
536 			if (c->xdp)
537 				sqs[num_sqs++] = c->rq_xdpsq.sqn;
538 
539 			sqs[num_sqs++] = c->xdpsq.sqn;
540 		}
541 	}
542 	if (ptp_sq) {
543 		struct mlx5e_ptp *ptp_ch = priv->channels.ptp;
544 
545 		for (tc = 0; tc < ptp_ch->num_tc; tc++)
546 			sqs[num_sqs++] = ptp_ch->ptpsq[tc].txqsq.sqn;
547 	}
548 
549 	err = mlx5e_sqs2vport_start(esw, rep, sqs, num_sqs);
550 	kvfree(sqs);
551 
552 out:
553 	if (err)
554 		netdev_warn(priv->netdev, "Failed to add SQs FWD rules %d\n", err);
555 	return err;
556 }
557 
558 static void
mlx5e_remove_sqs_fwd_rules(struct mlx5e_priv * priv)559 mlx5e_remove_sqs_fwd_rules(struct mlx5e_priv *priv)
560 {
561 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
562 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
563 	struct mlx5_eswitch_rep *rep = rpriv->rep;
564 
565 	mlx5e_sqs2vport_stop(esw, rep);
566 }
567 
568 static int
mlx5e_rep_add_meta_tunnel_rule(struct mlx5e_priv * priv)569 mlx5e_rep_add_meta_tunnel_rule(struct mlx5e_priv *priv)
570 {
571 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
572 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
573 	struct mlx5_eswitch_rep *rep = rpriv->rep;
574 	struct mlx5_flow_handle *flow_rule;
575 	struct mlx5_flow_group *g;
576 
577 	g = esw->fdb_table.offloads.send_to_vport_meta_grp;
578 	if (!g)
579 		return 0;
580 
581 	flow_rule = mlx5_eswitch_add_send_to_vport_meta_rule(esw, rep->vport);
582 	if (IS_ERR(flow_rule))
583 		return PTR_ERR(flow_rule);
584 
585 	rpriv->send_to_vport_meta_rule = flow_rule;
586 
587 	return 0;
588 }
589 
590 static void
mlx5e_rep_del_meta_tunnel_rule(struct mlx5e_priv * priv)591 mlx5e_rep_del_meta_tunnel_rule(struct mlx5e_priv *priv)
592 {
593 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
594 
595 	if (rpriv->send_to_vport_meta_rule)
596 		mlx5_eswitch_del_send_to_vport_meta_rule(rpriv->send_to_vport_meta_rule);
597 }
598 
mlx5e_rep_activate_channels(struct mlx5e_priv * priv)599 void mlx5e_rep_activate_channels(struct mlx5e_priv *priv)
600 {
601 	mlx5e_add_sqs_fwd_rules(priv);
602 	mlx5e_rep_add_meta_tunnel_rule(priv);
603 }
604 
mlx5e_rep_deactivate_channels(struct mlx5e_priv * priv)605 void mlx5e_rep_deactivate_channels(struct mlx5e_priv *priv)
606 {
607 	mlx5e_rep_del_meta_tunnel_rule(priv);
608 	mlx5e_remove_sqs_fwd_rules(priv);
609 }
610 
mlx5e_rep_open(struct net_device * dev)611 static int mlx5e_rep_open(struct net_device *dev)
612 {
613 	struct mlx5e_priv *priv = netdev_priv(dev);
614 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
615 	struct mlx5_eswitch_rep *rep = rpriv->rep;
616 	int err;
617 
618 	mutex_lock(&priv->state_lock);
619 	err = mlx5e_open_locked(dev);
620 	if (err)
621 		goto unlock;
622 
623 	if (!mlx5_modify_vport_admin_state(priv->mdev,
624 					   MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
625 					   rep->vport, 1,
626 					   MLX5_VPORT_ADMIN_STATE_UP))
627 		netif_carrier_on(dev);
628 
629 unlock:
630 	mutex_unlock(&priv->state_lock);
631 	return err;
632 }
633 
mlx5e_rep_close(struct net_device * dev)634 static int mlx5e_rep_close(struct net_device *dev)
635 {
636 	struct mlx5e_priv *priv = netdev_priv(dev);
637 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
638 	struct mlx5_eswitch_rep *rep = rpriv->rep;
639 	int ret;
640 
641 	mutex_lock(&priv->state_lock);
642 	mlx5_modify_vport_admin_state(priv->mdev,
643 				      MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
644 				      rep->vport, 1,
645 				      MLX5_VPORT_ADMIN_STATE_DOWN);
646 	ret = mlx5e_close_locked(dev);
647 	mutex_unlock(&priv->state_lock);
648 	return ret;
649 }
650 
mlx5e_is_uplink_rep(struct mlx5e_priv * priv)651 bool mlx5e_is_uplink_rep(struct mlx5e_priv *priv)
652 {
653 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
654 	struct mlx5_eswitch_rep *rep;
655 
656 	if (!MLX5_ESWITCH_MANAGER(priv->mdev))
657 		return false;
658 
659 	if (!rpriv) /* non vport rep mlx5e instances don't use this field */
660 		return false;
661 
662 	rep = rpriv->rep;
663 	return (rep->vport == MLX5_VPORT_UPLINK);
664 }
665 
mlx5e_rep_has_offload_stats(const struct net_device * dev,int attr_id)666 bool mlx5e_rep_has_offload_stats(const struct net_device *dev, int attr_id)
667 {
668 	switch (attr_id) {
669 	case IFLA_OFFLOAD_XSTATS_CPU_HIT:
670 			return true;
671 	}
672 
673 	return false;
674 }
675 
676 static int
mlx5e_get_sw_stats64(const struct net_device * dev,struct rtnl_link_stats64 * stats)677 mlx5e_get_sw_stats64(const struct net_device *dev,
678 		     struct rtnl_link_stats64 *stats)
679 {
680 	struct mlx5e_priv *priv = netdev_priv(dev);
681 
682 	mlx5e_fold_sw_stats64(priv, stats);
683 	return 0;
684 }
685 
mlx5e_rep_get_offload_stats(int attr_id,const struct net_device * dev,void * sp)686 int mlx5e_rep_get_offload_stats(int attr_id, const struct net_device *dev,
687 				void *sp)
688 {
689 	switch (attr_id) {
690 	case IFLA_OFFLOAD_XSTATS_CPU_HIT:
691 		return mlx5e_get_sw_stats64(dev, sp);
692 	}
693 
694 	return -EINVAL;
695 }
696 
697 static void
mlx5e_rep_get_stats(struct net_device * dev,struct rtnl_link_stats64 * stats)698 mlx5e_rep_get_stats(struct net_device *dev, struct rtnl_link_stats64 *stats)
699 {
700 	struct mlx5e_priv *priv = netdev_priv(dev);
701 
702 	/* update HW stats in background for next time */
703 	mlx5e_queue_update_stats(priv);
704 	mlx5e_stats_copy_rep_stats(stats, &priv->stats.rep_stats);
705 }
706 
mlx5e_rep_change_mtu(struct net_device * netdev,int new_mtu)707 static int mlx5e_rep_change_mtu(struct net_device *netdev, int new_mtu)
708 {
709 	return mlx5e_change_mtu(netdev, new_mtu, NULL);
710 }
711 
mlx5e_rep_change_carrier(struct net_device * dev,bool new_carrier)712 static int mlx5e_rep_change_carrier(struct net_device *dev, bool new_carrier)
713 {
714 	struct mlx5e_priv *priv = netdev_priv(dev);
715 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
716 	struct mlx5_eswitch_rep *rep = rpriv->rep;
717 	int err;
718 
719 	if (new_carrier) {
720 		err = mlx5_modify_vport_admin_state(priv->mdev, MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
721 						    rep->vport, 1, MLX5_VPORT_ADMIN_STATE_UP);
722 		if (err)
723 			return err;
724 		netif_carrier_on(dev);
725 	} else {
726 		err = mlx5_modify_vport_admin_state(priv->mdev, MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
727 						    rep->vport, 1, MLX5_VPORT_ADMIN_STATE_DOWN);
728 		if (err)
729 			return err;
730 		netif_carrier_off(dev);
731 	}
732 	return 0;
733 }
734 
735 static const struct net_device_ops mlx5e_netdev_ops_rep = {
736 	.ndo_open                = mlx5e_rep_open,
737 	.ndo_stop                = mlx5e_rep_close,
738 	.ndo_start_xmit          = mlx5e_xmit,
739 	.ndo_setup_tc            = mlx5e_rep_setup_tc,
740 	.ndo_get_stats64         = mlx5e_rep_get_stats,
741 	.ndo_has_offload_stats	 = mlx5e_rep_has_offload_stats,
742 	.ndo_get_offload_stats	 = mlx5e_rep_get_offload_stats,
743 	.ndo_change_mtu          = mlx5e_rep_change_mtu,
744 	.ndo_change_carrier      = mlx5e_rep_change_carrier,
745 };
746 
mlx5e_eswitch_uplink_rep(const struct net_device * netdev)747 bool mlx5e_eswitch_uplink_rep(const struct net_device *netdev)
748 {
749 	return netdev->netdev_ops == &mlx5e_netdev_ops &&
750 	       mlx5e_is_uplink_rep(netdev_priv(netdev));
751 }
752 
mlx5e_eswitch_vf_rep(const struct net_device * netdev)753 bool mlx5e_eswitch_vf_rep(const struct net_device *netdev)
754 {
755 	return netdev->netdev_ops == &mlx5e_netdev_ops_rep;
756 }
757 
758 /* One indirect TIR set for outer. Inner not supported in reps. */
759 #define REP_NUM_INDIR_TIRS MLX5E_NUM_INDIR_TIRS
760 
mlx5e_rep_max_nch_limit(struct mlx5_core_dev * mdev)761 static int mlx5e_rep_max_nch_limit(struct mlx5_core_dev *mdev)
762 {
763 	int max_tir_num = 1 << MLX5_CAP_GEN(mdev, log_max_tir);
764 	int num_vports = mlx5_eswitch_get_total_vports(mdev);
765 
766 	return (max_tir_num - mlx5e_get_pf_num_tirs(mdev)
767 		- (num_vports * REP_NUM_INDIR_TIRS)) / num_vports;
768 }
769 
mlx5e_build_rep_params(struct net_device * netdev)770 static void mlx5e_build_rep_params(struct net_device *netdev)
771 {
772 	const bool take_rtnl = netdev->reg_state == NETREG_REGISTERED;
773 	struct mlx5e_priv *priv = netdev_priv(netdev);
774 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
775 	struct mlx5_eswitch_rep *rep = rpriv->rep;
776 	struct mlx5_core_dev *mdev = priv->mdev;
777 	struct mlx5e_params *params;
778 
779 	u8 cq_period_mode = MLX5_CAP_GEN(mdev, cq_period_start_from_cqe) ?
780 					 MLX5_CQ_PERIOD_MODE_START_FROM_CQE :
781 					 MLX5_CQ_PERIOD_MODE_START_FROM_EQE;
782 
783 	params = &priv->channels.params;
784 
785 	params->num_channels = MLX5E_REP_PARAMS_DEF_NUM_CHANNELS;
786 	params->hard_mtu    = MLX5E_ETH_HARD_MTU;
787 	params->sw_mtu      = netdev->mtu;
788 
789 	/* SQ */
790 	if (rep->vport == MLX5_VPORT_UPLINK)
791 		params->log_sq_size = MLX5E_PARAMS_DEFAULT_LOG_SQ_SIZE;
792 	else
793 		params->log_sq_size = MLX5E_REP_PARAMS_DEF_LOG_SQ_SIZE;
794 
795 	/* RQ */
796 	mlx5e_build_rq_params(mdev, params);
797 
798 	/* If netdev is already registered (e.g. move from nic profile to uplink,
799 	 * RTNL lock must be held before triggering netdev notifiers.
800 	 */
801 	if (take_rtnl)
802 		rtnl_lock();
803 	/* update XDP supported features */
804 	mlx5e_set_xdp_feature(netdev);
805 	if (take_rtnl)
806 		rtnl_unlock();
807 
808 	/* CQ moderation params */
809 	params->rx_dim_enabled = MLX5_CAP_GEN(mdev, cq_moderation);
810 	mlx5e_set_rx_cq_mode_params(params, cq_period_mode);
811 
812 	params->mqprio.num_tc       = 1;
813 	if (rep->vport != MLX5_VPORT_UPLINK)
814 		params->vlan_strip_disable = true;
815 
816 	mlx5_query_min_inline(mdev, &params->tx_min_inline_mode);
817 }
818 
mlx5e_build_rep_netdev(struct net_device * netdev,struct mlx5_core_dev * mdev)819 static void mlx5e_build_rep_netdev(struct net_device *netdev,
820 				   struct mlx5_core_dev *mdev)
821 {
822 	SET_NETDEV_DEV(netdev, mdev->device);
823 	netdev->netdev_ops = &mlx5e_netdev_ops_rep;
824 	eth_hw_addr_random(netdev);
825 	netdev->ethtool_ops = &mlx5e_rep_ethtool_ops;
826 
827 	netdev->watchdog_timeo    = 15 * HZ;
828 
829 #if IS_ENABLED(CONFIG_MLX5_CLS_ACT)
830 	netdev->hw_features    |= NETIF_F_HW_TC;
831 #endif
832 	netdev->hw_features    |= NETIF_F_SG;
833 	netdev->hw_features    |= NETIF_F_IP_CSUM;
834 	netdev->hw_features    |= NETIF_F_IPV6_CSUM;
835 	netdev->hw_features    |= NETIF_F_GRO;
836 	netdev->hw_features    |= NETIF_F_TSO;
837 	netdev->hw_features    |= NETIF_F_TSO6;
838 	netdev->hw_features    |= NETIF_F_RXCSUM;
839 
840 	netdev->features |= netdev->hw_features;
841 	netdev->features |= NETIF_F_NETNS_LOCAL;
842 }
843 
mlx5e_init_rep(struct mlx5_core_dev * mdev,struct net_device * netdev)844 static int mlx5e_init_rep(struct mlx5_core_dev *mdev,
845 			  struct net_device *netdev)
846 {
847 	struct mlx5e_priv *priv = netdev_priv(netdev);
848 
849 	priv->fs =
850 		mlx5e_fs_init(priv->profile, mdev,
851 			      !test_bit(MLX5E_STATE_DESTROYING, &priv->state),
852 			      priv->dfs_root);
853 	if (!priv->fs) {
854 		netdev_err(priv->netdev, "FS allocation failed\n");
855 		return -ENOMEM;
856 	}
857 
858 	mlx5e_build_rep_params(netdev);
859 	mlx5e_timestamp_init(priv);
860 
861 	return 0;
862 }
863 
mlx5e_init_ul_rep(struct mlx5_core_dev * mdev,struct net_device * netdev)864 static int mlx5e_init_ul_rep(struct mlx5_core_dev *mdev,
865 			     struct net_device *netdev)
866 {
867 	struct mlx5e_priv *priv = netdev_priv(netdev);
868 
869 	priv->dfs_root = debugfs_create_dir("nic",
870 					    mlx5_debugfs_get_dev_root(mdev));
871 
872 	priv->fs = mlx5e_fs_init(priv->profile, mdev,
873 				 !test_bit(MLX5E_STATE_DESTROYING, &priv->state),
874 				 priv->dfs_root);
875 	if (!priv->fs) {
876 		netdev_err(priv->netdev, "FS allocation failed\n");
877 		debugfs_remove_recursive(priv->dfs_root);
878 		return -ENOMEM;
879 	}
880 
881 	mlx5e_vxlan_set_netdev_info(priv);
882 	mlx5e_build_rep_params(netdev);
883 	mlx5e_timestamp_init(priv);
884 	return 0;
885 }
886 
mlx5e_cleanup_rep(struct mlx5e_priv * priv)887 static void mlx5e_cleanup_rep(struct mlx5e_priv *priv)
888 {
889 	mlx5e_fs_cleanup(priv->fs);
890 	debugfs_remove_recursive(priv->dfs_root);
891 	priv->fs = NULL;
892 }
893 
mlx5e_create_rep_ttc_table(struct mlx5e_priv * priv)894 static int mlx5e_create_rep_ttc_table(struct mlx5e_priv *priv)
895 {
896 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
897 	struct mlx5_eswitch_rep *rep = rpriv->rep;
898 	struct ttc_params ttc_params = {};
899 	int err;
900 
901 	mlx5e_fs_set_ns(priv->fs,
902 			mlx5_get_flow_namespace(priv->mdev,
903 						MLX5_FLOW_NAMESPACE_KERNEL), false);
904 
905 	/* The inner_ttc in the ttc params is intentionally not set */
906 	mlx5e_set_ttc_params(priv->fs, priv->rx_res, &ttc_params, false);
907 
908 	if (rep->vport != MLX5_VPORT_UPLINK)
909 		/* To give uplik rep TTC a lower level for chaining from root ft */
910 		ttc_params.ft_attr.level = MLX5E_TTC_FT_LEVEL + 1;
911 
912 	mlx5e_fs_set_ttc(priv->fs, mlx5_create_ttc_table(priv->mdev, &ttc_params), false);
913 	if (IS_ERR(mlx5e_fs_get_ttc(priv->fs, false))) {
914 		err = PTR_ERR(mlx5e_fs_get_ttc(priv->fs, false));
915 		netdev_err(priv->netdev, "Failed to create rep ttc table, err=%d\n",
916 			   err);
917 		return err;
918 	}
919 	return 0;
920 }
921 
mlx5e_create_rep_root_ft(struct mlx5e_priv * priv)922 static int mlx5e_create_rep_root_ft(struct mlx5e_priv *priv)
923 {
924 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
925 	struct mlx5_eswitch_rep *rep = rpriv->rep;
926 	struct mlx5_flow_table_attr ft_attr = {};
927 	struct mlx5_flow_namespace *ns;
928 	int err = 0;
929 
930 	if (rep->vport != MLX5_VPORT_UPLINK) {
931 		/* non uplik reps will skip any bypass tables and go directly to
932 		 * their own ttc
933 		 */
934 		rpriv->root_ft = mlx5_get_ttc_flow_table(mlx5e_fs_get_ttc(priv->fs, false));
935 		return 0;
936 	}
937 
938 	/* uplink root ft will be used to auto chain, to ethtool or ttc tables */
939 	ns = mlx5_get_flow_namespace(priv->mdev, MLX5_FLOW_NAMESPACE_OFFLOADS);
940 	if (!ns) {
941 		netdev_err(priv->netdev, "Failed to get reps offloads namespace\n");
942 		return -EOPNOTSUPP;
943 	}
944 
945 	ft_attr.max_fte = 0; /* Empty table, miss rule will always point to next table */
946 	ft_attr.prio = 1;
947 	ft_attr.level = 1;
948 
949 	rpriv->root_ft = mlx5_create_flow_table(ns, &ft_attr);
950 	if (IS_ERR(rpriv->root_ft)) {
951 		err = PTR_ERR(rpriv->root_ft);
952 		rpriv->root_ft = NULL;
953 	}
954 
955 	return err;
956 }
957 
mlx5e_destroy_rep_root_ft(struct mlx5e_priv * priv)958 static void mlx5e_destroy_rep_root_ft(struct mlx5e_priv *priv)
959 {
960 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
961 	struct mlx5_eswitch_rep *rep = rpriv->rep;
962 
963 	if (rep->vport != MLX5_VPORT_UPLINK)
964 		return;
965 	mlx5_destroy_flow_table(rpriv->root_ft);
966 }
967 
mlx5e_create_rep_vport_rx_rule(struct mlx5e_priv * priv)968 static int mlx5e_create_rep_vport_rx_rule(struct mlx5e_priv *priv)
969 {
970 	struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
971 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
972 	struct mlx5_eswitch_rep *rep = rpriv->rep;
973 	struct mlx5_flow_handle *flow_rule;
974 	struct mlx5_flow_destination dest;
975 
976 	dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
977 	dest.ft = rpriv->root_ft;
978 
979 	flow_rule = mlx5_eswitch_create_vport_rx_rule(esw, rep->vport, &dest);
980 	if (IS_ERR(flow_rule))
981 		return PTR_ERR(flow_rule);
982 	rpriv->vport_rx_rule = flow_rule;
983 	return 0;
984 }
985 
rep_vport_rx_rule_destroy(struct mlx5e_priv * priv)986 static void rep_vport_rx_rule_destroy(struct mlx5e_priv *priv)
987 {
988 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
989 
990 	if (!rpriv->vport_rx_rule)
991 		return;
992 
993 	mlx5_del_flow_rules(rpriv->vport_rx_rule);
994 	rpriv->vport_rx_rule = NULL;
995 }
996 
mlx5e_rep_bond_update(struct mlx5e_priv * priv,bool cleanup)997 int mlx5e_rep_bond_update(struct mlx5e_priv *priv, bool cleanup)
998 {
999 	rep_vport_rx_rule_destroy(priv);
1000 
1001 	return cleanup ? 0 : mlx5e_create_rep_vport_rx_rule(priv);
1002 }
1003 
mlx5e_init_rep_rx(struct mlx5e_priv * priv)1004 static int mlx5e_init_rep_rx(struct mlx5e_priv *priv)
1005 {
1006 	struct mlx5_core_dev *mdev = priv->mdev;
1007 	int err;
1008 
1009 	priv->rx_res = mlx5e_rx_res_alloc();
1010 	if (!priv->rx_res) {
1011 		err = -ENOMEM;
1012 		goto err_free_fs;
1013 	}
1014 
1015 	mlx5e_fs_init_l2_addr(priv->fs, priv->netdev);
1016 
1017 	err = mlx5e_open_drop_rq(priv, &priv->drop_rq);
1018 	if (err) {
1019 		mlx5_core_err(mdev, "open drop rq failed, %d\n", err);
1020 		goto err_rx_res_free;
1021 	}
1022 
1023 	err = mlx5e_rx_res_init(priv->rx_res, priv->mdev, 0,
1024 				priv->max_nch, priv->drop_rq.rqn,
1025 				&priv->channels.params.packet_merge,
1026 				priv->channels.params.num_channels);
1027 	if (err)
1028 		goto err_close_drop_rq;
1029 
1030 	err = mlx5e_create_rep_ttc_table(priv);
1031 	if (err)
1032 		goto err_destroy_rx_res;
1033 
1034 	err = mlx5e_create_rep_root_ft(priv);
1035 	if (err)
1036 		goto err_destroy_ttc_table;
1037 
1038 	err = mlx5e_create_rep_vport_rx_rule(priv);
1039 	if (err)
1040 		goto err_destroy_root_ft;
1041 
1042 	mlx5e_ethtool_init_steering(priv->fs);
1043 
1044 	return 0;
1045 
1046 err_destroy_root_ft:
1047 	mlx5e_destroy_rep_root_ft(priv);
1048 err_destroy_ttc_table:
1049 	mlx5_destroy_ttc_table(mlx5e_fs_get_ttc(priv->fs, false));
1050 err_destroy_rx_res:
1051 	mlx5e_rx_res_destroy(priv->rx_res);
1052 err_close_drop_rq:
1053 	mlx5e_close_drop_rq(&priv->drop_rq);
1054 err_rx_res_free:
1055 	mlx5e_rx_res_free(priv->rx_res);
1056 	priv->rx_res = NULL;
1057 err_free_fs:
1058 	mlx5e_fs_cleanup(priv->fs);
1059 	priv->fs = NULL;
1060 	return err;
1061 }
1062 
mlx5e_cleanup_rep_rx(struct mlx5e_priv * priv)1063 static void mlx5e_cleanup_rep_rx(struct mlx5e_priv *priv)
1064 {
1065 	mlx5e_ethtool_cleanup_steering(priv->fs);
1066 	rep_vport_rx_rule_destroy(priv);
1067 	mlx5e_destroy_rep_root_ft(priv);
1068 	mlx5_destroy_ttc_table(mlx5e_fs_get_ttc(priv->fs, false));
1069 	mlx5e_rx_res_destroy(priv->rx_res);
1070 	mlx5e_close_drop_rq(&priv->drop_rq);
1071 	mlx5e_rx_res_free(priv->rx_res);
1072 	priv->rx_res = NULL;
1073 }
1074 
mlx5e_rep_mpesw_work(struct work_struct * work)1075 static void mlx5e_rep_mpesw_work(struct work_struct *work)
1076 {
1077 	struct mlx5_rep_uplink_priv *uplink_priv =
1078 		container_of(work, struct mlx5_rep_uplink_priv,
1079 			     mpesw_work);
1080 	struct mlx5e_rep_priv *rpriv =
1081 		container_of(uplink_priv, struct mlx5e_rep_priv,
1082 			     uplink_priv);
1083 	struct mlx5e_priv *priv = netdev_priv(rpriv->netdev);
1084 
1085 	rep_vport_rx_rule_destroy(priv);
1086 	mlx5e_create_rep_vport_rx_rule(priv);
1087 }
1088 
mlx5e_init_ul_rep_rx(struct mlx5e_priv * priv)1089 static int mlx5e_init_ul_rep_rx(struct mlx5e_priv *priv)
1090 {
1091 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1092 	int err;
1093 
1094 	mlx5e_create_q_counters(priv);
1095 	err = mlx5e_init_rep_rx(priv);
1096 	if (err)
1097 		goto out;
1098 
1099 	mlx5e_tc_int_port_init_rep_rx(priv);
1100 
1101 	INIT_WORK(&rpriv->uplink_priv.mpesw_work, mlx5e_rep_mpesw_work);
1102 
1103 out:
1104 	return err;
1105 }
1106 
mlx5e_cleanup_ul_rep_rx(struct mlx5e_priv * priv)1107 static void mlx5e_cleanup_ul_rep_rx(struct mlx5e_priv *priv)
1108 {
1109 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1110 
1111 	cancel_work_sync(&rpriv->uplink_priv.mpesw_work);
1112 	mlx5e_tc_int_port_cleanup_rep_rx(priv);
1113 	mlx5e_cleanup_rep_rx(priv);
1114 	mlx5e_destroy_q_counters(priv);
1115 }
1116 
mlx5e_init_uplink_rep_tx(struct mlx5e_rep_priv * rpriv)1117 static int mlx5e_init_uplink_rep_tx(struct mlx5e_rep_priv *rpriv)
1118 {
1119 	struct mlx5_rep_uplink_priv *uplink_priv;
1120 	struct net_device *netdev;
1121 	struct mlx5e_priv *priv;
1122 	int err;
1123 
1124 	netdev = rpriv->netdev;
1125 	priv = netdev_priv(netdev);
1126 	uplink_priv = &rpriv->uplink_priv;
1127 
1128 	err = mlx5e_rep_tc_init(rpriv);
1129 	if (err)
1130 		return err;
1131 
1132 	mlx5_init_port_tun_entropy(&uplink_priv->tun_entropy, priv->mdev);
1133 
1134 	mlx5e_rep_bond_init(rpriv);
1135 	err = mlx5e_rep_tc_netdevice_event_register(rpriv);
1136 	if (err) {
1137 		mlx5_core_err(priv->mdev, "Failed to register netdev notifier, err: %d\n",
1138 			      err);
1139 		goto err_event_reg;
1140 	}
1141 
1142 	return 0;
1143 
1144 err_event_reg:
1145 	mlx5e_rep_bond_cleanup(rpriv);
1146 	mlx5e_rep_tc_cleanup(rpriv);
1147 	return err;
1148 }
1149 
mlx5e_cleanup_uplink_rep_tx(struct mlx5e_rep_priv * rpriv)1150 static void mlx5e_cleanup_uplink_rep_tx(struct mlx5e_rep_priv *rpriv)
1151 {
1152 	mlx5e_rep_tc_netdevice_event_unregister(rpriv);
1153 	mlx5e_rep_bond_cleanup(rpriv);
1154 	mlx5e_rep_tc_cleanup(rpriv);
1155 }
1156 
mlx5e_init_rep_tx(struct mlx5e_priv * priv)1157 static int mlx5e_init_rep_tx(struct mlx5e_priv *priv)
1158 {
1159 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1160 	int err;
1161 
1162 	err = mlx5e_create_tises(priv);
1163 	if (err) {
1164 		mlx5_core_warn(priv->mdev, "create tises failed, %d\n", err);
1165 		return err;
1166 	}
1167 
1168 	err = mlx5e_rep_neigh_init(rpriv);
1169 	if (err)
1170 		goto err_neigh_init;
1171 
1172 	if (rpriv->rep->vport == MLX5_VPORT_UPLINK) {
1173 		err = mlx5e_init_uplink_rep_tx(rpriv);
1174 		if (err)
1175 			goto err_init_tx;
1176 	}
1177 
1178 	err = mlx5e_tc_ht_init(&rpriv->tc_ht);
1179 	if (err)
1180 		goto err_ht_init;
1181 
1182 	return 0;
1183 
1184 err_ht_init:
1185 	if (rpriv->rep->vport == MLX5_VPORT_UPLINK)
1186 		mlx5e_cleanup_uplink_rep_tx(rpriv);
1187 err_init_tx:
1188 	mlx5e_rep_neigh_cleanup(rpriv);
1189 err_neigh_init:
1190 	mlx5e_destroy_tises(priv);
1191 	return err;
1192 }
1193 
mlx5e_cleanup_rep_tx(struct mlx5e_priv * priv)1194 static void mlx5e_cleanup_rep_tx(struct mlx5e_priv *priv)
1195 {
1196 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1197 
1198 	mlx5e_tc_ht_cleanup(&rpriv->tc_ht);
1199 
1200 	if (rpriv->rep->vport == MLX5_VPORT_UPLINK)
1201 		mlx5e_cleanup_uplink_rep_tx(rpriv);
1202 
1203 	mlx5e_rep_neigh_cleanup(rpriv);
1204 	mlx5e_destroy_tises(priv);
1205 }
1206 
mlx5e_rep_enable(struct mlx5e_priv * priv)1207 static void mlx5e_rep_enable(struct mlx5e_priv *priv)
1208 {
1209 	mlx5e_set_netdev_mtu_boundaries(priv);
1210 }
1211 
mlx5e_rep_disable(struct mlx5e_priv * priv)1212 static void mlx5e_rep_disable(struct mlx5e_priv *priv)
1213 {
1214 }
1215 
mlx5e_update_rep_rx(struct mlx5e_priv * priv)1216 static int mlx5e_update_rep_rx(struct mlx5e_priv *priv)
1217 {
1218 	return 0;
1219 }
1220 
mlx5e_rep_event_mpesw(struct mlx5e_priv * priv)1221 static int mlx5e_rep_event_mpesw(struct mlx5e_priv *priv)
1222 {
1223 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1224 	struct mlx5_eswitch_rep *rep = rpriv->rep;
1225 
1226 	if (rep->vport != MLX5_VPORT_UPLINK)
1227 		return NOTIFY_DONE;
1228 
1229 	queue_work(priv->wq, &rpriv->uplink_priv.mpesw_work);
1230 
1231 	return NOTIFY_OK;
1232 }
1233 
uplink_rep_async_event(struct notifier_block * nb,unsigned long event,void * data)1234 static int uplink_rep_async_event(struct notifier_block *nb, unsigned long event, void *data)
1235 {
1236 	struct mlx5e_priv *priv = container_of(nb, struct mlx5e_priv, events_nb);
1237 
1238 	if (event == MLX5_EVENT_TYPE_PORT_CHANGE) {
1239 		struct mlx5_eqe *eqe = data;
1240 
1241 		switch (eqe->sub_type) {
1242 		case MLX5_PORT_CHANGE_SUBTYPE_DOWN:
1243 		case MLX5_PORT_CHANGE_SUBTYPE_ACTIVE:
1244 			queue_work(priv->wq, &priv->update_carrier_work);
1245 			break;
1246 		default:
1247 			return NOTIFY_DONE;
1248 		}
1249 
1250 		return NOTIFY_OK;
1251 	}
1252 
1253 	if (event == MLX5_DEV_EVENT_PORT_AFFINITY)
1254 		return mlx5e_rep_tc_event_port_affinity(priv);
1255 	else if (event == MLX5_DEV_EVENT_MULTIPORT_ESW)
1256 		return mlx5e_rep_event_mpesw(priv);
1257 
1258 	return NOTIFY_DONE;
1259 }
1260 
mlx5e_uplink_rep_enable(struct mlx5e_priv * priv)1261 static void mlx5e_uplink_rep_enable(struct mlx5e_priv *priv)
1262 {
1263 	struct net_device *netdev = priv->netdev;
1264 	struct mlx5_core_dev *mdev = priv->mdev;
1265 	u16 max_mtu;
1266 
1267 	mlx5e_ipsec_init(priv);
1268 
1269 	netdev->min_mtu = ETH_MIN_MTU;
1270 	mlx5_query_port_max_mtu(priv->mdev, &max_mtu, 1);
1271 	netdev->max_mtu = MLX5E_HW2SW_MTU(&priv->channels.params, max_mtu);
1272 	mlx5e_set_dev_port_mtu(priv);
1273 
1274 	mlx5e_rep_tc_enable(priv);
1275 
1276 	if (MLX5_CAP_GEN(mdev, uplink_follow))
1277 		mlx5_modify_vport_admin_state(mdev, MLX5_VPORT_STATE_OP_MOD_UPLINK,
1278 					      0, 0, MLX5_VPORT_ADMIN_STATE_AUTO);
1279 	mlx5_lag_add_netdev(mdev, netdev);
1280 	priv->events_nb.notifier_call = uplink_rep_async_event;
1281 	mlx5_notifier_register(mdev, &priv->events_nb);
1282 	mlx5e_dcbnl_initialize(priv);
1283 	mlx5e_dcbnl_init_app(priv);
1284 	mlx5e_rep_bridge_init(priv);
1285 
1286 	netdev->wanted_features |= NETIF_F_HW_TC;
1287 
1288 	rtnl_lock();
1289 	if (netif_running(netdev))
1290 		mlx5e_open(netdev);
1291 	udp_tunnel_nic_reset_ntf(priv->netdev);
1292 	netif_device_attach(netdev);
1293 	rtnl_unlock();
1294 }
1295 
mlx5e_uplink_rep_disable(struct mlx5e_priv * priv)1296 static void mlx5e_uplink_rep_disable(struct mlx5e_priv *priv)
1297 {
1298 	struct mlx5_core_dev *mdev = priv->mdev;
1299 
1300 	rtnl_lock();
1301 	if (netif_running(priv->netdev))
1302 		mlx5e_close(priv->netdev);
1303 	netif_device_detach(priv->netdev);
1304 	rtnl_unlock();
1305 
1306 	mlx5e_rep_bridge_cleanup(priv);
1307 	mlx5e_dcbnl_delete_app(priv);
1308 	mlx5_notifier_unregister(mdev, &priv->events_nb);
1309 	mlx5e_rep_tc_disable(priv);
1310 	mlx5_lag_remove_netdev(mdev, priv->netdev);
1311 	mlx5_vxlan_reset_to_default(mdev->vxlan);
1312 
1313 	mlx5e_ipsec_cleanup(priv);
1314 }
1315 
1316 static MLX5E_DEFINE_STATS_GRP(sw_rep, 0);
1317 static MLX5E_DEFINE_STATS_GRP(vport_rep, MLX5E_NDO_UPDATE_STATS);
1318 
1319 /* The stats groups order is opposite to the update_stats() order calls */
1320 static mlx5e_stats_grp_t mlx5e_rep_stats_grps[] = {
1321 	&MLX5E_STATS_GRP(sw_rep),
1322 	&MLX5E_STATS_GRP(vport_rep),
1323 };
1324 
mlx5e_rep_stats_grps_num(struct mlx5e_priv * priv)1325 static unsigned int mlx5e_rep_stats_grps_num(struct mlx5e_priv *priv)
1326 {
1327 	return ARRAY_SIZE(mlx5e_rep_stats_grps);
1328 }
1329 
1330 /* The stats groups order is opposite to the update_stats() order calls */
1331 static mlx5e_stats_grp_t mlx5e_ul_rep_stats_grps[] = {
1332 	&MLX5E_STATS_GRP(sw),
1333 	&MLX5E_STATS_GRP(qcnt),
1334 	&MLX5E_STATS_GRP(vnic_env),
1335 	&MLX5E_STATS_GRP(vport),
1336 	&MLX5E_STATS_GRP(802_3),
1337 	&MLX5E_STATS_GRP(2863),
1338 	&MLX5E_STATS_GRP(2819),
1339 	&MLX5E_STATS_GRP(phy),
1340 	&MLX5E_STATS_GRP(eth_ext),
1341 	&MLX5E_STATS_GRP(pcie),
1342 	&MLX5E_STATS_GRP(per_prio),
1343 	&MLX5E_STATS_GRP(pme),
1344 	&MLX5E_STATS_GRP(channels),
1345 	&MLX5E_STATS_GRP(per_port_buff_congest),
1346 #ifdef CONFIG_MLX5_EN_IPSEC
1347 	&MLX5E_STATS_GRP(ipsec_hw),
1348 	&MLX5E_STATS_GRP(ipsec_sw),
1349 #endif
1350 	&MLX5E_STATS_GRP(ptp),
1351 };
1352 
mlx5e_ul_rep_stats_grps_num(struct mlx5e_priv * priv)1353 static unsigned int mlx5e_ul_rep_stats_grps_num(struct mlx5e_priv *priv)
1354 {
1355 	return ARRAY_SIZE(mlx5e_ul_rep_stats_grps);
1356 }
1357 
1358 static int
mlx5e_rep_vnic_reporter_diagnose(struct devlink_health_reporter * reporter,struct devlink_fmsg * fmsg,struct netlink_ext_ack * extack)1359 mlx5e_rep_vnic_reporter_diagnose(struct devlink_health_reporter *reporter,
1360 				 struct devlink_fmsg *fmsg,
1361 				 struct netlink_ext_ack *extack)
1362 {
1363 	struct mlx5e_rep_priv *rpriv = devlink_health_reporter_priv(reporter);
1364 	struct mlx5_eswitch_rep *rep = rpriv->rep;
1365 
1366 	return mlx5_reporter_vnic_diagnose_counters(rep->esw->dev, fmsg,
1367 						    rep->vport, true);
1368 }
1369 
1370 static const struct devlink_health_reporter_ops mlx5_rep_vnic_reporter_ops = {
1371 	.name = "vnic",
1372 	.diagnose = mlx5e_rep_vnic_reporter_diagnose,
1373 };
1374 
mlx5e_rep_vnic_reporter_create(struct mlx5e_priv * priv,struct devlink_port * dl_port)1375 static void mlx5e_rep_vnic_reporter_create(struct mlx5e_priv *priv,
1376 					   struct devlink_port *dl_port)
1377 {
1378 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1379 	struct devlink_health_reporter *reporter;
1380 
1381 	reporter = devl_port_health_reporter_create(dl_port,
1382 						    &mlx5_rep_vnic_reporter_ops,
1383 						    0, rpriv);
1384 	if (IS_ERR(reporter)) {
1385 		mlx5_core_err(priv->mdev,
1386 			      "Failed to create representor vnic reporter, err = %ld\n",
1387 			      PTR_ERR(reporter));
1388 		return;
1389 	}
1390 
1391 	rpriv->rep_vnic_reporter = reporter;
1392 }
1393 
mlx5e_rep_vnic_reporter_destroy(struct mlx5e_priv * priv)1394 static void mlx5e_rep_vnic_reporter_destroy(struct mlx5e_priv *priv)
1395 {
1396 	struct mlx5e_rep_priv *rpriv = priv->ppriv;
1397 
1398 	if (!IS_ERR_OR_NULL(rpriv->rep_vnic_reporter))
1399 		devl_health_reporter_destroy(rpriv->rep_vnic_reporter);
1400 }
1401 
1402 static const struct mlx5e_profile mlx5e_rep_profile = {
1403 	.init			= mlx5e_init_rep,
1404 	.cleanup		= mlx5e_cleanup_rep,
1405 	.init_rx		= mlx5e_init_rep_rx,
1406 	.cleanup_rx		= mlx5e_cleanup_rep_rx,
1407 	.init_tx		= mlx5e_init_rep_tx,
1408 	.cleanup_tx		= mlx5e_cleanup_rep_tx,
1409 	.enable		        = mlx5e_rep_enable,
1410 	.disable	        = mlx5e_rep_disable,
1411 	.update_rx		= mlx5e_update_rep_rx,
1412 	.update_stats           = mlx5e_stats_update_ndo_stats,
1413 	.rx_handlers            = &mlx5e_rx_handlers_rep,
1414 	.max_tc			= 1,
1415 	.stats_grps		= mlx5e_rep_stats_grps,
1416 	.stats_grps_num		= mlx5e_rep_stats_grps_num,
1417 	.max_nch_limit		= mlx5e_rep_max_nch_limit,
1418 };
1419 
1420 static const struct mlx5e_profile mlx5e_uplink_rep_profile = {
1421 	.init			= mlx5e_init_ul_rep,
1422 	.cleanup		= mlx5e_cleanup_rep,
1423 	.init_rx		= mlx5e_init_ul_rep_rx,
1424 	.cleanup_rx		= mlx5e_cleanup_ul_rep_rx,
1425 	.init_tx		= mlx5e_init_rep_tx,
1426 	.cleanup_tx		= mlx5e_cleanup_rep_tx,
1427 	.enable		        = mlx5e_uplink_rep_enable,
1428 	.disable	        = mlx5e_uplink_rep_disable,
1429 	.update_rx		= mlx5e_update_rep_rx,
1430 	.update_stats           = mlx5e_stats_update_ndo_stats,
1431 	.update_carrier	        = mlx5e_update_carrier,
1432 	.rx_handlers            = &mlx5e_rx_handlers_rep,
1433 	.max_tc			= MLX5E_MAX_NUM_TC,
1434 	.stats_grps		= mlx5e_ul_rep_stats_grps,
1435 	.stats_grps_num		= mlx5e_ul_rep_stats_grps_num,
1436 };
1437 
1438 /* e-Switch vport representors */
1439 static int
mlx5e_vport_uplink_rep_load(struct mlx5_core_dev * dev,struct mlx5_eswitch_rep * rep)1440 mlx5e_vport_uplink_rep_load(struct mlx5_core_dev *dev, struct mlx5_eswitch_rep *rep)
1441 {
1442 	struct mlx5e_priv *priv = netdev_priv(mlx5_uplink_netdev_get(dev));
1443 	struct mlx5e_rep_priv *rpriv = mlx5e_rep_to_rep_priv(rep);
1444 
1445 	rpriv->netdev = priv->netdev;
1446 	return mlx5e_netdev_change_profile(priv, &mlx5e_uplink_rep_profile,
1447 					   rpriv);
1448 }
1449 
1450 static void
mlx5e_vport_uplink_rep_unload(struct mlx5e_rep_priv * rpriv)1451 mlx5e_vport_uplink_rep_unload(struct mlx5e_rep_priv *rpriv)
1452 {
1453 	struct net_device *netdev = rpriv->netdev;
1454 	struct mlx5e_priv *priv;
1455 
1456 	priv = netdev_priv(netdev);
1457 
1458 	mlx5e_netdev_attach_nic_profile(priv);
1459 }
1460 
1461 static int
mlx5e_vport_vf_rep_load(struct mlx5_core_dev * dev,struct mlx5_eswitch_rep * rep)1462 mlx5e_vport_vf_rep_load(struct mlx5_core_dev *dev, struct mlx5_eswitch_rep *rep)
1463 {
1464 	struct mlx5e_rep_priv *rpriv = mlx5e_rep_to_rep_priv(rep);
1465 	const struct mlx5e_profile *profile;
1466 	struct devlink_port *dl_port;
1467 	struct net_device *netdev;
1468 	struct mlx5e_priv *priv;
1469 	int err;
1470 
1471 	profile = &mlx5e_rep_profile;
1472 	netdev = mlx5e_create_netdev(dev, profile);
1473 	if (!netdev) {
1474 		mlx5_core_warn(dev,
1475 			       "Failed to create representor netdev for vport %d\n",
1476 			       rep->vport);
1477 		return -EINVAL;
1478 	}
1479 
1480 	mlx5e_build_rep_netdev(netdev, dev);
1481 	rpriv->netdev = netdev;
1482 
1483 	priv = netdev_priv(netdev);
1484 	priv->profile = profile;
1485 	priv->ppriv = rpriv;
1486 	err = profile->init(dev, netdev);
1487 	if (err) {
1488 		netdev_warn(netdev, "rep profile init failed, %d\n", err);
1489 		goto err_destroy_netdev;
1490 	}
1491 
1492 	err = mlx5e_attach_netdev(netdev_priv(netdev));
1493 	if (err) {
1494 		netdev_warn(netdev,
1495 			    "Failed to attach representor netdev for vport %d\n",
1496 			    rep->vport);
1497 		goto err_cleanup_profile;
1498 	}
1499 
1500 	dl_port = mlx5_esw_offloads_devlink_port(dev->priv.eswitch,
1501 						 rpriv->rep->vport);
1502 	if (dl_port) {
1503 		SET_NETDEV_DEVLINK_PORT(netdev, dl_port);
1504 		mlx5e_rep_vnic_reporter_create(priv, dl_port);
1505 	}
1506 
1507 	err = register_netdev(netdev);
1508 	if (err) {
1509 		netdev_warn(netdev,
1510 			    "Failed to register representor netdev for vport %d\n",
1511 			    rep->vport);
1512 		goto err_detach_netdev;
1513 	}
1514 
1515 	return 0;
1516 
1517 err_detach_netdev:
1518 	mlx5e_rep_vnic_reporter_destroy(priv);
1519 	mlx5e_detach_netdev(netdev_priv(netdev));
1520 err_cleanup_profile:
1521 	priv->profile->cleanup(priv);
1522 
1523 err_destroy_netdev:
1524 	mlx5e_destroy_netdev(netdev_priv(netdev));
1525 	return err;
1526 }
1527 
1528 static int
mlx5e_vport_rep_load(struct mlx5_core_dev * dev,struct mlx5_eswitch_rep * rep)1529 mlx5e_vport_rep_load(struct mlx5_core_dev *dev, struct mlx5_eswitch_rep *rep)
1530 {
1531 	struct mlx5e_rep_priv *rpriv;
1532 	int err;
1533 
1534 	rpriv = kvzalloc(sizeof(*rpriv), GFP_KERNEL);
1535 	if (!rpriv)
1536 		return -ENOMEM;
1537 
1538 	/* rpriv->rep to be looked up when profile->init() is called */
1539 	rpriv->rep = rep;
1540 	rep->rep_data[REP_ETH].priv = rpriv;
1541 	INIT_LIST_HEAD(&rpriv->vport_sqs_list);
1542 
1543 	if (rep->vport == MLX5_VPORT_UPLINK)
1544 		err = mlx5e_vport_uplink_rep_load(dev, rep);
1545 	else
1546 		err = mlx5e_vport_vf_rep_load(dev, rep);
1547 
1548 	if (err)
1549 		kvfree(rpriv);
1550 
1551 	return err;
1552 }
1553 
1554 static void
mlx5e_vport_rep_unload(struct mlx5_eswitch_rep * rep)1555 mlx5e_vport_rep_unload(struct mlx5_eswitch_rep *rep)
1556 {
1557 	struct mlx5e_rep_priv *rpriv = mlx5e_rep_to_rep_priv(rep);
1558 	struct net_device *netdev = rpriv->netdev;
1559 	struct mlx5e_priv *priv = netdev_priv(netdev);
1560 	void *ppriv = priv->ppriv;
1561 
1562 	if (rep->vport == MLX5_VPORT_UPLINK) {
1563 		mlx5e_vport_uplink_rep_unload(rpriv);
1564 		goto free_ppriv;
1565 	}
1566 
1567 	unregister_netdev(netdev);
1568 	mlx5e_rep_vnic_reporter_destroy(priv);
1569 	mlx5e_detach_netdev(priv);
1570 	priv->profile->cleanup(priv);
1571 	mlx5e_destroy_netdev(priv);
1572 free_ppriv:
1573 	kvfree(ppriv); /* mlx5e_rep_priv */
1574 }
1575 
mlx5e_vport_rep_get_proto_dev(struct mlx5_eswitch_rep * rep)1576 static void *mlx5e_vport_rep_get_proto_dev(struct mlx5_eswitch_rep *rep)
1577 {
1578 	struct mlx5e_rep_priv *rpriv;
1579 
1580 	rpriv = mlx5e_rep_to_rep_priv(rep);
1581 
1582 	return rpriv->netdev;
1583 }
1584 
mlx5e_vport_rep_event_unpair(struct mlx5_eswitch_rep * rep,struct mlx5_eswitch * peer_esw)1585 static void mlx5e_vport_rep_event_unpair(struct mlx5_eswitch_rep *rep,
1586 					 struct mlx5_eswitch *peer_esw)
1587 {
1588 	u16 i = MLX5_CAP_GEN(peer_esw->dev, vhca_id);
1589 	struct mlx5e_rep_priv *rpriv;
1590 	struct mlx5e_rep_sq *rep_sq;
1591 
1592 	WARN_ON_ONCE(!peer_esw);
1593 	rpriv = mlx5e_rep_to_rep_priv(rep);
1594 	list_for_each_entry(rep_sq, &rpriv->vport_sqs_list, list) {
1595 		struct mlx5e_rep_sq_peer *sq_peer = xa_load(&rep_sq->sq_peer, i);
1596 
1597 		if (!sq_peer || sq_peer->peer != peer_esw)
1598 			continue;
1599 
1600 		mlx5_eswitch_del_send_to_vport_rule(sq_peer->rule);
1601 		xa_erase(&rep_sq->sq_peer, i);
1602 		kfree(sq_peer);
1603 	}
1604 }
1605 
mlx5e_vport_rep_event_pair(struct mlx5_eswitch * esw,struct mlx5_eswitch_rep * rep,struct mlx5_eswitch * peer_esw)1606 static int mlx5e_vport_rep_event_pair(struct mlx5_eswitch *esw,
1607 				      struct mlx5_eswitch_rep *rep,
1608 				      struct mlx5_eswitch *peer_esw)
1609 {
1610 	u16 i = MLX5_CAP_GEN(peer_esw->dev, vhca_id);
1611 	struct mlx5_flow_handle *flow_rule;
1612 	struct mlx5e_rep_sq_peer *sq_peer;
1613 	struct mlx5e_rep_priv *rpriv;
1614 	struct mlx5e_rep_sq *rep_sq;
1615 	int err;
1616 
1617 	rpriv = mlx5e_rep_to_rep_priv(rep);
1618 	list_for_each_entry(rep_sq, &rpriv->vport_sqs_list, list) {
1619 		sq_peer = xa_load(&rep_sq->sq_peer, i);
1620 
1621 		if (sq_peer && sq_peer->peer)
1622 			continue;
1623 
1624 		flow_rule = mlx5_eswitch_add_send_to_vport_rule(peer_esw, esw, rep,
1625 								rep_sq->sqn);
1626 		if (IS_ERR(flow_rule)) {
1627 			err = PTR_ERR(flow_rule);
1628 			goto err_out;
1629 		}
1630 
1631 		if (sq_peer) {
1632 			sq_peer->rule = flow_rule;
1633 			sq_peer->peer = peer_esw;
1634 			continue;
1635 		}
1636 		sq_peer = kzalloc(sizeof(*sq_peer), GFP_KERNEL);
1637 		if (!sq_peer) {
1638 			err = -ENOMEM;
1639 			goto err_sq_alloc;
1640 		}
1641 		err = xa_insert(&rep_sq->sq_peer, i, sq_peer, GFP_KERNEL);
1642 		if (err)
1643 			goto err_xa;
1644 		sq_peer->rule = flow_rule;
1645 		sq_peer->peer = peer_esw;
1646 	}
1647 
1648 	return 0;
1649 err_xa:
1650 	kfree(sq_peer);
1651 err_sq_alloc:
1652 	mlx5_eswitch_del_send_to_vport_rule(flow_rule);
1653 err_out:
1654 	mlx5e_vport_rep_event_unpair(rep, peer_esw);
1655 	return err;
1656 }
1657 
mlx5e_vport_rep_event(struct mlx5_eswitch * esw,struct mlx5_eswitch_rep * rep,enum mlx5_switchdev_event event,void * data)1658 static int mlx5e_vport_rep_event(struct mlx5_eswitch *esw,
1659 				 struct mlx5_eswitch_rep *rep,
1660 				 enum mlx5_switchdev_event event,
1661 				 void *data)
1662 {
1663 	int err = 0;
1664 
1665 	if (event == MLX5_SWITCHDEV_EVENT_PAIR)
1666 		err = mlx5e_vport_rep_event_pair(esw, rep, data);
1667 	else if (event == MLX5_SWITCHDEV_EVENT_UNPAIR)
1668 		mlx5e_vport_rep_event_unpair(rep, data);
1669 
1670 	return err;
1671 }
1672 
1673 static const struct mlx5_eswitch_rep_ops rep_ops = {
1674 	.load = mlx5e_vport_rep_load,
1675 	.unload = mlx5e_vport_rep_unload,
1676 	.get_proto_dev = mlx5e_vport_rep_get_proto_dev,
1677 	.event = mlx5e_vport_rep_event,
1678 };
1679 
mlx5e_rep_probe(struct auxiliary_device * adev,const struct auxiliary_device_id * id)1680 static int mlx5e_rep_probe(struct auxiliary_device *adev,
1681 			   const struct auxiliary_device_id *id)
1682 {
1683 	struct mlx5_adev *edev = container_of(adev, struct mlx5_adev, adev);
1684 	struct mlx5_core_dev *mdev = edev->mdev;
1685 	struct mlx5_eswitch *esw;
1686 
1687 	esw = mdev->priv.eswitch;
1688 	mlx5_eswitch_register_vport_reps(esw, &rep_ops, REP_ETH);
1689 	return 0;
1690 }
1691 
mlx5e_rep_remove(struct auxiliary_device * adev)1692 static void mlx5e_rep_remove(struct auxiliary_device *adev)
1693 {
1694 	struct mlx5_adev *vdev = container_of(adev, struct mlx5_adev, adev);
1695 	struct mlx5_core_dev *mdev = vdev->mdev;
1696 	struct mlx5_eswitch *esw;
1697 
1698 	esw = mdev->priv.eswitch;
1699 	mlx5_eswitch_unregister_vport_reps(esw, REP_ETH);
1700 }
1701 
1702 static const struct auxiliary_device_id mlx5e_rep_id_table[] = {
1703 	{ .name = MLX5_ADEV_NAME ".eth-rep", },
1704 	{},
1705 };
1706 
1707 MODULE_DEVICE_TABLE(auxiliary, mlx5e_rep_id_table);
1708 
1709 static struct auxiliary_driver mlx5e_rep_driver = {
1710 	.name = "eth-rep",
1711 	.probe = mlx5e_rep_probe,
1712 	.remove = mlx5e_rep_remove,
1713 	.id_table = mlx5e_rep_id_table,
1714 };
1715 
mlx5e_rep_init(void)1716 int mlx5e_rep_init(void)
1717 {
1718 	return auxiliary_driver_register(&mlx5e_rep_driver);
1719 }
1720 
mlx5e_rep_cleanup(void)1721 void mlx5e_rep_cleanup(void)
1722 {
1723 	auxiliary_driver_unregister(&mlx5e_rep_driver);
1724 }
1725