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