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, ¶ms->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