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