net/mlx5e: Gather common netdev init/cleanup functionality in one place
[sfrench/cifs-2.6.git] / drivers / net / ethernet / mellanox / mlx5 / core / ipoib / ipoib.c
1 /*
2  * Copyright (c) 2017, 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 <rdma/ib_verbs.h>
34 #include <linux/mlx5/fs.h>
35 #include "en.h"
36 #include "ipoib.h"
37
38 #define IB_DEFAULT_Q_KEY   0xb1b
39 #define MLX5I_PARAMS_DEFAULT_LOG_RQ_SIZE 9
40
41 static int mlx5i_open(struct net_device *netdev);
42 static int mlx5i_close(struct net_device *netdev);
43 static int mlx5i_change_mtu(struct net_device *netdev, int new_mtu);
44
45 static const struct net_device_ops mlx5i_netdev_ops = {
46         .ndo_open                = mlx5i_open,
47         .ndo_stop                = mlx5i_close,
48         .ndo_get_stats64         = mlx5i_get_stats,
49         .ndo_init                = mlx5i_dev_init,
50         .ndo_uninit              = mlx5i_dev_cleanup,
51         .ndo_change_mtu          = mlx5i_change_mtu,
52         .ndo_do_ioctl            = mlx5i_ioctl,
53 };
54
55 /* IPoIB mlx5 netdev profile */
56 static void mlx5i_build_nic_params(struct mlx5_core_dev *mdev,
57                                    struct mlx5e_params *params)
58 {
59         /* Override RQ params as IPoIB supports only LINKED LIST RQ for now */
60         MLX5E_SET_PFLAG(params, MLX5E_PFLAG_RX_STRIDING_RQ, false);
61         mlx5e_set_rq_type(mdev, params);
62         mlx5e_init_rq_type_params(mdev, params);
63
64         /* RQ size in ipoib by default is 512 */
65         params->log_rq_mtu_frames = is_kdump_kernel() ?
66                 MLX5E_PARAMS_MINIMUM_LOG_RQ_SIZE :
67                 MLX5I_PARAMS_DEFAULT_LOG_RQ_SIZE;
68
69         params->lro_en = false;
70         params->hard_mtu = MLX5_IB_GRH_BYTES + MLX5_IPOIB_HARD_LEN;
71 }
72
73 /* Called directly after IPoIB netdevice was created to initialize SW structs */
74 int mlx5i_init(struct mlx5_core_dev *mdev,
75                struct net_device *netdev,
76                const struct mlx5e_profile *profile,
77                void *ppriv)
78 {
79         struct mlx5e_priv *priv  = mlx5i_epriv(netdev);
80         u16 max_mtu;
81         int err;
82
83         /* priv init */
84         priv->mdev        = mdev;
85         priv->netdev      = netdev;
86         priv->profile     = profile;
87         priv->ppriv       = ppriv;
88         priv->max_opened_tc = 1;
89         mutex_init(&priv->state_lock);
90
91         err = mlx5e_netdev_init(netdev, priv);
92         if (err)
93                 return err;
94
95         mlx5_query_port_max_mtu(mdev, &max_mtu, 1);
96         netdev->mtu = max_mtu;
97
98         mlx5e_build_nic_params(mdev, &priv->channels.params,
99                                profile->max_nch(mdev), netdev->mtu);
100         mlx5i_build_nic_params(mdev, &priv->channels.params);
101
102         mlx5e_timestamp_init(priv);
103
104         /* netdev init */
105         netdev->hw_features    |= NETIF_F_SG;
106         netdev->hw_features    |= NETIF_F_IP_CSUM;
107         netdev->hw_features    |= NETIF_F_IPV6_CSUM;
108         netdev->hw_features    |= NETIF_F_GRO;
109         netdev->hw_features    |= NETIF_F_TSO;
110         netdev->hw_features    |= NETIF_F_TSO6;
111         netdev->hw_features    |= NETIF_F_RXCSUM;
112         netdev->hw_features    |= NETIF_F_RXHASH;
113
114         netdev->netdev_ops = &mlx5i_netdev_ops;
115         netdev->ethtool_ops = &mlx5i_ethtool_ops;
116
117         return 0;
118 }
119
120 /* Called directly before IPoIB netdevice is destroyed to cleanup SW structs */
121 void mlx5i_cleanup(struct mlx5e_priv *priv)
122 {
123         mlx5e_netdev_cleanup(priv->netdev, priv);
124 }
125
126 static void mlx5i_grp_sw_update_stats(struct mlx5e_priv *priv)
127 {
128         struct mlx5e_sw_stats s = { 0 };
129         int i, j;
130
131         for (i = 0; i < priv->profile->max_nch(priv->mdev); i++) {
132                 struct mlx5e_channel_stats *channel_stats;
133                 struct mlx5e_rq_stats *rq_stats;
134
135                 channel_stats = &priv->channel_stats[i];
136                 rq_stats = &channel_stats->rq;
137
138                 s.rx_packets += rq_stats->packets;
139                 s.rx_bytes   += rq_stats->bytes;
140
141                 for (j = 0; j < priv->max_opened_tc; j++) {
142                         struct mlx5e_sq_stats *sq_stats = &channel_stats->sq[j];
143
144                         s.tx_packets           += sq_stats->packets;
145                         s.tx_bytes             += sq_stats->bytes;
146                         s.tx_queue_dropped     += sq_stats->dropped;
147                 }
148         }
149
150         memcpy(&priv->stats.sw, &s, sizeof(s));
151 }
152
153 void mlx5i_get_stats(struct net_device *dev, struct rtnl_link_stats64 *stats)
154 {
155         struct mlx5e_priv     *priv   = mlx5i_epriv(dev);
156         struct mlx5e_sw_stats *sstats = &priv->stats.sw;
157
158         mlx5i_grp_sw_update_stats(priv);
159
160         stats->rx_packets = sstats->rx_packets;
161         stats->rx_bytes   = sstats->rx_bytes;
162         stats->tx_packets = sstats->tx_packets;
163         stats->tx_bytes   = sstats->tx_bytes;
164         stats->tx_dropped = sstats->tx_queue_dropped;
165 }
166
167 int mlx5i_init_underlay_qp(struct mlx5e_priv *priv)
168 {
169         struct mlx5_core_dev *mdev = priv->mdev;
170         struct mlx5i_priv *ipriv = priv->ppriv;
171         struct mlx5_core_qp *qp = &ipriv->qp;
172         struct mlx5_qp_context *context;
173         int ret;
174
175         /* QP states */
176         context = kzalloc(sizeof(*context), GFP_KERNEL);
177         if (!context)
178                 return -ENOMEM;
179
180         context->flags = cpu_to_be32(MLX5_QP_PM_MIGRATED << 11);
181         context->pri_path.port = 1;
182         context->pri_path.pkey_index = cpu_to_be16(ipriv->pkey_index);
183         context->qkey = cpu_to_be32(IB_DEFAULT_Q_KEY);
184
185         ret = mlx5_core_qp_modify(mdev, MLX5_CMD_OP_RST2INIT_QP, 0, context, qp);
186         if (ret) {
187                 mlx5_core_err(mdev, "Failed to modify qp RST2INIT, err: %d\n", ret);
188                 goto err_qp_modify_to_err;
189         }
190         memset(context, 0, sizeof(*context));
191
192         ret = mlx5_core_qp_modify(mdev, MLX5_CMD_OP_INIT2RTR_QP, 0, context, qp);
193         if (ret) {
194                 mlx5_core_err(mdev, "Failed to modify qp INIT2RTR, err: %d\n", ret);
195                 goto err_qp_modify_to_err;
196         }
197
198         ret = mlx5_core_qp_modify(mdev, MLX5_CMD_OP_RTR2RTS_QP, 0, context, qp);
199         if (ret) {
200                 mlx5_core_err(mdev, "Failed to modify qp RTR2RTS, err: %d\n", ret);
201                 goto err_qp_modify_to_err;
202         }
203
204         kfree(context);
205         return 0;
206
207 err_qp_modify_to_err:
208         mlx5_core_qp_modify(mdev, MLX5_CMD_OP_2ERR_QP, 0, &context, qp);
209         kfree(context);
210         return ret;
211 }
212
213 void mlx5i_uninit_underlay_qp(struct mlx5e_priv *priv)
214 {
215         struct mlx5i_priv *ipriv = priv->ppriv;
216         struct mlx5_core_dev *mdev = priv->mdev;
217         struct mlx5_qp_context context;
218         int err;
219
220         err = mlx5_core_qp_modify(mdev, MLX5_CMD_OP_2RST_QP, 0, &context,
221                                   &ipriv->qp);
222         if (err)
223                 mlx5_core_err(mdev, "Failed to modify qp 2RST, err: %d\n", err);
224 }
225
226 #define MLX5_QP_ENHANCED_ULP_STATELESS_MODE 2
227
228 int mlx5i_create_underlay_qp(struct mlx5_core_dev *mdev, struct mlx5_core_qp *qp)
229 {
230         u32 *in = NULL;
231         void *addr_path;
232         int ret = 0;
233         int inlen;
234         void *qpc;
235
236         inlen = MLX5_ST_SZ_BYTES(create_qp_in);
237         in = kvzalloc(inlen, GFP_KERNEL);
238         if (!in)
239                 return -ENOMEM;
240
241         qpc = MLX5_ADDR_OF(create_qp_in, in, qpc);
242         MLX5_SET(qpc, qpc, st, MLX5_QP_ST_UD);
243         MLX5_SET(qpc, qpc, pm_state, MLX5_QP_PM_MIGRATED);
244         MLX5_SET(qpc, qpc, ulp_stateless_offload_mode,
245                  MLX5_QP_ENHANCED_ULP_STATELESS_MODE);
246
247         addr_path = MLX5_ADDR_OF(qpc, qpc, primary_address_path);
248         MLX5_SET(ads, addr_path, vhca_port_num, 1);
249         MLX5_SET(ads, addr_path, grh, 1);
250
251         ret = mlx5_core_create_qp(mdev, qp, in, inlen);
252         if (ret) {
253                 mlx5_core_err(mdev, "Failed creating IPoIB QP err : %d\n", ret);
254                 goto out;
255         }
256
257 out:
258         kvfree(in);
259         return ret;
260 }
261
262 void mlx5i_destroy_underlay_qp(struct mlx5_core_dev *mdev, struct mlx5_core_qp *qp)
263 {
264         mlx5_core_destroy_qp(mdev, qp);
265 }
266
267 static int mlx5i_init_tx(struct mlx5e_priv *priv)
268 {
269         struct mlx5i_priv *ipriv = priv->ppriv;
270         int err;
271
272         err = mlx5i_create_underlay_qp(priv->mdev, &ipriv->qp);
273         if (err) {
274                 mlx5_core_warn(priv->mdev, "create underlay QP failed, %d\n", err);
275                 return err;
276         }
277
278         err = mlx5e_create_tis(priv->mdev, 0 /* tc */, ipriv->qp.qpn, &priv->tisn[0]);
279         if (err) {
280                 mlx5_core_warn(priv->mdev, "create tis failed, %d\n", err);
281                 goto err_destroy_underlay_qp;
282         }
283
284         return 0;
285
286 err_destroy_underlay_qp:
287         mlx5i_destroy_underlay_qp(priv->mdev, &ipriv->qp);
288         return err;
289 }
290
291 static void mlx5i_cleanup_tx(struct mlx5e_priv *priv)
292 {
293         struct mlx5i_priv *ipriv = priv->ppriv;
294
295         mlx5e_destroy_tis(priv->mdev, priv->tisn[0]);
296         mlx5i_destroy_underlay_qp(priv->mdev, &ipriv->qp);
297 }
298
299 static int mlx5i_create_flow_steering(struct mlx5e_priv *priv)
300 {
301         struct ttc_params ttc_params = {};
302         int tt, err;
303
304         priv->fs.ns = mlx5_get_flow_namespace(priv->mdev,
305                                                MLX5_FLOW_NAMESPACE_KERNEL);
306
307         if (!priv->fs.ns)
308                 return -EINVAL;
309
310         err = mlx5e_arfs_create_tables(priv);
311         if (err) {
312                 netdev_err(priv->netdev, "Failed to create arfs tables, err=%d\n",
313                            err);
314                 priv->netdev->hw_features &= ~NETIF_F_NTUPLE;
315         }
316
317         mlx5e_set_ttc_basic_params(priv, &ttc_params);
318         mlx5e_set_inner_ttc_ft_params(&ttc_params);
319         for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
320                 ttc_params.indir_tirn[tt] = priv->inner_indir_tir[tt].tirn;
321
322         err = mlx5e_create_inner_ttc_table(priv, &ttc_params, &priv->fs.inner_ttc);
323         if (err) {
324                 netdev_err(priv->netdev, "Failed to create inner ttc table, err=%d\n",
325                            err);
326                 goto err_destroy_arfs_tables;
327         }
328
329         mlx5e_set_ttc_ft_params(&ttc_params);
330         for (tt = 0; tt < MLX5E_NUM_INDIR_TIRS; tt++)
331                 ttc_params.indir_tirn[tt] = priv->indir_tir[tt].tirn;
332
333         err = mlx5e_create_ttc_table(priv, &ttc_params, &priv->fs.ttc);
334         if (err) {
335                 netdev_err(priv->netdev, "Failed to create ttc table, err=%d\n",
336                            err);
337                 goto err_destroy_inner_ttc_table;
338         }
339
340         return 0;
341
342 err_destroy_inner_ttc_table:
343         mlx5e_destroy_inner_ttc_table(priv, &priv->fs.inner_ttc);
344 err_destroy_arfs_tables:
345         mlx5e_arfs_destroy_tables(priv);
346
347         return err;
348 }
349
350 static void mlx5i_destroy_flow_steering(struct mlx5e_priv *priv)
351 {
352         mlx5e_destroy_ttc_table(priv, &priv->fs.ttc);
353         mlx5e_destroy_inner_ttc_table(priv, &priv->fs.inner_ttc);
354         mlx5e_arfs_destroy_tables(priv);
355 }
356
357 static int mlx5i_init_rx(struct mlx5e_priv *priv)
358 {
359         struct mlx5_core_dev *mdev = priv->mdev;
360         int err;
361
362         mlx5e_create_q_counters(priv);
363
364         err = mlx5e_open_drop_rq(priv, &priv->drop_rq);
365         if (err) {
366                 mlx5_core_err(mdev, "open drop rq failed, %d\n", err);
367                 goto err_destroy_q_counters;
368         }
369
370         err = mlx5e_create_indirect_rqt(priv);
371         if (err)
372                 goto err_close_drop_rq;
373
374         err = mlx5e_create_direct_rqts(priv);
375         if (err)
376                 goto err_destroy_indirect_rqts;
377
378         err = mlx5e_create_indirect_tirs(priv, true);
379         if (err)
380                 goto err_destroy_direct_rqts;
381
382         err = mlx5e_create_direct_tirs(priv);
383         if (err)
384                 goto err_destroy_indirect_tirs;
385
386         err = mlx5i_create_flow_steering(priv);
387         if (err)
388                 goto err_destroy_direct_tirs;
389
390         return 0;
391
392 err_destroy_direct_tirs:
393         mlx5e_destroy_direct_tirs(priv);
394 err_destroy_indirect_tirs:
395         mlx5e_destroy_indirect_tirs(priv, true);
396 err_destroy_direct_rqts:
397         mlx5e_destroy_direct_rqts(priv);
398 err_destroy_indirect_rqts:
399         mlx5e_destroy_rqt(priv, &priv->indir_rqt);
400 err_close_drop_rq:
401         mlx5e_close_drop_rq(&priv->drop_rq);
402 err_destroy_q_counters:
403         mlx5e_destroy_q_counters(priv);
404         return err;
405 }
406
407 static void mlx5i_cleanup_rx(struct mlx5e_priv *priv)
408 {
409         mlx5i_destroy_flow_steering(priv);
410         mlx5e_destroy_direct_tirs(priv);
411         mlx5e_destroy_indirect_tirs(priv, true);
412         mlx5e_destroy_direct_rqts(priv);
413         mlx5e_destroy_rqt(priv, &priv->indir_rqt);
414         mlx5e_close_drop_rq(&priv->drop_rq);
415         mlx5e_destroy_q_counters(priv);
416 }
417
418 static const struct mlx5e_profile mlx5i_nic_profile = {
419         .init              = mlx5i_init,
420         .cleanup           = mlx5i_cleanup,
421         .init_tx           = mlx5i_init_tx,
422         .cleanup_tx        = mlx5i_cleanup_tx,
423         .init_rx           = mlx5i_init_rx,
424         .cleanup_rx        = mlx5i_cleanup_rx,
425         .enable            = NULL, /* mlx5i_enable */
426         .disable           = NULL, /* mlx5i_disable */
427         .update_stats      = NULL, /* mlx5i_update_stats */
428         .max_nch           = mlx5e_get_max_num_channels,
429         .update_carrier    = NULL, /* no HW update in IB link */
430         .rx_handlers.handle_rx_cqe       = mlx5i_handle_rx_cqe,
431         .rx_handlers.handle_rx_cqe_mpwqe = NULL, /* Not supported */
432         .max_tc            = MLX5I_MAX_NUM_TC,
433 };
434
435 /* mlx5i netdev NDos */
436
437 static int mlx5i_change_mtu(struct net_device *netdev, int new_mtu)
438 {
439         struct mlx5e_priv *priv = mlx5i_epriv(netdev);
440         struct mlx5e_channels new_channels = {};
441         struct mlx5e_params *params;
442         int err = 0;
443
444         mutex_lock(&priv->state_lock);
445
446         params = &priv->channels.params;
447
448         if (!test_bit(MLX5E_STATE_OPENED, &priv->state)) {
449                 params->sw_mtu = new_mtu;
450                 netdev->mtu = params->sw_mtu;
451                 goto out;
452         }
453
454         new_channels.params = *params;
455         new_channels.params.sw_mtu = new_mtu;
456         err = mlx5e_open_channels(priv, &new_channels);
457         if (err)
458                 goto out;
459
460         mlx5e_switch_priv_channels(priv, &new_channels, NULL);
461         netdev->mtu = new_channels.params.sw_mtu;
462
463 out:
464         mutex_unlock(&priv->state_lock);
465         return err;
466 }
467
468 int mlx5i_dev_init(struct net_device *dev)
469 {
470         struct mlx5e_priv    *priv   = mlx5i_epriv(dev);
471         struct mlx5i_priv    *ipriv  = priv->ppriv;
472
473         /* Set dev address using underlay QP */
474         dev->dev_addr[1] = (ipriv->qp.qpn >> 16) & 0xff;
475         dev->dev_addr[2] = (ipriv->qp.qpn >>  8) & 0xff;
476         dev->dev_addr[3] = (ipriv->qp.qpn) & 0xff;
477
478         /* Add QPN to net-device mapping to HT */
479         mlx5i_pkey_add_qpn(dev ,ipriv->qp.qpn);
480
481         return 0;
482 }
483
484 int mlx5i_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
485 {
486         struct mlx5e_priv *priv = mlx5i_epriv(dev);
487
488         switch (cmd) {
489         case SIOCSHWTSTAMP:
490                 return mlx5e_hwstamp_set(priv, ifr);
491         case SIOCGHWTSTAMP:
492                 return mlx5e_hwstamp_get(priv, ifr);
493         default:
494                 return -EOPNOTSUPP;
495         }
496 }
497
498 void mlx5i_dev_cleanup(struct net_device *dev)
499 {
500         struct mlx5e_priv    *priv   = mlx5i_epriv(dev);
501         struct mlx5i_priv    *ipriv = priv->ppriv;
502
503         mlx5i_uninit_underlay_qp(priv);
504
505         /* Delete QPN to net-device mapping from HT */
506         mlx5i_pkey_del_qpn(dev, ipriv->qp.qpn);
507 }
508
509 static int mlx5i_open(struct net_device *netdev)
510 {
511         struct mlx5e_priv *epriv = mlx5i_epriv(netdev);
512         struct mlx5i_priv *ipriv = epriv->ppriv;
513         struct mlx5_core_dev *mdev = epriv->mdev;
514         int err;
515
516         mutex_lock(&epriv->state_lock);
517
518         set_bit(MLX5E_STATE_OPENED, &epriv->state);
519
520         err = mlx5i_init_underlay_qp(epriv);
521         if (err) {
522                 mlx5_core_warn(mdev, "prepare underlay qp state failed, %d\n", err);
523                 goto err_clear_state_opened_flag;
524         }
525
526         err = mlx5_fs_add_rx_underlay_qpn(mdev, ipriv->qp.qpn);
527         if (err) {
528                 mlx5_core_warn(mdev, "attach underlay qp to ft failed, %d\n", err);
529                 goto err_reset_qp;
530         }
531
532         err = mlx5e_open_channels(epriv, &epriv->channels);
533         if (err)
534                 goto err_remove_fs_underlay_qp;
535
536         mlx5e_refresh_tirs(epriv, false);
537         mlx5e_activate_priv_channels(epriv);
538
539         mutex_unlock(&epriv->state_lock);
540         return 0;
541
542 err_remove_fs_underlay_qp:
543         mlx5_fs_remove_rx_underlay_qpn(mdev, ipriv->qp.qpn);
544 err_reset_qp:
545         mlx5i_uninit_underlay_qp(epriv);
546 err_clear_state_opened_flag:
547         clear_bit(MLX5E_STATE_OPENED, &epriv->state);
548         mutex_unlock(&epriv->state_lock);
549         return err;
550 }
551
552 static int mlx5i_close(struct net_device *netdev)
553 {
554         struct mlx5e_priv *epriv = mlx5i_epriv(netdev);
555         struct mlx5i_priv *ipriv = epriv->ppriv;
556         struct mlx5_core_dev *mdev = epriv->mdev;
557
558         /* May already be CLOSED in case a previous configuration operation
559          * (e.g RX/TX queue size change) that involves close&open failed.
560          */
561         mutex_lock(&epriv->state_lock);
562
563         if (!test_bit(MLX5E_STATE_OPENED, &epriv->state))
564                 goto unlock;
565
566         clear_bit(MLX5E_STATE_OPENED, &epriv->state);
567
568         netif_carrier_off(epriv->netdev);
569         mlx5_fs_remove_rx_underlay_qpn(mdev, ipriv->qp.qpn);
570         mlx5i_uninit_underlay_qp(epriv);
571         mlx5e_deactivate_priv_channels(epriv);
572         mlx5e_close_channels(&epriv->channels);
573 unlock:
574         mutex_unlock(&epriv->state_lock);
575         return 0;
576 }
577
578 /* IPoIB RDMA netdev callbacks */
579 static int mlx5i_attach_mcast(struct net_device *netdev, struct ib_device *hca,
580                               union ib_gid *gid, u16 lid, int set_qkey,
581                               u32 qkey)
582 {
583         struct mlx5e_priv    *epriv = mlx5i_epriv(netdev);
584         struct mlx5_core_dev *mdev  = epriv->mdev;
585         struct mlx5i_priv    *ipriv = epriv->ppriv;
586         int err;
587
588         mlx5_core_dbg(mdev, "attaching QPN 0x%x, MGID %pI6\n", ipriv->qp.qpn, gid->raw);
589         err = mlx5_core_attach_mcg(mdev, gid, ipriv->qp.qpn);
590         if (err)
591                 mlx5_core_warn(mdev, "failed attaching QPN 0x%x, MGID %pI6\n",
592                                ipriv->qp.qpn, gid->raw);
593
594         if (set_qkey) {
595                 mlx5_core_dbg(mdev, "%s setting qkey 0x%x\n",
596                               netdev->name, qkey);
597                 ipriv->qkey = qkey;
598         }
599
600         return err;
601 }
602
603 static int mlx5i_detach_mcast(struct net_device *netdev, struct ib_device *hca,
604                               union ib_gid *gid, u16 lid)
605 {
606         struct mlx5e_priv    *epriv = mlx5i_epriv(netdev);
607         struct mlx5_core_dev *mdev  = epriv->mdev;
608         struct mlx5i_priv    *ipriv = epriv->ppriv;
609         int err;
610
611         mlx5_core_dbg(mdev, "detaching QPN 0x%x, MGID %pI6\n", ipriv->qp.qpn, gid->raw);
612
613         err = mlx5_core_detach_mcg(mdev, gid, ipriv->qp.qpn);
614         if (err)
615                 mlx5_core_dbg(mdev, "failed detaching QPN 0x%x, MGID %pI6\n",
616                               ipriv->qp.qpn, gid->raw);
617
618         return err;
619 }
620
621 static int mlx5i_xmit(struct net_device *dev, struct sk_buff *skb,
622                       struct ib_ah *address, u32 dqpn)
623 {
624         struct mlx5e_priv *epriv = mlx5i_epriv(dev);
625         struct mlx5e_txqsq *sq   = epriv->txq2sq[skb_get_queue_mapping(skb)];
626         struct mlx5_ib_ah *mah   = to_mah(address);
627         struct mlx5i_priv *ipriv = epriv->ppriv;
628
629         return mlx5i_sq_xmit(sq, skb, &mah->av, dqpn, ipriv->qkey);
630 }
631
632 static void mlx5i_set_pkey_index(struct net_device *netdev, int id)
633 {
634         struct mlx5i_priv *ipriv = netdev_priv(netdev);
635
636         ipriv->pkey_index = (u16)id;
637 }
638
639 static int mlx5i_check_required_hca_cap(struct mlx5_core_dev *mdev)
640 {
641         if (MLX5_CAP_GEN(mdev, port_type) != MLX5_CAP_PORT_TYPE_IB)
642                 return -EOPNOTSUPP;
643
644         if (!MLX5_CAP_GEN(mdev, ipoib_enhanced_offloads)) {
645                 mlx5_core_warn(mdev, "IPoIB enhanced offloads are not supported\n");
646                 return -EOPNOTSUPP;
647         }
648
649         return 0;
650 }
651
652 static void mlx5_rdma_netdev_free(struct net_device *netdev)
653 {
654         struct mlx5e_priv *priv = mlx5i_epriv(netdev);
655         struct mlx5i_priv *ipriv = priv->ppriv;
656         const struct mlx5e_profile *profile = priv->profile;
657
658         mlx5e_detach_netdev(priv);
659         profile->cleanup(priv);
660
661         if (!ipriv->sub_interface) {
662                 mlx5i_pkey_qpn_ht_cleanup(netdev);
663                 mlx5e_destroy_mdev_resources(priv->mdev);
664         }
665 }
666
667 static bool mlx5_is_sub_interface(struct mlx5_core_dev *mdev)
668 {
669         return mdev->mlx5e_res.pdn != 0;
670 }
671
672 static const struct mlx5e_profile *mlx5_get_profile(struct mlx5_core_dev *mdev)
673 {
674         if (mlx5_is_sub_interface(mdev))
675                 return mlx5i_pkey_get_profile();
676         return &mlx5i_nic_profile;
677 }
678
679 static int mlx5_rdma_setup_rn(struct ib_device *ibdev, u8 port_num,
680                               struct net_device *netdev, void *param)
681 {
682         struct mlx5_core_dev *mdev = (struct mlx5_core_dev *)param;
683         const struct mlx5e_profile *prof = mlx5_get_profile(mdev);
684         struct mlx5i_priv *ipriv;
685         struct mlx5e_priv *epriv;
686         struct rdma_netdev *rn;
687         int err;
688
689         ipriv = netdev_priv(netdev);
690         epriv = mlx5i_epriv(netdev);
691
692         ipriv->sub_interface = mlx5_is_sub_interface(mdev);
693         if (!ipriv->sub_interface) {
694                 err = mlx5i_pkey_qpn_ht_init(netdev);
695                 if (err) {
696                         mlx5_core_warn(mdev, "allocate qpn_to_netdev ht failed\n");
697                         return err;
698                 }
699
700                 /* This should only be called once per mdev */
701                 err = mlx5e_create_mdev_resources(mdev);
702                 if (err)
703                         goto destroy_ht;
704         }
705
706         prof->init(mdev, netdev, prof, ipriv);
707
708         mlx5e_attach_netdev(epriv);
709         netif_carrier_off(netdev);
710
711         /* set rdma_netdev func pointers */
712         rn = &ipriv->rn;
713         rn->hca  = ibdev;
714         rn->send = mlx5i_xmit;
715         rn->attach_mcast = mlx5i_attach_mcast;
716         rn->detach_mcast = mlx5i_detach_mcast;
717         rn->set_id = mlx5i_set_pkey_index;
718
719         netdev->priv_destructor = mlx5_rdma_netdev_free;
720         netdev->needs_free_netdev = 1;
721
722         return 0;
723
724 destroy_ht:
725         mlx5i_pkey_qpn_ht_cleanup(netdev);
726         return err;
727 }
728
729 int mlx5_rdma_rn_get_params(struct mlx5_core_dev *mdev,
730                             struct ib_device *device,
731                             struct rdma_netdev_alloc_params *params)
732 {
733         int nch;
734         int rc;
735
736         rc = mlx5i_check_required_hca_cap(mdev);
737         if (rc)
738                 return rc;
739
740         nch = mlx5_get_profile(mdev)->max_nch(mdev);
741
742         *params = (struct rdma_netdev_alloc_params){
743                 .sizeof_priv = sizeof(struct mlx5i_priv) +
744                                sizeof(struct mlx5e_priv),
745                 .txqs = nch * MLX5E_MAX_NUM_TC,
746                 .rxqs = nch,
747                 .param = mdev,
748                 .initialize_rdma_netdev = mlx5_rdma_setup_rn,
749         };
750
751         return 0;
752 }
753 EXPORT_SYMBOL(mlx5_rdma_rn_get_params);