virtio_pci.c revision 1.34 1 1.34 uwe /* $NetBSD: virtio_pci.c,v 1.34 2022/03/14 12:22:02 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.34 uwe __KERNEL_RCSID(0, "$NetBSD: virtio_pci.c,v 1.34 2022/03/14 12:22:02 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.15 reinoud reg = PCI_MAPREG_START + i * 4;
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.18 reinoud * By definition little endian only in v1.0 and 8 byters are allowed to be
698 1.18 reinoud * written as two 4 byters
699 1.24 thorpej *
700 1.20 christos * This is not a general purpose function that can be used in any
701 1.20 christos * driver. Virtio specifically allows the 8 byte bus transaction
702 1.20 christos * to be split into two 4 byte transactions. Do not copy/use it
703 1.20 christos * in other device drivers unless you know that the device accepts it.
704 1.20 christos */
705 1.19 christos static __inline void
706 1.24 thorpej virtio_pci_bus_space_write_8(bus_space_tag_t iot, bus_space_handle_t ioh,
707 1.19 christos bus_size_t offset, uint64_t value)
708 1.19 christos {
709 1.24 thorpej #if defined(__HAVE_BUS_SPACE_8)
710 1.24 thorpej bus_space_write_8(iot, ioh, offset, value);
711 1.24 thorpej #elif _QUAD_HIGHWORD
712 1.19 christos bus_space_write_4(iot, ioh, offset, BUS_ADDR_LO32(value));
713 1.19 christos bus_space_write_4(iot, ioh, offset + 4, BUS_ADDR_HI32(value));
714 1.19 christos #else
715 1.19 christos bus_space_write_4(iot, ioh, offset, BUS_ADDR_HI32(value));
716 1.19 christos bus_space_write_4(iot, ioh, offset + 4, BUS_ADDR_LO32(value));
717 1.19 christos #endif
718 1.19 christos }
719 1.18 reinoud
720 1.4 jakllsch static void
721 1.15 reinoud virtio_pci_setup_queue_10(struct virtio_softc *sc, uint16_t idx, uint64_t addr)
722 1.4 jakllsch {
723 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
724 1.15 reinoud struct virtqueue *vq = &sc->sc_vqs[idx];
725 1.15 reinoud bus_space_tag_t iot = psc->sc_iot;
726 1.15 reinoud bus_space_handle_t ioh = psc->sc_ioh;
727 1.15 reinoud KASSERT(vq->vq_index == idx);
728 1.15 reinoud
729 1.15 reinoud bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, vq->vq_index);
730 1.15 reinoud if (addr == 0) {
731 1.15 reinoud bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_ENABLE, 0);
732 1.24 thorpej virtio_pci_bus_space_write_8(iot, ioh,
733 1.24 thorpej VIRTIO_CONFIG1_QUEUE_DESC, 0);
734 1.24 thorpej virtio_pci_bus_space_write_8(iot, ioh,
735 1.24 thorpej VIRTIO_CONFIG1_QUEUE_AVAIL, 0);
736 1.24 thorpej virtio_pci_bus_space_write_8(iot, ioh,
737 1.24 thorpej VIRTIO_CONFIG1_QUEUE_USED, 0);
738 1.15 reinoud } else {
739 1.24 thorpej virtio_pci_bus_space_write_8(iot, ioh,
740 1.15 reinoud VIRTIO_CONFIG1_QUEUE_DESC, addr);
741 1.24 thorpej virtio_pci_bus_space_write_8(iot, ioh,
742 1.15 reinoud VIRTIO_CONFIG1_QUEUE_AVAIL, addr + vq->vq_availoffset);
743 1.24 thorpej virtio_pci_bus_space_write_8(iot, ioh,
744 1.15 reinoud VIRTIO_CONFIG1_QUEUE_USED, addr + vq->vq_usedoffset);
745 1.15 reinoud bus_space_write_2(iot, ioh,
746 1.15 reinoud VIRTIO_CONFIG1_QUEUE_ENABLE, 1);
747 1.15 reinoud vq->vq_notify_off = bus_space_read_2(iot, ioh,
748 1.15 reinoud VIRTIO_CONFIG1_QUEUE_NOTIFY_OFF);
749 1.15 reinoud }
750 1.4 jakllsch
751 1.4 jakllsch if (psc->sc_ihs_num > 1) {
752 1.4 jakllsch int vec = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
753 1.6 yamaguch if (sc->sc_child_mq)
754 1.4 jakllsch vec += idx;
755 1.15 reinoud bus_space_write_2(iot, ioh,
756 1.15 reinoud VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR, vec);
757 1.4 jakllsch }
758 1.4 jakllsch }
759 1.4 jakllsch
760 1.4 jakllsch static void
761 1.15 reinoud virtio_pci_set_status_10(struct virtio_softc *sc, int status)
762 1.4 jakllsch {
763 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
764 1.15 reinoud bus_space_tag_t iot = psc->sc_iot;
765 1.15 reinoud bus_space_handle_t ioh = psc->sc_ioh;
766 1.4 jakllsch int old = 0;
767 1.4 jakllsch
768 1.15 reinoud if (status)
769 1.15 reinoud old = bus_space_read_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS);
770 1.15 reinoud bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS, status | old);
771 1.15 reinoud }
772 1.15 reinoud
773 1.15 reinoud void
774 1.15 reinoud virtio_pci_negotiate_features_10(struct virtio_softc *sc, uint64_t guest_features)
775 1.15 reinoud {
776 1.15 reinoud struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
777 1.15 reinoud device_t self = sc->sc_dev;
778 1.15 reinoud bus_space_tag_t iot = psc->sc_iot;
779 1.15 reinoud bus_space_handle_t ioh = psc->sc_ioh;
780 1.15 reinoud uint64_t host, negotiated, device_status;
781 1.15 reinoud
782 1.15 reinoud guest_features |= VIRTIO_F_VERSION_1;
783 1.15 reinoud /* notify on empty is 0.9 only */
784 1.15 reinoud guest_features &= ~VIRTIO_F_NOTIFY_ON_EMPTY;
785 1.15 reinoud sc->sc_active_features = 0;
786 1.15 reinoud
787 1.15 reinoud bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE_SELECT, 0);
788 1.15 reinoud host = bus_space_read_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE);
789 1.15 reinoud bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE_SELECT, 1);
790 1.15 reinoud host |= (uint64_t)
791 1.15 reinoud bus_space_read_4(iot, ioh, VIRTIO_CONFIG1_DEVICE_FEATURE) << 32;
792 1.15 reinoud
793 1.15 reinoud negotiated = host & guest_features;
794 1.15 reinoud
795 1.15 reinoud bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE_SELECT, 0);
796 1.15 reinoud bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE,
797 1.15 reinoud negotiated & 0xffffffff);
798 1.15 reinoud bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE_SELECT, 1);
799 1.15 reinoud bus_space_write_4(iot, ioh, VIRTIO_CONFIG1_DRIVER_FEATURE,
800 1.15 reinoud negotiated >> 32);
801 1.15 reinoud virtio_pci_set_status_10(sc, VIRTIO_CONFIG_DEVICE_STATUS_FEATURES_OK);
802 1.15 reinoud
803 1.15 reinoud device_status = bus_space_read_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS);
804 1.15 reinoud if ((device_status & VIRTIO_CONFIG_DEVICE_STATUS_FEATURES_OK) == 0) {
805 1.15 reinoud aprint_error_dev(self, "feature negotiation failed\n");
806 1.15 reinoud bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS,
807 1.15 reinoud VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
808 1.15 reinoud return;
809 1.15 reinoud }
810 1.15 reinoud
811 1.15 reinoud if ((negotiated & VIRTIO_F_VERSION_1) == 0) {
812 1.15 reinoud aprint_error_dev(self, "host rejected version 1\n");
813 1.15 reinoud bus_space_write_1(iot, ioh, VIRTIO_CONFIG1_DEVICE_STATUS,
814 1.15 reinoud VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
815 1.15 reinoud return;
816 1.4 jakllsch }
817 1.15 reinoud
818 1.15 reinoud sc->sc_active_features = negotiated;
819 1.15 reinoud return;
820 1.15 reinoud }
821 1.15 reinoud
822 1.15 reinoud
823 1.15 reinoud /* -------------------------------------
824 1.15 reinoud * Generic PCI interrupt code
825 1.15 reinoud * -------------------------------------*/
826 1.15 reinoud
827 1.15 reinoud static int
828 1.32 yamaguch virtio_pci_setup_interrupts_10(struct virtio_softc *sc, int reinit)
829 1.4 jakllsch {
830 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
831 1.15 reinoud bus_space_tag_t iot = psc->sc_iot;
832 1.15 reinoud bus_space_handle_t ioh = psc->sc_ioh;
833 1.15 reinoud int vector, ret, qid;
834 1.15 reinoud
835 1.31 yamaguch if (!virtio_pci_msix_enabled(psc))
836 1.31 yamaguch return 0;
837 1.31 yamaguch
838 1.15 reinoud vector = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
839 1.15 reinoud bus_space_write_2(iot, ioh,
840 1.15 reinoud VIRTIO_CONFIG1_CONFIG_MSIX_VECTOR, vector);
841 1.15 reinoud ret = bus_space_read_2(iot, ioh, VIRTIO_CONFIG1_CONFIG_MSIX_VECTOR);
842 1.15 reinoud if (ret != vector) {
843 1.33 yamaguch VIRTIO_PCI_LOG(sc, reinit,
844 1.33 yamaguch "can't set config msix vector\n");
845 1.15 reinoud return -1;
846 1.15 reinoud }
847 1.15 reinoud
848 1.15 reinoud for (qid = 0; qid < sc->sc_nvqs; qid++) {
849 1.15 reinoud vector = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
850 1.4 jakllsch
851 1.15 reinoud if (sc->sc_child_mq)
852 1.15 reinoud vector += qid;
853 1.15 reinoud bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_SELECT, qid);
854 1.15 reinoud bus_space_write_2(iot, ioh, VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR,
855 1.15 reinoud vector);
856 1.15 reinoud ret = bus_space_read_2(iot, ioh,
857 1.15 reinoud VIRTIO_CONFIG1_QUEUE_MSIX_VECTOR);
858 1.15 reinoud if (ret != vector) {
859 1.33 yamaguch VIRTIO_PCI_LOG(sc, reinit, "can't set queue %d "
860 1.33 yamaguch "msix vector\n", qid);
861 1.15 reinoud return -1;
862 1.15 reinoud }
863 1.15 reinoud }
864 1.4 jakllsch
865 1.15 reinoud return 0;
866 1.4 jakllsch }
867 1.4 jakllsch
868 1.4 jakllsch static int
869 1.32 yamaguch virtio_pci_setup_interrupts_09(struct virtio_softc *sc, int reinit)
870 1.4 jakllsch {
871 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
872 1.4 jakllsch int offset, vector, ret, qid;
873 1.4 jakllsch
874 1.31 yamaguch if (!virtio_pci_msix_enabled(psc))
875 1.31 yamaguch return 0;
876 1.31 yamaguch
877 1.4 jakllsch offset = VIRTIO_CONFIG_MSI_CONFIG_VECTOR;
878 1.4 jakllsch vector = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
879 1.4 jakllsch
880 1.15 reinoud bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, vector);
881 1.15 reinoud ret = bus_space_read_2(psc->sc_iot, psc->sc_ioh, offset);
882 1.4 jakllsch aprint_debug_dev(sc->sc_dev, "expected=%d, actual=%d\n",
883 1.4 jakllsch vector, ret);
884 1.15 reinoud if (ret != vector) {
885 1.33 yamaguch VIRTIO_PCI_LOG(sc, reinit,
886 1.33 yamaguch "can't set config msix vector\n");
887 1.4 jakllsch return -1;
888 1.15 reinoud }
889 1.4 jakllsch
890 1.4 jakllsch for (qid = 0; qid < sc->sc_nvqs; qid++) {
891 1.4 jakllsch offset = VIRTIO_CONFIG_QUEUE_SELECT;
892 1.15 reinoud bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, qid);
893 1.4 jakllsch
894 1.4 jakllsch offset = VIRTIO_CONFIG_MSI_QUEUE_VECTOR;
895 1.4 jakllsch vector = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
896 1.4 jakllsch
897 1.6 yamaguch if (sc->sc_child_mq)
898 1.6 yamaguch vector += qid;
899 1.6 yamaguch
900 1.15 reinoud bus_space_write_2(psc->sc_iot, psc->sc_ioh, offset, vector);
901 1.15 reinoud ret = bus_space_read_2(psc->sc_iot, psc->sc_ioh, offset);
902 1.4 jakllsch aprint_debug_dev(sc->sc_dev, "expected=%d, actual=%d\n",
903 1.4 jakllsch vector, ret);
904 1.15 reinoud if (ret != vector) {
905 1.33 yamaguch VIRTIO_PCI_LOG(sc, reinit, "can't set queue %d "
906 1.33 yamaguch "msix vector\n", qid);
907 1.4 jakllsch return -1;
908 1.15 reinoud }
909 1.4 jakllsch }
910 1.4 jakllsch
911 1.4 jakllsch return 0;
912 1.4 jakllsch }
913 1.4 jakllsch
914 1.4 jakllsch static int
915 1.31 yamaguch virtio_pci_establish_msix_interrupts(struct virtio_softc *sc,
916 1.4 jakllsch struct pci_attach_args *pa)
917 1.4 jakllsch {
918 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
919 1.4 jakllsch device_t self = sc->sc_dev;
920 1.4 jakllsch pci_chipset_tag_t pc = pa->pa_pc;
921 1.9 yamaguch struct virtqueue *vq;
922 1.4 jakllsch char intrbuf[PCI_INTRSTR_LEN];
923 1.6 yamaguch char intr_xname[INTRDEVNAMEBUF];
924 1.4 jakllsch char const *intrstr;
925 1.6 yamaguch int idx, qid, n;
926 1.4 jakllsch
927 1.4 jakllsch idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
928 1.15 reinoud if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
929 1.4 jakllsch pci_intr_setattr(pc, &psc->sc_ihp[idx], PCI_INTR_MPSAFE, true);
930 1.4 jakllsch
931 1.6 yamaguch snprintf(intr_xname, sizeof(intr_xname), "%s config",
932 1.6 yamaguch device_xname(sc->sc_dev));
933 1.6 yamaguch
934 1.4 jakllsch psc->sc_ihs[idx] = pci_intr_establish_xname(pc, psc->sc_ihp[idx],
935 1.6 yamaguch sc->sc_ipl, virtio_pci_msix_config_intr, sc, intr_xname);
936 1.4 jakllsch if (psc->sc_ihs[idx] == NULL) {
937 1.4 jakllsch aprint_error_dev(self, "couldn't establish MSI-X for config\n");
938 1.4 jakllsch goto error;
939 1.4 jakllsch }
940 1.4 jakllsch
941 1.4 jakllsch idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
942 1.6 yamaguch if (sc->sc_child_mq) {
943 1.6 yamaguch for (qid = 0; qid < sc->sc_nvqs; qid++) {
944 1.6 yamaguch n = idx + qid;
945 1.9 yamaguch vq = &sc->sc_vqs[qid];
946 1.6 yamaguch
947 1.6 yamaguch snprintf(intr_xname, sizeof(intr_xname), "%s vq#%d",
948 1.6 yamaguch device_xname(sc->sc_dev), qid);
949 1.6 yamaguch
950 1.15 reinoud if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE) {
951 1.6 yamaguch pci_intr_setattr(pc, &psc->sc_ihp[n],
952 1.6 yamaguch PCI_INTR_MPSAFE, true);
953 1.6 yamaguch }
954 1.6 yamaguch
955 1.6 yamaguch psc->sc_ihs[n] = pci_intr_establish_xname(pc, psc->sc_ihp[n],
956 1.10 yamaguch sc->sc_ipl, vq->vq_intrhand, vq->vq_intrhand_arg, intr_xname);
957 1.6 yamaguch if (psc->sc_ihs[n] == NULL) {
958 1.6 yamaguch aprint_error_dev(self, "couldn't establish MSI-X for a vq\n");
959 1.6 yamaguch goto error;
960 1.6 yamaguch }
961 1.6 yamaguch }
962 1.6 yamaguch } else {
963 1.15 reinoud if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
964 1.6 yamaguch pci_intr_setattr(pc, &psc->sc_ihp[idx], PCI_INTR_MPSAFE, true);
965 1.4 jakllsch
966 1.6 yamaguch snprintf(intr_xname, sizeof(intr_xname), "%s queues",
967 1.6 yamaguch device_xname(sc->sc_dev));
968 1.6 yamaguch psc->sc_ihs[idx] = pci_intr_establish_xname(pc, psc->sc_ihp[idx],
969 1.6 yamaguch sc->sc_ipl, virtio_pci_msix_queue_intr, sc, intr_xname);
970 1.6 yamaguch if (psc->sc_ihs[idx] == NULL) {
971 1.6 yamaguch aprint_error_dev(self, "couldn't establish MSI-X for queues\n");
972 1.6 yamaguch goto error;
973 1.6 yamaguch }
974 1.4 jakllsch }
975 1.4 jakllsch
976 1.4 jakllsch idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
977 1.4 jakllsch intrstr = pci_intr_string(pc, psc->sc_ihp[idx], intrbuf, sizeof(intrbuf));
978 1.4 jakllsch aprint_normal_dev(self, "config interrupting at %s\n", intrstr);
979 1.4 jakllsch idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
980 1.6 yamaguch if (sc->sc_child_mq) {
981 1.6 yamaguch kcpuset_t *affinity;
982 1.6 yamaguch int affinity_to, r;
983 1.6 yamaguch
984 1.6 yamaguch kcpuset_create(&affinity, false);
985 1.6 yamaguch
986 1.6 yamaguch for (qid = 0; qid < sc->sc_nvqs; qid++) {
987 1.6 yamaguch n = idx + qid;
988 1.6 yamaguch affinity_to = (qid / 2) % ncpu;
989 1.6 yamaguch
990 1.6 yamaguch intrstr = pci_intr_string(pc, psc->sc_ihp[n],
991 1.6 yamaguch intrbuf, sizeof(intrbuf));
992 1.6 yamaguch
993 1.6 yamaguch kcpuset_zero(affinity);
994 1.6 yamaguch kcpuset_set(affinity, affinity_to);
995 1.6 yamaguch r = interrupt_distribute(psc->sc_ihs[n], affinity, NULL);
996 1.6 yamaguch if (r == 0) {
997 1.6 yamaguch aprint_normal_dev(self,
998 1.6 yamaguch "for vq #%d interrupting at %s affinity to %u\n",
999 1.6 yamaguch qid, intrstr, affinity_to);
1000 1.6 yamaguch } else {
1001 1.6 yamaguch aprint_normal_dev(self,
1002 1.6 yamaguch "for vq #%d interrupting at %s\n",
1003 1.6 yamaguch qid, intrstr);
1004 1.6 yamaguch }
1005 1.6 yamaguch }
1006 1.6 yamaguch
1007 1.6 yamaguch kcpuset_destroy(affinity);
1008 1.6 yamaguch } else {
1009 1.6 yamaguch intrstr = pci_intr_string(pc, psc->sc_ihp[idx], intrbuf, sizeof(intrbuf));
1010 1.6 yamaguch aprint_normal_dev(self, "queues interrupting at %s\n", intrstr);
1011 1.6 yamaguch }
1012 1.4 jakllsch
1013 1.4 jakllsch return 0;
1014 1.4 jakllsch
1015 1.4 jakllsch error:
1016 1.4 jakllsch idx = VIRTIO_MSIX_CONFIG_VECTOR_INDEX;
1017 1.4 jakllsch if (psc->sc_ihs[idx] != NULL)
1018 1.4 jakllsch pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[idx]);
1019 1.4 jakllsch idx = VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
1020 1.6 yamaguch if (sc->sc_child_mq) {
1021 1.6 yamaguch for (qid = 0; qid < sc->sc_nvqs; qid++) {
1022 1.6 yamaguch n = idx + qid;
1023 1.6 yamaguch if (psc->sc_ihs[n] == NULL)
1024 1.6 yamaguch continue;
1025 1.6 yamaguch pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[n]);
1026 1.6 yamaguch }
1027 1.6 yamaguch
1028 1.6 yamaguch } else {
1029 1.6 yamaguch if (psc->sc_ihs[idx] != NULL)
1030 1.6 yamaguch pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[idx]);
1031 1.6 yamaguch }
1032 1.4 jakllsch
1033 1.4 jakllsch return -1;
1034 1.4 jakllsch }
1035 1.4 jakllsch
1036 1.4 jakllsch static int
1037 1.31 yamaguch virtio_pci_establish_intx_interrupt(struct virtio_softc *sc,
1038 1.4 jakllsch struct pci_attach_args *pa)
1039 1.4 jakllsch {
1040 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1041 1.4 jakllsch device_t self = sc->sc_dev;
1042 1.4 jakllsch pci_chipset_tag_t pc = pa->pa_pc;
1043 1.4 jakllsch char intrbuf[PCI_INTRSTR_LEN];
1044 1.4 jakllsch char const *intrstr;
1045 1.4 jakllsch
1046 1.15 reinoud if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
1047 1.4 jakllsch pci_intr_setattr(pc, &psc->sc_ihp[0], PCI_INTR_MPSAFE, true);
1048 1.4 jakllsch
1049 1.4 jakllsch psc->sc_ihs[0] = pci_intr_establish_xname(pc, psc->sc_ihp[0],
1050 1.4 jakllsch sc->sc_ipl, virtio_pci_intr, sc, device_xname(sc->sc_dev));
1051 1.4 jakllsch if (psc->sc_ihs[0] == NULL) {
1052 1.4 jakllsch aprint_error_dev(self, "couldn't establish INTx\n");
1053 1.4 jakllsch return -1;
1054 1.4 jakllsch }
1055 1.4 jakllsch
1056 1.4 jakllsch intrstr = pci_intr_string(pc, psc->sc_ihp[0], intrbuf, sizeof(intrbuf));
1057 1.4 jakllsch aprint_normal_dev(self, "interrupting at %s\n", intrstr);
1058 1.4 jakllsch
1059 1.4 jakllsch return 0;
1060 1.4 jakllsch }
1061 1.4 jakllsch
1062 1.4 jakllsch static int
1063 1.31 yamaguch virtio_pci_alloc_interrupts(struct virtio_softc *sc)
1064 1.4 jakllsch {
1065 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1066 1.4 jakllsch device_t self = sc->sc_dev;
1067 1.4 jakllsch pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
1068 1.13 jakllsch pcitag_t tag = psc->sc_pa.pa_tag;
1069 1.4 jakllsch int error;
1070 1.4 jakllsch int nmsix;
1071 1.13 jakllsch int off;
1072 1.4 jakllsch int counts[PCI_INTR_TYPE_SIZE];
1073 1.4 jakllsch pci_intr_type_t max_type;
1074 1.13 jakllsch pcireg_t ctl;
1075 1.4 jakllsch
1076 1.4 jakllsch nmsix = pci_msix_count(psc->sc_pa.pa_pc, psc->sc_pa.pa_tag);
1077 1.4 jakllsch aprint_debug_dev(self, "pci_msix_count=%d\n", nmsix);
1078 1.4 jakllsch
1079 1.4 jakllsch /* We need at least two: one for config and the other for queues */
1080 1.15 reinoud if ((sc->sc_flags & VIRTIO_F_INTR_MSIX) == 0 || nmsix < 2) {
1081 1.4 jakllsch /* Try INTx only */
1082 1.4 jakllsch max_type = PCI_INTR_TYPE_INTX;
1083 1.4 jakllsch counts[PCI_INTR_TYPE_INTX] = 1;
1084 1.4 jakllsch } else {
1085 1.4 jakllsch /* Try MSI-X first and INTx second */
1086 1.11 yamaguch if (sc->sc_nvqs + VIRTIO_MSIX_QUEUE_VECTOR_INDEX <= nmsix) {
1087 1.11 yamaguch nmsix = sc->sc_nvqs + VIRTIO_MSIX_QUEUE_VECTOR_INDEX;
1088 1.11 yamaguch } else {
1089 1.11 yamaguch sc->sc_child_mq = false;
1090 1.11 yamaguch }
1091 1.11 yamaguch
1092 1.11 yamaguch if (sc->sc_child_mq == false) {
1093 1.6 yamaguch nmsix = 2;
1094 1.6 yamaguch }
1095 1.6 yamaguch
1096 1.4 jakllsch max_type = PCI_INTR_TYPE_MSIX;
1097 1.6 yamaguch counts[PCI_INTR_TYPE_MSIX] = nmsix;
1098 1.4 jakllsch counts[PCI_INTR_TYPE_MSI] = 0;
1099 1.4 jakllsch counts[PCI_INTR_TYPE_INTX] = 1;
1100 1.4 jakllsch }
1101 1.4 jakllsch
1102 1.4 jakllsch retry:
1103 1.4 jakllsch error = pci_intr_alloc(&psc->sc_pa, &psc->sc_ihp, counts, max_type);
1104 1.4 jakllsch if (error != 0) {
1105 1.4 jakllsch aprint_error_dev(self, "couldn't map interrupt\n");
1106 1.4 jakllsch return -1;
1107 1.4 jakllsch }
1108 1.4 jakllsch
1109 1.4 jakllsch if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_MSIX) {
1110 1.12 jakllsch psc->sc_ihs = kmem_zalloc(sizeof(*psc->sc_ihs) * nmsix,
1111 1.4 jakllsch KM_SLEEP);
1112 1.4 jakllsch
1113 1.31 yamaguch error = virtio_pci_establish_msix_interrupts(sc, &psc->sc_pa);
1114 1.4 jakllsch if (error != 0) {
1115 1.6 yamaguch kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * nmsix);
1116 1.6 yamaguch pci_intr_release(pc, psc->sc_ihp, nmsix);
1117 1.4 jakllsch
1118 1.4 jakllsch /* Retry INTx */
1119 1.4 jakllsch max_type = PCI_INTR_TYPE_INTX;
1120 1.4 jakllsch counts[PCI_INTR_TYPE_INTX] = 1;
1121 1.4 jakllsch goto retry;
1122 1.4 jakllsch }
1123 1.4 jakllsch
1124 1.6 yamaguch psc->sc_ihs_num = nmsix;
1125 1.15 reinoud psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_MSI;
1126 1.15 reinoud virtio_pci_adjust_config_region(psc);
1127 1.4 jakllsch } else if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_INTX) {
1128 1.12 jakllsch psc->sc_ihs = kmem_zalloc(sizeof(*psc->sc_ihs) * 1,
1129 1.4 jakllsch KM_SLEEP);
1130 1.4 jakllsch
1131 1.31 yamaguch error = virtio_pci_establish_intx_interrupt(sc, &psc->sc_pa);
1132 1.4 jakllsch if (error != 0) {
1133 1.4 jakllsch kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * 1);
1134 1.4 jakllsch pci_intr_release(pc, psc->sc_ihp, 1);
1135 1.4 jakllsch return -1;
1136 1.4 jakllsch }
1137 1.4 jakllsch
1138 1.4 jakllsch psc->sc_ihs_num = 1;
1139 1.15 reinoud psc->sc_devcfg_offset = VIRTIO_CONFIG_DEVICE_CONFIG_NOMSI;
1140 1.15 reinoud virtio_pci_adjust_config_region(psc);
1141 1.13 jakllsch
1142 1.14 jakllsch error = pci_get_capability(pc, tag, PCI_CAP_MSIX, &off, NULL);
1143 1.13 jakllsch if (error != 0) {
1144 1.13 jakllsch ctl = pci_conf_read(pc, tag, off + PCI_MSIX_CTL);
1145 1.13 jakllsch ctl &= ~PCI_MSIX_CTL_ENABLE;
1146 1.13 jakllsch pci_conf_write(pc, tag, off + PCI_MSIX_CTL, ctl);
1147 1.13 jakllsch }
1148 1.4 jakllsch }
1149 1.4 jakllsch
1150 1.4 jakllsch return 0;
1151 1.4 jakllsch }
1152 1.4 jakllsch
1153 1.4 jakllsch static void
1154 1.4 jakllsch virtio_pci_free_interrupts(struct virtio_softc *sc)
1155 1.4 jakllsch {
1156 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1157 1.4 jakllsch
1158 1.4 jakllsch for (int i = 0; i < psc->sc_ihs_num; i++) {
1159 1.4 jakllsch if (psc->sc_ihs[i] == NULL)
1160 1.4 jakllsch continue;
1161 1.4 jakllsch pci_intr_disestablish(psc->sc_pa.pa_pc, psc->sc_ihs[i]);
1162 1.4 jakllsch psc->sc_ihs[i] = NULL;
1163 1.4 jakllsch }
1164 1.4 jakllsch
1165 1.4 jakllsch if (psc->sc_ihs_num > 0)
1166 1.4 jakllsch pci_intr_release(psc->sc_pa.pa_pc, psc->sc_ihp, psc->sc_ihs_num);
1167 1.4 jakllsch
1168 1.4 jakllsch if (psc->sc_ihs != NULL) {
1169 1.4 jakllsch kmem_free(psc->sc_ihs, sizeof(*psc->sc_ihs) * psc->sc_ihs_num);
1170 1.4 jakllsch psc->sc_ihs = NULL;
1171 1.4 jakllsch }
1172 1.4 jakllsch psc->sc_ihs_num = 0;
1173 1.4 jakllsch }
1174 1.4 jakllsch
1175 1.31 yamaguch static bool
1176 1.31 yamaguch virtio_pci_msix_enabled(struct virtio_pci_softc *psc)
1177 1.31 yamaguch {
1178 1.31 yamaguch pci_chipset_tag_t pc = psc->sc_pa.pa_pc;
1179 1.31 yamaguch
1180 1.31 yamaguch if (pci_intr_type(pc, psc->sc_ihp[0]) == PCI_INTR_TYPE_MSIX)
1181 1.31 yamaguch return true;
1182 1.31 yamaguch
1183 1.31 yamaguch return false;
1184 1.31 yamaguch }
1185 1.31 yamaguch
1186 1.4 jakllsch /*
1187 1.4 jakllsch * Interrupt handler.
1188 1.4 jakllsch */
1189 1.4 jakllsch static int
1190 1.4 jakllsch virtio_pci_intr(void *arg)
1191 1.4 jakllsch {
1192 1.4 jakllsch struct virtio_softc *sc = arg;
1193 1.4 jakllsch struct virtio_pci_softc * const psc = (struct virtio_pci_softc *)sc;
1194 1.4 jakllsch int isr, r = 0;
1195 1.4 jakllsch
1196 1.4 jakllsch /* check and ack the interrupt */
1197 1.15 reinoud isr = bus_space_read_1(psc->sc_isr_iot, psc->sc_isr_ioh, 0);
1198 1.4 jakllsch if (isr == 0)
1199 1.4 jakllsch return 0;
1200 1.4 jakllsch if ((isr & VIRTIO_CONFIG_ISR_CONFIG_CHANGE) &&
1201 1.4 jakllsch (sc->sc_config_change != NULL))
1202 1.4 jakllsch r = (sc->sc_config_change)(sc);
1203 1.4 jakllsch if (sc->sc_intrhand != NULL) {
1204 1.4 jakllsch if (sc->sc_soft_ih != NULL)
1205 1.4 jakllsch softint_schedule(sc->sc_soft_ih);
1206 1.4 jakllsch else
1207 1.4 jakllsch r |= (sc->sc_intrhand)(sc);
1208 1.4 jakllsch }
1209 1.4 jakllsch
1210 1.4 jakllsch return r;
1211 1.4 jakllsch }
1212 1.4 jakllsch
1213 1.4 jakllsch static int
1214 1.4 jakllsch virtio_pci_msix_queue_intr(void *arg)
1215 1.4 jakllsch {
1216 1.4 jakllsch struct virtio_softc *sc = arg;
1217 1.4 jakllsch int r = 0;
1218 1.4 jakllsch
1219 1.4 jakllsch if (sc->sc_intrhand != NULL) {
1220 1.4 jakllsch if (sc->sc_soft_ih != NULL)
1221 1.4 jakllsch softint_schedule(sc->sc_soft_ih);
1222 1.4 jakllsch else
1223 1.4 jakllsch r |= (sc->sc_intrhand)(sc);
1224 1.4 jakllsch }
1225 1.4 jakllsch
1226 1.4 jakllsch return r;
1227 1.4 jakllsch }
1228 1.4 jakllsch
1229 1.4 jakllsch static int
1230 1.4 jakllsch virtio_pci_msix_config_intr(void *arg)
1231 1.4 jakllsch {
1232 1.4 jakllsch struct virtio_softc *sc = arg;
1233 1.4 jakllsch int r = 0;
1234 1.4 jakllsch
1235 1.4 jakllsch if (sc->sc_config_change != NULL)
1236 1.4 jakllsch r = (sc->sc_config_change)(sc);
1237 1.4 jakllsch return r;
1238 1.4 jakllsch }
1239 1.5 jakllsch
1240 1.5 jakllsch MODULE(MODULE_CLASS_DRIVER, virtio_pci, "pci,virtio");
1241 1.5 jakllsch
1242 1.5 jakllsch #ifdef _MODULE
1243 1.5 jakllsch #include "ioconf.c"
1244 1.5 jakllsch #endif
1245 1.5 jakllsch
1246 1.5 jakllsch static int
1247 1.5 jakllsch virtio_pci_modcmd(modcmd_t cmd, void *opaque)
1248 1.5 jakllsch {
1249 1.5 jakllsch int error = 0;
1250 1.5 jakllsch
1251 1.5 jakllsch #ifdef _MODULE
1252 1.5 jakllsch switch (cmd) {
1253 1.5 jakllsch case MODULE_CMD_INIT:
1254 1.5 jakllsch error = config_init_component(cfdriver_ioconf_virtio_pci,
1255 1.5 jakllsch cfattach_ioconf_virtio_pci, cfdata_ioconf_virtio_pci);
1256 1.5 jakllsch break;
1257 1.5 jakllsch case MODULE_CMD_FINI:
1258 1.5 jakllsch error = config_fini_component(cfdriver_ioconf_virtio_pci,
1259 1.5 jakllsch cfattach_ioconf_virtio_pci, cfdata_ioconf_virtio_pci);
1260 1.5 jakllsch break;
1261 1.5 jakllsch default:
1262 1.5 jakllsch error = ENOTTY;
1263 1.5 jakllsch break;
1264 1.5 jakllsch }
1265 1.5 jakllsch #endif
1266 1.5 jakllsch
1267 1.5 jakllsch return error;
1268 1.5 jakllsch }
1269