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