xref: /openbmc/linux/drivers/net/ethernet/broadcom/bnxt/bnxt_ulp.c (revision b240b419db5d624ce7a5a397d6f62a1a686009ec)
1 /* Broadcom NetXtreme-C/E network driver.
2  *
3  * Copyright (c) 2016-2018 Broadcom Limited
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation.
8  */
9 
10 #include <linux/module.h>
11 
12 #include <linux/kernel.h>
13 #include <linux/errno.h>
14 #include <linux/interrupt.h>
15 #include <linux/pci.h>
16 #include <linux/netdevice.h>
17 #include <linux/rtnetlink.h>
18 #include <linux/bitops.h>
19 #include <linux/irq.h>
20 #include <asm/byteorder.h>
21 #include <linux/bitmap.h>
22 
23 #include "bnxt_hsi.h"
24 #include "bnxt.h"
25 #include "bnxt_ulp.h"
26 
27 static int bnxt_register_dev(struct bnxt_en_dev *edev, int ulp_id,
28 			     struct bnxt_ulp_ops *ulp_ops, void *handle)
29 {
30 	struct net_device *dev = edev->net;
31 	struct bnxt *bp = netdev_priv(dev);
32 	struct bnxt_ulp *ulp;
33 
34 	ASSERT_RTNL();
35 	if (ulp_id >= BNXT_MAX_ULP)
36 		return -EINVAL;
37 
38 	ulp = &edev->ulp_tbl[ulp_id];
39 	if (rcu_access_pointer(ulp->ulp_ops)) {
40 		netdev_err(bp->dev, "ulp id %d already registered\n", ulp_id);
41 		return -EBUSY;
42 	}
43 	if (ulp_id == BNXT_ROCE_ULP) {
44 		unsigned int max_stat_ctxs;
45 
46 		max_stat_ctxs = bnxt_get_max_func_stat_ctxs(bp);
47 		if (max_stat_ctxs <= BNXT_MIN_ROCE_STAT_CTXS ||
48 		    bp->num_stat_ctxs == max_stat_ctxs)
49 			return -ENOMEM;
50 		bnxt_set_max_func_stat_ctxs(bp, max_stat_ctxs -
51 					    BNXT_MIN_ROCE_STAT_CTXS);
52 	}
53 
54 	atomic_set(&ulp->ref_count, 0);
55 	ulp->handle = handle;
56 	rcu_assign_pointer(ulp->ulp_ops, ulp_ops);
57 
58 	if (ulp_id == BNXT_ROCE_ULP) {
59 		if (test_bit(BNXT_STATE_OPEN, &bp->state))
60 			bnxt_hwrm_vnic_cfg(bp, 0);
61 	}
62 
63 	return 0;
64 }
65 
66 static int bnxt_unregister_dev(struct bnxt_en_dev *edev, int ulp_id)
67 {
68 	struct net_device *dev = edev->net;
69 	struct bnxt *bp = netdev_priv(dev);
70 	struct bnxt_ulp *ulp;
71 	int i = 0;
72 
73 	ASSERT_RTNL();
74 	if (ulp_id >= BNXT_MAX_ULP)
75 		return -EINVAL;
76 
77 	ulp = &edev->ulp_tbl[ulp_id];
78 	if (!rcu_access_pointer(ulp->ulp_ops)) {
79 		netdev_err(bp->dev, "ulp id %d not registered\n", ulp_id);
80 		return -EINVAL;
81 	}
82 	if (ulp_id == BNXT_ROCE_ULP) {
83 		unsigned int max_stat_ctxs;
84 
85 		max_stat_ctxs = bnxt_get_max_func_stat_ctxs(bp);
86 		bnxt_set_max_func_stat_ctxs(bp, max_stat_ctxs + 1);
87 		if (ulp->msix_requested)
88 			edev->en_ops->bnxt_free_msix(edev, ulp_id);
89 	}
90 	if (ulp->max_async_event_id)
91 		bnxt_hwrm_func_rgtr_async_events(bp, NULL, 0);
92 
93 	RCU_INIT_POINTER(ulp->ulp_ops, NULL);
94 	synchronize_rcu();
95 	ulp->max_async_event_id = 0;
96 	ulp->async_events_bmap = NULL;
97 	while (atomic_read(&ulp->ref_count) != 0 && i < 10) {
98 		msleep(100);
99 		i++;
100 	}
101 	return 0;
102 }
103 
104 static void bnxt_fill_msix_vecs(struct bnxt *bp, struct bnxt_msix_entry *ent)
105 {
106 	struct bnxt_en_dev *edev = bp->edev;
107 	int num_msix, idx, i;
108 
109 	num_msix = edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested;
110 	idx = edev->ulp_tbl[BNXT_ROCE_ULP].msix_base;
111 	for (i = 0; i < num_msix; i++) {
112 		ent[i].vector = bp->irq_tbl[idx + i].vector;
113 		ent[i].ring_idx = idx + i;
114 		ent[i].db_offset = (idx + i) * 0x80;
115 	}
116 }
117 
118 static int bnxt_req_msix_vecs(struct bnxt_en_dev *edev, int ulp_id,
119 			      struct bnxt_msix_entry *ent, int num_msix)
120 {
121 	struct net_device *dev = edev->net;
122 	struct bnxt *bp = netdev_priv(dev);
123 	int max_idx, max_cp_rings;
124 	int avail_msix, idx;
125 	int rc = 0;
126 
127 	ASSERT_RTNL();
128 	if (ulp_id != BNXT_ROCE_ULP)
129 		return -EINVAL;
130 
131 	if (!(bp->flags & BNXT_FLAG_USING_MSIX))
132 		return -ENODEV;
133 
134 	if (edev->ulp_tbl[ulp_id].msix_requested)
135 		return -EAGAIN;
136 
137 	max_cp_rings = bnxt_get_max_func_cp_rings(bp);
138 	avail_msix = bnxt_get_avail_msix(bp, num_msix);
139 	if (!avail_msix)
140 		return -ENOMEM;
141 	if (avail_msix > num_msix)
142 		avail_msix = num_msix;
143 
144 	if (bp->flags & BNXT_FLAG_NEW_RM) {
145 		idx = bp->cp_nr_rings;
146 	} else {
147 		max_idx = min_t(int, bp->total_irqs, max_cp_rings);
148 		idx = max_idx - avail_msix;
149 	}
150 	edev->ulp_tbl[ulp_id].msix_base = idx;
151 	edev->ulp_tbl[ulp_id].msix_requested = avail_msix;
152 	if (bp->total_irqs < (idx + avail_msix)) {
153 		if (netif_running(dev)) {
154 			bnxt_close_nic(bp, true, false);
155 			rc = bnxt_open_nic(bp, true, false);
156 		} else {
157 			rc = bnxt_reserve_rings(bp);
158 		}
159 	}
160 	if (rc) {
161 		edev->ulp_tbl[ulp_id].msix_requested = 0;
162 		return -EAGAIN;
163 	}
164 
165 	if (bp->flags & BNXT_FLAG_NEW_RM) {
166 		struct bnxt_hw_resc *hw_resc = &bp->hw_resc;
167 
168 		avail_msix = hw_resc->resv_cp_rings - bp->cp_nr_rings;
169 		edev->ulp_tbl[ulp_id].msix_requested = avail_msix;
170 	}
171 	bnxt_fill_msix_vecs(bp, ent);
172 	bnxt_set_max_func_irqs(bp, bnxt_get_max_func_irqs(bp) - avail_msix);
173 	bnxt_set_max_func_cp_rings(bp, max_cp_rings - avail_msix);
174 	edev->flags |= BNXT_EN_FLAG_MSIX_REQUESTED;
175 	return avail_msix;
176 }
177 
178 static int bnxt_free_msix_vecs(struct bnxt_en_dev *edev, int ulp_id)
179 {
180 	struct net_device *dev = edev->net;
181 	struct bnxt *bp = netdev_priv(dev);
182 	int max_cp_rings, msix_requested;
183 
184 	ASSERT_RTNL();
185 	if (ulp_id != BNXT_ROCE_ULP)
186 		return -EINVAL;
187 
188 	if (!(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED))
189 		return 0;
190 
191 	max_cp_rings = bnxt_get_max_func_cp_rings(bp);
192 	msix_requested = edev->ulp_tbl[ulp_id].msix_requested;
193 	bnxt_set_max_func_cp_rings(bp, max_cp_rings + msix_requested);
194 	edev->ulp_tbl[ulp_id].msix_requested = 0;
195 	bnxt_set_max_func_irqs(bp, bnxt_get_max_func_irqs(bp) + msix_requested);
196 	edev->flags &= ~BNXT_EN_FLAG_MSIX_REQUESTED;
197 	if (netif_running(dev)) {
198 		bnxt_close_nic(bp, true, false);
199 		bnxt_open_nic(bp, true, false);
200 	}
201 	return 0;
202 }
203 
204 int bnxt_get_ulp_msix_num(struct bnxt *bp)
205 {
206 	if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
207 		struct bnxt_en_dev *edev = bp->edev;
208 
209 		return edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested;
210 	}
211 	return 0;
212 }
213 
214 int bnxt_get_ulp_msix_base(struct bnxt *bp)
215 {
216 	if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
217 		struct bnxt_en_dev *edev = bp->edev;
218 
219 		if (edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested)
220 			return edev->ulp_tbl[BNXT_ROCE_ULP].msix_base;
221 	}
222 	return 0;
223 }
224 
225 void bnxt_subtract_ulp_resources(struct bnxt *bp, int ulp_id)
226 {
227 	ASSERT_RTNL();
228 	if (bnxt_ulp_registered(bp->edev, ulp_id)) {
229 		struct bnxt_en_dev *edev = bp->edev;
230 		unsigned int msix_req, max;
231 
232 		msix_req = edev->ulp_tbl[ulp_id].msix_requested;
233 		max = bnxt_get_max_func_cp_rings(bp);
234 		bnxt_set_max_func_cp_rings(bp, max - msix_req);
235 		max = bnxt_get_max_func_stat_ctxs(bp);
236 		bnxt_set_max_func_stat_ctxs(bp, max - 1);
237 	}
238 }
239 
240 static int bnxt_send_msg(struct bnxt_en_dev *edev, int ulp_id,
241 			 struct bnxt_fw_msg *fw_msg)
242 {
243 	struct net_device *dev = edev->net;
244 	struct bnxt *bp = netdev_priv(dev);
245 	struct input *req;
246 	int rc;
247 
248 	mutex_lock(&bp->hwrm_cmd_lock);
249 	req = fw_msg->msg;
250 	req->resp_addr = cpu_to_le64(bp->hwrm_cmd_resp_dma_addr);
251 	rc = _hwrm_send_message(bp, fw_msg->msg, fw_msg->msg_len,
252 				fw_msg->timeout);
253 	if (!rc) {
254 		struct output *resp = bp->hwrm_cmd_resp_addr;
255 		u32 len = le16_to_cpu(resp->resp_len);
256 
257 		if (fw_msg->resp_max_len < len)
258 			len = fw_msg->resp_max_len;
259 
260 		memcpy(fw_msg->resp, resp, len);
261 	}
262 	mutex_unlock(&bp->hwrm_cmd_lock);
263 	return rc;
264 }
265 
266 static void bnxt_ulp_get(struct bnxt_ulp *ulp)
267 {
268 	atomic_inc(&ulp->ref_count);
269 }
270 
271 static void bnxt_ulp_put(struct bnxt_ulp *ulp)
272 {
273 	atomic_dec(&ulp->ref_count);
274 }
275 
276 void bnxt_ulp_stop(struct bnxt *bp)
277 {
278 	struct bnxt_en_dev *edev = bp->edev;
279 	struct bnxt_ulp_ops *ops;
280 	int i;
281 
282 	if (!edev)
283 		return;
284 
285 	for (i = 0; i < BNXT_MAX_ULP; i++) {
286 		struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
287 
288 		ops = rtnl_dereference(ulp->ulp_ops);
289 		if (!ops || !ops->ulp_stop)
290 			continue;
291 		ops->ulp_stop(ulp->handle);
292 	}
293 }
294 
295 void bnxt_ulp_start(struct bnxt *bp)
296 {
297 	struct bnxt_en_dev *edev = bp->edev;
298 	struct bnxt_ulp_ops *ops;
299 	int i;
300 
301 	if (!edev)
302 		return;
303 
304 	for (i = 0; i < BNXT_MAX_ULP; i++) {
305 		struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
306 
307 		ops = rtnl_dereference(ulp->ulp_ops);
308 		if (!ops || !ops->ulp_start)
309 			continue;
310 		ops->ulp_start(ulp->handle);
311 	}
312 }
313 
314 void bnxt_ulp_sriov_cfg(struct bnxt *bp, int num_vfs)
315 {
316 	struct bnxt_en_dev *edev = bp->edev;
317 	struct bnxt_ulp_ops *ops;
318 	int i;
319 
320 	if (!edev)
321 		return;
322 
323 	for (i = 0; i < BNXT_MAX_ULP; i++) {
324 		struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
325 
326 		rcu_read_lock();
327 		ops = rcu_dereference(ulp->ulp_ops);
328 		if (!ops || !ops->ulp_sriov_config) {
329 			rcu_read_unlock();
330 			continue;
331 		}
332 		bnxt_ulp_get(ulp);
333 		rcu_read_unlock();
334 		ops->ulp_sriov_config(ulp->handle, num_vfs);
335 		bnxt_ulp_put(ulp);
336 	}
337 }
338 
339 void bnxt_ulp_shutdown(struct bnxt *bp)
340 {
341 	struct bnxt_en_dev *edev = bp->edev;
342 	struct bnxt_ulp_ops *ops;
343 	int i;
344 
345 	if (!edev)
346 		return;
347 
348 	for (i = 0; i < BNXT_MAX_ULP; i++) {
349 		struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
350 
351 		ops = rtnl_dereference(ulp->ulp_ops);
352 		if (!ops || !ops->ulp_shutdown)
353 			continue;
354 		ops->ulp_shutdown(ulp->handle);
355 	}
356 }
357 
358 void bnxt_ulp_irq_stop(struct bnxt *bp)
359 {
360 	struct bnxt_en_dev *edev = bp->edev;
361 	struct bnxt_ulp_ops *ops;
362 
363 	if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED))
364 		return;
365 
366 	if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
367 		struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP];
368 
369 		if (!ulp->msix_requested)
370 			return;
371 
372 		ops = rtnl_dereference(ulp->ulp_ops);
373 		if (!ops || !ops->ulp_irq_stop)
374 			return;
375 		ops->ulp_irq_stop(ulp->handle);
376 	}
377 }
378 
379 void bnxt_ulp_irq_restart(struct bnxt *bp, int err)
380 {
381 	struct bnxt_en_dev *edev = bp->edev;
382 	struct bnxt_ulp_ops *ops;
383 
384 	if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED))
385 		return;
386 
387 	if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
388 		struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP];
389 		struct bnxt_msix_entry *ent = NULL;
390 
391 		if (!ulp->msix_requested)
392 			return;
393 
394 		ops = rtnl_dereference(ulp->ulp_ops);
395 		if (!ops || !ops->ulp_irq_restart)
396 			return;
397 
398 		if (!err) {
399 			ent = kcalloc(ulp->msix_requested, sizeof(*ent),
400 				      GFP_KERNEL);
401 			if (!ent)
402 				return;
403 			bnxt_fill_msix_vecs(bp, ent);
404 		}
405 		ops->ulp_irq_restart(ulp->handle, ent);
406 		kfree(ent);
407 	}
408 }
409 
410 void bnxt_ulp_async_events(struct bnxt *bp, struct hwrm_async_event_cmpl *cmpl)
411 {
412 	u16 event_id = le16_to_cpu(cmpl->event_id);
413 	struct bnxt_en_dev *edev = bp->edev;
414 	struct bnxt_ulp_ops *ops;
415 	int i;
416 
417 	if (!edev)
418 		return;
419 
420 	rcu_read_lock();
421 	for (i = 0; i < BNXT_MAX_ULP; i++) {
422 		struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
423 
424 		ops = rcu_dereference(ulp->ulp_ops);
425 		if (!ops || !ops->ulp_async_notifier)
426 			continue;
427 		if (!ulp->async_events_bmap ||
428 		    event_id > ulp->max_async_event_id)
429 			continue;
430 
431 		/* Read max_async_event_id first before testing the bitmap. */
432 		smp_rmb();
433 		if (test_bit(event_id, ulp->async_events_bmap))
434 			ops->ulp_async_notifier(ulp->handle, cmpl);
435 	}
436 	rcu_read_unlock();
437 }
438 
439 static int bnxt_register_async_events(struct bnxt_en_dev *edev, int ulp_id,
440 				      unsigned long *events_bmap, u16 max_id)
441 {
442 	struct net_device *dev = edev->net;
443 	struct bnxt *bp = netdev_priv(dev);
444 	struct bnxt_ulp *ulp;
445 
446 	if (ulp_id >= BNXT_MAX_ULP)
447 		return -EINVAL;
448 
449 	ulp = &edev->ulp_tbl[ulp_id];
450 	ulp->async_events_bmap = events_bmap;
451 	/* Make sure bnxt_ulp_async_events() sees this order */
452 	smp_wmb();
453 	ulp->max_async_event_id = max_id;
454 	bnxt_hwrm_func_rgtr_async_events(bp, events_bmap, max_id + 1);
455 	return 0;
456 }
457 
458 static const struct bnxt_en_ops bnxt_en_ops_tbl = {
459 	.bnxt_register_device	= bnxt_register_dev,
460 	.bnxt_unregister_device	= bnxt_unregister_dev,
461 	.bnxt_request_msix	= bnxt_req_msix_vecs,
462 	.bnxt_free_msix		= bnxt_free_msix_vecs,
463 	.bnxt_send_fw_msg	= bnxt_send_msg,
464 	.bnxt_register_fw_async_events	= bnxt_register_async_events,
465 };
466 
467 struct bnxt_en_dev *bnxt_ulp_probe(struct net_device *dev)
468 {
469 	struct bnxt *bp = netdev_priv(dev);
470 	struct bnxt_en_dev *edev;
471 
472 	edev = bp->edev;
473 	if (!edev) {
474 		edev = kzalloc(sizeof(*edev), GFP_KERNEL);
475 		if (!edev)
476 			return ERR_PTR(-ENOMEM);
477 		edev->en_ops = &bnxt_en_ops_tbl;
478 		if (bp->flags & BNXT_FLAG_ROCEV1_CAP)
479 			edev->flags |= BNXT_EN_FLAG_ROCEV1_CAP;
480 		if (bp->flags & BNXT_FLAG_ROCEV2_CAP)
481 			edev->flags |= BNXT_EN_FLAG_ROCEV2_CAP;
482 		edev->net = dev;
483 		edev->pdev = bp->pdev;
484 		bp->edev = edev;
485 	}
486 	return bp->edev;
487 }
488