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