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