virtio_pci.c revision 1.30 1 /* $NetBSD: virtio_pci.c,v 1.30 2021/08/07 16:19:14 thorpej Exp $ */
2
3 /*
4 * Copyright (c) 2020 The NetBSD Foundation, Inc.
5 * Copyright (c) 2012 Stefan Fritsch.
6 * Copyright (c) 2010 Minoura Makoto.
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30 #include <sys/cdefs.h>
31 __KERNEL_RCSID(0, "$NetBSD: virtio_pci.c,v 1.30 2021/08/07 16:19:14 thorpej Exp $");
32
33 #include <sys/param.h>
34 #include <sys/systm.h>
35 #include <sys/kmem.h>
36 #include <sys/module.h>
37 #include <sys/endian.h>
38 #include <sys/interrupt.h>
39
40 #include <sys/device.h>
41
42 #include <dev/pci/pcidevs.h>
43 #include <dev/pci/pcireg.h>
44 #include <dev/pci/pcivar.h>
45
46 #include <dev/pci/virtioreg.h> /* XXX: move to non-pci */
47 #include <dev/pci/virtio_pcireg.h>
48
49 #define VIRTIO_PRIVATE
50 #include <dev/pci/virtiovar.h> /* XXX: move to non-pci */
51
52
53 static int virtio_pci_match(device_t, cfdata_t, void *);
54 static void virtio_pci_attach(device_t, device_t, void *);
55 static int virtio_pci_rescan(device_t, const char *, const int *);
56 static int virtio_pci_detach(device_t, int);
57
58
59 #define NMAPREG ((PCI_MAPREG_END - PCI_MAPREG_START) / \
60 sizeof(pcireg_t))
61 struct virtio_pci_softc {
62 struct virtio_softc sc_sc;
63
64 /* IO space */
65 bus_space_tag_t sc_iot;
66 bus_space_handle_t sc_ioh;
67 bus_size_t sc_iosize;
68 bus_size_t sc_mapped_iosize;
69
70 /* BARs */
71 bus_space_tag_t sc_bars_iot[NMAPREG];
72 bus_space_handle_t sc_bars_ioh[NMAPREG];
73 bus_size_t sc_bars_iosize[NMAPREG];
74
75 /* notify space */
76 bus_space_tag_t sc_notify_iot;
77 bus_space_handle_t sc_notify_ioh;
78 bus_size_t sc_notify_iosize;
79 uint32_t sc_notify_off_multiplier;
80
81 /* isr space */
82 bus_space_tag_t sc_isr_iot;
83 bus_space_handle_t sc_isr_ioh;
84 bus_size_t sc_isr_iosize;
85
86 /* generic */
87 struct pci_attach_args sc_pa;
88 pci_intr_handle_t *sc_ihp;
89 void **sc_ihs;
90 int sc_ihs_num;
91 int sc_devcfg_offset; /* for 0.9 */
92 };
93
94 static int virtio_pci_attach_09(device_t, void *);
95 static void virtio_pci_kick_09(struct virtio_softc *, uint16_t);
96 static uint16_t virtio_pci_read_queue_size_09(struct virtio_softc *, uint16_t);
97 static void virtio_pci_setup_queue_09(struct virtio_softc *, uint16_t, uint64_t);
98 static void virtio_pci_set_status_09(struct virtio_softc *, int);
99 static void virtio_pci_negotiate_features_09(struct virtio_softc *, uint64_t);
100
101 static int virtio_pci_attach_10(device_t, void *);
102 static void virtio_pci_kick_10(struct virtio_softc *, uint16_t);
103 static uint16_t virtio_pci_read_queue_size_10(struct virtio_softc *, uint16_t);
104 static void virtio_pci_setup_queue_10(struct virtio_softc *, uint16_t, uint64_t);
105 static void virtio_pci_set_status_10(struct virtio_softc *, int);
106 static void virtio_pci_negotiate_features_10(struct virtio_softc *, uint64_t);
107 static int virtio_pci_find_cap(struct virtio_pci_softc *psc, int cfg_type, void *buf, int buflen);
108
109 static int virtio_pci_setup_interrupts(struct virtio_softc *);
110 static void virtio_pci_free_interrupts(struct virtio_softc *);
111 static int virtio_pci_adjust_config_region(struct virtio_pci_softc *psc);
112 static int virtio_pci_intr(void *arg);
113 static int virtio_pci_msix_queue_intr(void *);
114 static int virtio_pci_msix_config_intr(void *);
115 static int virtio_pci_setup_msix_vectors_09(struct virtio_softc *);
116 static int virtio_pci_setup_msix_vectors_10(struct virtio_softc *);
117 static int virtio_pci_setup_msix_interrupts(struct virtio_softc *,
118 struct pci_attach_args *);
119 static int virtio_pci_setup_intx_interrupt(struct virtio_softc *,
120 struct pci_attach_args *);
121
122 #define VIRTIO_MSIX_CONFIG_VECTOR_INDEX 0
123 #define VIRTIO_MSIX_QUEUE_VECTOR_INDEX 1
124
125 /*
126 * When using PCI attached virtio on aarch64-eb under Qemu, the IO space
127 * suddenly read BIG_ENDIAN where it should stay LITTLE_ENDIAN. The data read
128 * 1 byte at a time seem OK but reading bigger lengths result in swapped
129 * endian. This is most notable on reading 8 byters since we can't use
130 * bus_space_{read,write}_8().
131 */
132
133 #if defined(__aarch64__) && BYTE_ORDER == BIG_ENDIAN
134 # define READ_ENDIAN_09 BIG_ENDIAN /* should be LITTLE_ENDIAN */
135 # define READ_ENDIAN_10 BIG_ENDIAN
136 # define STRUCT_ENDIAN_09 BIG_ENDIAN
137 # define STRUCT_ENDIAN_10 LITTLE_ENDIAN
138 #elif BYTE_ORDER == BIG_ENDIAN
139 # define READ_ENDIAN_09 LITTLE_ENDIAN
140 # define READ_ENDIAN_10 BIG_ENDIAN
141 # define STRUCT_ENDIAN_09 BIG_ENDIAN
142 # define STRUCT_ENDIAN_10 LITTLE_ENDIAN
143 #else /* little endian */
144 # define READ_ENDIAN_09 LITTLE_ENDIAN
145 # define READ_ENDIAN_10 LITTLE_ENDIAN
146 # define STRUCT_ENDIAN_09 LITTLE_ENDIAN
147 # define STRUCT_ENDIAN_10 LITTLE_ENDIAN
148 #endif
149
150
151 CFATTACH_DECL3_NEW(virtio_pci, sizeof(struct virtio_pci_softc),
152 virtio_pci_match, virtio_pci_attach, virtio_pci_detach, NULL,
153 virtio_pci_rescan, NULL, DVF_DETACH_SHUTDOWN);
154
155 static const struct virtio_ops virtio_pci_ops_09 = {
156 .kick = virtio_pci_kick_09,
157 .read_queue_size = virtio_pci_read_queue_size_09,
158 .setup_queue = virtio_pci_setup_queue_09,
159 .set_status = virtio_pci_set_status_09,
160 .neg_features = virtio_pci_negotiate_features_09,
161 .setup_interrupts = virtio_pci_setup_interrupts,
162 .free_interrupts = virtio_pci_free_interrupts,
163 };
164
165 static const struct virtio_ops virtio_pci_ops_10 = {
166 .kick = virtio_pci_kick_10,
167 .read_queue_size = virtio_pci_read_queue_size_10,
168 .setup_queue = virtio_pci_setup_queue_10,
169 .set_status = virtio_pci_set_status_10,
170 .neg_features = virtio_pci_negotiate_features_10,
171 .setup_interrupts = virtio_pci_setup_interrupts,
172 .free_interrupts = virtio_pci_free_interrupts,
173 };
174
175 static int
176 virtio_pci_match(device_t parent, cfdata_t match, void *aux)
177 {
178 struct pci_attach_args *pa;
179
180 pa = (struct pci_attach_args *)aux;
181 switch (PCI_VENDOR(pa->pa_id)) {
182 case PCI_VENDOR_QUMRANET:
183 if (((PCI_PRODUCT_QUMRANET_VIRTIO_1000 <=
184 PCI_PRODUCT(pa->pa_id)) &&
185 (PCI_PRODUCT(pa->pa_id) <=
186 PCI_PRODUCT_QUMRANET_VIRTIO_103F)) &&
187 PCI_REVISION(pa->pa_class) == 0)
188 return 1;
189 if (((PCI_PRODUCT_QUMRANET_VIRTIO_1040 <=
190 PCI_PRODUCT(pa->pa_id)) &&
191 (PCI_PRODUCT(pa->pa_id) <=
192 PCI_PRODUCT_QUMRANET_VIRTIO_107F)) &&
193 PCI_REVISION(pa->pa_class) == 1)
194 return 1;
195 break;
196 }
197
198 return 0;
199 }
200
201 static void
202 virtio_pci_attach(device_t parent, device_t self, void *aux)
203 {
204 struct virtio_pci_softc * const psc = device_private(self);
205 struct virtio_softc * const sc = &psc->sc_sc;
206 struct pci_attach_args *pa = (struct pci_attach_args *)aux;
207 pci_chipset_tag_t pc = pa->pa_pc;
208 pcitag_t tag = pa->pa_tag;
209 int revision;
210 int ret;
211 pcireg_t id;
212 pcireg_t csr;
213
214 revision = PCI_REVISION(pa->pa_class);
215 switch (revision) {
216 case 0:
217 /* subsystem ID shows what I am */
218 id = PCI_SUBSYS_ID(pci_conf_read(pc, tag, PCI_SUBSYS_ID_REG));
219 break;
220 case 1:
221 /* pci product number shows what I am */
222 id = PCI_PRODUCT(pa->pa_id) - PCI_PRODUCT_QUMRANET_VIRTIO_1040;
223 break;
224 default:
225 aprint_normal(": unknown revision 0x%02x; giving up\n",
226 revision);
227 return;
228 }
229
230 aprint_normal("\n");
231 aprint_naive("\n");
232 virtio_print_device_type(self, id, revision);
233
234 csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
235 csr |= PCI_COMMAND_MASTER_ENABLE | PCI_COMMAND_IO_ENABLE;
236 pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, csr);
237
238 sc->sc_dev = self;
239 psc->sc_pa = *pa;
240 psc->sc_iot = pa->pa_iot;
241
242 sc->sc_dmat = pa->pa_dmat;
243 if (pci_dma64_available(pa))
244 sc->sc_dmat = pa->pa_dmat64;
245
246 /* attach is dependent on revision */
247 ret = 0;
248 if (revision == 1) {
249 /* try to attach 1.0 */
250 ret = virtio_pci_attach_10(self, aux);
251 }
252 if (ret == 0 && revision == 0) {
253 /* revision 0 means 0.9 only or both 0.9 and 1.0 */
254 ret = virtio_pci_attach_09(self, aux);
255 }
256 if (ret) {
257 aprint_error_dev(self, "cannot attach (%d)\n", ret);
258 return;
259 }
260 KASSERT(sc->sc_ops);
261
262 /* preset config region */
263 psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_NOMSI;
264 if (virtio_pci_adjust_config_region(psc))
265 return;
266
267 /* generic */
268 virtio_device_reset(sc);
269 virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_ACK);
270 virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_DRIVER);
271
272 sc->sc_childdevid = id;
273 sc->sc_child = NULL;
274 virtio_pci_rescan(self, NULL, NULL);
275 return;
276 }
277
278 /* ARGSUSED */
279 static int
280 virtio_pci_rescan(device_t self, const char *ifattr, const int *locs)
281 {
282 struct virtio_pci_softc * const psc = device_private(self);
283 struct virtio_softc * const sc = &psc->sc_sc;
284 struct virtio_attach_args va;
285
286 if (sc->sc_child) /* Child already attached? */
287 return 0;
288
289 memset(&va, 0, sizeof(va));
290 va.sc_childdevid = sc->sc_childdevid;
291
292 config_found(self, &va, NULL, CFARGS_NONE);
293
294 if (virtio_attach_failed(sc))
295 return 0;
296
297 return 0;
298 }
299
300
301 static int
302 virtio_pci_detach(device_t self, int flags)
303 {
304 struct virtio_pci_softc * const psc = device_private(self);
305 struct virtio_softc * const sc = &psc->sc_sc;
306 int r;
307
308 if (sc->sc_child != NULL) {
309 r = config_detach(sc->sc_child, flags);
310 if (r)
311 return r;
312 }
313
314 /* Check that child detached properly */
315 KASSERT(sc->sc_child == NULL);
316 KASSERT(sc->sc_vqs == NULL);
317 KASSERT(psc->sc_ihs_num == 0);
318
319 if (psc->sc_iosize)
320 bus_space_unmap(psc->sc_iot, psc->sc_ioh,
321 psc->sc_mapped_iosize);
322 psc->sc_iosize = 0;
323
324 return 0;
325 }
326
327
328 static int
329 virtio_pci_attach_09(device_t self, void *aux)
330 //struct virtio_pci_softc *psc, struct pci_attach_args *pa)
331 {
332 struct virtio_pci_softc * const psc = device_private(self);
333 struct pci_attach_args *pa = (struct pci_attach_args *)aux;
334 struct virtio_softc * const sc = &psc->sc_sc;
335 // pci_chipset_tag_t pc = pa->pa_pc;
336 // pcitag_t tag = pa->pa_tag;
337
338 /* complete IO region */
339 if (pci_mapreg_map(pa, PCI_MAPREG_START, PCI_MAPREG_TYPE_IO, 0,
340 &psc->sc_iot, &psc->sc_ioh, NULL, &psc->sc_iosize)) {
341 aprint_error_dev(self, "can't map i/o space\n");
342 return EIO;
343 }
344 psc->sc_mapped_iosize = psc->sc_iosize;
345
346 /* queue space */
347 if (bus_space_subregion(psc->sc_iot, psc->sc_ioh,
348 VIRTIO_CONFIG_QUEUE_NOTIFY, 2, &psc->sc_notify_ioh)) {
349 aprint_error_dev(self, "can't map notify i/o space\n");
350 return EIO;
351 }
352 psc->sc_notify_iosize = 2;
353 psc->sc_notify_iot = psc->sc_iot;
354
355 /* ISR space */
356 if (bus_space_subregion(psc->sc_iot, psc->sc_ioh,
357 VIRTIO_CONFIG_ISR_STATUS, 1, &psc->sc_isr_ioh)) {
358 aprint_error_dev(self, "can't map isr i/o space\n");
359 return EIO;
360 }
361 psc->sc_isr_iosize = 1;
362 psc->sc_isr_iot = psc->sc_iot;
363
364 /* set our version 0.9 ops */
365 sc->sc_ops = &virtio_pci_ops_09;
366 sc->sc_bus_endian = READ_ENDIAN_09;
367 sc->sc_struct_endian = STRUCT_ENDIAN_09;
368 return 0;
369 }
370
371
372 static int
373 virtio_pci_attach_10(device_t self, void *aux)
374 {
375 struct virtio_pci_softc * const psc = device_private(self);
376 struct pci_attach_args *pa = (struct pci_attach_args *)aux;
377 struct virtio_softc * const sc = &psc->sc_sc;
378 pci_chipset_tag_t pc = pa->pa_pc;
379 pcitag_t tag = pa->pa_tag;
380
381 struct virtio_pci_cap common, isr, device;
382 struct virtio_pci_notify_cap notify;
383 int have_device_cfg = 0;
384 bus_size_t bars[NMAPREG] = { 0 };
385 int bars_idx[NMAPREG] = { 0 };
386 struct virtio_pci_cap *caps[] = { &common, &isr, &device, ¬ify.cap };
387 int i, j, ret = 0;
388
389 if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_COMMON_CFG,
390 &common, sizeof(common)))
391 return ENODEV;
392 if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_NOTIFY_CFG,
393 ¬ify, sizeof(notify)))
394 return ENODEV;
395 if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_ISR_CFG,
396 &isr, sizeof(isr)))
397 return ENODEV;
398 if (virtio_pci_find_cap(psc, VIRTIO_PCI_CAP_DEVICE_CFG,
399 &device, sizeof(device)))
400 memset(&device, 0, sizeof(device));
401 else
402 have_device_cfg = 1;
403
404 /* Figure out which bars we need to map */
405 for (i = 0; i < __arraycount(caps); i++) {
406 int bar = caps[i]->bar;
407 bus_size_t len = caps[i]->offset + caps[i]->length;
408 if (caps[i]->length == 0)
409 continue;
410 if (bars[bar] < len)
411 bars[bar] = len;
412 }
413
414 for (i = j = 0; i < __arraycount(bars); i++) {
415 int reg;
416 pcireg_t type;
417 if (bars[i] == 0)
418 continue;
419 reg = PCI_MAPREG_START + i * 4;
420 type = pci_mapreg_type(pc, tag, reg);
421 if (pci_mapreg_map(pa, reg, type, 0,
422 &psc->sc_bars_iot[j], &psc->sc_bars_ioh[j],
423 NULL, &psc->sc_bars_iosize[j])) {
424 aprint_error_dev(self, "can't map bar %u \n", i);
425 ret = EIO;
426 goto err;
427 }
428 aprint_debug_dev(self,
429 "bar[%d]: iot %p, size 0x%" PRIxBUSSIZE "\n",
430 j, psc->sc_bars_iot[j], psc->sc_bars_iosize[j]);
431 bars_idx[i] = j;
432 j++;
433 }
434
435 i = bars_idx[notify.cap.bar];
436 if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
437 notify.cap.offset, notify.cap.length,
438 &psc->sc_notify_ioh)) {
439 aprint_error_dev(self, "can't map notify i/o space\n");
440 ret = EIO;
441 goto err;
442 }
443 psc->sc_notify_iosize = notify.cap.length;
444 psc->sc_notify_iot = psc->sc_bars_iot[i];
445 psc->sc_notify_off_multiplier = le32toh(notify.notify_off_multiplier);
446
447 if (have_device_cfg) {
448 i = bars_idx[device.bar];
449 if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
450 device.offset, device.length,
451 &sc->sc_devcfg_ioh)) {
452 aprint_error_dev(self, "can't map devcfg i/o space\n");
453 ret = EIO;
454 goto err;
455 }
456 aprint_debug_dev(self,
457 "device.offset = 0x%x, device.length = 0x%x\n",
458 device.offset, device.length);
459 sc->sc_devcfg_iosize = device.length;
460 sc->sc_devcfg_iot = psc->sc_bars_iot[i];
461 }
462
463 i = bars_idx[isr.bar];
464 if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
465 isr.offset, isr.length, &psc->sc_isr_ioh)) {
466 aprint_error_dev(self, "can't map isr i/o space\n");
467 ret = EIO;
468 goto err;
469 }
470 psc->sc_isr_iosize = isr.length;
471 psc->sc_isr_iot = psc->sc_bars_iot[i];
472
473 i = bars_idx[common.bar];
474 if (bus_space_subregion(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
475 common.offset, common.length, &psc->sc_ioh)) {
476 aprint_error_dev(self, "can't map common i/o space\n");
477 ret = EIO;
478 goto err;
479 }
480 psc->sc_iosize = common.length;
481 psc->sc_iot = psc->sc_bars_iot[i];
482 psc->sc_mapped_iosize = psc->sc_bars_iosize[i];
483
484 psc->sc_sc.sc_version_1 = 1;
485
486 /* set our version 1.0 ops */
487 sc->sc_ops = &virtio_pci_ops_10;
488 sc->sc_bus_endian = READ_ENDIAN_10;
489 sc->sc_struct_endian = STRUCT_ENDIAN_10;
490 return 0;
491
492 err:
493 /* undo our pci_mapreg_map()s */
494 for (i = 0; i < __arraycount(bars); i++) {
495 if (psc->sc_bars_iosize[i] == 0)
496 continue;
497 bus_space_unmap(psc->sc_bars_iot[i], psc->sc_bars_ioh[i],
498 psc->sc_bars_iosize[i]);
499 }
500 return ret;
501 }
502
503 /* v1.0 attach helper */
504 static int
505 virtio_pci_find_cap(struct virtio_pci_softc *psc, int cfg_type, void *buf, int buflen)
506 {
507 device_t self = psc->sc_sc.sc_dev;
508 pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
509 pcitag_t tag = psc->sc_pa.pa_tag;
510 unsigned int offset, i, len;
511 union {
512 pcireg_t reg[8];
513 struct virtio_pci_cap vcap;
514 } *v = buf;
515
516 if (buflen < sizeof(struct virtio_pci_cap))
517 return ERANGE;
518
519 if (!pci_get_capability(pc, tag, PCI_CAP_VENDSPEC, &offset, &v->reg[0]))
520 return ENOENT;
521
522 do {
523 for (i = 0; i < 4; i++)
524 v->reg[i] =
525 le32toh(pci_conf_read(pc, tag, offset + i * 4));
526 if (v->vcap.cfg_type == cfg_type)
527 break;
528 offset = v->vcap.cap_next;
529 } while (offset != 0);
530
531 if (offset == 0)
532 return ENOENT;
533
534 if (v->vcap.cap_len > sizeof(struct virtio_pci_cap)) {
535 len = roundup(v->vcap.cap_len, sizeof(pcireg_t));
536 if (len > buflen) {
537 aprint_error_dev(self, "%s cap too large\n", __func__);
538 return ERANGE;
539 }
540 for (i = 4; i < len / sizeof(pcireg_t); i++)
541 v->reg[i] =
542 le32toh(pci_conf_read(pc, tag, offset + i * 4));
543 }
544
545 /* endian fixup */
546 v->vcap.offset = le32toh(v->vcap.offset);
547 v->vcap.length = le32toh(v->vcap.length);
548 return 0;
549 }
550
551
552 /* -------------------------------------
553 * Version 0.9 support
554 * -------------------------------------*/
555
556 static void
557 virtio_pci_kick_09(struct virtio_softc *sc, uint16_t idx)
558 {
559 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
560
561 bus_space_write_2(psc->sc_notify_iot, psc->sc_notify_ioh, 0, idx);
562 }
563
564 /* only applicable for v 0.9 but also called for 1.0 */
565 static int
566 virtio_pci_adjust_config_region(struct virtio_pci_softc *psc)
567 {
568 struct virtio_softc * const sc = (struct virtio_softc *) psc;
569 device_t self = psc->sc_sc.sc_dev;
570
571 if (psc->sc_sc.sc_version_1)
572 return 0;
573
574 sc->sc_devcfg_iosize = psc->sc_iosize - psc->sc_devcfg_offset;
575 sc->sc_devcfg_iot = psc->sc_iot;
576 if (bus_space_subregion(psc->sc_iot, psc->sc_ioh,
577 psc->sc_devcfg_offset, sc->sc_devcfg_iosize,
578 &sc->sc_devcfg_ioh)) {
579 aprint_error_dev(self, "can't map config i/o space\n");
580 return EIO;
581 }
582
583 return 0;
584 }
585
586 static uint16_t
587 virtio_pci_read_queue_size_09(struct virtio_softc *sc, uint16_t idx)
588 {
589 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
590
591 bus_space_write_2(psc->sc_iot, psc->sc_ioh,
592 VIRTIO_CONFIG_QUEUE_SELECT, idx);
593 return bus_space_read_2(psc->sc_iot, psc->sc_ioh,
594 VIRTIO_CONFIG_QUEUE_SIZE);
595 }
596
597 static void
598 virtio_pci_setup_queue_09(struct virtio_softc *sc, uint16_t idx, uint64_t addr)
599 {
600 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
601
602 bus_space_write_2(psc->sc_iot, psc->sc_ioh,
603 VIRTIO_CONFIG_QUEUE_SELECT, idx);
604 bus_space_write_4(psc->sc_iot, psc->sc_ioh,
605 VIRTIO_CONFIG_QUEUE_ADDRESS, addr / VIRTIO_PAGE_SIZE);
606
607 if (psc->sc_ihs_num > 1) {
608 int vec = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
609 if (sc->sc_child_mq)
610 vec += idx;
611 bus_space_write_2(psc->sc_iot, psc->sc_ioh,
612 VIRTIO_CONFIG_MSI_QUEUE_VECTOR, vec);
613 }
614 }
615
616 static void
617 virtio_pci_set_status_09(struct virtio_softc *sc, int status)
618 {
619 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
620 int old = 0;
621
622 if (status != 0) {
623 old = bus_space_read_1(psc->sc_iot, psc->sc_ioh,
624 VIRTIO_CONFIG_DEVICE_STATUS);
625 }
626 bus_space_write_1(psc->sc_iot, psc->sc_ioh,
627 VIRTIO_CONFIG_DEVICE_STATUS, status|old);
628 }
629
630 static void
631 virtio_pci_negotiate_features_09(struct virtio_softc *sc, uint64_t guest_features)
632 {
633 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
634 uint32_t r;
635
636 r = bus_space_read_4(psc->sc_iot, psc->sc_ioh,
637 VIRTIO_CONFIG_DEVICE_FEATURES);
638
639 r &= guest_features;
640
641 bus_space_write_4(psc->sc_iot, psc->sc_ioh,
642 VIRTIO_CONFIG_GUEST_FEATURES, r);
643
644 sc->sc_active_features = r;
645 }
646
647 /* -------------------------------------
648 * Version 1.0 support
649 * -------------------------------------*/
650
651 static void
652 virtio_pci_kick_10(struct virtio_softc *sc, uint16_t idx)
653 {
654 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
655 unsigned offset = sc->sc_vqs[idx].vq_notify_off *
656 psc->sc_notify_off_multiplier;
657
658 bus_space_write_2(psc->sc_notify_iot, psc->sc_notify_ioh, offset, idx);
659 }
660
661
662 static uint16_t
663 virtio_pci_read_queue_size_10(struct virtio_softc *sc, uint16_t idx)
664 {
665 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
666 bus_space_tag_t iot = psc->sc_iot;
667 bus_space_handle_t ioh = psc->sc_ioh;
668
669 bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, idx);
670 return bus_space_read_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SIZE);
671 }
672
673 /*
674 * By definition little endian only in v1.0 and 8 byters are allowed to be
675 * written as two 4 byters
676 *
677 * This is not a general purpose function that can be used in any
678 * driver. Virtio specifically allows the 8 byte bus transaction
679 * to be split into two 4 byte transactions. Do not copy/use it
680 * in other device drivers unless you know that the device accepts it.
681 */
682 static __inline void
683 virtio_pci_bus_space_write_8(bus_space_tag_t iot, bus_space_handle_t ioh,
684 bus_size_t offset, uint64_t value)
685 {
686 #if defined(__HAVE_BUS_SPACE_8)
687 bus_space_write_8(iot, ioh, offset, value);
688 #elif _QUAD_HIGHWORD
689 bus_space_write_4(iot, ioh, offset, BUS_ADDR_LO32(value));
690 bus_space_write_4(iot, ioh, offset + 4, BUS_ADDR_HI32(value));
691 #else
692 bus_space_write_4(iot, ioh, offset, BUS_ADDR_HI32(value));
693 bus_space_write_4(iot, ioh, offset + 4, BUS_ADDR_LO32(value));
694 #endif
695 }
696
697 static void
698 virtio_pci_setup_queue_10(struct virtio_softc *sc, uint16_t idx, uint64_t addr)
699 {
700 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
701 struct virtqueue *vq = &sc->sc_vqs[idx];
702 bus_space_tag_t iot = psc->sc_iot;
703 bus_space_handle_t ioh = psc->sc_ioh;
704 KASSERT(vq->vq_index == idx);
705
706 bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, vq->vq_index);
707 if (addr == 0) {
708 bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_ENABLE, 0);
709 virtio_pci_bus_space_write_8(iot, ioh,
710 VIRTIO_CONFIG1_QUEUE_DESC, 0);
711 virtio_pci_bus_space_write_8(iot, ioh,
712 VIRTIO_CONFIG1_QUEUE_AVAIL, 0);
713 virtio_pci_bus_space_write_8(iot, ioh,
714 VIRTIO_CONFIG1_QUEUE_USED, 0);
715 } else {
716 virtio_pci_bus_space_write_8(iot, ioh,
717 VIRTIO_CONFIG1_QUEUE_DESC, addr);
718 virtio_pci_bus_space_write_8(iot, ioh,
719 VIRTIO_CONFIG1_QUEUE_AVAIL, addr + vq->vq_availoffset);
720 virtio_pci_bus_space_write_8(iot, ioh,
721 VIRTIO_CONFIG1_QUEUE_USED, addr + vq->vq_usedoffset);
722 bus_space_write_2(iot, ioh,
723 VIRTIO_CONFIG1_QUEUE_ENABLE, 1);
724 vq->vq_notify_off = bus_space_read_2(iot, ioh,
725 VIRTIO_CONFIG1_QUEUE_NOTIFY_OFF);
726 }
727
728 if (psc->sc_ihs_num > 1) {
729 int vec = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
730 if (sc->sc_child_mq)
731 vec += idx;
732 bus_space_write_2(iot, ioh,
733 VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR, vec);
734 }
735 }
736
737 static void
738 virtio_pci_set_status_10(struct virtio_softc *sc, int status)
739 {
740 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
741 bus_space_tag_t iot = psc->sc_iot;
742 bus_space_handle_t ioh = psc->sc_ioh;
743 int old = 0;
744
745 if (status)
746 old = bus_space_read_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS);
747 bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS, status | old);
748 }
749
750 void
751 virtio_pci_negotiate_features_10(struct virtio_softc *sc, uint64_t guest_features)
752 {
753 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
754 device_t self = sc->sc_dev;
755 bus_space_tag_t iot = psc->sc_iot;
756 bus_space_handle_t ioh = psc->sc_ioh;
757 uint64_t host, negotiated, device_status;
758
759 guest_features |= VIRTIO_F_VERSION_1;
760 /* notify on empty is 0.9 only */
761 guest_features &= ~VIRTIO_F_NOTIFY_ON_EMPTY;
762 sc->sc_active_features = 0;
763
764 bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE_SELECT, 0);
765 host = bus_space_read_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE);
766 bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE_SELECT, 1);
767 host |= (uint64_t)
768 bus_space_read_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE) << 32;
769
770 negotiated = host & guest_features;
771
772 bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE_SELECT, 0);
773 bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE,
774 negotiated & 0xffffffff);
775 bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE_SELECT, 1);
776 bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE,
777 negotiated >> 32);
778 virtio_pci_set_status_10(sc, VIRTIO_CONFIG_DEVICE_STATUS_FEATURES_OK);
779
780 device_status = bus_space_read_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS);
781 if ((device_status & VIRTIO_CONFIG_DEVICE_STATUS_FEATURES_OK) == 0) {
782 aprint_error_dev(self, "feature negotiation failed\n");
783 bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS,
784 VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
785 return;
786 }
787
788 if ((negotiated & VIRTIO_F_VERSION_1) == 0) {
789 aprint_error_dev(self, "host rejected version 1\n");
790 bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS,
791 VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
792 return;
793 }
794
795 sc->sc_active_features = negotiated;
796 return;
797 }
798
799
800 /* -------------------------------------
801 * Generic PCI interrupt code
802 * -------------------------------------*/
803
804 static int
805 virtio_pci_setup_msix_vectors_10(struct virtio_softc *sc)
806 {
807 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
808 device_t self = sc->sc_dev;
809 bus_space_tag_t iot = psc->sc_iot;
810 bus_space_handle_t ioh = psc->sc_ioh;
811 int vector, ret, qid;
812
813 vector = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
814 bus_space_write_2(iot, ioh,
815 VIRTIO_CONFIG1_CONFIG_MSIX_VECTOR, vector);
816 ret = bus_space_read_2(iot, ioh, VIRTIO_CONFIG1_CONFIG_MSIX_VECTOR);
817 if (ret != vector) {
818 aprint_error_dev(self, "can't set config msix vector\n");
819 return -1;
820 }
821
822 for (qid = 0; qid < sc->sc_nvqs; qid++) {
823 vector = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
824
825 if (sc->sc_child_mq)
826 vector += qid;
827 bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, qid);
828 bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR,
829 vector);
830 ret = bus_space_read_2(iot, ioh,
831 VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR);
832 if (ret != vector) {
833 aprint_error_dev(self, "can't set queue %d "
834 "msix vector\n", qid);
835 return -1;
836 }
837 }
838
839 return 0;
840 }
841
842 static int
843 virtio_pci_setup_msix_vectors_09(struct virtio_softc *sc)
844 {
845 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
846 device_t self = sc->sc_dev;
847 int offset, vector, ret, qid;
848
849 offset = VIRTIO_CONFIG_MSI_CONFIG_VECTOR;
850 vector = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
851
852 bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, vector);
853 ret = bus_space_read_2(psc->sc_iot, psc->sc_ioh, offset);
854 aprint_debug_dev(sc->sc_dev, "expected=%d, actual=%d\n",
855 vector, ret);
856 if (ret != vector) {
857 aprint_error_dev(self, "can't set config msix vector\n");
858 return -1;
859 }
860
861 for (qid = 0; qid < sc->sc_nvqs; qid++) {
862 offset = VIRTIO_CONFIG_QUEUE_SELECT;
863 bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, qid);
864
865 offset = VIRTIO_CONFIG_MSI_QUEUE_VECTOR;
866 vector = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
867
868 if (sc->sc_child_mq)
869 vector += qid;
870
871 bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, vector);
872 ret = bus_space_read_2(psc->sc_iot, psc->sc_ioh, offset);
873 aprint_debug_dev(sc->sc_dev, "expected=%d, actual=%d\n",
874 vector, ret);
875 if (ret != vector) {
876 aprint_error_dev(self, "can't set queue %d "
877 "msix vector\n", qid);
878 return -1;
879 }
880 }
881
882 return 0;
883 }
884
885 static int
886 virtio_pci_setup_msix_interrupts(struct virtio_softc *sc,
887 struct pci_attach_args *pa)
888 {
889 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
890 device_t self = sc->sc_dev;
891 pci_chipset_tag_t pc = pa->pa_pc;
892 struct virtqueue *vq;
893 char intrbuf[PCI_INTRSTR_LEN];
894 char intr_xname[INTRDEVNAMEBUF];
895 char const *intrstr;
896 int idx, qid, n;
897 int ret;
898
899 idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
900 if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
901 pci_intr_setattr(pc, &psc->sc_ihp[idx], PCI_INTR_MPSAFE, true);
902
903 snprintf(intr_xname, sizeof(intr_xname), "%s config",
904 device_xname(sc->sc_dev));
905
906 psc->sc_ihs[idx] = pci_intr_establish_xname(pc, psc->sc_ihp[idx],
907 sc->sc_ipl, virtio_pci_msix_config_intr, sc, intr_xname);
908 if (psc->sc_ihs[idx] == NULL) {
909 aprint_error_dev(self, "couldn't establish MSI-X for config\n");
910 goto error;
911 }
912
913 idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
914 if (sc->sc_child_mq) {
915 for (qid = 0; qid < sc->sc_nvqs; qid++) {
916 n = idx + qid;
917 vq = &sc->sc_vqs[qid];
918
919 snprintf(intr_xname, sizeof(intr_xname), "%s vq#%d",
920 device_xname(sc->sc_dev), qid);
921
922 if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE) {
923 pci_intr_setattr(pc, &psc->sc_ihp[n],
924 PCI_INTR_MPSAFE, true);
925 }
926
927 psc->sc_ihs[n] = pci_intr_establish_xname(pc, psc->sc_ihp[n],
928 sc->sc_ipl, vq->vq_intrhand, vq->vq_intrhand_arg, intr_xname);
929 if (psc->sc_ihs[n] == NULL) {
930 aprint_error_dev(self, "couldn't establish MSI-X for a vq\n");
931 goto error;
932 }
933 }
934 } else {
935 if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
936 pci_intr_setattr(pc, &psc->sc_ihp[idx], PCI_INTR_MPSAFE, true);
937
938 snprintf(intr_xname, sizeof(intr_xname), "%s queues",
939 device_xname(sc->sc_dev));
940 psc->sc_ihs[idx] = pci_intr_establish_xname(pc, psc->sc_ihp[idx],
941 sc->sc_ipl, virtio_pci_msix_queue_intr, sc, intr_xname);
942 if (psc->sc_ihs[idx] == NULL) {
943 aprint_error_dev(self, "couldn't establish MSI-X for queues\n");
944 goto error;
945 }
946 }
947
948 if (sc->sc_version_1) {
949 ret = virtio_pci_setup_msix_vectors_10(sc);
950 } else {
951 ret = virtio_pci_setup_msix_vectors_09(sc);
952 }
953 if (ret) {
954 aprint_error_dev(self, "couldn't setup MSI-X vectors\n");
955 goto error;
956 }
957
958 idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
959 intrstr = pci_intr_string(pc, psc->sc_ihp[idx], intrbuf, sizeof(intrbuf));
960 aprint_normal_dev(self, "config interrupting at %s\n", intrstr);
961 idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
962 if (sc->sc_child_mq) {
963 kcpuset_t *affinity;
964 int affinity_to, r;
965
966 kcpuset_create(&affinity, false);
967
968 for (qid = 0; qid < sc->sc_nvqs; qid++) {
969 n = idx + qid;
970 affinity_to = (qid / 2) % ncpu;
971
972 intrstr = pci_intr_string(pc, psc->sc_ihp[n],
973 intrbuf, sizeof(intrbuf));
974
975 kcpuset_zero(affinity);
976 kcpuset_set(affinity, affinity_to);
977 r = interrupt_distribute(psc->sc_ihs[n], affinity, NULL);
978 if (r == 0) {
979 aprint_normal_dev(self,
980 "for vq #%d interrupting at %s affinity to %u\n",
981 qid, intrstr, affinity_to);
982 } else {
983 aprint_normal_dev(self,
984 "for vq #%d interrupting at %s\n",
985 qid, intrstr);
986 }
987 }
988
989 kcpuset_destroy(affinity);
990 } else {
991 intrstr = pci_intr_string(pc, psc->sc_ihp[idx], intrbuf, sizeof(intrbuf));
992 aprint_normal_dev(self, "queues interrupting at %s\n", intrstr);
993 }
994
995 return 0;
996
997 error:
998 idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
999 if (psc->sc_ihs[idx] != NULL)
1000 pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[idx]);
1001 idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
1002 if (sc->sc_child_mq) {
1003 for (qid = 0; qid < sc->sc_nvqs; qid++) {
1004 n = idx + qid;
1005 if (psc->sc_ihs[n] == NULL)
1006 continue;
1007 pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[n]);
1008 }
1009
1010 } else {
1011 if (psc->sc_ihs[idx] != NULL)
1012 pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[idx]);
1013 }
1014
1015 return -1;
1016 }
1017
1018 static int
1019 virtio_pci_setup_intx_interrupt(struct virtio_softc *sc,
1020 struct pci_attach_args *pa)
1021 {
1022 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1023 device_t self = sc->sc_dev;
1024 pci_chipset_tag_t pc = pa->pa_pc;
1025 char intrbuf[PCI_INTRSTR_LEN];
1026 char const *intrstr;
1027
1028 if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
1029 pci_intr_setattr(pc, &psc->sc_ihp[0], PCI_INTR_MPSAFE, true);
1030
1031 psc->sc_ihs[0] = pci_intr_establish_xname(pc, psc->sc_ihp[0],
1032 sc->sc_ipl, virtio_pci_intr, sc, device_xname(sc->sc_dev));
1033 if (psc->sc_ihs[0] == NULL) {
1034 aprint_error_dev(self, "couldn't establish INTx\n");
1035 return -1;
1036 }
1037
1038 intrstr = pci_intr_string(pc, psc->sc_ihp[0], intrbuf, sizeof(intrbuf));
1039 aprint_normal_dev(self, "interrupting at %s\n", intrstr);
1040
1041 return 0;
1042 }
1043
1044 static int
1045 virtio_pci_setup_interrupts(struct virtio_softc *sc)
1046 {
1047 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1048 device_t self = sc->sc_dev;
1049 pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
1050 pcitag_t tag = psc->sc_pa.pa_tag;
1051 int error;
1052 int nmsix;
1053 int off;
1054 int counts[PCI_INTR_TYPE_SIZE];
1055 pci_intr_type_t max_type;
1056 pcireg_t ctl;
1057
1058 nmsix = pci_msix_count(psc->sc_pa.pa_pc, psc->sc_pa.pa_tag);
1059 aprint_debug_dev(self, "pci_msix_count=%d\n", nmsix);
1060
1061 /* We need at least two: one for config and the other for queues */
1062 if ((sc->sc_flags & VIRTIO_F_INTR_MSIX) == 0 || nmsix < 2) {
1063 /* Try INTx only */
1064 max_type = PCI_INTR_TYPE_INTX;
1065 counts[PCI_INTR_TYPE_INTX] = 1;
1066 } else {
1067 /* Try MSI-X first and INTx second */
1068 if (sc->sc_nvqs + VIRTIO_MSIX_QUEUE_VECTOR_INDEX <= nmsix) {
1069 nmsix = sc->sc_nvqs + VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
1070 } else {
1071 sc->sc_child_mq = false;
1072 }
1073
1074 if (sc->sc_child_mq == false) {
1075 nmsix = 2;
1076 }
1077
1078 max_type = PCI_INTR_TYPE_MSIX;
1079 counts[PCI_INTR_TYPE_MSIX] = nmsix;
1080 counts[PCI_INTR_TYPE_MSI] = 0;
1081 counts[PCI_INTR_TYPE_INTX] = 1;
1082 }
1083
1084 retry:
1085 error = pci_intr_alloc(&psc->sc_pa, &psc->sc_ihp, counts, max_type);
1086 if (error != 0) {
1087 aprint_error_dev(self, "couldn't map interrupt\n");
1088 return -1;
1089 }
1090
1091 if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_MSIX) {
1092 psc->sc_ihs = kmem_zalloc(sizeof(*psc->sc_ihs) * nmsix,
1093 KM_SLEEP);
1094
1095 error = virtio_pci_setup_msix_interrupts(sc, &psc->sc_pa);
1096 if (error != 0) {
1097 kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * nmsix);
1098 pci_intr_release(pc, psc->sc_ihp, nmsix);
1099
1100 /* Retry INTx */
1101 max_type = PCI_INTR_TYPE_INTX;
1102 counts[PCI_INTR_TYPE_INTX] = 1;
1103 goto retry;
1104 }
1105
1106 psc->sc_ihs_num = nmsix;
1107 psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_MSI;
1108 virtio_pci_adjust_config_region(psc);
1109 } else if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_INTX) {
1110 psc->sc_ihs = kmem_zalloc(sizeof(*psc->sc_ihs) * 1,
1111 KM_SLEEP);
1112
1113 error = virtio_pci_setup_intx_interrupt(sc, &psc->sc_pa);
1114 if (error != 0) {
1115 kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * 1);
1116 pci_intr_release(pc, psc->sc_ihp, 1);
1117 return -1;
1118 }
1119
1120 psc->sc_ihs_num = 1;
1121 psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_NOMSI;
1122 virtio_pci_adjust_config_region(psc);
1123
1124 error = pci_get_capability(pc, tag, PCI_CAP_MSIX, &off, NULL);
1125 if (error != 0) {
1126 ctl = pci_conf_read(pc, tag, off + PCI_MSIX_CTL);
1127 ctl &= ~PCI_MSIX_CTL_ENABLE;
1128 pci_conf_write(pc, tag, off + PCI_MSIX_CTL, ctl);
1129 }
1130 }
1131
1132 return 0;
1133 }
1134
1135 static void
1136 virtio_pci_free_interrupts(struct virtio_softc *sc)
1137 {
1138 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1139
1140 for (int i = 0; i < psc->sc_ihs_num; i++) {
1141 if (psc->sc_ihs[i] == NULL)
1142 continue;
1143 pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[i]);
1144 psc->sc_ihs[i] = NULL;
1145 }
1146
1147 if (psc->sc_ihs_num > 0)
1148 pci_intr_release(psc->sc_pa.pa_pc, psc->sc_ihp, psc->sc_ihs_num);
1149
1150 if (psc->sc_ihs != NULL) {
1151 kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * psc->sc_ihs_num);
1152 psc->sc_ihs = NULL;
1153 }
1154 psc->sc_ihs_num = 0;
1155 }
1156
1157 /*
1158 * Interrupt handler.
1159 */
1160 static int
1161 virtio_pci_intr(void *arg)
1162 {
1163 struct virtio_softc *sc = arg;
1164 struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1165 int isr, r = 0;
1166
1167 /* check and ack the interrupt */
1168 isr = bus_space_read_1(psc->sc_isr_iot, psc->sc_isr_ioh, 0);
1169 if (isr == 0)
1170 return 0;
1171 if ((isr & VIRTIO_CONFIG_ISR_CONFIG_CHANGE) &&
1172 (sc->sc_config_change != NULL))
1173 r = (sc->sc_config_change)(sc);
1174 if (sc->sc_intrhand != NULL) {
1175 if (sc->sc_soft_ih != NULL)
1176 softint_schedule(sc->sc_soft_ih);
1177 else
1178 r |= (sc->sc_intrhand)(sc);
1179 }
1180
1181 return r;
1182 }
1183
1184 static int
1185 virtio_pci_msix_queue_intr(void *arg)
1186 {
1187 struct virtio_softc *sc = arg;
1188 int r = 0;
1189
1190 if (sc->sc_intrhand != NULL) {
1191 if (sc->sc_soft_ih != NULL)
1192 softint_schedule(sc->sc_soft_ih);
1193 else
1194 r |= (sc->sc_intrhand)(sc);
1195 }
1196
1197 return r;
1198 }
1199
1200 static int
1201 virtio_pci_msix_config_intr(void *arg)
1202 {
1203 struct virtio_softc *sc = arg;
1204 int r = 0;
1205
1206 if (sc->sc_config_change != NULL)
1207 r = (sc->sc_config_change)(sc);
1208 return r;
1209 }
1210
1211 MODULE(MODULE_CLASS_DRIVER, virtio_pci, "pci,virtio");
1212
1213 #ifdef _MODULE
1214 #include "ioconf.c"
1215 #endif
1216
1217 static int
1218 virtio_pci_modcmd(modcmd_t cmd, void *opaque)
1219 {
1220 int error = 0;
1221
1222 #ifdef _MODULE
1223 switch (cmd) {
1224 case MODULE_CMD_INIT:
1225 error = config_init_component(cfdriver_ioconf_virtio_pci,
1226 cfattach_ioconf_virtio_pci, cfdata_ioconf_virtio_pci);
1227 break;
1228 case MODULE_CMD_FINI:
1229 error = config_fini_component(cfdriver_ioconf_virtio_pci,
1230 cfattach_ioconf_virtio_pci, cfdata_ioconf_virtio_pci);
1231 break;
1232 default:
1233 error = ENOTTY;
1234 break;
1235 }
1236 #endif
1237
1238 return error;
1239 }
1240