xref: /freebsd/sys/dev/cxgbe/t4_vf.c (revision e8643b01e6312a56d1e44a760fb4e95f0b10b54c)
1 /*-
2  * Copyright (c) 2016 Chelsio Communications, Inc.
3  * All rights reserved.
4  * Written by: John Baldwin <jhb@FreeBSD.org>
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25  * SUCH DAMAGE.
26  */
27 
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD$");
30 
31 #include "opt_inet.h"
32 #include "opt_inet6.h"
33 
34 #include <sys/param.h>
35 #include <sys/bus.h>
36 #include <sys/conf.h>
37 #include <sys/kernel.h>
38 #include <sys/module.h>
39 #include <sys/priv.h>
40 #include <dev/pci/pcivar.h>
41 #if defined(__i386__) || defined(__amd64__)
42 #include <vm/vm.h>
43 #include <vm/pmap.h>
44 #endif
45 
46 #include "common/common.h"
47 #include "common/t4_regs.h"
48 #include "t4_ioctl.h"
49 #include "t4_mp_ring.h"
50 
51 /*
52  * Some notes:
53  *
54  * The Virtual Interfaces are connected to an internal switch on the chip
55  * which allows VIs attached to the same port to talk to each other even when
56  * the port link is down.  As a result, we might want to always report a
57  * VF's link as being "up".
58  *
59  * XXX: Add a TUNABLE and possible per-device sysctl for this?
60  */
61 
62 struct intrs_and_queues {
63 	uint16_t intr_type;	/* MSI, or MSI-X */
64 	uint16_t nirq;		/* Total # of vectors */
65 	uint16_t ntxq;		/* # of NIC txq's for each port */
66 	uint16_t nrxq;		/* # of NIC rxq's for each port */
67 };
68 
69 struct {
70 	uint16_t device;
71 	char *desc;
72 } t4vf_pciids[] = {
73 	{0x4800, "Chelsio T440-dbg VF"},
74 	{0x4801, "Chelsio T420-CR VF"},
75 	{0x4802, "Chelsio T422-CR VF"},
76 	{0x4803, "Chelsio T440-CR VF"},
77 	{0x4804, "Chelsio T420-BCH VF"},
78 	{0x4805, "Chelsio T440-BCH VF"},
79 	{0x4806, "Chelsio T440-CH VF"},
80 	{0x4807, "Chelsio T420-SO VF"},
81 	{0x4808, "Chelsio T420-CX VF"},
82 	{0x4809, "Chelsio T420-BT VF"},
83 	{0x480a, "Chelsio T404-BT VF"},
84 	{0x480e, "Chelsio T440-LP-CR VF"},
85 }, t5vf_pciids[] = {
86 	{0x5800, "Chelsio T580-dbg VF"},
87 	{0x5801,  "Chelsio T520-CR VF"},	/* 2 x 10G */
88 	{0x5802,  "Chelsio T522-CR VF"},	/* 2 x 10G, 2 X 1G */
89 	{0x5803,  "Chelsio T540-CR VF"},	/* 4 x 10G */
90 	{0x5807,  "Chelsio T520-SO VF"},	/* 2 x 10G, nomem */
91 	{0x5809,  "Chelsio T520-BT VF"},	/* 2 x 10GBaseT */
92 	{0x580a,  "Chelsio T504-BT VF"},	/* 4 x 1G */
93 	{0x580d,  "Chelsio T580-CR VF"},	/* 2 x 40G */
94 	{0x580e,  "Chelsio T540-LP-CR VF"},	/* 4 x 10G */
95 	{0x5810,  "Chelsio T580-LP-CR VF"},	/* 2 x 40G */
96 	{0x5811,  "Chelsio T520-LL-CR VF"},	/* 2 x 10G */
97 	{0x5812,  "Chelsio T560-CR VF"},	/* 1 x 40G, 2 x 10G */
98 	{0x5814,  "Chelsio T580-LP-SO-CR VF"},	/* 2 x 40G, nomem */
99 	{0x5815,  "Chelsio T502-BT VF"},	/* 2 x 1G */
100 #ifdef notyet
101 	{0x5804,  "Chelsio T520-BCH VF"},
102 	{0x5805,  "Chelsio T540-BCH VF"},
103 	{0x5806,  "Chelsio T540-CH VF"},
104 	{0x5808,  "Chelsio T520-CX VF"},
105 	{0x580b,  "Chelsio B520-SR VF"},
106 	{0x580c,  "Chelsio B504-BT VF"},
107 	{0x580f,  "Chelsio Amsterdam VF"},
108 	{0x5813,  "Chelsio T580-CHR VF"},
109 #endif
110 }, t6vf_pciids[] = {
111 	{0x6800, "Chelsio T6-DBG-25 VF"},	/* 2 x 10/25G, debug */
112 	{0x6801, "Chelsio T6225-CR VF"},	/* 2 x 10/25G */
113 	{0x6802, "Chelsio T6225-SO-CR VF"},	/* 2 x 10/25G, nomem */
114 	{0x6803, "Chelsio T6425-CR VF"},	/* 4 x 10/25G */
115 	{0x6804, "Chelsio T6425-SO-CR VF"},	/* 4 x 10/25G, nomem */
116 	{0x6805, "Chelsio T6225-OCP-SO VF"},	/* 2 x 10/25G, nomem */
117 	{0x6806, "Chelsio T62100-OCP-SO VF"},	/* 2 x 40/50/100G, nomem */
118 	{0x6807, "Chelsio T62100-LP-CR VF"},	/* 2 x 40/50/100G */
119 	{0x6808, "Chelsio T62100-SO-CR VF"},	/* 2 x 40/50/100G, nomem */
120 	{0x6809, "Chelsio T6210-BT VF"},	/* 2 x 10GBASE-T */
121 	{0x680d, "Chelsio T62100-CR VF"},	/* 2 x 40/50/100G */
122 	{0x6810, "Chelsio T6-DBG-100 VF"},	/* 2 x 40/50/100G, debug */
123 	{0x6811, "Chelsio T6225-LL-CR VF"},	/* 2 x 10/25G */
124 	{0x6814, "Chelsio T61100-OCP-SO VF"},	/* 1 x 40/50/100G, nomem */
125 	{0x6815, "Chelsio T6201-BT VF"},	/* 2 x 1000BASE-T */
126 
127 	/* Custom */
128 	{0x6880, "Chelsio T6225 80 VF"},
129 	{0x6881, "Chelsio T62100 81 VF"},
130 };
131 
132 static d_ioctl_t t4vf_ioctl;
133 
134 static struct cdevsw t4vf_cdevsw = {
135        .d_version = D_VERSION,
136        .d_ioctl = t4vf_ioctl,
137        .d_name = "t4vf",
138 };
139 
140 static int
141 t4vf_probe(device_t dev)
142 {
143 	uint16_t d;
144 	size_t i;
145 
146 	d = pci_get_device(dev);
147 	for (i = 0; i < nitems(t4vf_pciids); i++) {
148 		if (d == t4vf_pciids[i].device) {
149 			device_set_desc(dev, t4vf_pciids[i].desc);
150 			return (BUS_PROBE_DEFAULT);
151 		}
152 	}
153 	return (ENXIO);
154 }
155 
156 static int
157 t5vf_probe(device_t dev)
158 {
159 	uint16_t d;
160 	size_t i;
161 
162 	d = pci_get_device(dev);
163 	for (i = 0; i < nitems(t5vf_pciids); i++) {
164 		if (d == t5vf_pciids[i].device) {
165 			device_set_desc(dev, t5vf_pciids[i].desc);
166 			return (BUS_PROBE_DEFAULT);
167 		}
168 	}
169 	return (ENXIO);
170 }
171 
172 static int
173 t6vf_probe(device_t dev)
174 {
175 	uint16_t d;
176 	size_t i;
177 
178 	d = pci_get_device(dev);
179 	for (i = 0; i < nitems(t6vf_pciids); i++) {
180 		if (d == t6vf_pciids[i].device) {
181 			device_set_desc(dev, t6vf_pciids[i].desc);
182 			return (BUS_PROBE_DEFAULT);
183 		}
184 	}
185 	return (ENXIO);
186 }
187 
188 #define FW_PARAM_DEV(param) \
189 	(V_FW_PARAMS_MNEM(FW_PARAMS_MNEM_DEV) | \
190 	 V_FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DEV_##param))
191 #define FW_PARAM_PFVF(param) \
192 	(V_FW_PARAMS_MNEM(FW_PARAMS_MNEM_PFVF) | \
193 	 V_FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_PFVF_##param))
194 
195 static int
196 get_params__pre_init(struct adapter *sc)
197 {
198 	int rc;
199 	uint32_t param[3], val[3];
200 
201 	param[0] = FW_PARAM_DEV(FWREV);
202 	param[1] = FW_PARAM_DEV(TPREV);
203 	param[2] = FW_PARAM_DEV(CCLK);
204 	rc = -t4vf_query_params(sc, nitems(param), param, val);
205 	if (rc != 0) {
206 		device_printf(sc->dev,
207 		    "failed to query parameters (pre_init): %d.\n", rc);
208 		return (rc);
209 	}
210 
211 	sc->params.fw_vers = val[0];
212 	sc->params.tp_vers = val[1];
213 	sc->params.vpd.cclk = val[2];
214 
215 	snprintf(sc->fw_version, sizeof(sc->fw_version), "%u.%u.%u.%u",
216 	    G_FW_HDR_FW_VER_MAJOR(sc->params.fw_vers),
217 	    G_FW_HDR_FW_VER_MINOR(sc->params.fw_vers),
218 	    G_FW_HDR_FW_VER_MICRO(sc->params.fw_vers),
219 	    G_FW_HDR_FW_VER_BUILD(sc->params.fw_vers));
220 
221 	snprintf(sc->tp_version, sizeof(sc->tp_version), "%u.%u.%u.%u",
222 	    G_FW_HDR_FW_VER_MAJOR(sc->params.tp_vers),
223 	    G_FW_HDR_FW_VER_MINOR(sc->params.tp_vers),
224 	    G_FW_HDR_FW_VER_MICRO(sc->params.tp_vers),
225 	    G_FW_HDR_FW_VER_BUILD(sc->params.tp_vers));
226 
227 	return (0);
228 }
229 
230 static int
231 get_params__post_init(struct adapter *sc)
232 {
233 	int rc;
234 
235 	rc = -t4vf_get_sge_params(sc);
236 	if (rc != 0) {
237 		device_printf(sc->dev,
238 		    "unable to retrieve adapter SGE parameters: %d\n", rc);
239 		return (rc);
240 	}
241 
242 	rc = -t4vf_get_rss_glb_config(sc);
243 	if (rc != 0) {
244 		device_printf(sc->dev,
245 		    "unable to retrieve adapter RSS parameters: %d\n", rc);
246 		return (rc);
247 	}
248 	if (sc->params.rss.mode != FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL) {
249 		device_printf(sc->dev,
250 		    "unable to operate with global RSS mode %d\n",
251 		    sc->params.rss.mode);
252 		return (EINVAL);
253 	}
254 
255 	rc = t4_read_chip_settings(sc);
256 	if (rc != 0)
257 		return (rc);
258 
259 	/*
260 	 * Grab our Virtual Interface resource allocation, extract the
261 	 * features that we're interested in and do a bit of sanity testing on
262 	 * what we discover.
263 	 */
264 	rc = -t4vf_get_vfres(sc);
265 	if (rc != 0) {
266 		device_printf(sc->dev,
267 		    "unable to get virtual interface resources: %d\n", rc);
268 		return (rc);
269 	}
270 
271 	/*
272 	 * Check for various parameter sanity issues.
273 	 */
274 	if (sc->params.vfres.pmask == 0) {
275 		device_printf(sc->dev, "no port access configured/usable!\n");
276 		return (EINVAL);
277 	}
278 	if (sc->params.vfres.nvi == 0) {
279 		device_printf(sc->dev,
280 		    "no virtual interfaces configured/usable!\n");
281 		return (EINVAL);
282 	}
283 	sc->params.portvec = sc->params.vfres.pmask;
284 
285 	return (0);
286 }
287 
288 static int
289 set_params__post_init(struct adapter *sc)
290 {
291 	uint32_t param, val;
292 
293 	/* ask for encapsulated CPLs */
294 	param = FW_PARAM_PFVF(CPLFW4MSG_ENCAP);
295 	val = 1;
296 	(void)t4vf_set_params(sc, 1, &param, &val);
297 
298 	return (0);
299 }
300 
301 #undef FW_PARAM_PFVF
302 #undef FW_PARAM_DEV
303 
304 static int
305 cfg_itype_and_nqueues(struct adapter *sc, struct intrs_and_queues *iaq)
306 {
307 	struct vf_resources *vfres;
308 	int nrxq, ntxq, nports;
309 	int itype, iq_avail, navail, rc;
310 
311 	/*
312 	 * Figure out the layout of queues across our VIs and ensure
313 	 * we can allocate enough interrupts for our layout.
314 	 */
315 	vfres = &sc->params.vfres;
316 	nports = sc->params.nports;
317 	bzero(iaq, sizeof(*iaq));
318 
319 	for (itype = INTR_MSIX; itype != 0; itype >>= 1) {
320 		if (itype == INTR_INTX)
321 			continue;
322 
323 		if (itype == INTR_MSIX)
324 			navail = pci_msix_count(sc->dev);
325 		else
326 			navail = pci_msi_count(sc->dev);
327 
328 		if (navail == 0)
329 			continue;
330 
331 		iaq->intr_type = itype;
332 
333 		/*
334 		 * XXX: The Linux driver reserves an Ingress Queue for
335 		 * forwarded interrupts when using MSI (but not MSI-X).
336 		 * It seems it just always asks for 2 interrupts and
337 		 * forwards all rxqs to the forwarded interrupt.
338 		 *
339 		 * We must reserve one IRQ for the for the firmware
340 		 * event queue.
341 		 *
342 		 * Every rxq requires an ingress queue with a free
343 		 * list and interrupts and an egress queue.  Every txq
344 		 * requires an ETH egress queue.
345 		 */
346 		iaq->nirq = T4VF_EXTRA_INTR;
347 
348 		/*
349 		 * First, determine how many queues we can allocate.
350 		 * Start by finding the upper bound on rxqs from the
351 		 * limit on ingress queues.
352 		 */
353 		iq_avail = vfres->niqflint - iaq->nirq;
354 		if (iq_avail < nports) {
355 			device_printf(sc->dev,
356 			    "Not enough ingress queues (%d) for %d ports\n",
357 			    vfres->niqflint, nports);
358 			return (ENXIO);
359 		}
360 
361 		/*
362 		 * Try to honor the cap on interrupts.  If there aren't
363 		 * enough interrupts for at least one interrupt per
364 		 * port, then don't bother, we will just forward all
365 		 * interrupts to one interrupt in that case.
366 		 */
367 		if (iaq->nirq + nports <= navail) {
368 			if (iq_avail > navail - iaq->nirq)
369 				iq_avail = navail - iaq->nirq;
370 		}
371 
372 		nrxq = nports * t4_nrxq;
373 		if (nrxq > iq_avail) {
374 			/*
375 			 * Too many ingress queues.  Use what we can.
376 			 */
377 			nrxq = (iq_avail / nports) * nports;
378 		}
379 		KASSERT(nrxq <= iq_avail, ("too many ingress queues"));
380 
381 		/*
382 		 * Next, determine the upper bound on txqs from the limit
383 		 * on ETH queues.
384 		 */
385 		if (vfres->nethctrl < nports) {
386 			device_printf(sc->dev,
387 			    "Not enough ETH queues (%d) for %d ports\n",
388 			    vfres->nethctrl, nports);
389 			return (ENXIO);
390 		}
391 
392 		ntxq = nports * t4_ntxq;
393 		if (ntxq > vfres->nethctrl) {
394 			/*
395 			 * Too many ETH queues.  Use what we can.
396 			 */
397 			ntxq = (vfres->nethctrl / nports) * nports;
398 		}
399 		KASSERT(ntxq <= vfres->nethctrl, ("too many ETH queues"));
400 
401 		/*
402 		 * Finally, ensure we have enough egress queues.
403 		 */
404 		if (vfres->neq < nports * 2) {
405 			device_printf(sc->dev,
406 			    "Not enough egress queues (%d) for %d ports\n",
407 			    vfres->neq, nports);
408 			return (ENXIO);
409 		}
410 		if (nrxq + ntxq > vfres->neq) {
411 			/* Just punt and use 1 for everything. */
412 			nrxq = ntxq = nports;
413 		}
414 		KASSERT(nrxq <= iq_avail, ("too many ingress queues"));
415 		KASSERT(ntxq <= vfres->nethctrl, ("too many ETH queues"));
416 		KASSERT(nrxq + ntxq <= vfres->neq, ("too many egress queues"));
417 
418 		/*
419 		 * Do we have enough interrupts?  For MSI the interrupts
420 		 * have to be a power of 2 as well.
421 		 */
422 		iaq->nirq += nrxq;
423 		iaq->ntxq = ntxq;
424 		iaq->nrxq = nrxq;
425 		if (iaq->nirq <= navail &&
426 		    (itype != INTR_MSI || powerof2(iaq->nirq))) {
427 			navail = iaq->nirq;
428 			if (itype == INTR_MSIX)
429 				rc = pci_alloc_msix(sc->dev, &navail);
430 			else
431 				rc = pci_alloc_msi(sc->dev, &navail);
432 			if (rc != 0) {
433 				device_printf(sc->dev,
434 		    "failed to allocate vectors:%d, type=%d, req=%d, rcvd=%d\n",
435 				    itype, rc, iaq->nirq, navail);
436 				return (rc);
437 			}
438 			if (navail == iaq->nirq) {
439 				return (0);
440 			}
441 			pci_release_msi(sc->dev);
442 		}
443 
444 		/* Fall back to a single interrupt. */
445 		iaq->nirq = 1;
446 		navail = iaq->nirq;
447 		if (itype == INTR_MSIX)
448 			rc = pci_alloc_msix(sc->dev, &navail);
449 		else
450 			rc = pci_alloc_msi(sc->dev, &navail);
451 		if (rc != 0)
452 			device_printf(sc->dev,
453 		    "failed to allocate vectors:%d, type=%d, req=%d, rcvd=%d\n",
454 			    itype, rc, iaq->nirq, navail);
455 		return (rc);
456 	}
457 
458 	device_printf(sc->dev,
459 	    "failed to find a usable interrupt type.  "
460 	    "allowed=%d, msi-x=%d, msi=%d, intx=1", t4_intr_types,
461 	    pci_msix_count(sc->dev), pci_msi_count(sc->dev));
462 
463 	return (ENXIO);
464 }
465 
466 static int
467 t4vf_attach(device_t dev)
468 {
469 	struct adapter *sc;
470 	int rc = 0, i, j, rqidx, tqidx;
471 	struct make_dev_args mda;
472 	struct intrs_and_queues iaq;
473 	struct sge *s;
474 
475 	sc = device_get_softc(dev);
476 	sc->dev = dev;
477 	pci_enable_busmaster(dev);
478 	pci_set_max_read_req(dev, 4096);
479 	sc->params.pci.mps = pci_get_max_payload(dev);
480 
481 	sc->flags |= IS_VF;
482 	TUNABLE_INT_FETCH("hw.cxgbe.dflags", &sc->debug_flags);
483 
484 	sc->sge_gts_reg = VF_SGE_REG(A_SGE_VF_GTS);
485 	sc->sge_kdoorbell_reg = VF_SGE_REG(A_SGE_VF_KDOORBELL);
486 	snprintf(sc->lockname, sizeof(sc->lockname), "%s",
487 	    device_get_nameunit(dev));
488 	mtx_init(&sc->sc_lock, sc->lockname, 0, MTX_DEF);
489 	t4_add_adapter(sc);
490 
491 	mtx_init(&sc->sfl_lock, "starving freelists", 0, MTX_DEF);
492 	TAILQ_INIT(&sc->sfl);
493 	callout_init_mtx(&sc->sfl_callout, &sc->sfl_lock, 0);
494 
495 	mtx_init(&sc->reg_lock, "indirect register access", 0, MTX_DEF);
496 
497 	rc = t4_map_bars_0_and_4(sc);
498 	if (rc != 0)
499 		goto done; /* error message displayed already */
500 
501 	rc = -t4vf_prep_adapter(sc);
502 	if (rc != 0)
503 		goto done;
504 
505 	t4_init_devnames(sc);
506 	if (sc->names == NULL) {
507 		rc = ENOTSUP;
508 		goto done; /* error message displayed already */
509 	}
510 
511 	/*
512 	 * Leave the 'pf' and 'mbox' values as zero.  This ensures
513 	 * that various firmware messages do not set the fields which
514 	 * is the correct thing to do for a VF.
515 	 */
516 
517 	memset(sc->chan_map, 0xff, sizeof(sc->chan_map));
518 
519 	make_dev_args_init(&mda);
520 	mda.mda_devsw = &t4vf_cdevsw;
521 	mda.mda_uid = UID_ROOT;
522 	mda.mda_gid = GID_WHEEL;
523 	mda.mda_mode = 0600;
524 	mda.mda_si_drv1 = sc;
525 	rc = make_dev_s(&mda, &sc->cdev, "%s", device_get_nameunit(dev));
526 	if (rc != 0)
527 		device_printf(dev, "failed to create nexus char device: %d.\n",
528 		    rc);
529 
530 #if defined(__i386__)
531 	if ((cpu_feature & CPUID_CX8) == 0) {
532 		device_printf(dev, "64 bit atomics not available.\n");
533 		rc = ENOTSUP;
534 		goto done;
535 	}
536 #endif
537 
538 	/*
539 	 * Some environments do not properly handle PCIE FLRs -- e.g. in Linux
540 	 * 2.6.31 and later we can't call pci_reset_function() in order to
541 	 * issue an FLR because of a self- deadlock on the device semaphore.
542 	 * Meanwhile, the OS infrastructure doesn't issue FLRs in all the
543 	 * cases where they're needed -- for instance, some versions of KVM
544 	 * fail to reset "Assigned Devices" when the VM reboots.  Therefore we
545 	 * use the firmware based reset in order to reset any per function
546 	 * state.
547 	 */
548 	rc = -t4vf_fw_reset(sc);
549 	if (rc != 0) {
550 		device_printf(dev, "FW reset failed: %d\n", rc);
551 		goto done;
552 	}
553 	sc->flags |= FW_OK;
554 
555 	/*
556 	 * Grab basic operational parameters.  These will predominantly have
557 	 * been set up by the Physical Function Driver or will be hard coded
558 	 * into the adapter.  We just have to live with them ...  Note that
559 	 * we _must_ get our VPD parameters before our SGE parameters because
560 	 * we need to know the adapter's core clock from the VPD in order to
561 	 * properly decode the SGE Timer Values.
562 	 */
563 	rc = get_params__pre_init(sc);
564 	if (rc != 0)
565 		goto done; /* error message displayed already */
566 	rc = get_params__post_init(sc);
567 	if (rc != 0)
568 		goto done; /* error message displayed already */
569 
570 	rc = set_params__post_init(sc);
571 	if (rc != 0)
572 		goto done; /* error message displayed already */
573 
574 	rc = t4_map_bar_2(sc);
575 	if (rc != 0)
576 		goto done; /* error message displayed already */
577 
578 	rc = t4_create_dma_tag(sc);
579 	if (rc != 0)
580 		goto done; /* error message displayed already */
581 
582 	/*
583 	 * The number of "ports" which we support is equal to the number of
584 	 * Virtual Interfaces with which we've been provisioned.
585 	 */
586 	sc->params.nports = imin(sc->params.vfres.nvi, MAX_NPORTS);
587 
588 	/*
589 	 * We may have been provisioned with more VIs than the number of
590 	 * ports we're allowed to access (our Port Access Rights Mask).
591 	 * Just use a single VI for each port.
592 	 */
593 	sc->params.nports = imin(sc->params.nports,
594 	    bitcount32(sc->params.vfres.pmask));
595 
596 #ifdef notyet
597 	/*
598 	 * XXX: The Linux VF driver will lower nports if it thinks there
599 	 * are too few resources in vfres (niqflint, nethctrl, neq).
600 	 */
601 #endif
602 
603 	/*
604 	 * First pass over all the ports - allocate VIs and initialize some
605 	 * basic parameters like mac address, port type, etc.
606 	 */
607 	for_each_port(sc, i) {
608 		struct port_info *pi;
609 
610 		pi = malloc(sizeof(*pi), M_CXGBE, M_ZERO | M_WAITOK);
611 		sc->port[i] = pi;
612 
613 		/* These must be set before t4_port_init */
614 		pi->adapter = sc;
615 		pi->port_id = i;
616 		pi->nvi = 1;
617 		pi->vi = malloc(sizeof(struct vi_info) * pi->nvi, M_CXGBE,
618 		    M_ZERO | M_WAITOK);
619 
620 		/*
621 		 * Allocate the "main" VI and initialize parameters
622 		 * like mac addr.
623 		 */
624 		rc = -t4_port_init(sc, sc->mbox, sc->pf, 0, i);
625 		if (rc != 0) {
626 			device_printf(dev, "unable to initialize port %d: %d\n",
627 			    i, rc);
628 			free(pi->vi, M_CXGBE);
629 			free(pi, M_CXGBE);
630 			sc->port[i] = NULL;
631 			goto done;
632 		}
633 
634 		/* No t4_link_start. */
635 
636 		snprintf(pi->lockname, sizeof(pi->lockname), "%sp%d",
637 		    device_get_nameunit(dev), i);
638 		mtx_init(&pi->pi_lock, pi->lockname, 0, MTX_DEF);
639 		sc->chan_map[pi->tx_chan] = i;
640 
641 		/* All VIs on this port share this media. */
642 		ifmedia_init(&pi->media, IFM_IMASK, cxgbe_media_change,
643 		    cxgbe_media_status);
644 
645 		pi->dev = device_add_child(dev, sc->names->vf_ifnet_name, -1);
646 		if (pi->dev == NULL) {
647 			device_printf(dev,
648 			    "failed to add device for port %d.\n", i);
649 			rc = ENXIO;
650 			goto done;
651 		}
652 		pi->vi[0].dev = pi->dev;
653 		device_set_softc(pi->dev, pi);
654 	}
655 
656 	/*
657 	 * Interrupt type, # of interrupts, # of rx/tx queues, etc.
658 	 */
659 	rc = cfg_itype_and_nqueues(sc, &iaq);
660 	if (rc != 0)
661 		goto done; /* error message displayed already */
662 
663 	sc->intr_type = iaq.intr_type;
664 	sc->intr_count = iaq.nirq;
665 
666 	s = &sc->sge;
667 	s->nrxq = sc->params.nports * iaq.nrxq;
668 	s->ntxq = sc->params.nports * iaq.ntxq;
669 	s->neq = s->ntxq + s->nrxq;	/* the free list in an rxq is an eq */
670 	s->neq += sc->params.nports;	/* ctrl queues: 1 per port */
671 	s->niq = s->nrxq + 1;		/* 1 extra for firmware event queue */
672 
673 	s->rxq = malloc(s->nrxq * sizeof(struct sge_rxq), M_CXGBE,
674 	    M_ZERO | M_WAITOK);
675 	s->txq = malloc(s->ntxq * sizeof(struct sge_txq), M_CXGBE,
676 	    M_ZERO | M_WAITOK);
677 	s->iqmap = malloc(s->niq * sizeof(struct sge_iq *), M_CXGBE,
678 	    M_ZERO | M_WAITOK);
679 	s->eqmap = malloc(s->neq * sizeof(struct sge_eq *), M_CXGBE,
680 	    M_ZERO | M_WAITOK);
681 
682 	sc->irq = malloc(sc->intr_count * sizeof(struct irq), M_CXGBE,
683 	    M_ZERO | M_WAITOK);
684 
685 	/*
686 	 * Second pass over the ports.  This time we know the number of rx and
687 	 * tx queues that each port should get.
688 	 */
689 	rqidx = tqidx = 0;
690 	for_each_port(sc, i) {
691 		struct port_info *pi = sc->port[i];
692 		struct vi_info *vi;
693 
694 		if (pi == NULL)
695 			continue;
696 
697 		for_each_vi(pi, j, vi) {
698 			vi->pi = pi;
699 			vi->qsize_rxq = t4_qsize_rxq;
700 			vi->qsize_txq = t4_qsize_txq;
701 
702 			vi->first_rxq = rqidx;
703 			vi->first_txq = tqidx;
704 			vi->tmr_idx = t4_tmr_idx;
705 			vi->pktc_idx = t4_pktc_idx;
706 			vi->nrxq = j == 0 ? iaq.nrxq: 1;
707 			vi->ntxq = j == 0 ? iaq.ntxq: 1;
708 
709 			rqidx += vi->nrxq;
710 			tqidx += vi->ntxq;
711 
712 			vi->rsrv_noflowq = 0;
713 		}
714 	}
715 
716 	rc = t4_setup_intr_handlers(sc);
717 	if (rc != 0) {
718 		device_printf(dev,
719 		    "failed to setup interrupt handlers: %d\n", rc);
720 		goto done;
721 	}
722 
723 	rc = bus_generic_attach(dev);
724 	if (rc != 0) {
725 		device_printf(dev,
726 		    "failed to attach all child ports: %d\n", rc);
727 		goto done;
728 	}
729 
730 	device_printf(dev,
731 	    "%d ports, %d %s interrupt%s, %d eq, %d iq\n",
732 	    sc->params.nports, sc->intr_count, sc->intr_type == INTR_MSIX ?
733 	    "MSI-X" : "MSI", sc->intr_count > 1 ? "s" : "", sc->sge.neq,
734 	    sc->sge.niq);
735 
736 done:
737 	if (rc != 0)
738 		t4_detach_common(dev);
739 	else
740 		t4_sysctls(sc);
741 
742 	return (rc);
743 }
744 
745 static void
746 get_regs(struct adapter *sc, struct t4_regdump *regs, uint8_t *buf)
747 {
748 
749 	/* 0x3f is used as the revision for VFs. */
750 	regs->version = chip_id(sc) | (0x3f << 10);
751 	t4_get_regs(sc, buf, regs->len);
752 }
753 
754 static void
755 t4_clr_vi_stats(struct adapter *sc)
756 {
757 	int reg;
758 
759 	for (reg = A_MPS_VF_STAT_TX_VF_BCAST_BYTES_L;
760 	     reg <= A_MPS_VF_STAT_RX_VF_ERR_FRAMES_H; reg += 4)
761 		t4_write_reg(sc, VF_MPS_REG(reg), 0);
762 }
763 
764 static int
765 t4vf_ioctl(struct cdev *dev, unsigned long cmd, caddr_t data, int fflag,
766     struct thread *td)
767 {
768 	int rc;
769 	struct adapter *sc = dev->si_drv1;
770 
771 	rc = priv_check(td, PRIV_DRIVER);
772 	if (rc != 0)
773 		return (rc);
774 
775 	switch (cmd) {
776 	case CHELSIO_T4_GETREG: {
777 		struct t4_reg *edata = (struct t4_reg *)data;
778 
779 		if ((edata->addr & 0x3) != 0 || edata->addr >= sc->mmio_len)
780 			return (EFAULT);
781 
782 		if (edata->size == 4)
783 			edata->val = t4_read_reg(sc, edata->addr);
784 		else if (edata->size == 8)
785 			edata->val = t4_read_reg64(sc, edata->addr);
786 		else
787 			return (EINVAL);
788 
789 		break;
790 	}
791 	case CHELSIO_T4_SETREG: {
792 		struct t4_reg *edata = (struct t4_reg *)data;
793 
794 		if ((edata->addr & 0x3) != 0 || edata->addr >= sc->mmio_len)
795 			return (EFAULT);
796 
797 		if (edata->size == 4) {
798 			if (edata->val & 0xffffffff00000000)
799 				return (EINVAL);
800 			t4_write_reg(sc, edata->addr, (uint32_t) edata->val);
801 		} else if (edata->size == 8)
802 			t4_write_reg64(sc, edata->addr, edata->val);
803 		else
804 			return (EINVAL);
805 		break;
806 	}
807 	case CHELSIO_T4_REGDUMP: {
808 		struct t4_regdump *regs = (struct t4_regdump *)data;
809 		int reglen = t4_get_regs_len(sc);
810 		uint8_t *buf;
811 
812 		if (regs->len < reglen) {
813 			regs->len = reglen; /* hint to the caller */
814 			return (ENOBUFS);
815 		}
816 
817 		regs->len = reglen;
818 		buf = malloc(reglen, M_CXGBE, M_WAITOK | M_ZERO);
819 		get_regs(sc, regs, buf);
820 		rc = copyout(buf, regs->data, reglen);
821 		free(buf, M_CXGBE);
822 		break;
823 	}
824 	case CHELSIO_T4_CLEAR_STATS: {
825 		int i, v;
826 		u_int port_id = *(uint32_t *)data;
827 		struct port_info *pi;
828 		struct vi_info *vi;
829 
830 		if (port_id >= sc->params.nports)
831 			return (EINVAL);
832 		pi = sc->port[port_id];
833 
834 		/* MAC stats */
835 		pi->tx_parse_error = 0;
836 		t4_clr_vi_stats(sc);
837 
838 		/*
839 		 * Since this command accepts a port, clear stats for
840 		 * all VIs on this port.
841 		 */
842 		for_each_vi(pi, v, vi) {
843 			if (vi->flags & VI_INIT_DONE) {
844 				struct sge_rxq *rxq;
845 				struct sge_txq *txq;
846 
847 				for_each_rxq(vi, i, rxq) {
848 #if defined(INET) || defined(INET6)
849 					rxq->lro.lro_queued = 0;
850 					rxq->lro.lro_flushed = 0;
851 #endif
852 					rxq->rxcsum = 0;
853 					rxq->vlan_extraction = 0;
854 				}
855 
856 				for_each_txq(vi, i, txq) {
857 					txq->txcsum = 0;
858 					txq->tso_wrs = 0;
859 					txq->vlan_insertion = 0;
860 					txq->imm_wrs = 0;
861 					txq->sgl_wrs = 0;
862 					txq->txpkt_wrs = 0;
863 					txq->txpkts0_wrs = 0;
864 					txq->txpkts1_wrs = 0;
865 					txq->txpkts0_pkts = 0;
866 					txq->txpkts1_pkts = 0;
867 					mp_ring_reset_stats(txq->r);
868 				}
869 			}
870 		}
871 		break;
872 	}
873 	case CHELSIO_T4_SCHED_CLASS:
874 		rc = t4_set_sched_class(sc, (struct t4_sched_params *)data);
875 		break;
876 	case CHELSIO_T4_SCHED_QUEUE:
877 		rc = t4_set_sched_queue(sc, (struct t4_sched_queue *)data);
878 		break;
879 	default:
880 		rc = ENOTTY;
881 	}
882 
883 	return (rc);
884 }
885 
886 static device_method_t t4vf_methods[] = {
887 	DEVMETHOD(device_probe,		t4vf_probe),
888 	DEVMETHOD(device_attach,	t4vf_attach),
889 	DEVMETHOD(device_detach,	t4_detach_common),
890 
891 	DEVMETHOD_END
892 };
893 
894 static driver_t t4vf_driver = {
895 	"t4vf",
896 	t4vf_methods,
897 	sizeof(struct adapter)
898 };
899 
900 static device_method_t t5vf_methods[] = {
901 	DEVMETHOD(device_probe,		t5vf_probe),
902 	DEVMETHOD(device_attach,	t4vf_attach),
903 	DEVMETHOD(device_detach,	t4_detach_common),
904 
905 	DEVMETHOD_END
906 };
907 
908 static driver_t t5vf_driver = {
909 	"t5vf",
910 	t5vf_methods,
911 	sizeof(struct adapter)
912 };
913 
914 static device_method_t t6vf_methods[] = {
915 	DEVMETHOD(device_probe,		t6vf_probe),
916 	DEVMETHOD(device_attach,	t4vf_attach),
917 	DEVMETHOD(device_detach,	t4_detach_common),
918 
919 	DEVMETHOD_END
920 };
921 
922 static driver_t t6vf_driver = {
923 	"t6vf",
924 	t6vf_methods,
925 	sizeof(struct adapter)
926 };
927 
928 static driver_t cxgbev_driver = {
929 	"cxgbev",
930 	cxgbe_methods,
931 	sizeof(struct port_info)
932 };
933 
934 static driver_t cxlv_driver = {
935 	"cxlv",
936 	cxgbe_methods,
937 	sizeof(struct port_info)
938 };
939 
940 static driver_t ccv_driver = {
941 	"ccv",
942 	cxgbe_methods,
943 	sizeof(struct port_info)
944 };
945 
946 static devclass_t t4vf_devclass, t5vf_devclass, t6vf_devclass;
947 static devclass_t cxgbev_devclass, cxlv_devclass, ccv_devclass;
948 
949 DRIVER_MODULE(t4vf, pci, t4vf_driver, t4vf_devclass, 0, 0);
950 MODULE_VERSION(t4vf, 1);
951 MODULE_DEPEND(t4vf, t4nex, 1, 1, 1);
952 
953 DRIVER_MODULE(t5vf, pci, t5vf_driver, t5vf_devclass, 0, 0);
954 MODULE_VERSION(t5vf, 1);
955 MODULE_DEPEND(t5vf, t5nex, 1, 1, 1);
956 
957 DRIVER_MODULE(t6vf, pci, t6vf_driver, t6vf_devclass, 0, 0);
958 MODULE_VERSION(t6vf, 1);
959 MODULE_DEPEND(t6vf, t6nex, 1, 1, 1);
960 
961 DRIVER_MODULE(cxgbev, t4vf, cxgbev_driver, cxgbev_devclass, 0, 0);
962 MODULE_VERSION(cxgbev, 1);
963 
964 DRIVER_MODULE(cxlv, t5vf, cxlv_driver, cxlv_devclass, 0, 0);
965 MODULE_VERSION(cxlv, 1);
966 
967 DRIVER_MODULE(ccv, t6vf, ccv_driver, ccv_devclass, 0, 0);
968 MODULE_VERSION(ccv, 1);
969