xref: /openbmc/linux/drivers/net/ethernet/chelsio/cxgb4/cxgb4_uld.c (revision e983940270f10fe8551baf0098be76ea478294a3)
1 /*
2  * cxgb4_uld.c:Chelsio Upper Layer Driver Interface for T4/T5/T6 SGE management
3  *
4  * Copyright (c) 2016 Chelsio Communications, Inc. All rights reserved.
5  *
6  * This software is available to you under a choice of one of two
7  * licenses.  You may choose to be licensed under the terms of the GNU
8  * General Public License (GPL) Version 2, available from the file
9  * COPYING in the main directory of this source tree, or the
10  * OpenIB.org BSD license below:
11  *
12  *     Redistribution and use in source and binary forms, with or
13  *     without modification, are permitted provided that the following
14  *     conditions are met:
15  *
16  *      - Redistributions of source code must retain the above
17  *        copyright notice, this list of conditions and the following
18  *        disclaimer.
19  *
20  *      - Redistributions in binary form must reproduce the above
21  *        copyright notice, this list of conditions and the following
22  *        disclaimer in the documentation and/or other materials
23  *        provided with the distribution.
24  *
25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32  * SOFTWARE.
33  *
34  *  Written by: Atul Gupta (atul.gupta@chelsio.com)
35  *  Written by: Hariprasad Shenai (hariprasad@chelsio.com)
36  */
37 
38 #include <linux/kernel.h>
39 #include <linux/module.h>
40 #include <linux/errno.h>
41 #include <linux/types.h>
42 #include <linux/debugfs.h>
43 #include <linux/export.h>
44 #include <linux/list.h>
45 #include <linux/skbuff.h>
46 #include <linux/pci.h>
47 
48 #include "cxgb4.h"
49 #include "cxgb4_uld.h"
50 #include "t4_regs.h"
51 #include "t4fw_api.h"
52 #include "t4_msg.h"
53 
54 #define for_each_uldrxq(m, i) for (i = 0; i < ((m)->nrxq + (m)->nciq); i++)
55 
56 static int get_msix_idx_from_bmap(struct adapter *adap)
57 {
58 	struct uld_msix_bmap *bmap = &adap->msix_bmap_ulds;
59 	unsigned long flags;
60 	unsigned int msix_idx;
61 
62 	spin_lock_irqsave(&bmap->lock, flags);
63 	msix_idx = find_first_zero_bit(bmap->msix_bmap, bmap->mapsize);
64 	if (msix_idx < bmap->mapsize) {
65 		__set_bit(msix_idx, bmap->msix_bmap);
66 	} else {
67 		spin_unlock_irqrestore(&bmap->lock, flags);
68 		return -ENOSPC;
69 	}
70 
71 	spin_unlock_irqrestore(&bmap->lock, flags);
72 	return msix_idx;
73 }
74 
75 static void free_msix_idx_in_bmap(struct adapter *adap, unsigned int msix_idx)
76 {
77 	struct uld_msix_bmap *bmap = &adap->msix_bmap_ulds;
78 	unsigned long flags;
79 
80 	spin_lock_irqsave(&bmap->lock, flags);
81 	 __clear_bit(msix_idx, bmap->msix_bmap);
82 	spin_unlock_irqrestore(&bmap->lock, flags);
83 }
84 
85 /* Flush the aggregated lro sessions */
86 static void uldrx_flush_handler(struct sge_rspq *q)
87 {
88 	struct adapter *adap = q->adap;
89 
90 	if (adap->uld[q->uld].lro_flush)
91 		adap->uld[q->uld].lro_flush(&q->lro_mgr);
92 }
93 
94 /**
95  *	uldrx_handler - response queue handler for ULD queues
96  *	@q: the response queue that received the packet
97  *	@rsp: the response queue descriptor holding the offload message
98  *	@gl: the gather list of packet fragments
99  *
100  *	Deliver an ingress offload packet to a ULD.  All processing is done by
101  *	the ULD, we just maintain statistics.
102  */
103 static int uldrx_handler(struct sge_rspq *q, const __be64 *rsp,
104 			 const struct pkt_gl *gl)
105 {
106 	struct adapter *adap = q->adap;
107 	struct sge_ofld_rxq *rxq = container_of(q, struct sge_ofld_rxq, rspq);
108 	int ret;
109 
110 	/* FW can send CPLs encapsulated in a CPL_FW4_MSG */
111 	if (((const struct rss_header *)rsp)->opcode == CPL_FW4_MSG &&
112 	    ((const struct cpl_fw4_msg *)(rsp + 1))->type == FW_TYPE_RSSCPL)
113 		rsp += 2;
114 
115 	if (q->flush_handler)
116 		ret = adap->uld[q->uld].lro_rx_handler(adap->uld[q->uld].handle,
117 				rsp, gl, &q->lro_mgr,
118 				&q->napi);
119 	else
120 		ret = adap->uld[q->uld].rx_handler(adap->uld[q->uld].handle,
121 				rsp, gl);
122 
123 	if (ret) {
124 		rxq->stats.nomem++;
125 		return -1;
126 	}
127 
128 	if (!gl)
129 		rxq->stats.imm++;
130 	else if (gl == CXGB4_MSG_AN)
131 		rxq->stats.an++;
132 	else
133 		rxq->stats.pkts++;
134 	return 0;
135 }
136 
137 static int alloc_uld_rxqs(struct adapter *adap,
138 			  struct sge_uld_rxq_info *rxq_info,
139 			  unsigned int nq, unsigned int offset, bool lro)
140 {
141 	struct sge *s = &adap->sge;
142 	struct sge_ofld_rxq *q = rxq_info->uldrxq + offset;
143 	unsigned short *ids = rxq_info->rspq_id + offset;
144 	unsigned int per_chan = nq / adap->params.nports;
145 	unsigned int bmap_idx = 0;
146 	int i, err, msi_idx;
147 
148 	if (adap->flags & USING_MSIX)
149 		msi_idx = 1;
150 	else
151 		msi_idx = -((int)s->intrq.abs_id + 1);
152 
153 	for (i = 0; i < nq; i++, q++) {
154 		if (msi_idx >= 0) {
155 			bmap_idx = get_msix_idx_from_bmap(adap);
156 			msi_idx = adap->msix_info_ulds[bmap_idx].idx;
157 		}
158 		err = t4_sge_alloc_rxq(adap, &q->rspq, false,
159 				       adap->port[i / per_chan],
160 				       msi_idx,
161 				       q->fl.size ? &q->fl : NULL,
162 				       uldrx_handler,
163 				       lro ? uldrx_flush_handler : NULL,
164 				       0);
165 		if (err)
166 			goto freeout;
167 		if (msi_idx >= 0)
168 			rxq_info->msix_tbl[i + offset] = bmap_idx;
169 		memset(&q->stats, 0, sizeof(q->stats));
170 		if (ids)
171 			ids[i] = q->rspq.abs_id;
172 	}
173 	return 0;
174 freeout:
175 	q = rxq_info->uldrxq + offset;
176 	for ( ; i; i--, q++) {
177 		if (q->rspq.desc)
178 			free_rspq_fl(adap, &q->rspq,
179 				     q->fl.size ? &q->fl : NULL);
180 	}
181 
182 	/* We need to free rxq also in case of ciq allocation failure */
183 	if (offset) {
184 		q = rxq_info->uldrxq + offset;
185 		for ( ; i; i--, q++) {
186 			if (q->rspq.desc)
187 				free_rspq_fl(adap, &q->rspq,
188 					     q->fl.size ? &q->fl : NULL);
189 		}
190 	}
191 	return err;
192 }
193 
194 static int
195 setup_sge_queues_uld(struct adapter *adap, unsigned int uld_type, bool lro)
196 {
197 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
198 	int i, ret = 0;
199 
200 	if (adap->flags & USING_MSIX) {
201 		rxq_info->msix_tbl = kcalloc((rxq_info->nrxq + rxq_info->nciq),
202 					     sizeof(unsigned short),
203 					     GFP_KERNEL);
204 		if (!rxq_info->msix_tbl)
205 			return -ENOMEM;
206 	}
207 
208 	ret = !(!alloc_uld_rxqs(adap, rxq_info, rxq_info->nrxq, 0, lro) &&
209 		 !alloc_uld_rxqs(adap, rxq_info, rxq_info->nciq,
210 				 rxq_info->nrxq, lro));
211 
212 	/* Tell uP to route control queue completions to rdma rspq */
213 	if (adap->flags & FULL_INIT_DONE &&
214 	    !ret && uld_type == CXGB4_ULD_RDMA) {
215 		struct sge *s = &adap->sge;
216 		unsigned int cmplqid;
217 		u32 param, cmdop;
218 
219 		cmdop = FW_PARAMS_PARAM_DMAQ_EQ_CMPLIQID_CTRL;
220 		for_each_port(adap, i) {
221 			cmplqid = rxq_info->uldrxq[i].rspq.cntxt_id;
222 			param = (FW_PARAMS_MNEM_V(FW_PARAMS_MNEM_DMAQ) |
223 				 FW_PARAMS_PARAM_X_V(cmdop) |
224 				 FW_PARAMS_PARAM_YZ_V(s->ctrlq[i].q.cntxt_id));
225 			ret = t4_set_params(adap, adap->mbox, adap->pf,
226 					    0, 1, &param, &cmplqid);
227 		}
228 	}
229 	return ret;
230 }
231 
232 static void t4_free_uld_rxqs(struct adapter *adap, int n,
233 			     struct sge_ofld_rxq *q)
234 {
235 	for ( ; n; n--, q++) {
236 		if (q->rspq.desc)
237 			free_rspq_fl(adap, &q->rspq,
238 				     q->fl.size ? &q->fl : NULL);
239 	}
240 }
241 
242 static void free_sge_queues_uld(struct adapter *adap, unsigned int uld_type)
243 {
244 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
245 
246 	if (adap->flags & FULL_INIT_DONE && uld_type == CXGB4_ULD_RDMA) {
247 		struct sge *s = &adap->sge;
248 		u32 param, cmdop, cmplqid = 0;
249 		int i;
250 
251 		cmdop = FW_PARAMS_PARAM_DMAQ_EQ_CMPLIQID_CTRL;
252 		for_each_port(adap, i) {
253 			param = (FW_PARAMS_MNEM_V(FW_PARAMS_MNEM_DMAQ) |
254 				 FW_PARAMS_PARAM_X_V(cmdop) |
255 				 FW_PARAMS_PARAM_YZ_V(s->ctrlq[i].q.cntxt_id));
256 			t4_set_params(adap, adap->mbox, adap->pf,
257 				      0, 1, &param, &cmplqid);
258 		}
259 	}
260 
261 	if (rxq_info->nciq)
262 		t4_free_uld_rxqs(adap, rxq_info->nciq,
263 				 rxq_info->uldrxq + rxq_info->nrxq);
264 	t4_free_uld_rxqs(adap, rxq_info->nrxq, rxq_info->uldrxq);
265 	if (adap->flags & USING_MSIX)
266 		kfree(rxq_info->msix_tbl);
267 }
268 
269 static int cfg_queues_uld(struct adapter *adap, unsigned int uld_type,
270 			  const struct cxgb4_uld_info *uld_info)
271 {
272 	struct sge *s = &adap->sge;
273 	struct sge_uld_rxq_info *rxq_info;
274 	int i, nrxq, ciq_size;
275 
276 	rxq_info = kzalloc(sizeof(*rxq_info), GFP_KERNEL);
277 	if (!rxq_info)
278 		return -ENOMEM;
279 
280 	if (adap->flags & USING_MSIX && uld_info->nrxq > s->nqs_per_uld) {
281 		i = s->nqs_per_uld;
282 		rxq_info->nrxq = roundup(i, adap->params.nports);
283 	} else {
284 		i = min_t(int, uld_info->nrxq,
285 			  num_online_cpus());
286 		rxq_info->nrxq = roundup(i, adap->params.nports);
287 	}
288 	if (!uld_info->ciq) {
289 		rxq_info->nciq = 0;
290 	} else  {
291 		if (adap->flags & USING_MSIX)
292 			rxq_info->nciq = min_t(int, s->nqs_per_uld,
293 					       num_online_cpus());
294 		else
295 			rxq_info->nciq = min_t(int, MAX_OFLD_QSETS,
296 					       num_online_cpus());
297 		rxq_info->nciq = ((rxq_info->nciq / adap->params.nports) *
298 				  adap->params.nports);
299 		rxq_info->nciq = max_t(int, rxq_info->nciq,
300 				       adap->params.nports);
301 	}
302 
303 	nrxq = rxq_info->nrxq + rxq_info->nciq; /* total rxq's */
304 	rxq_info->uldrxq = kcalloc(nrxq, sizeof(struct sge_ofld_rxq),
305 				   GFP_KERNEL);
306 	if (!rxq_info->uldrxq) {
307 		kfree(rxq_info);
308 		return -ENOMEM;
309 	}
310 
311 	rxq_info->rspq_id = kcalloc(nrxq, sizeof(unsigned short), GFP_KERNEL);
312 	if (!rxq_info->rspq_id) {
313 		kfree(rxq_info->uldrxq);
314 		kfree(rxq_info);
315 		return -ENOMEM;
316 	}
317 
318 	for (i = 0; i < rxq_info->nrxq; i++) {
319 		struct sge_ofld_rxq *r = &rxq_info->uldrxq[i];
320 
321 		init_rspq(adap, &r->rspq, 5, 1, uld_info->rxq_size, 64);
322 		r->rspq.uld = uld_type;
323 		r->fl.size = 72;
324 	}
325 
326 	ciq_size = 64 + adap->vres.cq.size + adap->tids.nftids;
327 	if (ciq_size > SGE_MAX_IQ_SIZE) {
328 		dev_warn(adap->pdev_dev, "CIQ size too small for available IQs\n");
329 		ciq_size = SGE_MAX_IQ_SIZE;
330 	}
331 
332 	for (i = rxq_info->nrxq; i < nrxq; i++) {
333 		struct sge_ofld_rxq *r = &rxq_info->uldrxq[i];
334 
335 		init_rspq(adap, &r->rspq, 5, 1, ciq_size, 64);
336 		r->rspq.uld = uld_type;
337 	}
338 
339 	memcpy(rxq_info->name, uld_info->name, IFNAMSIZ);
340 	adap->sge.uld_rxq_info[uld_type] = rxq_info;
341 
342 	return 0;
343 }
344 
345 static void free_queues_uld(struct adapter *adap, unsigned int uld_type)
346 {
347 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
348 
349 	kfree(rxq_info->rspq_id);
350 	kfree(rxq_info->uldrxq);
351 	kfree(rxq_info);
352 }
353 
354 static int
355 request_msix_queue_irqs_uld(struct adapter *adap, unsigned int uld_type)
356 {
357 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
358 	int err = 0;
359 	unsigned int idx, bmap_idx;
360 
361 	for_each_uldrxq(rxq_info, idx) {
362 		bmap_idx = rxq_info->msix_tbl[idx];
363 		err = request_irq(adap->msix_info_ulds[bmap_idx].vec,
364 				  t4_sge_intr_msix, 0,
365 				  adap->msix_info_ulds[bmap_idx].desc,
366 				  &rxq_info->uldrxq[idx].rspq);
367 		if (err)
368 			goto unwind;
369 	}
370 	return 0;
371 unwind:
372 	while (idx-- > 0) {
373 		bmap_idx = rxq_info->msix_tbl[idx];
374 		free_msix_idx_in_bmap(adap, bmap_idx);
375 		free_irq(adap->msix_info_ulds[bmap_idx].vec,
376 			 &rxq_info->uldrxq[idx].rspq);
377 	}
378 	return err;
379 }
380 
381 static void
382 free_msix_queue_irqs_uld(struct adapter *adap, unsigned int uld_type)
383 {
384 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
385 	unsigned int idx, bmap_idx;
386 
387 	for_each_uldrxq(rxq_info, idx) {
388 		bmap_idx = rxq_info->msix_tbl[idx];
389 
390 		free_msix_idx_in_bmap(adap, bmap_idx);
391 		free_irq(adap->msix_info_ulds[bmap_idx].vec,
392 			 &rxq_info->uldrxq[idx].rspq);
393 	}
394 }
395 
396 static void name_msix_vecs_uld(struct adapter *adap, unsigned int uld_type)
397 {
398 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
399 	int n = sizeof(adap->msix_info_ulds[0].desc);
400 	unsigned int idx, bmap_idx;
401 
402 	for_each_uldrxq(rxq_info, idx) {
403 		bmap_idx = rxq_info->msix_tbl[idx];
404 
405 		snprintf(adap->msix_info_ulds[bmap_idx].desc, n, "%s-%s%d",
406 			 adap->port[0]->name, rxq_info->name, idx);
407 	}
408 }
409 
410 static void enable_rx(struct adapter *adap, struct sge_rspq *q)
411 {
412 	if (!q)
413 		return;
414 
415 	if (q->handler) {
416 		cxgb_busy_poll_init_lock(q);
417 		napi_enable(&q->napi);
418 	}
419 	/* 0-increment GTS to start the timer and enable interrupts */
420 	t4_write_reg(adap, MYPF_REG(SGE_PF_GTS_A),
421 		     SEINTARM_V(q->intr_params) |
422 		     INGRESSQID_V(q->cntxt_id));
423 }
424 
425 static void quiesce_rx(struct adapter *adap, struct sge_rspq *q)
426 {
427 	if (q && q->handler) {
428 		napi_disable(&q->napi);
429 		local_bh_disable();
430 		while (!cxgb_poll_lock_napi(q))
431 			mdelay(1);
432 		local_bh_enable();
433 	}
434 }
435 
436 static void enable_rx_uld(struct adapter *adap, unsigned int uld_type)
437 {
438 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
439 	int idx;
440 
441 	for_each_uldrxq(rxq_info, idx)
442 		enable_rx(adap, &rxq_info->uldrxq[idx].rspq);
443 }
444 
445 static void quiesce_rx_uld(struct adapter *adap, unsigned int uld_type)
446 {
447 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
448 	int idx;
449 
450 	for_each_uldrxq(rxq_info, idx)
451 		quiesce_rx(adap, &rxq_info->uldrxq[idx].rspq);
452 }
453 
454 static void uld_queue_init(struct adapter *adap, unsigned int uld_type,
455 			   struct cxgb4_lld_info *lli)
456 {
457 	struct sge_uld_rxq_info *rxq_info = adap->sge.uld_rxq_info[uld_type];
458 
459 	lli->rxq_ids = rxq_info->rspq_id;
460 	lli->nrxq = rxq_info->nrxq;
461 	lli->ciq_ids = rxq_info->rspq_id + rxq_info->nrxq;
462 	lli->nciq = rxq_info->nciq;
463 }
464 
465 int t4_uld_mem_alloc(struct adapter *adap)
466 {
467 	struct sge *s = &adap->sge;
468 
469 	adap->uld = kcalloc(CXGB4_ULD_MAX, sizeof(*adap->uld), GFP_KERNEL);
470 	if (!adap->uld)
471 		return -ENOMEM;
472 
473 	s->uld_rxq_info = kzalloc(CXGB4_ULD_MAX *
474 				  sizeof(struct sge_uld_rxq_info *),
475 				  GFP_KERNEL);
476 	if (!s->uld_rxq_info)
477 		goto err_uld;
478 
479 	return 0;
480 err_uld:
481 	kfree(adap->uld);
482 	return -ENOMEM;
483 }
484 
485 void t4_uld_mem_free(struct adapter *adap)
486 {
487 	struct sge *s = &adap->sge;
488 
489 	kfree(s->uld_rxq_info);
490 	kfree(adap->uld);
491 }
492 
493 void t4_uld_clean_up(struct adapter *adap)
494 {
495 	struct sge_uld_rxq_info *rxq_info;
496 	unsigned int i;
497 
498 	if (!adap->uld)
499 		return;
500 	for (i = 0; i < CXGB4_ULD_MAX; i++) {
501 		if (!adap->uld[i].handle)
502 			continue;
503 		rxq_info = adap->sge.uld_rxq_info[i];
504 		if (adap->flags & FULL_INIT_DONE)
505 			quiesce_rx_uld(adap, i);
506 		if (adap->flags & USING_MSIX)
507 			free_msix_queue_irqs_uld(adap, i);
508 		free_sge_queues_uld(adap, i);
509 		free_queues_uld(adap, i);
510 	}
511 }
512 
513 static void uld_init(struct adapter *adap, struct cxgb4_lld_info *lld)
514 {
515 	int i;
516 
517 	lld->pdev = adap->pdev;
518 	lld->pf = adap->pf;
519 	lld->l2t = adap->l2t;
520 	lld->tids = &adap->tids;
521 	lld->ports = adap->port;
522 	lld->vr = &adap->vres;
523 	lld->mtus = adap->params.mtus;
524 	lld->ntxq = adap->sge.ofldqsets;
525 	lld->nchan = adap->params.nports;
526 	lld->nports = adap->params.nports;
527 	lld->wr_cred = adap->params.ofldq_wr_cred;
528 	lld->iscsi_iolen = MAXRXDATA_G(t4_read_reg(adap, TP_PARA_REG2_A));
529 	lld->iscsi_tagmask = t4_read_reg(adap, ULP_RX_ISCSI_TAGMASK_A);
530 	lld->iscsi_pgsz_order = t4_read_reg(adap, ULP_RX_ISCSI_PSZ_A);
531 	lld->iscsi_llimit = t4_read_reg(adap, ULP_RX_ISCSI_LLIMIT_A);
532 	lld->iscsi_ppm = &adap->iscsi_ppm;
533 	lld->adapter_type = adap->params.chip;
534 	lld->cclk_ps = 1000000000 / adap->params.vpd.cclk;
535 	lld->udb_density = 1 << adap->params.sge.eq_qpp;
536 	lld->ucq_density = 1 << adap->params.sge.iq_qpp;
537 	lld->filt_mode = adap->params.tp.vlan_pri_map;
538 	/* MODQ_REQ_MAP sets queues 0-3 to chan 0-3 */
539 	for (i = 0; i < NCHAN; i++)
540 		lld->tx_modq[i] = i;
541 	lld->gts_reg = adap->regs + MYPF_REG(SGE_PF_GTS_A);
542 	lld->db_reg = adap->regs + MYPF_REG(SGE_PF_KDOORBELL_A);
543 	lld->fw_vers = adap->params.fw_vers;
544 	lld->dbfifo_int_thresh = dbfifo_int_thresh;
545 	lld->sge_ingpadboundary = adap->sge.fl_align;
546 	lld->sge_egrstatuspagesize = adap->sge.stat_len;
547 	lld->sge_pktshift = adap->sge.pktshift;
548 	lld->enable_fw_ofld_conn = adap->flags & FW_OFLD_CONN;
549 	lld->max_ordird_qp = adap->params.max_ordird_qp;
550 	lld->max_ird_adapter = adap->params.max_ird_adapter;
551 	lld->ulptx_memwrite_dsgl = adap->params.ulptx_memwrite_dsgl;
552 	lld->nodeid = dev_to_node(adap->pdev_dev);
553 	lld->fr_nsmr_tpte_wr_support = adap->params.fr_nsmr_tpte_wr_support;
554 }
555 
556 static void uld_attach(struct adapter *adap, unsigned int uld)
557 {
558 	void *handle;
559 	struct cxgb4_lld_info lli;
560 
561 	uld_init(adap, &lli);
562 	uld_queue_init(adap, uld, &lli);
563 
564 	handle = adap->uld[uld].add(&lli);
565 	if (IS_ERR(handle)) {
566 		dev_warn(adap->pdev_dev,
567 			 "could not attach to the %s driver, error %ld\n",
568 			 adap->uld[uld].name, PTR_ERR(handle));
569 		return;
570 	}
571 
572 	adap->uld[uld].handle = handle;
573 	t4_register_netevent_notifier();
574 
575 	if (adap->flags & FULL_INIT_DONE)
576 		adap->uld[uld].state_change(handle, CXGB4_STATE_UP);
577 }
578 
579 /**
580  *	cxgb4_register_uld - register an upper-layer driver
581  *	@type: the ULD type
582  *	@p: the ULD methods
583  *
584  *	Registers an upper-layer driver with this driver and notifies the ULD
585  *	about any presently available devices that support its type.  Returns
586  *	%-EBUSY if a ULD of the same type is already registered.
587  */
588 int cxgb4_register_uld(enum cxgb4_uld type,
589 		       const struct cxgb4_uld_info *p)
590 {
591 	int ret = 0;
592 	unsigned int adap_idx = 0;
593 	struct adapter *adap;
594 
595 	if (type >= CXGB4_ULD_MAX)
596 		return -EINVAL;
597 
598 	mutex_lock(&uld_mutex);
599 	list_for_each_entry(adap, &adapter_list, list_node) {
600 		if ((type == CXGB4_ULD_CRYPTO && !is_pci_uld(adap)) ||
601 		    (type != CXGB4_ULD_CRYPTO && !is_offload(adap)))
602 			continue;
603 		if (type == CXGB4_ULD_ISCSIT && is_t4(adap->params.chip))
604 			continue;
605 		ret = cfg_queues_uld(adap, type, p);
606 		if (ret)
607 			goto out;
608 		ret = setup_sge_queues_uld(adap, type, p->lro);
609 		if (ret)
610 			goto free_queues;
611 		if (adap->flags & USING_MSIX) {
612 			name_msix_vecs_uld(adap, type);
613 			ret = request_msix_queue_irqs_uld(adap, type);
614 			if (ret)
615 				goto free_rxq;
616 		}
617 		if (adap->flags & FULL_INIT_DONE)
618 			enable_rx_uld(adap, type);
619 		if (adap->uld[type].add) {
620 			ret = -EBUSY;
621 			goto free_irq;
622 		}
623 		adap->uld[type] = *p;
624 		uld_attach(adap, type);
625 		adap_idx++;
626 	}
627 	mutex_unlock(&uld_mutex);
628 	return 0;
629 
630 free_irq:
631 	if (adap->flags & FULL_INIT_DONE)
632 		quiesce_rx_uld(adap, type);
633 	if (adap->flags & USING_MSIX)
634 		free_msix_queue_irqs_uld(adap, type);
635 free_rxq:
636 	free_sge_queues_uld(adap, type);
637 free_queues:
638 	free_queues_uld(adap, type);
639 out:
640 
641 	list_for_each_entry(adap, &adapter_list, list_node) {
642 		if ((type == CXGB4_ULD_CRYPTO && !is_pci_uld(adap)) ||
643 		    (type != CXGB4_ULD_CRYPTO && !is_offload(adap)))
644 			continue;
645 		if (type == CXGB4_ULD_ISCSIT && is_t4(adap->params.chip))
646 			continue;
647 		if (!adap_idx)
648 			break;
649 		adap->uld[type].handle = NULL;
650 		adap->uld[type].add = NULL;
651 		if (adap->flags & FULL_INIT_DONE)
652 			quiesce_rx_uld(adap, type);
653 		if (adap->flags & USING_MSIX)
654 			free_msix_queue_irqs_uld(adap, type);
655 		free_sge_queues_uld(adap, type);
656 		free_queues_uld(adap, type);
657 		adap_idx--;
658 	}
659 	mutex_unlock(&uld_mutex);
660 	return ret;
661 }
662 EXPORT_SYMBOL(cxgb4_register_uld);
663 
664 /**
665  *	cxgb4_unregister_uld - unregister an upper-layer driver
666  *	@type: the ULD type
667  *
668  *	Unregisters an existing upper-layer driver.
669  */
670 int cxgb4_unregister_uld(enum cxgb4_uld type)
671 {
672 	struct adapter *adap;
673 
674 	if (type >= CXGB4_ULD_MAX)
675 		return -EINVAL;
676 
677 	mutex_lock(&uld_mutex);
678 	list_for_each_entry(adap, &adapter_list, list_node) {
679 		if ((type == CXGB4_ULD_CRYPTO && !is_pci_uld(adap)) ||
680 		    (type != CXGB4_ULD_CRYPTO && !is_offload(adap)))
681 			continue;
682 		if (type == CXGB4_ULD_ISCSIT && is_t4(adap->params.chip))
683 			continue;
684 		adap->uld[type].handle = NULL;
685 		adap->uld[type].add = NULL;
686 		if (adap->flags & FULL_INIT_DONE)
687 			quiesce_rx_uld(adap, type);
688 		if (adap->flags & USING_MSIX)
689 			free_msix_queue_irqs_uld(adap, type);
690 		free_sge_queues_uld(adap, type);
691 		free_queues_uld(adap, type);
692 	}
693 	mutex_unlock(&uld_mutex);
694 
695 	return 0;
696 }
697 EXPORT_SYMBOL(cxgb4_unregister_uld);
698