sfc: ensure recovery after allocation failures
[linux-2.6-block.git] / drivers / net / ethernet / mellanox / mlx5 / core / en_rep.c
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 <generated/utsrelease.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/netevent.h>
39 #include <net/arp.h>
40
41 #include "eswitch.h"
42 #include "en.h"
43 #include "en_rep.h"
44 #include "en_tc.h"
45 #include "en/tc_tun.h"
46 #include "fs_core.h"
47
48 #define MLX5E_REP_PARAMS_DEF_LOG_SQ_SIZE \
49         max(0x7, MLX5E_PARAMS_MINIMUM_LOG_SQ_SIZE)
50 #define MLX5E_REP_PARAMS_DEF_NUM_CHANNELS 1
51
52 static const char mlx5e_rep_driver_name[] = "mlx5e_rep";
53
54 struct mlx5e_rep_indr_block_priv {
55         struct net_device *netdev;
56         struct mlx5e_rep_priv *rpriv;
57
58         struct list_head list;
59 };
60
61 static void mlx5e_rep_indr_unregister_block(struct mlx5e_rep_priv *rpriv,
62                                             struct net_device *netdev);
63
64 static void mlx5e_rep_get_drvinfo(struct net_device *dev,
65                                   struct ethtool_drvinfo *drvinfo)
66 {
67         strlcpy(drvinfo->driver, mlx5e_rep_driver_name,
68                 sizeof(drvinfo->driver));
69         strlcpy(drvinfo->version, UTS_RELEASE, sizeof(drvinfo->version));
70 }
71
72 static const struct counter_desc sw_rep_stats_desc[] = {
73         { MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, rx_packets) },
74         { MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, rx_bytes) },
75         { MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, tx_packets) },
76         { MLX5E_DECLARE_STAT(struct mlx5e_sw_stats, tx_bytes) },
77 };
78
79 struct vport_stats {
80         u64 vport_rx_packets;
81         u64 vport_tx_packets;
82         u64 vport_rx_bytes;
83         u64 vport_tx_bytes;
84 };
85
86 static const struct counter_desc vport_rep_stats_desc[] = {
87         { MLX5E_DECLARE_STAT(struct vport_stats, vport_rx_packets) },
88         { MLX5E_DECLARE_STAT(struct vport_stats, vport_rx_bytes) },
89         { MLX5E_DECLARE_STAT(struct vport_stats, vport_tx_packets) },
90         { MLX5E_DECLARE_STAT(struct vport_stats, vport_tx_bytes) },
91 };
92
93 #define NUM_VPORT_REP_SW_COUNTERS ARRAY_SIZE(sw_rep_stats_desc)
94 #define NUM_VPORT_REP_HW_COUNTERS ARRAY_SIZE(vport_rep_stats_desc)
95
96 static void mlx5e_rep_get_strings(struct net_device *dev,
97                                   u32 stringset, uint8_t *data)
98 {
99         int i, j;
100
101         switch (stringset) {
102         case ETH_SS_STATS:
103                 for (i = 0; i < NUM_VPORT_REP_SW_COUNTERS; i++)
104                         strcpy(data + (i * ETH_GSTRING_LEN),
105                                sw_rep_stats_desc[i].format);
106                 for (j = 0; j < NUM_VPORT_REP_HW_COUNTERS; j++, i++)
107                         strcpy(data + (i * ETH_GSTRING_LEN),
108                                vport_rep_stats_desc[j].format);
109                 break;
110         }
111 }
112
113 static void mlx5e_vf_rep_update_hw_counters(struct mlx5e_priv *priv)
114 {
115         struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
116         struct mlx5e_rep_priv *rpriv = priv->ppriv;
117         struct mlx5_eswitch_rep *rep = rpriv->rep;
118         struct rtnl_link_stats64 *vport_stats;
119         struct ifla_vf_stats vf_stats;
120         int err;
121
122         err = mlx5_eswitch_get_vport_stats(esw, rep->vport, &vf_stats);
123         if (err) {
124                 pr_warn("vport %d error %d reading stats\n", rep->vport, err);
125                 return;
126         }
127
128         vport_stats = &priv->stats.vf_vport;
129         /* flip tx/rx as we are reporting the counters for the switch vport */
130         vport_stats->rx_packets = vf_stats.tx_packets;
131         vport_stats->rx_bytes   = vf_stats.tx_bytes;
132         vport_stats->tx_packets = vf_stats.rx_packets;
133         vport_stats->tx_bytes   = vf_stats.rx_bytes;
134 }
135
136 static void mlx5e_uplink_rep_update_hw_counters(struct mlx5e_priv *priv)
137 {
138         struct mlx5e_pport_stats *pstats = &priv->stats.pport;
139         struct rtnl_link_stats64 *vport_stats;
140
141         mlx5e_grp_802_3_update_stats(priv);
142
143         vport_stats = &priv->stats.vf_vport;
144
145         vport_stats->rx_packets = PPORT_802_3_GET(pstats, a_frames_received_ok);
146         vport_stats->rx_bytes   = PPORT_802_3_GET(pstats, a_octets_received_ok);
147         vport_stats->tx_packets = PPORT_802_3_GET(pstats, a_frames_transmitted_ok);
148         vport_stats->tx_bytes   = PPORT_802_3_GET(pstats, a_octets_transmitted_ok);
149 }
150
151 static void mlx5e_rep_update_hw_counters(struct mlx5e_priv *priv)
152 {
153         struct mlx5e_rep_priv *rpriv = priv->ppriv;
154         struct mlx5_eswitch_rep *rep = rpriv->rep;
155
156         if (rep->vport == FDB_UPLINK_VPORT)
157                 mlx5e_uplink_rep_update_hw_counters(priv);
158         else
159                 mlx5e_vf_rep_update_hw_counters(priv);
160 }
161
162 static void mlx5e_rep_update_sw_counters(struct mlx5e_priv *priv)
163 {
164         struct mlx5e_sw_stats *s = &priv->stats.sw;
165         struct rtnl_link_stats64 stats64 = {};
166
167         memset(s, 0, sizeof(*s));
168         mlx5e_fold_sw_stats64(priv, &stats64);
169
170         s->rx_packets = stats64.rx_packets;
171         s->rx_bytes   = stats64.rx_bytes;
172         s->tx_packets = stats64.tx_packets;
173         s->tx_bytes   = stats64.tx_bytes;
174         s->tx_queue_dropped = stats64.tx_dropped;
175 }
176
177 static void mlx5e_rep_get_ethtool_stats(struct net_device *dev,
178                                         struct ethtool_stats *stats, u64 *data)
179 {
180         struct mlx5e_priv *priv = netdev_priv(dev);
181         int i, j;
182
183         if (!data)
184                 return;
185
186         mutex_lock(&priv->state_lock);
187         mlx5e_rep_update_sw_counters(priv);
188         mlx5e_rep_update_hw_counters(priv);
189         mutex_unlock(&priv->state_lock);
190
191         for (i = 0; i < NUM_VPORT_REP_SW_COUNTERS; i++)
192                 data[i] = MLX5E_READ_CTR64_CPU(&priv->stats.sw,
193                                                sw_rep_stats_desc, i);
194
195         for (j = 0; j < NUM_VPORT_REP_HW_COUNTERS; j++, i++)
196                 data[i] = MLX5E_READ_CTR64_CPU(&priv->stats.vf_vport,
197                                                vport_rep_stats_desc, j);
198 }
199
200 static int mlx5e_rep_get_sset_count(struct net_device *dev, int sset)
201 {
202         switch (sset) {
203         case ETH_SS_STATS:
204                 return NUM_VPORT_REP_SW_COUNTERS + NUM_VPORT_REP_HW_COUNTERS;
205         default:
206                 return -EOPNOTSUPP;
207         }
208 }
209
210 static void mlx5e_rep_get_ringparam(struct net_device *dev,
211                                 struct ethtool_ringparam *param)
212 {
213         struct mlx5e_priv *priv = netdev_priv(dev);
214
215         mlx5e_ethtool_get_ringparam(priv, param);
216 }
217
218 static int mlx5e_rep_set_ringparam(struct net_device *dev,
219                                struct ethtool_ringparam *param)
220 {
221         struct mlx5e_priv *priv = netdev_priv(dev);
222
223         return mlx5e_ethtool_set_ringparam(priv, param);
224 }
225
226 static int mlx5e_replace_rep_vport_rx_rule(struct mlx5e_priv *priv,
227                                            struct mlx5_flow_destination *dest)
228 {
229         struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
230         struct mlx5e_rep_priv *rpriv = priv->ppriv;
231         struct mlx5_eswitch_rep *rep = rpriv->rep;
232         struct mlx5_flow_handle *flow_rule;
233
234         flow_rule = mlx5_eswitch_create_vport_rx_rule(esw,
235                                                       rep->vport,
236                                                       dest);
237         if (IS_ERR(flow_rule))
238                 return PTR_ERR(flow_rule);
239
240         mlx5_del_flow_rules(rpriv->vport_rx_rule);
241         rpriv->vport_rx_rule = flow_rule;
242         return 0;
243 }
244
245 static void mlx5e_rep_get_channels(struct net_device *dev,
246                                    struct ethtool_channels *ch)
247 {
248         struct mlx5e_priv *priv = netdev_priv(dev);
249
250         mlx5e_ethtool_get_channels(priv, ch);
251 }
252
253 static int mlx5e_rep_set_channels(struct net_device *dev,
254                                   struct ethtool_channels *ch)
255 {
256         struct mlx5e_priv *priv = netdev_priv(dev);
257         u16 curr_channels_amount = priv->channels.params.num_channels;
258         u32 new_channels_amount = ch->combined_count;
259         struct mlx5_flow_destination new_dest;
260         int err = 0;
261
262         err = mlx5e_ethtool_set_channels(priv, ch);
263         if (err)
264                 return err;
265
266         if (curr_channels_amount == 1 && new_channels_amount > 1) {
267                 new_dest.type = MLX5_FLOW_DESTINATION_TYPE_FLOW_TABLE;
268                 new_dest.ft = priv->fs.ttc.ft.t;
269         } else if (new_channels_amount == 1 && curr_channels_amount > 1) {
270                 new_dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
271                 new_dest.tir_num = priv->direct_tir[0].tirn;
272         } else {
273                 return 0;
274         }
275
276         err = mlx5e_replace_rep_vport_rx_rule(priv, &new_dest);
277         if (err) {
278                 netdev_warn(priv->netdev, "Failed to update vport rx rule, when going from (%d) channels to (%d) channels\n",
279                             curr_channels_amount, new_channels_amount);
280                 return err;
281         }
282
283         return 0;
284 }
285
286 static int mlx5e_rep_get_coalesce(struct net_device *netdev,
287                                   struct ethtool_coalesce *coal)
288 {
289         struct mlx5e_priv *priv = netdev_priv(netdev);
290
291         return mlx5e_ethtool_get_coalesce(priv, coal);
292 }
293
294 static int mlx5e_rep_set_coalesce(struct net_device *netdev,
295                                   struct ethtool_coalesce *coal)
296 {
297         struct mlx5e_priv *priv = netdev_priv(netdev);
298
299         return mlx5e_ethtool_set_coalesce(priv, coal);
300 }
301
302 static u32 mlx5e_rep_get_rxfh_key_size(struct net_device *netdev)
303 {
304         struct mlx5e_priv *priv = netdev_priv(netdev);
305
306         return mlx5e_ethtool_get_rxfh_key_size(priv);
307 }
308
309 static u32 mlx5e_rep_get_rxfh_indir_size(struct net_device *netdev)
310 {
311         struct mlx5e_priv *priv = netdev_priv(netdev);
312
313         return mlx5e_ethtool_get_rxfh_indir_size(priv);
314 }
315
316 static void mlx5e_uplink_rep_get_pauseparam(struct net_device *netdev,
317                                             struct ethtool_pauseparam *pauseparam)
318 {
319         struct mlx5e_priv *priv = netdev_priv(netdev);
320
321         mlx5e_ethtool_get_pauseparam(priv, pauseparam);
322 }
323
324 static int mlx5e_uplink_rep_set_pauseparam(struct net_device *netdev,
325                                            struct ethtool_pauseparam *pauseparam)
326 {
327         struct mlx5e_priv *priv = netdev_priv(netdev);
328
329         return mlx5e_ethtool_set_pauseparam(priv, pauseparam);
330 }
331
332 static int mlx5e_uplink_rep_get_link_ksettings(struct net_device *netdev,
333                                                struct ethtool_link_ksettings *link_ksettings)
334 {
335         struct mlx5e_priv *priv = netdev_priv(netdev);
336
337         return mlx5e_ethtool_get_link_ksettings(priv, link_ksettings);
338 }
339
340 static int mlx5e_uplink_rep_set_link_ksettings(struct net_device *netdev,
341                                                const struct ethtool_link_ksettings *link_ksettings)
342 {
343         struct mlx5e_priv *priv = netdev_priv(netdev);
344
345         return mlx5e_ethtool_set_link_ksettings(priv, link_ksettings);
346 }
347
348 static const struct ethtool_ops mlx5e_vf_rep_ethtool_ops = {
349         .get_drvinfo       = mlx5e_rep_get_drvinfo,
350         .get_link          = ethtool_op_get_link,
351         .get_strings       = mlx5e_rep_get_strings,
352         .get_sset_count    = mlx5e_rep_get_sset_count,
353         .get_ethtool_stats = mlx5e_rep_get_ethtool_stats,
354         .get_ringparam     = mlx5e_rep_get_ringparam,
355         .set_ringparam     = mlx5e_rep_set_ringparam,
356         .get_channels      = mlx5e_rep_get_channels,
357         .set_channels      = mlx5e_rep_set_channels,
358         .get_coalesce      = mlx5e_rep_get_coalesce,
359         .set_coalesce      = mlx5e_rep_set_coalesce,
360         .get_rxfh_key_size   = mlx5e_rep_get_rxfh_key_size,
361         .get_rxfh_indir_size = mlx5e_rep_get_rxfh_indir_size,
362 };
363
364 static const struct ethtool_ops mlx5e_uplink_rep_ethtool_ops = {
365         .get_drvinfo       = mlx5e_rep_get_drvinfo,
366         .get_link          = ethtool_op_get_link,
367         .get_strings       = mlx5e_rep_get_strings,
368         .get_sset_count    = mlx5e_rep_get_sset_count,
369         .get_ethtool_stats = mlx5e_rep_get_ethtool_stats,
370         .get_ringparam     = mlx5e_rep_get_ringparam,
371         .set_ringparam     = mlx5e_rep_set_ringparam,
372         .get_channels      = mlx5e_rep_get_channels,
373         .set_channels      = mlx5e_rep_set_channels,
374         .get_coalesce      = mlx5e_rep_get_coalesce,
375         .set_coalesce      = mlx5e_rep_set_coalesce,
376         .get_link_ksettings = mlx5e_uplink_rep_get_link_ksettings,
377         .set_link_ksettings = mlx5e_uplink_rep_set_link_ksettings,
378         .get_rxfh_key_size   = mlx5e_rep_get_rxfh_key_size,
379         .get_rxfh_indir_size = mlx5e_rep_get_rxfh_indir_size,
380         .get_pauseparam    = mlx5e_uplink_rep_get_pauseparam,
381         .set_pauseparam    = mlx5e_uplink_rep_set_pauseparam,
382 };
383
384 static int mlx5e_rep_get_port_parent_id(struct net_device *dev,
385                                         struct netdev_phys_item_id *ppid)
386 {
387         struct mlx5e_priv *priv = netdev_priv(dev);
388         struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
389         struct net_device *uplink_upper = NULL;
390         struct mlx5e_priv *uplink_priv = NULL;
391         struct net_device *uplink_dev;
392
393         if (esw->mode == SRIOV_NONE)
394                 return -EOPNOTSUPP;
395
396         uplink_dev = mlx5_eswitch_uplink_get_proto_dev(esw, REP_ETH);
397         if (uplink_dev) {
398                 uplink_upper = netdev_master_upper_dev_get(uplink_dev);
399                 uplink_priv = netdev_priv(uplink_dev);
400         }
401
402         ppid->id_len = ETH_ALEN;
403         if (uplink_upper && mlx5_lag_is_sriov(uplink_priv->mdev)) {
404                 ether_addr_copy(ppid->id, uplink_upper->dev_addr);
405         } else {
406                 struct mlx5e_rep_priv *rpriv = priv->ppriv;
407                 struct mlx5_eswitch_rep *rep = rpriv->rep;
408
409                 ether_addr_copy(ppid->id, rep->hw_id);
410         }
411
412         return 0;
413 }
414
415 static void mlx5e_sqs2vport_stop(struct mlx5_eswitch *esw,
416                                  struct mlx5_eswitch_rep *rep)
417 {
418         struct mlx5e_rep_sq *rep_sq, *tmp;
419         struct mlx5e_rep_priv *rpriv;
420
421         if (esw->mode != SRIOV_OFFLOADS)
422                 return;
423
424         rpriv = mlx5e_rep_to_rep_priv(rep);
425         list_for_each_entry_safe(rep_sq, tmp, &rpriv->vport_sqs_list, list) {
426                 mlx5_eswitch_del_send_to_vport_rule(rep_sq->send_to_vport_rule);
427                 list_del(&rep_sq->list);
428                 kfree(rep_sq);
429         }
430 }
431
432 static int mlx5e_sqs2vport_start(struct mlx5_eswitch *esw,
433                                  struct mlx5_eswitch_rep *rep,
434                                  u32 *sqns_array, int sqns_num)
435 {
436         struct mlx5_flow_handle *flow_rule;
437         struct mlx5e_rep_priv *rpriv;
438         struct mlx5e_rep_sq *rep_sq;
439         int err;
440         int i;
441
442         if (esw->mode != SRIOV_OFFLOADS)
443                 return 0;
444
445         rpriv = mlx5e_rep_to_rep_priv(rep);
446         for (i = 0; i < sqns_num; i++) {
447                 rep_sq = kzalloc(sizeof(*rep_sq), GFP_KERNEL);
448                 if (!rep_sq) {
449                         err = -ENOMEM;
450                         goto out_err;
451                 }
452
453                 /* Add re-inject rule to the PF/representor sqs */
454                 flow_rule = mlx5_eswitch_add_send_to_vport_rule(esw,
455                                                                 rep->vport,
456                                                                 sqns_array[i]);
457                 if (IS_ERR(flow_rule)) {
458                         err = PTR_ERR(flow_rule);
459                         kfree(rep_sq);
460                         goto out_err;
461                 }
462                 rep_sq->send_to_vport_rule = flow_rule;
463                 list_add(&rep_sq->list, &rpriv->vport_sqs_list);
464         }
465         return 0;
466
467 out_err:
468         mlx5e_sqs2vport_stop(esw, rep);
469         return err;
470 }
471
472 int mlx5e_add_sqs_fwd_rules(struct mlx5e_priv *priv)
473 {
474         struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
475         struct mlx5e_rep_priv *rpriv = priv->ppriv;
476         struct mlx5_eswitch_rep *rep = rpriv->rep;
477         struct mlx5e_channel *c;
478         int n, tc, num_sqs = 0;
479         int err = -ENOMEM;
480         u32 *sqs;
481
482         sqs = kcalloc(priv->channels.num * priv->channels.params.num_tc, sizeof(*sqs), GFP_KERNEL);
483         if (!sqs)
484                 goto out;
485
486         for (n = 0; n < priv->channels.num; n++) {
487                 c = priv->channels.c[n];
488                 for (tc = 0; tc < c->num_tc; tc++)
489                         sqs[num_sqs++] = c->sq[tc].sqn;
490         }
491
492         err = mlx5e_sqs2vport_start(esw, rep, sqs, num_sqs);
493         kfree(sqs);
494
495 out:
496         if (err)
497                 netdev_warn(priv->netdev, "Failed to add SQs FWD rules %d\n", err);
498         return err;
499 }
500
501 void mlx5e_remove_sqs_fwd_rules(struct mlx5e_priv *priv)
502 {
503         struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
504         struct mlx5e_rep_priv *rpriv = priv->ppriv;
505         struct mlx5_eswitch_rep *rep = rpriv->rep;
506
507         mlx5e_sqs2vport_stop(esw, rep);
508 }
509
510 static void mlx5e_rep_neigh_update_init_interval(struct mlx5e_rep_priv *rpriv)
511 {
512 #if IS_ENABLED(CONFIG_IPV6)
513         unsigned long ipv6_interval = NEIGH_VAR(&nd_tbl.parms,
514                                                 DELAY_PROBE_TIME);
515 #else
516         unsigned long ipv6_interval = ~0UL;
517 #endif
518         unsigned long ipv4_interval = NEIGH_VAR(&arp_tbl.parms,
519                                                 DELAY_PROBE_TIME);
520         struct net_device *netdev = rpriv->netdev;
521         struct mlx5e_priv *priv = netdev_priv(netdev);
522
523         rpriv->neigh_update.min_interval = min_t(unsigned long, ipv6_interval, ipv4_interval);
524         mlx5_fc_update_sampling_interval(priv->mdev, rpriv->neigh_update.min_interval);
525 }
526
527 void mlx5e_rep_queue_neigh_stats_work(struct mlx5e_priv *priv)
528 {
529         struct mlx5e_rep_priv *rpriv = priv->ppriv;
530         struct mlx5e_neigh_update_table *neigh_update = &rpriv->neigh_update;
531
532         mlx5_fc_queue_stats_work(priv->mdev,
533                                  &neigh_update->neigh_stats_work,
534                                  neigh_update->min_interval);
535 }
536
537 static void mlx5e_rep_neigh_stats_work(struct work_struct *work)
538 {
539         struct mlx5e_rep_priv *rpriv = container_of(work, struct mlx5e_rep_priv,
540                                                     neigh_update.neigh_stats_work.work);
541         struct net_device *netdev = rpriv->netdev;
542         struct mlx5e_priv *priv = netdev_priv(netdev);
543         struct mlx5e_neigh_hash_entry *nhe;
544
545         rtnl_lock();
546         if (!list_empty(&rpriv->neigh_update.neigh_list))
547                 mlx5e_rep_queue_neigh_stats_work(priv);
548
549         list_for_each_entry(nhe, &rpriv->neigh_update.neigh_list, neigh_list)
550                 mlx5e_tc_update_neigh_used_value(nhe);
551
552         rtnl_unlock();
553 }
554
555 static void mlx5e_rep_neigh_entry_hold(struct mlx5e_neigh_hash_entry *nhe)
556 {
557         refcount_inc(&nhe->refcnt);
558 }
559
560 static void mlx5e_rep_neigh_entry_release(struct mlx5e_neigh_hash_entry *nhe)
561 {
562         if (refcount_dec_and_test(&nhe->refcnt))
563                 kfree(nhe);
564 }
565
566 static void mlx5e_rep_update_flows(struct mlx5e_priv *priv,
567                                    struct mlx5e_encap_entry *e,
568                                    bool neigh_connected,
569                                    unsigned char ha[ETH_ALEN])
570 {
571         struct ethhdr *eth = (struct ethhdr *)e->encap_header;
572
573         ASSERT_RTNL();
574
575         if ((e->flags & MLX5_ENCAP_ENTRY_VALID) &&
576             (!neigh_connected || !ether_addr_equal(e->h_dest, ha)))
577                 mlx5e_tc_encap_flows_del(priv, e);
578
579         if (neigh_connected && !(e->flags & MLX5_ENCAP_ENTRY_VALID)) {
580                 ether_addr_copy(e->h_dest, ha);
581                 ether_addr_copy(eth->h_dest, ha);
582                 /* Update the encap source mac, in case that we delete
583                  * the flows when encap source mac changed.
584                  */
585                 ether_addr_copy(eth->h_source, e->route_dev->dev_addr);
586
587                 mlx5e_tc_encap_flows_add(priv, e);
588         }
589 }
590
591 static void mlx5e_rep_neigh_update(struct work_struct *work)
592 {
593         struct mlx5e_neigh_hash_entry *nhe =
594                 container_of(work, struct mlx5e_neigh_hash_entry, neigh_update_work);
595         struct neighbour *n = nhe->n;
596         struct mlx5e_encap_entry *e;
597         unsigned char ha[ETH_ALEN];
598         struct mlx5e_priv *priv;
599         bool neigh_connected;
600         bool encap_connected;
601         u8 nud_state, dead;
602
603         rtnl_lock();
604
605         /* If these parameters are changed after we release the lock,
606          * we'll receive another event letting us know about it.
607          * We use this lock to avoid inconsistency between the neigh validity
608          * and it's hw address.
609          */
610         read_lock_bh(&n->lock);
611         memcpy(ha, n->ha, ETH_ALEN);
612         nud_state = n->nud_state;
613         dead = n->dead;
614         read_unlock_bh(&n->lock);
615
616         neigh_connected = (nud_state & NUD_VALID) && !dead;
617
618         list_for_each_entry(e, &nhe->encap_list, encap_list) {
619                 encap_connected = !!(e->flags & MLX5_ENCAP_ENTRY_VALID);
620                 priv = netdev_priv(e->out_dev);
621
622                 if (encap_connected != neigh_connected ||
623                     !ether_addr_equal(e->h_dest, ha))
624                         mlx5e_rep_update_flows(priv, e, neigh_connected, ha);
625         }
626         mlx5e_rep_neigh_entry_release(nhe);
627         rtnl_unlock();
628         neigh_release(n);
629 }
630
631 static struct mlx5e_rep_indr_block_priv *
632 mlx5e_rep_indr_block_priv_lookup(struct mlx5e_rep_priv *rpriv,
633                                  struct net_device *netdev)
634 {
635         struct mlx5e_rep_indr_block_priv *cb_priv;
636
637         /* All callback list access should be protected by RTNL. */
638         ASSERT_RTNL();
639
640         list_for_each_entry(cb_priv,
641                             &rpriv->uplink_priv.tc_indr_block_priv_list,
642                             list)
643                 if (cb_priv->netdev == netdev)
644                         return cb_priv;
645
646         return NULL;
647 }
648
649 static void mlx5e_rep_indr_clean_block_privs(struct mlx5e_rep_priv *rpriv)
650 {
651         struct mlx5e_rep_indr_block_priv *cb_priv, *temp;
652         struct list_head *head = &rpriv->uplink_priv.tc_indr_block_priv_list;
653
654         list_for_each_entry_safe(cb_priv, temp, head, list) {
655                 mlx5e_rep_indr_unregister_block(rpriv, cb_priv->netdev);
656                 kfree(cb_priv);
657         }
658 }
659
660 static int
661 mlx5e_rep_indr_offload(struct net_device *netdev,
662                        struct tc_cls_flower_offload *flower,
663                        struct mlx5e_rep_indr_block_priv *indr_priv)
664 {
665         struct mlx5e_priv *priv = netdev_priv(indr_priv->rpriv->netdev);
666         int flags = MLX5E_TC_EGRESS | MLX5E_TC_ESW_OFFLOAD;
667         int err = 0;
668
669         switch (flower->command) {
670         case TC_CLSFLOWER_REPLACE:
671                 err = mlx5e_configure_flower(netdev, priv, flower, flags);
672                 break;
673         case TC_CLSFLOWER_DESTROY:
674                 err = mlx5e_delete_flower(netdev, priv, flower, flags);
675                 break;
676         case TC_CLSFLOWER_STATS:
677                 err = mlx5e_stats_flower(netdev, priv, flower, flags);
678                 break;
679         default:
680                 err = -EOPNOTSUPP;
681         }
682
683         return err;
684 }
685
686 static int mlx5e_rep_indr_setup_block_cb(enum tc_setup_type type,
687                                          void *type_data, void *indr_priv)
688 {
689         struct mlx5e_rep_indr_block_priv *priv = indr_priv;
690
691         switch (type) {
692         case TC_SETUP_CLSFLOWER:
693                 return mlx5e_rep_indr_offload(priv->netdev, type_data, priv);
694         default:
695                 return -EOPNOTSUPP;
696         }
697 }
698
699 static int
700 mlx5e_rep_indr_setup_tc_block(struct net_device *netdev,
701                               struct mlx5e_rep_priv *rpriv,
702                               struct tc_block_offload *f)
703 {
704         struct mlx5e_rep_indr_block_priv *indr_priv;
705         int err = 0;
706
707         if (f->binder_type != TCF_BLOCK_BINDER_TYPE_CLSACT_INGRESS)
708                 return -EOPNOTSUPP;
709
710         switch (f->command) {
711         case TC_BLOCK_BIND:
712                 indr_priv = mlx5e_rep_indr_block_priv_lookup(rpriv, netdev);
713                 if (indr_priv)
714                         return -EEXIST;
715
716                 indr_priv = kmalloc(sizeof(*indr_priv), GFP_KERNEL);
717                 if (!indr_priv)
718                         return -ENOMEM;
719
720                 indr_priv->netdev = netdev;
721                 indr_priv->rpriv = rpriv;
722                 list_add(&indr_priv->list,
723                          &rpriv->uplink_priv.tc_indr_block_priv_list);
724
725                 err = tcf_block_cb_register(f->block,
726                                             mlx5e_rep_indr_setup_block_cb,
727                                             indr_priv, indr_priv, f->extack);
728                 if (err) {
729                         list_del(&indr_priv->list);
730                         kfree(indr_priv);
731                 }
732
733                 return err;
734         case TC_BLOCK_UNBIND:
735                 indr_priv = mlx5e_rep_indr_block_priv_lookup(rpriv, netdev);
736                 if (!indr_priv)
737                         return -ENOENT;
738
739                 tcf_block_cb_unregister(f->block,
740                                         mlx5e_rep_indr_setup_block_cb,
741                                         indr_priv);
742                 list_del(&indr_priv->list);
743                 kfree(indr_priv);
744
745                 return 0;
746         default:
747                 return -EOPNOTSUPP;
748         }
749         return 0;
750 }
751
752 static
753 int mlx5e_rep_indr_setup_tc_cb(struct net_device *netdev, void *cb_priv,
754                                enum tc_setup_type type, void *type_data)
755 {
756         switch (type) {
757         case TC_SETUP_BLOCK:
758                 return mlx5e_rep_indr_setup_tc_block(netdev, cb_priv,
759                                                       type_data);
760         default:
761                 return -EOPNOTSUPP;
762         }
763 }
764
765 static int mlx5e_rep_indr_register_block(struct mlx5e_rep_priv *rpriv,
766                                          struct net_device *netdev)
767 {
768         int err;
769
770         err = __tc_indr_block_cb_register(netdev, rpriv,
771                                           mlx5e_rep_indr_setup_tc_cb,
772                                           rpriv);
773         if (err) {
774                 struct mlx5e_priv *priv = netdev_priv(rpriv->netdev);
775
776                 mlx5_core_err(priv->mdev, "Failed to register remote block notifier for %s err=%d\n",
777                               netdev_name(netdev), err);
778         }
779         return err;
780 }
781
782 static void mlx5e_rep_indr_unregister_block(struct mlx5e_rep_priv *rpriv,
783                                             struct net_device *netdev)
784 {
785         __tc_indr_block_cb_unregister(netdev, mlx5e_rep_indr_setup_tc_cb,
786                                       rpriv);
787 }
788
789 static int mlx5e_nic_rep_netdevice_event(struct notifier_block *nb,
790                                          unsigned long event, void *ptr)
791 {
792         struct mlx5e_rep_priv *rpriv = container_of(nb, struct mlx5e_rep_priv,
793                                                      uplink_priv.netdevice_nb);
794         struct mlx5e_priv *priv = netdev_priv(rpriv->netdev);
795         struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
796
797         if (!mlx5e_tc_tun_device_to_offload(priv, netdev))
798                 return NOTIFY_OK;
799
800         switch (event) {
801         case NETDEV_REGISTER:
802                 mlx5e_rep_indr_register_block(rpriv, netdev);
803                 break;
804         case NETDEV_UNREGISTER:
805                 mlx5e_rep_indr_unregister_block(rpriv, netdev);
806                 break;
807         }
808         return NOTIFY_OK;
809 }
810
811 static struct mlx5e_neigh_hash_entry *
812 mlx5e_rep_neigh_entry_lookup(struct mlx5e_priv *priv,
813                              struct mlx5e_neigh *m_neigh);
814
815 static int mlx5e_rep_netevent_event(struct notifier_block *nb,
816                                     unsigned long event, void *ptr)
817 {
818         struct mlx5e_rep_priv *rpriv = container_of(nb, struct mlx5e_rep_priv,
819                                                     neigh_update.netevent_nb);
820         struct mlx5e_neigh_update_table *neigh_update = &rpriv->neigh_update;
821         struct net_device *netdev = rpriv->netdev;
822         struct mlx5e_priv *priv = netdev_priv(netdev);
823         struct mlx5e_neigh_hash_entry *nhe = NULL;
824         struct mlx5e_neigh m_neigh = {};
825         struct neigh_parms *p;
826         struct neighbour *n;
827         bool found = false;
828
829         switch (event) {
830         case NETEVENT_NEIGH_UPDATE:
831                 n = ptr;
832 #if IS_ENABLED(CONFIG_IPV6)
833                 if (n->tbl != &nd_tbl && n->tbl != &arp_tbl)
834 #else
835                 if (n->tbl != &arp_tbl)
836 #endif
837                         return NOTIFY_DONE;
838
839                 m_neigh.dev = n->dev;
840                 m_neigh.family = n->ops->family;
841                 memcpy(&m_neigh.dst_ip, n->primary_key, n->tbl->key_len);
842
843                 /* We are in atomic context and can't take RTNL mutex, so use
844                  * spin_lock_bh to lookup the neigh table. bh is used since
845                  * netevent can be called from a softirq context.
846                  */
847                 spin_lock_bh(&neigh_update->encap_lock);
848                 nhe = mlx5e_rep_neigh_entry_lookup(priv, &m_neigh);
849                 if (!nhe) {
850                         spin_unlock_bh(&neigh_update->encap_lock);
851                         return NOTIFY_DONE;
852                 }
853
854                 /* This assignment is valid as long as the the neigh reference
855                  * is taken
856                  */
857                 nhe->n = n;
858
859                 /* Take a reference to ensure the neighbour and mlx5 encap
860                  * entry won't be destructed until we drop the reference in
861                  * delayed work.
862                  */
863                 neigh_hold(n);
864                 mlx5e_rep_neigh_entry_hold(nhe);
865
866                 if (!queue_work(priv->wq, &nhe->neigh_update_work)) {
867                         mlx5e_rep_neigh_entry_release(nhe);
868                         neigh_release(n);
869                 }
870                 spin_unlock_bh(&neigh_update->encap_lock);
871                 break;
872
873         case NETEVENT_DELAY_PROBE_TIME_UPDATE:
874                 p = ptr;
875
876                 /* We check the device is present since we don't care about
877                  * changes in the default table, we only care about changes
878                  * done per device delay prob time parameter.
879                  */
880 #if IS_ENABLED(CONFIG_IPV6)
881                 if (!p->dev || (p->tbl != &nd_tbl && p->tbl != &arp_tbl))
882 #else
883                 if (!p->dev || p->tbl != &arp_tbl)
884 #endif
885                         return NOTIFY_DONE;
886
887                 /* We are in atomic context and can't take RTNL mutex,
888                  * so use spin_lock_bh to walk the neigh list and look for
889                  * the relevant device. bh is used since netevent can be
890                  * called from a softirq context.
891                  */
892                 spin_lock_bh(&neigh_update->encap_lock);
893                 list_for_each_entry(nhe, &neigh_update->neigh_list, neigh_list) {
894                         if (p->dev == nhe->m_neigh.dev) {
895                                 found = true;
896                                 break;
897                         }
898                 }
899                 spin_unlock_bh(&neigh_update->encap_lock);
900                 if (!found)
901                         return NOTIFY_DONE;
902
903                 neigh_update->min_interval = min_t(unsigned long,
904                                                    NEIGH_VAR(p, DELAY_PROBE_TIME),
905                                                    neigh_update->min_interval);
906                 mlx5_fc_update_sampling_interval(priv->mdev,
907                                                  neigh_update->min_interval);
908                 break;
909         }
910         return NOTIFY_DONE;
911 }
912
913 static const struct rhashtable_params mlx5e_neigh_ht_params = {
914         .head_offset = offsetof(struct mlx5e_neigh_hash_entry, rhash_node),
915         .key_offset = offsetof(struct mlx5e_neigh_hash_entry, m_neigh),
916         .key_len = sizeof(struct mlx5e_neigh),
917         .automatic_shrinking = true,
918 };
919
920 static int mlx5e_rep_neigh_init(struct mlx5e_rep_priv *rpriv)
921 {
922         struct mlx5e_neigh_update_table *neigh_update = &rpriv->neigh_update;
923         int err;
924
925         err = rhashtable_init(&neigh_update->neigh_ht, &mlx5e_neigh_ht_params);
926         if (err)
927                 return err;
928
929         INIT_LIST_HEAD(&neigh_update->neigh_list);
930         spin_lock_init(&neigh_update->encap_lock);
931         INIT_DELAYED_WORK(&neigh_update->neigh_stats_work,
932                           mlx5e_rep_neigh_stats_work);
933         mlx5e_rep_neigh_update_init_interval(rpriv);
934
935         rpriv->neigh_update.netevent_nb.notifier_call = mlx5e_rep_netevent_event;
936         err = register_netevent_notifier(&rpriv->neigh_update.netevent_nb);
937         if (err)
938                 goto out_err;
939         return 0;
940
941 out_err:
942         rhashtable_destroy(&neigh_update->neigh_ht);
943         return err;
944 }
945
946 static void mlx5e_rep_neigh_cleanup(struct mlx5e_rep_priv *rpriv)
947 {
948         struct mlx5e_neigh_update_table *neigh_update = &rpriv->neigh_update;
949         struct mlx5e_priv *priv = netdev_priv(rpriv->netdev);
950
951         unregister_netevent_notifier(&neigh_update->netevent_nb);
952
953         flush_workqueue(priv->wq); /* flush neigh update works */
954
955         cancel_delayed_work_sync(&rpriv->neigh_update.neigh_stats_work);
956
957         rhashtable_destroy(&neigh_update->neigh_ht);
958 }
959
960 static int mlx5e_rep_neigh_entry_insert(struct mlx5e_priv *priv,
961                                         struct mlx5e_neigh_hash_entry *nhe)
962 {
963         struct mlx5e_rep_priv *rpriv = priv->ppriv;
964         int err;
965
966         err = rhashtable_insert_fast(&rpriv->neigh_update.neigh_ht,
967                                      &nhe->rhash_node,
968                                      mlx5e_neigh_ht_params);
969         if (err)
970                 return err;
971
972         list_add(&nhe->neigh_list, &rpriv->neigh_update.neigh_list);
973
974         return err;
975 }
976
977 static void mlx5e_rep_neigh_entry_remove(struct mlx5e_priv *priv,
978                                          struct mlx5e_neigh_hash_entry *nhe)
979 {
980         struct mlx5e_rep_priv *rpriv = priv->ppriv;
981
982         spin_lock_bh(&rpriv->neigh_update.encap_lock);
983
984         list_del(&nhe->neigh_list);
985
986         rhashtable_remove_fast(&rpriv->neigh_update.neigh_ht,
987                                &nhe->rhash_node,
988                                mlx5e_neigh_ht_params);
989         spin_unlock_bh(&rpriv->neigh_update.encap_lock);
990 }
991
992 /* This function must only be called under RTNL lock or under the
993  * representor's encap_lock in case RTNL mutex can't be held.
994  */
995 static struct mlx5e_neigh_hash_entry *
996 mlx5e_rep_neigh_entry_lookup(struct mlx5e_priv *priv,
997                              struct mlx5e_neigh *m_neigh)
998 {
999         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1000         struct mlx5e_neigh_update_table *neigh_update = &rpriv->neigh_update;
1001
1002         return rhashtable_lookup_fast(&neigh_update->neigh_ht, m_neigh,
1003                                       mlx5e_neigh_ht_params);
1004 }
1005
1006 static int mlx5e_rep_neigh_entry_create(struct mlx5e_priv *priv,
1007                                         struct mlx5e_encap_entry *e,
1008                                         struct mlx5e_neigh_hash_entry **nhe)
1009 {
1010         int err;
1011
1012         *nhe = kzalloc(sizeof(**nhe), GFP_KERNEL);
1013         if (!*nhe)
1014                 return -ENOMEM;
1015
1016         memcpy(&(*nhe)->m_neigh, &e->m_neigh, sizeof(e->m_neigh));
1017         INIT_WORK(&(*nhe)->neigh_update_work, mlx5e_rep_neigh_update);
1018         INIT_LIST_HEAD(&(*nhe)->encap_list);
1019         refcount_set(&(*nhe)->refcnt, 1);
1020
1021         err = mlx5e_rep_neigh_entry_insert(priv, *nhe);
1022         if (err)
1023                 goto out_free;
1024         return 0;
1025
1026 out_free:
1027         kfree(*nhe);
1028         return err;
1029 }
1030
1031 static void mlx5e_rep_neigh_entry_destroy(struct mlx5e_priv *priv,
1032                                           struct mlx5e_neigh_hash_entry *nhe)
1033 {
1034         /* The neigh hash entry must be removed from the hash table regardless
1035          * of the reference count value, so it won't be found by the next
1036          * neigh notification call. The neigh hash entry reference count is
1037          * incremented only during creation and neigh notification calls and
1038          * protects from freeing the nhe struct.
1039          */
1040         mlx5e_rep_neigh_entry_remove(priv, nhe);
1041         mlx5e_rep_neigh_entry_release(nhe);
1042 }
1043
1044 int mlx5e_rep_encap_entry_attach(struct mlx5e_priv *priv,
1045                                  struct mlx5e_encap_entry *e)
1046 {
1047         struct mlx5e_neigh_hash_entry *nhe;
1048         int err;
1049
1050         nhe = mlx5e_rep_neigh_entry_lookup(priv, &e->m_neigh);
1051         if (!nhe) {
1052                 err = mlx5e_rep_neigh_entry_create(priv, e, &nhe);
1053                 if (err)
1054                         return err;
1055         }
1056         list_add(&e->encap_list, &nhe->encap_list);
1057         return 0;
1058 }
1059
1060 void mlx5e_rep_encap_entry_detach(struct mlx5e_priv *priv,
1061                                   struct mlx5e_encap_entry *e)
1062 {
1063         struct mlx5e_neigh_hash_entry *nhe;
1064
1065         list_del(&e->encap_list);
1066         nhe = mlx5e_rep_neigh_entry_lookup(priv, &e->m_neigh);
1067
1068         if (list_empty(&nhe->encap_list))
1069                 mlx5e_rep_neigh_entry_destroy(priv, nhe);
1070 }
1071
1072 static int mlx5e_vf_rep_open(struct net_device *dev)
1073 {
1074         struct mlx5e_priv *priv = netdev_priv(dev);
1075         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1076         struct mlx5_eswitch_rep *rep = rpriv->rep;
1077         int err;
1078
1079         mutex_lock(&priv->state_lock);
1080         err = mlx5e_open_locked(dev);
1081         if (err)
1082                 goto unlock;
1083
1084         if (!mlx5_modify_vport_admin_state(priv->mdev,
1085                                            MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
1086                                            rep->vport, MLX5_VPORT_ADMIN_STATE_UP))
1087                 netif_carrier_on(dev);
1088
1089 unlock:
1090         mutex_unlock(&priv->state_lock);
1091         return err;
1092 }
1093
1094 static int mlx5e_vf_rep_close(struct net_device *dev)
1095 {
1096         struct mlx5e_priv *priv = netdev_priv(dev);
1097         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1098         struct mlx5_eswitch_rep *rep = rpriv->rep;
1099         int ret;
1100
1101         mutex_lock(&priv->state_lock);
1102         mlx5_modify_vport_admin_state(priv->mdev,
1103                                       MLX5_VPORT_STATE_OP_MOD_ESW_VPORT,
1104                                       rep->vport, MLX5_VPORT_ADMIN_STATE_DOWN);
1105         ret = mlx5e_close_locked(dev);
1106         mutex_unlock(&priv->state_lock);
1107         return ret;
1108 }
1109
1110 static int mlx5e_rep_get_phys_port_name(struct net_device *dev,
1111                                         char *buf, size_t len)
1112 {
1113         struct mlx5e_priv *priv = netdev_priv(dev);
1114         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1115         struct mlx5_eswitch_rep *rep = rpriv->rep;
1116         int ret, pf_num;
1117
1118         ret = mlx5_lag_get_pf_num(priv->mdev, &pf_num);
1119         if (ret)
1120                 return ret;
1121
1122         if (rep->vport == FDB_UPLINK_VPORT)
1123                 ret = snprintf(buf, len, "p%d", pf_num);
1124         else
1125                 ret = snprintf(buf, len, "pf%dvf%d", pf_num, rep->vport - 1);
1126
1127         if (ret >= len)
1128                 return -EOPNOTSUPP;
1129
1130         return 0;
1131 }
1132
1133 static int
1134 mlx5e_rep_setup_tc_cls_flower(struct mlx5e_priv *priv,
1135                               struct tc_cls_flower_offload *cls_flower, int flags)
1136 {
1137         switch (cls_flower->command) {
1138         case TC_CLSFLOWER_REPLACE:
1139                 return mlx5e_configure_flower(priv->netdev, priv, cls_flower,
1140                                               flags);
1141         case TC_CLSFLOWER_DESTROY:
1142                 return mlx5e_delete_flower(priv->netdev, priv, cls_flower,
1143                                            flags);
1144         case TC_CLSFLOWER_STATS:
1145                 return mlx5e_stats_flower(priv->netdev, priv, cls_flower,
1146                                           flags);
1147         default:
1148                 return -EOPNOTSUPP;
1149         }
1150 }
1151
1152 static int mlx5e_rep_setup_tc_cb(enum tc_setup_type type, void *type_data,
1153                                  void *cb_priv)
1154 {
1155         struct mlx5e_priv *priv = cb_priv;
1156
1157         switch (type) {
1158         case TC_SETUP_CLSFLOWER:
1159                 return mlx5e_rep_setup_tc_cls_flower(priv, type_data, MLX5E_TC_INGRESS |
1160                                                      MLX5E_TC_ESW_OFFLOAD);
1161         default:
1162                 return -EOPNOTSUPP;
1163         }
1164 }
1165
1166 static int mlx5e_rep_setup_tc_block(struct net_device *dev,
1167                                     struct tc_block_offload *f)
1168 {
1169         struct mlx5e_priv *priv = netdev_priv(dev);
1170
1171         if (f->binder_type != TCF_BLOCK_BINDER_TYPE_CLSACT_INGRESS)
1172                 return -EOPNOTSUPP;
1173
1174         switch (f->command) {
1175         case TC_BLOCK_BIND:
1176                 return tcf_block_cb_register(f->block, mlx5e_rep_setup_tc_cb,
1177                                              priv, priv, f->extack);
1178         case TC_BLOCK_UNBIND:
1179                 tcf_block_cb_unregister(f->block, mlx5e_rep_setup_tc_cb, priv);
1180                 return 0;
1181         default:
1182                 return -EOPNOTSUPP;
1183         }
1184 }
1185
1186 static int mlx5e_rep_setup_tc(struct net_device *dev, enum tc_setup_type type,
1187                               void *type_data)
1188 {
1189         switch (type) {
1190         case TC_SETUP_BLOCK:
1191                 return mlx5e_rep_setup_tc_block(dev, type_data);
1192         default:
1193                 return -EOPNOTSUPP;
1194         }
1195 }
1196
1197 bool mlx5e_is_uplink_rep(struct mlx5e_priv *priv)
1198 {
1199         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1200         struct mlx5_eswitch_rep *rep;
1201
1202         if (!MLX5_ESWITCH_MANAGER(priv->mdev))
1203                 return false;
1204
1205         if (!rpriv) /* non vport rep mlx5e instances don't use this field */
1206                 return false;
1207
1208         rep = rpriv->rep;
1209         return (rep->vport == FDB_UPLINK_VPORT);
1210 }
1211
1212 static bool mlx5e_rep_has_offload_stats(const struct net_device *dev, int attr_id)
1213 {
1214         switch (attr_id) {
1215         case IFLA_OFFLOAD_XSTATS_CPU_HIT:
1216                         return true;
1217         }
1218
1219         return false;
1220 }
1221
1222 static int
1223 mlx5e_get_sw_stats64(const struct net_device *dev,
1224                      struct rtnl_link_stats64 *stats)
1225 {
1226         struct mlx5e_priv *priv = netdev_priv(dev);
1227
1228         mlx5e_fold_sw_stats64(priv, stats);
1229         return 0;
1230 }
1231
1232 static int mlx5e_rep_get_offload_stats(int attr_id, const struct net_device *dev,
1233                                        void *sp)
1234 {
1235         switch (attr_id) {
1236         case IFLA_OFFLOAD_XSTATS_CPU_HIT:
1237                 return mlx5e_get_sw_stats64(dev, sp);
1238         }
1239
1240         return -EINVAL;
1241 }
1242
1243 static void
1244 mlx5e_vf_rep_get_stats(struct net_device *dev, struct rtnl_link_stats64 *stats)
1245 {
1246         struct mlx5e_priv *priv = netdev_priv(dev);
1247
1248         /* update HW stats in background for next time */
1249         mlx5e_queue_update_stats(priv);
1250         memcpy(stats, &priv->stats.vf_vport, sizeof(*stats));
1251 }
1252
1253 static int mlx5e_vf_rep_change_mtu(struct net_device *netdev, int new_mtu)
1254 {
1255         return mlx5e_change_mtu(netdev, new_mtu, NULL);
1256 }
1257
1258 static int mlx5e_uplink_rep_change_mtu(struct net_device *netdev, int new_mtu)
1259 {
1260         return mlx5e_change_mtu(netdev, new_mtu, mlx5e_set_dev_port_mtu);
1261 }
1262
1263 static int mlx5e_uplink_rep_set_mac(struct net_device *netdev, void *addr)
1264 {
1265         struct sockaddr *saddr = addr;
1266
1267         if (!is_valid_ether_addr(saddr->sa_data))
1268                 return -EADDRNOTAVAIL;
1269
1270         ether_addr_copy(netdev->dev_addr, saddr->sa_data);
1271         return 0;
1272 }
1273
1274 static int mlx5e_uplink_rep_set_vf_vlan(struct net_device *dev, int vf, u16 vlan, u8 qos,
1275                                         __be16 vlan_proto)
1276 {
1277         netdev_warn_once(dev, "legacy vf vlan setting isn't supported in switchdev mode\n");
1278
1279         if (vlan != 0)
1280                 return -EOPNOTSUPP;
1281
1282         /* allow setting 0-vid for compatibility with libvirt */
1283         return 0;
1284 }
1285
1286 static const struct net_device_ops mlx5e_netdev_ops_vf_rep = {
1287         .ndo_open                = mlx5e_vf_rep_open,
1288         .ndo_stop                = mlx5e_vf_rep_close,
1289         .ndo_start_xmit          = mlx5e_xmit,
1290         .ndo_get_phys_port_name  = mlx5e_rep_get_phys_port_name,
1291         .ndo_setup_tc            = mlx5e_rep_setup_tc,
1292         .ndo_get_stats64         = mlx5e_vf_rep_get_stats,
1293         .ndo_has_offload_stats   = mlx5e_rep_has_offload_stats,
1294         .ndo_get_offload_stats   = mlx5e_rep_get_offload_stats,
1295         .ndo_change_mtu          = mlx5e_vf_rep_change_mtu,
1296         .ndo_get_port_parent_id  = mlx5e_rep_get_port_parent_id,
1297 };
1298
1299 static const struct net_device_ops mlx5e_netdev_ops_uplink_rep = {
1300         .ndo_open                = mlx5e_open,
1301         .ndo_stop                = mlx5e_close,
1302         .ndo_start_xmit          = mlx5e_xmit,
1303         .ndo_set_mac_address     = mlx5e_uplink_rep_set_mac,
1304         .ndo_get_phys_port_name  = mlx5e_rep_get_phys_port_name,
1305         .ndo_setup_tc            = mlx5e_rep_setup_tc,
1306         .ndo_get_stats64         = mlx5e_get_stats,
1307         .ndo_has_offload_stats   = mlx5e_rep_has_offload_stats,
1308         .ndo_get_offload_stats   = mlx5e_rep_get_offload_stats,
1309         .ndo_change_mtu          = mlx5e_uplink_rep_change_mtu,
1310         .ndo_udp_tunnel_add      = mlx5e_add_vxlan_port,
1311         .ndo_udp_tunnel_del      = mlx5e_del_vxlan_port,
1312         .ndo_features_check      = mlx5e_features_check,
1313         .ndo_set_vf_mac          = mlx5e_set_vf_mac,
1314         .ndo_set_vf_rate         = mlx5e_set_vf_rate,
1315         .ndo_get_vf_config       = mlx5e_get_vf_config,
1316         .ndo_get_vf_stats        = mlx5e_get_vf_stats,
1317         .ndo_set_vf_vlan         = mlx5e_uplink_rep_set_vf_vlan,
1318         .ndo_get_port_parent_id  = mlx5e_rep_get_port_parent_id,
1319 };
1320
1321 bool mlx5e_eswitch_rep(struct net_device *netdev)
1322 {
1323         if (netdev->netdev_ops == &mlx5e_netdev_ops_vf_rep ||
1324             netdev->netdev_ops == &mlx5e_netdev_ops_uplink_rep)
1325                 return true;
1326
1327         return false;
1328 }
1329
1330 static void mlx5e_build_rep_params(struct net_device *netdev)
1331 {
1332         struct mlx5e_priv *priv = netdev_priv(netdev);
1333         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1334         struct mlx5_eswitch_rep *rep = rpriv->rep;
1335         struct mlx5_core_dev *mdev = priv->mdev;
1336         struct mlx5e_params *params;
1337
1338         u8 cq_period_mode = MLX5_CAP_GEN(mdev, cq_period_start_from_cqe) ?
1339                                          MLX5_CQ_PERIOD_MODE_START_FROM_CQE :
1340                                          MLX5_CQ_PERIOD_MODE_START_FROM_EQE;
1341
1342         params = &priv->channels.params;
1343         params->hard_mtu    = MLX5E_ETH_HARD_MTU;
1344         params->sw_mtu      = netdev->mtu;
1345
1346         /* SQ */
1347         if (rep->vport == FDB_UPLINK_VPORT)
1348                 params->log_sq_size = MLX5E_PARAMS_DEFAULT_LOG_SQ_SIZE;
1349         else
1350                 params->log_sq_size = MLX5E_REP_PARAMS_DEF_LOG_SQ_SIZE;
1351
1352         /* RQ */
1353         mlx5e_build_rq_params(mdev, params);
1354
1355         /* CQ moderation params */
1356         params->rx_dim_enabled = MLX5_CAP_GEN(mdev, cq_moderation);
1357         mlx5e_set_rx_cq_mode_params(params, cq_period_mode);
1358
1359         params->num_tc                = 1;
1360
1361         mlx5_query_min_inline(mdev, &params->tx_min_inline_mode);
1362
1363         /* RSS */
1364         mlx5e_build_rss_params(&priv->rss_params, params->num_channels);
1365 }
1366
1367 static void mlx5e_build_rep_netdev(struct net_device *netdev)
1368 {
1369         struct mlx5e_priv *priv = netdev_priv(netdev);
1370         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1371         struct mlx5_eswitch_rep *rep = rpriv->rep;
1372         struct mlx5_core_dev *mdev = priv->mdev;
1373
1374         if (rep->vport == FDB_UPLINK_VPORT) {
1375                 SET_NETDEV_DEV(netdev, &priv->mdev->pdev->dev);
1376                 netdev->netdev_ops = &mlx5e_netdev_ops_uplink_rep;
1377                 /* we want a persistent mac for the uplink rep */
1378                 mlx5_query_nic_vport_mac_address(mdev, 0, netdev->dev_addr);
1379                 netdev->ethtool_ops = &mlx5e_uplink_rep_ethtool_ops;
1380 #ifdef CONFIG_MLX5_CORE_EN_DCB
1381                 if (MLX5_CAP_GEN(mdev, qos))
1382                         netdev->dcbnl_ops = &mlx5e_dcbnl_ops;
1383 #endif
1384         } else {
1385                 netdev->netdev_ops = &mlx5e_netdev_ops_vf_rep;
1386                 eth_hw_addr_random(netdev);
1387                 netdev->ethtool_ops = &mlx5e_vf_rep_ethtool_ops;
1388         }
1389
1390         netdev->watchdog_timeo    = 15 * HZ;
1391
1392
1393         netdev->features         |= NETIF_F_HW_TC | NETIF_F_NETNS_LOCAL;
1394         netdev->hw_features      |= NETIF_F_HW_TC;
1395
1396         netdev->hw_features    |= NETIF_F_SG;
1397         netdev->hw_features    |= NETIF_F_IP_CSUM;
1398         netdev->hw_features    |= NETIF_F_IPV6_CSUM;
1399         netdev->hw_features    |= NETIF_F_GRO;
1400         netdev->hw_features    |= NETIF_F_TSO;
1401         netdev->hw_features    |= NETIF_F_TSO6;
1402         netdev->hw_features    |= NETIF_F_RXCSUM;
1403
1404         if (rep->vport != FDB_UPLINK_VPORT)
1405                 netdev->features |= NETIF_F_VLAN_CHALLENGED;
1406
1407         netdev->features |= netdev->hw_features;
1408 }
1409
1410 static int mlx5e_init_rep(struct mlx5_core_dev *mdev,
1411                           struct net_device *netdev,
1412                           const struct mlx5e_profile *profile,
1413                           void *ppriv)
1414 {
1415         struct mlx5e_priv *priv = netdev_priv(netdev);
1416         int err;
1417
1418         err = mlx5e_netdev_init(netdev, priv, mdev, profile, ppriv);
1419         if (err)
1420                 return err;
1421
1422         priv->channels.params.num_channels = MLX5E_REP_PARAMS_DEF_NUM_CHANNELS;
1423
1424         mlx5e_build_rep_params(netdev);
1425         mlx5e_build_rep_netdev(netdev);
1426
1427         mlx5e_timestamp_init(priv);
1428
1429         return 0;
1430 }
1431
1432 static void mlx5e_cleanup_rep(struct mlx5e_priv *priv)
1433 {
1434         mlx5e_netdev_cleanup(priv->netdev, priv);
1435 }
1436
1437 static int mlx5e_create_rep_ttc_table(struct mlx5e_priv *priv)
1438 {
1439         struct ttc_params ttc_params = {};
1440         int tt, err;
1441
1442         priv->fs.ns = mlx5_get_flow_namespace(priv->mdev,
1443                                               MLX5_FLOW_NAMESPACE_KERNEL);
1444
1445         /* The inner_ttc in the ttc params is intentionally not set */
1446         ttc_params.any_tt_tirn = priv->direct_tir[0].tirn;
1447         mlx5e_set_ttc_ft_params(&ttc_params);
1448         for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
1449                 ttc_params.indir_tirn[tt] = priv->indir_tir[tt].tirn;
1450
1451         err = mlx5e_create_ttc_table(priv, &ttc_params, &priv->fs.ttc);
1452         if (err) {
1453                 netdev_err(priv->netdev, "Failed to create rep ttc table, err=%d\n", err);
1454                 return err;
1455         }
1456         return 0;
1457 }
1458
1459 static int mlx5e_create_rep_vport_rx_rule(struct mlx5e_priv *priv)
1460 {
1461         struct mlx5_eswitch *esw = priv->mdev->priv.eswitch;
1462         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1463         struct mlx5_eswitch_rep *rep = rpriv->rep;
1464         struct mlx5_flow_handle *flow_rule;
1465         struct mlx5_flow_destination dest;
1466
1467         dest.type = MLX5_FLOW_DESTINATION_TYPE_TIR;
1468         dest.tir_num = priv->direct_tir[0].tirn;
1469         flow_rule = mlx5_eswitch_create_vport_rx_rule(esw,
1470                                                       rep->vport,
1471                                                       &dest);
1472         if (IS_ERR(flow_rule))
1473                 return PTR_ERR(flow_rule);
1474         rpriv->vport_rx_rule = flow_rule;
1475         return 0;
1476 }
1477
1478 static int mlx5e_init_rep_rx(struct mlx5e_priv *priv)
1479 {
1480         struct mlx5_core_dev *mdev = priv->mdev;
1481         int err;
1482
1483         mlx5e_init_l2_addr(priv);
1484
1485         err = mlx5e_open_drop_rq(priv, &priv->drop_rq);
1486         if (err) {
1487                 mlx5_core_err(mdev, "open drop rq failed, %d\n", err);
1488                 return err;
1489         }
1490
1491         err = mlx5e_create_indirect_rqt(priv);
1492         if (err)
1493                 goto err_close_drop_rq;
1494
1495         err = mlx5e_create_direct_rqts(priv);
1496         if (err)
1497                 goto err_destroy_indirect_rqts;
1498
1499         err = mlx5e_create_indirect_tirs(priv, false);
1500         if (err)
1501                 goto err_destroy_direct_rqts;
1502
1503         err = mlx5e_create_direct_tirs(priv);
1504         if (err)
1505                 goto err_destroy_indirect_tirs;
1506
1507         err = mlx5e_create_rep_ttc_table(priv);
1508         if (err)
1509                 goto err_destroy_direct_tirs;
1510
1511         err = mlx5e_create_rep_vport_rx_rule(priv);
1512         if (err)
1513                 goto err_destroy_ttc_table;
1514
1515         return 0;
1516
1517 err_destroy_ttc_table:
1518         mlx5e_destroy_ttc_table(priv, &priv->fs.ttc);
1519 err_destroy_direct_tirs:
1520         mlx5e_destroy_direct_tirs(priv);
1521 err_destroy_indirect_tirs:
1522         mlx5e_destroy_indirect_tirs(priv, false);
1523 err_destroy_direct_rqts:
1524         mlx5e_destroy_direct_rqts(priv);
1525 err_destroy_indirect_rqts:
1526         mlx5e_destroy_rqt(priv, &priv->indir_rqt);
1527 err_close_drop_rq:
1528         mlx5e_close_drop_rq(&priv->drop_rq);
1529         return err;
1530 }
1531
1532 static void mlx5e_cleanup_rep_rx(struct mlx5e_priv *priv)
1533 {
1534         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1535
1536         mlx5_del_flow_rules(rpriv->vport_rx_rule);
1537         mlx5e_destroy_ttc_table(priv, &priv->fs.ttc);
1538         mlx5e_destroy_direct_tirs(priv);
1539         mlx5e_destroy_indirect_tirs(priv, false);
1540         mlx5e_destroy_direct_rqts(priv);
1541         mlx5e_destroy_rqt(priv, &priv->indir_rqt);
1542         mlx5e_close_drop_rq(&priv->drop_rq);
1543 }
1544
1545 static int mlx5e_init_rep_tx(struct mlx5e_priv *priv)
1546 {
1547         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1548         struct mlx5_rep_uplink_priv *uplink_priv;
1549         int tc, err;
1550
1551         err = mlx5e_create_tises(priv);
1552         if (err) {
1553                 mlx5_core_warn(priv->mdev, "create tises failed, %d\n", err);
1554                 return err;
1555         }
1556
1557         if (rpriv->rep->vport == FDB_UPLINK_VPORT) {
1558                 uplink_priv = &rpriv->uplink_priv;
1559
1560                 /* init shared tc flow table */
1561                 err = mlx5e_tc_esw_init(&uplink_priv->tc_ht);
1562                 if (err)
1563                         goto destroy_tises;
1564
1565                 /* init indirect block notifications */
1566                 INIT_LIST_HEAD(&uplink_priv->tc_indr_block_priv_list);
1567                 uplink_priv->netdevice_nb.notifier_call = mlx5e_nic_rep_netdevice_event;
1568                 err = register_netdevice_notifier(&uplink_priv->netdevice_nb);
1569                 if (err) {
1570                         mlx5_core_err(priv->mdev, "Failed to register netdev notifier\n");
1571                         goto tc_esw_cleanup;
1572                 }
1573         }
1574
1575         return 0;
1576
1577 tc_esw_cleanup:
1578         mlx5e_tc_esw_cleanup(&uplink_priv->tc_ht);
1579 destroy_tises:
1580         for (tc = 0; tc < priv->profile->max_tc; tc++)
1581                 mlx5e_destroy_tis(priv->mdev, priv->tisn[tc]);
1582         return err;
1583 }
1584
1585 static void mlx5e_cleanup_rep_tx(struct mlx5e_priv *priv)
1586 {
1587         struct mlx5e_rep_priv *rpriv = priv->ppriv;
1588         int tc;
1589
1590         for (tc = 0; tc < priv->profile->max_tc; tc++)
1591                 mlx5e_destroy_tis(priv->mdev, priv->tisn[tc]);
1592
1593         if (rpriv->rep->vport == FDB_UPLINK_VPORT) {
1594                 /* clean indirect TC block notifications */
1595                 unregister_netdevice_notifier(&rpriv->uplink_priv.netdevice_nb);
1596                 mlx5e_rep_indr_clean_block_privs(rpriv);
1597
1598                 /* delete shared tc flow table */
1599                 mlx5e_tc_esw_cleanup(&rpriv->uplink_priv.tc_ht);
1600         }
1601 }
1602
1603 static void mlx5e_vf_rep_enable(struct mlx5e_priv *priv)
1604 {
1605         struct net_device *netdev = priv->netdev;
1606         struct mlx5_core_dev *mdev = priv->mdev;
1607         u16 max_mtu;
1608
1609         netdev->min_mtu = ETH_MIN_MTU;
1610         mlx5_query_port_max_mtu(mdev, &max_mtu, 1);
1611         netdev->max_mtu = MLX5E_HW2SW_MTU(&priv->channels.params, max_mtu);
1612 }
1613
1614 static int uplink_rep_async_event(struct notifier_block *nb, unsigned long event, void *data)
1615 {
1616         struct mlx5e_priv *priv = container_of(nb, struct mlx5e_priv, events_nb);
1617         struct mlx5_eqe   *eqe = data;
1618
1619         if (event != MLX5_EVENT_TYPE_PORT_CHANGE)
1620                 return NOTIFY_DONE;
1621
1622         switch (eqe->sub_type) {
1623         case MLX5_PORT_CHANGE_SUBTYPE_DOWN:
1624         case MLX5_PORT_CHANGE_SUBTYPE_ACTIVE:
1625                 queue_work(priv->wq, &priv->update_carrier_work);
1626                 break;
1627         default:
1628                 return NOTIFY_DONE;
1629         }
1630
1631         return NOTIFY_OK;
1632 }
1633
1634 static void mlx5e_uplink_rep_enable(struct mlx5e_priv *priv)
1635 {
1636         struct net_device *netdev = priv->netdev;
1637         struct mlx5_core_dev *mdev = priv->mdev;
1638         u16 max_mtu;
1639
1640         netdev->min_mtu = ETH_MIN_MTU;
1641         mlx5_query_port_max_mtu(priv->mdev, &max_mtu, 1);
1642         netdev->max_mtu = MLX5E_HW2SW_MTU(&priv->channels.params, max_mtu);
1643         mlx5e_set_dev_port_mtu(priv);
1644
1645         mlx5_lag_add(mdev, netdev);
1646         priv->events_nb.notifier_call = uplink_rep_async_event;
1647         mlx5_notifier_register(mdev, &priv->events_nb);
1648 #ifdef CONFIG_MLX5_CORE_EN_DCB
1649         mlx5e_dcbnl_initialize(priv);
1650         mlx5e_dcbnl_init_app(priv);
1651 #endif
1652 }
1653
1654 static void mlx5e_uplink_rep_disable(struct mlx5e_priv *priv)
1655 {
1656         struct mlx5_core_dev *mdev = priv->mdev;
1657
1658 #ifdef CONFIG_MLX5_CORE_EN_DCB
1659         mlx5e_dcbnl_delete_app(priv);
1660 #endif
1661         mlx5_notifier_unregister(mdev, &priv->events_nb);
1662         mlx5_lag_remove(mdev);
1663 }
1664
1665 static const struct mlx5e_profile mlx5e_vf_rep_profile = {
1666         .init                   = mlx5e_init_rep,
1667         .cleanup                = mlx5e_cleanup_rep,
1668         .init_rx                = mlx5e_init_rep_rx,
1669         .cleanup_rx             = mlx5e_cleanup_rep_rx,
1670         .init_tx                = mlx5e_init_rep_tx,
1671         .cleanup_tx             = mlx5e_cleanup_rep_tx,
1672         .enable                 = mlx5e_vf_rep_enable,
1673         .update_stats           = mlx5e_vf_rep_update_hw_counters,
1674         .rx_handlers.handle_rx_cqe       = mlx5e_handle_rx_cqe_rep,
1675         .rx_handlers.handle_rx_cqe_mpwqe = mlx5e_handle_rx_cqe_mpwrq,
1676         .max_tc                 = 1,
1677 };
1678
1679 static const struct mlx5e_profile mlx5e_uplink_rep_profile = {
1680         .init                   = mlx5e_init_rep,
1681         .cleanup                = mlx5e_cleanup_rep,
1682         .init_rx                = mlx5e_init_rep_rx,
1683         .cleanup_rx             = mlx5e_cleanup_rep_rx,
1684         .init_tx                = mlx5e_init_rep_tx,
1685         .cleanup_tx             = mlx5e_cleanup_rep_tx,
1686         .enable                 = mlx5e_uplink_rep_enable,
1687         .disable                = mlx5e_uplink_rep_disable,
1688         .update_stats           = mlx5e_uplink_rep_update_hw_counters,
1689         .update_carrier         = mlx5e_update_carrier,
1690         .rx_handlers.handle_rx_cqe       = mlx5e_handle_rx_cqe_rep,
1691         .rx_handlers.handle_rx_cqe_mpwqe = mlx5e_handle_rx_cqe_mpwrq,
1692         .max_tc                 = MLX5E_MAX_NUM_TC,
1693 };
1694
1695 /* e-Switch vport representors */
1696 static int
1697 mlx5e_vport_rep_load(struct mlx5_core_dev *dev, struct mlx5_eswitch_rep *rep)
1698 {
1699         const struct mlx5e_profile *profile;
1700         struct mlx5e_rep_priv *rpriv;
1701         struct net_device *netdev;
1702         int nch, err;
1703
1704         rpriv = kzalloc(sizeof(*rpriv), GFP_KERNEL);
1705         if (!rpriv)
1706                 return -ENOMEM;
1707
1708         /* rpriv->rep to be looked up when profile->init() is called */
1709         rpriv->rep = rep;
1710
1711         nch = mlx5e_get_max_num_channels(dev);
1712         profile = (rep->vport == FDB_UPLINK_VPORT) ? &mlx5e_uplink_rep_profile : &mlx5e_vf_rep_profile;
1713         netdev = mlx5e_create_netdev(dev, profile, nch, rpriv);
1714         if (!netdev) {
1715                 pr_warn("Failed to create representor netdev for vport %d\n",
1716                         rep->vport);
1717                 kfree(rpriv);
1718                 return -EINVAL;
1719         }
1720
1721         rpriv->netdev = netdev;
1722         rep->rep_if[REP_ETH].priv = rpriv;
1723         INIT_LIST_HEAD(&rpriv->vport_sqs_list);
1724
1725         if (rep->vport == FDB_UPLINK_VPORT) {
1726                 err = mlx5e_create_mdev_resources(dev);
1727                 if (err)
1728                         goto err_destroy_netdev;
1729         }
1730
1731         err = mlx5e_attach_netdev(netdev_priv(netdev));
1732         if (err) {
1733                 pr_warn("Failed to attach representor netdev for vport %d\n",
1734                         rep->vport);
1735                 goto err_destroy_mdev_resources;
1736         }
1737
1738         err = mlx5e_rep_neigh_init(rpriv);
1739         if (err) {
1740                 pr_warn("Failed to initialized neighbours handling for vport %d\n",
1741                         rep->vport);
1742                 goto err_detach_netdev;
1743         }
1744
1745         err = register_netdev(netdev);
1746         if (err) {
1747                 pr_warn("Failed to register representor netdev for vport %d\n",
1748                         rep->vport);
1749                 goto err_neigh_cleanup;
1750         }
1751
1752         return 0;
1753
1754 err_neigh_cleanup:
1755         mlx5e_rep_neigh_cleanup(rpriv);
1756
1757 err_detach_netdev:
1758         mlx5e_detach_netdev(netdev_priv(netdev));
1759
1760 err_destroy_mdev_resources:
1761         if (rep->vport == FDB_UPLINK_VPORT)
1762                 mlx5e_destroy_mdev_resources(dev);
1763
1764 err_destroy_netdev:
1765         mlx5e_destroy_netdev(netdev_priv(netdev));
1766         kfree(rpriv);
1767         return err;
1768 }
1769
1770 static void
1771 mlx5e_vport_rep_unload(struct mlx5_eswitch_rep *rep)
1772 {
1773         struct mlx5e_rep_priv *rpriv = mlx5e_rep_to_rep_priv(rep);
1774         struct net_device *netdev = rpriv->netdev;
1775         struct mlx5e_priv *priv = netdev_priv(netdev);
1776         void *ppriv = priv->ppriv;
1777
1778         unregister_netdev(netdev);
1779         mlx5e_rep_neigh_cleanup(rpriv);
1780         mlx5e_detach_netdev(priv);
1781         if (rep->vport == FDB_UPLINK_VPORT)
1782                 mlx5e_destroy_mdev_resources(priv->mdev);
1783         mlx5e_destroy_netdev(priv);
1784         kfree(ppriv); /* mlx5e_rep_priv */
1785 }
1786
1787 static void *mlx5e_vport_rep_get_proto_dev(struct mlx5_eswitch_rep *rep)
1788 {
1789         struct mlx5e_rep_priv *rpriv;
1790
1791         rpriv = mlx5e_rep_to_rep_priv(rep);
1792
1793         return rpriv->netdev;
1794 }
1795
1796 void mlx5e_rep_register_vport_reps(struct mlx5_core_dev *mdev)
1797 {
1798         struct mlx5_eswitch *esw = mdev->priv.eswitch;
1799         int total_vfs = MLX5_TOTAL_VPORTS(mdev);
1800         int vport;
1801
1802         for (vport = 0; vport < total_vfs; vport++) {
1803                 struct mlx5_eswitch_rep_if rep_if = {};
1804
1805                 rep_if.load = mlx5e_vport_rep_load;
1806                 rep_if.unload = mlx5e_vport_rep_unload;
1807                 rep_if.get_proto_dev = mlx5e_vport_rep_get_proto_dev;
1808                 mlx5_eswitch_register_vport_rep(esw, vport, &rep_if, REP_ETH);
1809         }
1810 }
1811
1812 void mlx5e_rep_unregister_vport_reps(struct mlx5_core_dev *mdev)
1813 {
1814         struct mlx5_eswitch *esw = mdev->priv.eswitch;
1815         int total_vfs = MLX5_TOTAL_VPORTS(mdev);
1816         int vport;
1817
1818         for (vport = total_vfs - 1; vport >= 0; vport--)
1819                 mlx5_eswitch_unregister_vport_rep(esw, vport, REP_ETH);
1820 }