virtio.c revision 1.72 1 1.72 riastrad /* $NetBSD: virtio.c,v 1.72 2023/03/29 09:44:25 riastradh Exp $ */
2 1.1 hannken
3 1.1 hannken /*
4 1.43 reinoud * Copyright (c) 2020 The NetBSD Foundation, Inc.
5 1.43 reinoud * Copyright (c) 2012 Stefan Fritsch, Alexander Fiveg.
6 1.1 hannken * Copyright (c) 2010 Minoura Makoto.
7 1.1 hannken * All rights reserved.
8 1.1 hannken *
9 1.1 hannken * Redistribution and use in source and binary forms, with or without
10 1.1 hannken * modification, are permitted provided that the following conditions
11 1.1 hannken * are met:
12 1.1 hannken * 1. Redistributions of source code must retain the above copyright
13 1.1 hannken * notice, this list of conditions and the following disclaimer.
14 1.1 hannken * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 hannken * notice, this list of conditions and the following disclaimer in the
16 1.1 hannken * documentation and/or other materials provided with the distribution.
17 1.1 hannken *
18 1.1 hannken * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 1.1 hannken * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 1.1 hannken * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 1.1 hannken * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 1.1 hannken * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 1.1 hannken * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 1.1 hannken * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 1.1 hannken * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 1.1 hannken * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 1.1 hannken * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 1.1 hannken */
29 1.1 hannken
30 1.1 hannken #include <sys/cdefs.h>
31 1.72 riastrad __KERNEL_RCSID(0, "$NetBSD: virtio.c,v 1.72 2023/03/29 09:44:25 riastradh Exp $");
32 1.1 hannken
33 1.1 hannken #include <sys/param.h>
34 1.1 hannken #include <sys/systm.h>
35 1.1 hannken #include <sys/kernel.h>
36 1.1 hannken #include <sys/atomic.h>
37 1.1 hannken #include <sys/bus.h>
38 1.1 hannken #include <sys/device.h>
39 1.1 hannken #include <sys/kmem.h>
40 1.18 pgoyette #include <sys/module.h>
41 1.1 hannken
42 1.22 jdolecek #define VIRTIO_PRIVATE
43 1.22 jdolecek
44 1.29 cherry #include <dev/pci/virtioreg.h> /* XXX: move to non-pci */
45 1.29 cherry #include <dev/pci/virtiovar.h> /* XXX: move to non-pci */
46 1.1 hannken
47 1.1 hannken #define MINSEG_INDIRECT 2 /* use indirect if nsegs >= this value */
48 1.1 hannken
49 1.43 reinoud /* incomplete list */
50 1.43 reinoud static const char *virtio_device_name[] = {
51 1.43 reinoud "unknown (0)", /* 0 */
52 1.43 reinoud "network", /* 1 */
53 1.43 reinoud "block", /* 2 */
54 1.43 reinoud "console", /* 3 */
55 1.43 reinoud "entropy", /* 4 */
56 1.43 reinoud "memory balloon", /* 5 */
57 1.43 reinoud "I/O memory", /* 6 */
58 1.43 reinoud "remote processor messaging", /* 7 */
59 1.43 reinoud "SCSI", /* 8 */
60 1.43 reinoud "9P transport", /* 9 */
61 1.43 reinoud };
62 1.43 reinoud #define NDEVNAMES __arraycount(virtio_device_name)
63 1.43 reinoud
64 1.67 yamaguch static void virtio_reset_vq(struct virtio_softc *,
65 1.67 yamaguch struct virtqueue *);
66 1.1 hannken
67 1.29 cherry void
68 1.1 hannken virtio_set_status(struct virtio_softc *sc, int status)
69 1.1 hannken {
70 1.31 jakllsch sc->sc_ops->set_status(sc, status);
71 1.11 ozaki }
72 1.11 ozaki
73 1.1 hannken /*
74 1.1 hannken * Reset the device.
75 1.1 hannken */
76 1.1 hannken /*
77 1.1 hannken * To reset the device to a known state, do following:
78 1.1 hannken * virtio_reset(sc); // this will stop the device activity
79 1.1 hannken * <dequeue finished requests>; // virtio_dequeue() still can be called
80 1.1 hannken * <revoke pending requests in the vqs if any>;
81 1.42 jakllsch * virtio_reinit_start(sc); // dequeue prohibitted
82 1.1 hannken * newfeatures = virtio_negotiate_features(sc, requestedfeatures);
83 1.1 hannken * <some other initialization>;
84 1.1 hannken * virtio_reinit_end(sc); // device activated; enqueue allowed
85 1.1 hannken * Once attached, feature negotiation can only be allowed after virtio_reset.
86 1.1 hannken */
87 1.1 hannken void
88 1.1 hannken virtio_reset(struct virtio_softc *sc)
89 1.1 hannken {
90 1.1 hannken virtio_device_reset(sc);
91 1.1 hannken }
92 1.1 hannken
93 1.53 yamaguch int
94 1.1 hannken virtio_reinit_start(struct virtio_softc *sc)
95 1.1 hannken {
96 1.51 yamaguch int i, r;
97 1.1 hannken
98 1.1 hannken virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_ACK);
99 1.1 hannken virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_DRIVER);
100 1.1 hannken for (i = 0; i < sc->sc_nvqs; i++) {
101 1.1 hannken int n;
102 1.1 hannken struct virtqueue *vq = &sc->sc_vqs[i];
103 1.31 jakllsch n = sc->sc_ops->read_queue_size(sc, vq->vq_index);
104 1.1 hannken if (n == 0) /* vq disappeared */
105 1.1 hannken continue;
106 1.1 hannken if (n != vq->vq_num) {
107 1.1 hannken panic("%s: virtqueue size changed, vq index %d\n",
108 1.59 riastrad device_xname(sc->sc_dev),
109 1.59 riastrad vq->vq_index);
110 1.1 hannken }
111 1.67 yamaguch virtio_reset_vq(sc, vq);
112 1.31 jakllsch sc->sc_ops->setup_queue(sc, vq->vq_index,
113 1.43 reinoud vq->vq_dmamap->dm_segs[0].ds_addr);
114 1.11 ozaki }
115 1.51 yamaguch
116 1.51 yamaguch r = sc->sc_ops->setup_interrupts(sc, 1);
117 1.53 yamaguch if (r != 0)
118 1.53 yamaguch goto fail;
119 1.53 yamaguch
120 1.53 yamaguch return 0;
121 1.53 yamaguch
122 1.53 yamaguch fail:
123 1.53 yamaguch virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
124 1.53 yamaguch
125 1.53 yamaguch return 1;
126 1.1 hannken }
127 1.1 hannken
128 1.1 hannken void
129 1.1 hannken virtio_reinit_end(struct virtio_softc *sc)
130 1.1 hannken {
131 1.1 hannken virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_DRIVER_OK);
132 1.1 hannken }
133 1.1 hannken
134 1.1 hannken /*
135 1.1 hannken * Feature negotiation.
136 1.1 hannken */
137 1.43 reinoud void
138 1.43 reinoud virtio_negotiate_features(struct virtio_softc *sc, uint64_t guest_features)
139 1.1 hannken {
140 1.1 hannken if (!(device_cfdata(sc->sc_dev)->cf_flags & 1) &&
141 1.1 hannken !(device_cfdata(sc->sc_child)->cf_flags & 1)) /* XXX */
142 1.1 hannken guest_features |= VIRTIO_F_RING_INDIRECT_DESC;
143 1.43 reinoud sc->sc_ops->neg_features(sc, guest_features);
144 1.43 reinoud if (sc->sc_active_features & VIRTIO_F_RING_INDIRECT_DESC)
145 1.1 hannken sc->sc_indirect = true;
146 1.1 hannken else
147 1.1 hannken sc->sc_indirect = false;
148 1.43 reinoud }
149 1.1 hannken
150 1.1 hannken
151 1.1 hannken /*
152 1.43 reinoud * Device configuration registers readers/writers
153 1.1 hannken */
154 1.43 reinoud #if 0
155 1.43 reinoud #define DPRINTFR(n, fmt, val, index, num) \
156 1.43 reinoud printf("\n%s (", n); \
157 1.43 reinoud for (int i = 0; i < num; i++) \
158 1.43 reinoud printf("%02x ", bus_space_read_1(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, index+i)); \
159 1.43 reinoud printf(") -> "); printf(fmt, val); printf("\n");
160 1.45 reinoud #define DPRINTFR2(n, fmt, val_s, val_n) \
161 1.45 reinoud printf("%s ", n); \
162 1.45 reinoud printf("\n stream "); printf(fmt, val_s); printf(" norm "); printf(fmt, val_n); printf("\n");
163 1.43 reinoud #else
164 1.43 reinoud #define DPRINTFR(n, fmt, val, index, num)
165 1.45 reinoud #define DPRINTFR2(n, fmt, val_s, val_n)
166 1.43 reinoud #endif
167 1.43 reinoud
168 1.45 reinoud
169 1.1 hannken uint8_t
170 1.59 riastrad virtio_read_device_config_1(struct virtio_softc *sc, int index)
171 1.59 riastrad {
172 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
173 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
174 1.43 reinoud uint8_t val;
175 1.45 reinoud
176 1.45 reinoud val = bus_space_read_1(iot, ioh, index);
177 1.45 reinoud
178 1.43 reinoud DPRINTFR("read_1", "%02x", val, index, 1);
179 1.43 reinoud return val;
180 1.43 reinoud }
181 1.43 reinoud
182 1.43 reinoud uint16_t
183 1.59 riastrad virtio_read_device_config_2(struct virtio_softc *sc, int index)
184 1.59 riastrad {
185 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
186 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
187 1.43 reinoud uint16_t val;
188 1.45 reinoud
189 1.45 reinoud val = bus_space_read_2(iot, ioh, index);
190 1.45 reinoud if (BYTE_ORDER != sc->sc_bus_endian)
191 1.45 reinoud val = bswap16(val);
192 1.45 reinoud
193 1.43 reinoud DPRINTFR("read_2", "%04x", val, index, 2);
194 1.45 reinoud DPRINTFR2("read_2", "%04x",
195 1.59 riastrad bus_space_read_stream_2(sc->sc_devcfg_iot, sc->sc_devcfg_ioh,
196 1.59 riastrad index),
197 1.59 riastrad bus_space_read_2(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, index));
198 1.43 reinoud return val;
199 1.43 reinoud }
200 1.43 reinoud
201 1.43 reinoud uint32_t
202 1.59 riastrad virtio_read_device_config_4(struct virtio_softc *sc, int index)
203 1.59 riastrad {
204 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
205 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
206 1.43 reinoud uint32_t val;
207 1.45 reinoud
208 1.45 reinoud val = bus_space_read_4(iot, ioh, index);
209 1.45 reinoud if (BYTE_ORDER != sc->sc_bus_endian)
210 1.45 reinoud val = bswap32(val);
211 1.45 reinoud
212 1.43 reinoud DPRINTFR("read_4", "%08x", val, index, 4);
213 1.45 reinoud DPRINTFR2("read_4", "%08x",
214 1.59 riastrad bus_space_read_stream_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh,
215 1.59 riastrad index),
216 1.59 riastrad bus_space_read_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, index));
217 1.43 reinoud return val;
218 1.43 reinoud }
219 1.43 reinoud
220 1.46 reinoud /*
221 1.46 reinoud * The Virtio spec explicitly tells that reading and writing 8 bytes are not
222 1.46 reinoud * considered atomic and no triggers may be connected to reading or writing
223 1.47 reinoud * it. We access it using two 32 reads. See virtio spec 4.1.3.1.
224 1.46 reinoud */
225 1.43 reinoud uint64_t
226 1.59 riastrad virtio_read_device_config_8(struct virtio_softc *sc, int index)
227 1.59 riastrad {
228 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
229 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
230 1.46 reinoud union {
231 1.46 reinoud uint64_t u64;
232 1.47 reinoud uint32_t l[2];
233 1.46 reinoud } v;
234 1.46 reinoud uint64_t val;
235 1.46 reinoud
236 1.47 reinoud v.l[0] = bus_space_read_4(iot, ioh, index);
237 1.47 reinoud v.l[1] = bus_space_read_4(iot, ioh, index + 4);
238 1.47 reinoud if (sc->sc_bus_endian != sc->sc_struct_endian) {
239 1.47 reinoud v.l[0] = bswap32(v.l[0]);
240 1.47 reinoud v.l[1] = bswap32(v.l[1]);
241 1.47 reinoud }
242 1.46 reinoud val = v.u64;
243 1.45 reinoud
244 1.46 reinoud if (BYTE_ORDER != sc->sc_struct_endian)
245 1.46 reinoud val = bswap64(val);
246 1.45 reinoud
247 1.63 simonb DPRINTFR("read_8", "%08"PRIx64, val, index, 8);
248 1.45 reinoud DPRINTFR2("read_8 low ", "%08x",
249 1.59 riastrad bus_space_read_stream_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh,
250 1.59 riastrad index),
251 1.59 riastrad bus_space_read_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, index));
252 1.45 reinoud DPRINTFR2("read_8 high ", "%08x",
253 1.59 riastrad bus_space_read_stream_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh,
254 1.59 riastrad index + 4),
255 1.59 riastrad bus_space_read_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, index + 4));
256 1.43 reinoud return val;
257 1.1 hannken }
258 1.1 hannken
259 1.43 reinoud /*
260 1.43 reinoud * In the older virtio spec, device config registers are host endian. On newer
261 1.45 reinoud * they are little endian. Some newer devices however explicitly specify their
262 1.55 andvar * register to always be little endian. These functions cater for these.
263 1.43 reinoud */
264 1.1 hannken uint16_t
265 1.59 riastrad virtio_read_device_config_le_2(struct virtio_softc *sc, int index)
266 1.59 riastrad {
267 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
268 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
269 1.43 reinoud uint16_t val;
270 1.43 reinoud
271 1.45 reinoud val = bus_space_read_2(iot, ioh, index);
272 1.45 reinoud if (sc->sc_bus_endian != LITTLE_ENDIAN)
273 1.45 reinoud val = bswap16(val);
274 1.45 reinoud
275 1.45 reinoud DPRINTFR("read_le_2", "%04x", val, index, 2);
276 1.45 reinoud DPRINTFR2("read_le_2", "%04x",
277 1.59 riastrad bus_space_read_stream_2(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, 0),
278 1.59 riastrad bus_space_read_2(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, 0));
279 1.43 reinoud return val;
280 1.1 hannken }
281 1.1 hannken
282 1.1 hannken uint32_t
283 1.59 riastrad virtio_read_device_config_le_4(struct virtio_softc *sc, int index)
284 1.59 riastrad {
285 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
286 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
287 1.43 reinoud uint32_t val;
288 1.43 reinoud
289 1.45 reinoud val = bus_space_read_4(iot, ioh, index);
290 1.45 reinoud if (sc->sc_bus_endian != LITTLE_ENDIAN)
291 1.45 reinoud val = bswap32(val);
292 1.45 reinoud
293 1.43 reinoud DPRINTFR("read_le_4", "%08x", val, index, 4);
294 1.45 reinoud DPRINTFR2("read_le_4", "%08x",
295 1.59 riastrad bus_space_read_stream_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, 0),
296 1.59 riastrad bus_space_read_4(sc->sc_devcfg_iot, sc->sc_devcfg_ioh, 0));
297 1.43 reinoud return val;
298 1.43 reinoud }
299 1.43 reinoud
300 1.43 reinoud void
301 1.43 reinoud virtio_write_device_config_1(struct virtio_softc *sc, int index, uint8_t value)
302 1.1 hannken {
303 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
304 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
305 1.45 reinoud
306 1.45 reinoud bus_space_write_1(iot, ioh, index, value);
307 1.1 hannken }
308 1.1 hannken
309 1.43 reinoud void
310 1.59 riastrad virtio_write_device_config_2(struct virtio_softc *sc, int index,
311 1.59 riastrad uint16_t value)
312 1.1 hannken {
313 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
314 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
315 1.45 reinoud
316 1.45 reinoud if (BYTE_ORDER != sc->sc_bus_endian)
317 1.45 reinoud value = bswap16(value);
318 1.45 reinoud bus_space_write_2(iot, ioh, index, value);
319 1.1 hannken }
320 1.1 hannken
321 1.1 hannken void
322 1.59 riastrad virtio_write_device_config_4(struct virtio_softc *sc, int index,
323 1.59 riastrad uint32_t value)
324 1.1 hannken {
325 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
326 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
327 1.45 reinoud
328 1.45 reinoud if (BYTE_ORDER != sc->sc_bus_endian)
329 1.45 reinoud value = bswap32(value);
330 1.45 reinoud bus_space_write_4(iot, ioh, index, value);
331 1.1 hannken }
332 1.1 hannken
333 1.46 reinoud /*
334 1.46 reinoud * The Virtio spec explicitly tells that reading and writing 8 bytes are not
335 1.46 reinoud * considered atomic and no triggers may be connected to reading or writing
336 1.47 reinoud * it. We access it using two 32 bit writes. For good measure it is stated to
337 1.47 reinoud * always write lsb first just in case of a hypervisor bug. See See virtio
338 1.47 reinoud * spec 4.1.3.1.
339 1.46 reinoud */
340 1.1 hannken void
341 1.59 riastrad virtio_write_device_config_8(struct virtio_softc *sc, int index,
342 1.59 riastrad uint64_t value)
343 1.1 hannken {
344 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
345 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
346 1.46 reinoud union {
347 1.46 reinoud uint64_t u64;
348 1.47 reinoud uint32_t l[2];
349 1.46 reinoud } v;
350 1.46 reinoud
351 1.46 reinoud if (BYTE_ORDER != sc->sc_struct_endian)
352 1.46 reinoud value = bswap64(value);
353 1.46 reinoud
354 1.46 reinoud v.u64 = value;
355 1.47 reinoud if (sc->sc_bus_endian != sc->sc_struct_endian) {
356 1.47 reinoud v.l[0] = bswap32(v.l[0]);
357 1.47 reinoud v.l[1] = bswap32(v.l[1]);
358 1.47 reinoud }
359 1.47 reinoud
360 1.47 reinoud if (sc->sc_struct_endian == LITTLE_ENDIAN) {
361 1.47 reinoud bus_space_write_4(iot, ioh, index, v.l[0]);
362 1.47 reinoud bus_space_write_4(iot, ioh, index + 4, v.l[1]);
363 1.47 reinoud } else {
364 1.47 reinoud bus_space_write_4(iot, ioh, index + 4, v.l[1]);
365 1.47 reinoud bus_space_write_4(iot, ioh, index, v.l[0]);
366 1.47 reinoud }
367 1.1 hannken }
368 1.1 hannken
369 1.43 reinoud /*
370 1.43 reinoud * In the older virtio spec, device config registers are host endian. On newer
371 1.45 reinoud * they are little endian. Some newer devices however explicitly specify their
372 1.55 andvar * register to always be little endian. These functions cater for these.
373 1.43 reinoud */
374 1.1 hannken void
375 1.59 riastrad virtio_write_device_config_le_2(struct virtio_softc *sc, int index,
376 1.59 riastrad uint16_t value)
377 1.1 hannken {
378 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
379 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
380 1.45 reinoud
381 1.45 reinoud if (sc->sc_bus_endian != LITTLE_ENDIAN)
382 1.45 reinoud value = bswap16(value);
383 1.45 reinoud bus_space_write_2(iot, ioh, index, value);
384 1.1 hannken }
385 1.1 hannken
386 1.1 hannken void
387 1.59 riastrad virtio_write_device_config_le_4(struct virtio_softc *sc, int index,
388 1.59 riastrad uint32_t value)
389 1.43 reinoud {
390 1.45 reinoud bus_space_tag_t iot = sc->sc_devcfg_iot;
391 1.45 reinoud bus_space_handle_t ioh = sc->sc_devcfg_ioh;
392 1.45 reinoud
393 1.45 reinoud if (sc->sc_bus_endian != LITTLE_ENDIAN)
394 1.45 reinoud value = bswap32(value);
395 1.45 reinoud bus_space_write_4(iot, ioh, index, value);
396 1.43 reinoud }
397 1.43 reinoud
398 1.45 reinoud
399 1.43 reinoud /*
400 1.43 reinoud * data structures endian helpers
401 1.43 reinoud */
402 1.59 riastrad uint16_t
403 1.59 riastrad virtio_rw16(struct virtio_softc *sc, uint16_t val)
404 1.1 hannken {
405 1.43 reinoud KASSERT(sc);
406 1.45 reinoud return BYTE_ORDER != sc->sc_struct_endian ? bswap16(val) : val;
407 1.1 hannken }
408 1.1 hannken
409 1.59 riastrad uint32_t
410 1.59 riastrad virtio_rw32(struct virtio_softc *sc, uint32_t val)
411 1.43 reinoud {
412 1.43 reinoud KASSERT(sc);
413 1.45 reinoud return BYTE_ORDER != sc->sc_struct_endian ? bswap32(val) : val;
414 1.43 reinoud }
415 1.43 reinoud
416 1.59 riastrad uint64_t
417 1.59 riastrad virtio_rw64(struct virtio_softc *sc, uint64_t val)
418 1.43 reinoud {
419 1.43 reinoud KASSERT(sc);
420 1.45 reinoud return BYTE_ORDER != sc->sc_struct_endian ? bswap64(val) : val;
421 1.43 reinoud }
422 1.43 reinoud
423 1.43 reinoud
424 1.1 hannken /*
425 1.1 hannken * Interrupt handler.
426 1.1 hannken */
427 1.8 ozaki static void
428 1.8 ozaki virtio_soft_intr(void *arg)
429 1.8 ozaki {
430 1.8 ozaki struct virtio_softc *sc = arg;
431 1.8 ozaki
432 1.8 ozaki KASSERT(sc->sc_intrhand != NULL);
433 1.8 ozaki
434 1.54 uwe (*sc->sc_intrhand)(sc);
435 1.8 ozaki }
436 1.8 ozaki
437 1.67 yamaguch /* set to vq->vq_intrhand in virtio_init_vq_vqdone() */
438 1.67 yamaguch static int
439 1.67 yamaguch virtio_vq_done(void *xvq)
440 1.67 yamaguch {
441 1.67 yamaguch struct virtqueue *vq = xvq;
442 1.67 yamaguch
443 1.67 yamaguch return vq->vq_done(vq);
444 1.67 yamaguch }
445 1.67 yamaguch
446 1.67 yamaguch static int
447 1.67 yamaguch virtio_vq_intr(struct virtio_softc *sc)
448 1.67 yamaguch {
449 1.67 yamaguch struct virtqueue *vq;
450 1.67 yamaguch int i, r = 0;
451 1.67 yamaguch
452 1.67 yamaguch for (i = 0; i < sc->sc_nvqs; i++) {
453 1.67 yamaguch vq = &sc->sc_vqs[i];
454 1.67 yamaguch if (virtio_vq_is_enqueued(sc, vq) == 1) {
455 1.67 yamaguch r |= (*vq->vq_intrhand)(vq->vq_intrhand_arg);
456 1.67 yamaguch }
457 1.67 yamaguch }
458 1.67 yamaguch
459 1.67 yamaguch return r;
460 1.67 yamaguch }
461 1.67 yamaguch
462 1.1 hannken /*
463 1.1 hannken * dmamap sync operations for a virtqueue.
464 1.1 hannken */
465 1.1 hannken static inline void
466 1.1 hannken vq_sync_descs(struct virtio_softc *sc, struct virtqueue *vq, int ops)
467 1.1 hannken {
468 1.57 riastrad
469 1.62 skrll /* availoffset == sizeof(vring_desc) * vq_num */
470 1.1 hannken bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap, 0, vq->vq_availoffset,
471 1.57 riastrad ops);
472 1.1 hannken }
473 1.1 hannken
474 1.1 hannken static inline void
475 1.57 riastrad vq_sync_aring_all(struct virtio_softc *sc, struct virtqueue *vq, int ops)
476 1.1 hannken {
477 1.43 reinoud uint16_t hdrlen = offsetof(struct vring_avail, ring);
478 1.64 jakllsch size_t payloadlen = vq->vq_num * sizeof(uint16_t);
479 1.57 riastrad size_t usedlen = 0;
480 1.57 riastrad
481 1.43 reinoud if (sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX)
482 1.57 riastrad usedlen = sizeof(uint16_t);
483 1.57 riastrad bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
484 1.57 riastrad vq->vq_availoffset, hdrlen + payloadlen + usedlen, ops);
485 1.57 riastrad }
486 1.57 riastrad
487 1.57 riastrad static inline void
488 1.57 riastrad vq_sync_aring_header(struct virtio_softc *sc, struct virtqueue *vq, int ops)
489 1.57 riastrad {
490 1.57 riastrad uint16_t hdrlen = offsetof(struct vring_avail, ring);
491 1.57 riastrad
492 1.57 riastrad bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
493 1.57 riastrad vq->vq_availoffset, hdrlen, ops);
494 1.57 riastrad }
495 1.57 riastrad
496 1.57 riastrad static inline void
497 1.57 riastrad vq_sync_aring_payload(struct virtio_softc *sc, struct virtqueue *vq, int ops)
498 1.57 riastrad {
499 1.57 riastrad uint16_t hdrlen = offsetof(struct vring_avail, ring);
500 1.64 jakllsch size_t payloadlen = vq->vq_num * sizeof(uint16_t);
501 1.43 reinoud
502 1.1 hannken bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
503 1.57 riastrad vq->vq_availoffset + hdrlen, payloadlen, ops);
504 1.1 hannken }
505 1.1 hannken
506 1.1 hannken static inline void
507 1.57 riastrad vq_sync_aring_used(struct virtio_softc *sc, struct virtqueue *vq, int ops)
508 1.57 riastrad {
509 1.57 riastrad uint16_t hdrlen = offsetof(struct vring_avail, ring);
510 1.64 jakllsch size_t payloadlen = vq->vq_num * sizeof(uint16_t);
511 1.57 riastrad size_t usedlen = sizeof(uint16_t);
512 1.57 riastrad
513 1.57 riastrad if ((sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX) == 0)
514 1.57 riastrad return;
515 1.57 riastrad bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
516 1.57 riastrad vq->vq_availoffset + hdrlen + payloadlen, usedlen, ops);
517 1.57 riastrad }
518 1.57 riastrad
519 1.57 riastrad static inline void
520 1.57 riastrad vq_sync_uring_all(struct virtio_softc *sc, struct virtqueue *vq, int ops)
521 1.1 hannken {
522 1.43 reinoud uint16_t hdrlen = offsetof(struct vring_used, ring);
523 1.64 jakllsch size_t payloadlen = vq->vq_num * sizeof(struct vring_used_elem);
524 1.57 riastrad size_t availlen = 0;
525 1.57 riastrad
526 1.43 reinoud if (sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX)
527 1.57 riastrad availlen = sizeof(uint16_t);
528 1.57 riastrad bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
529 1.57 riastrad vq->vq_usedoffset, hdrlen + payloadlen + availlen, ops);
530 1.57 riastrad }
531 1.57 riastrad
532 1.57 riastrad static inline void
533 1.57 riastrad vq_sync_uring_header(struct virtio_softc *sc, struct virtqueue *vq, int ops)
534 1.57 riastrad {
535 1.57 riastrad uint16_t hdrlen = offsetof(struct vring_used, ring);
536 1.43 reinoud
537 1.1 hannken bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
538 1.57 riastrad vq->vq_usedoffset, hdrlen, ops);
539 1.57 riastrad }
540 1.57 riastrad
541 1.57 riastrad static inline void
542 1.57 riastrad vq_sync_uring_payload(struct virtio_softc *sc, struct virtqueue *vq, int ops)
543 1.57 riastrad {
544 1.57 riastrad uint16_t hdrlen = offsetof(struct vring_used, ring);
545 1.64 jakllsch size_t payloadlen = vq->vq_num * sizeof(struct vring_used_elem);
546 1.57 riastrad
547 1.57 riastrad bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
548 1.57 riastrad vq->vq_usedoffset + hdrlen, payloadlen, ops);
549 1.57 riastrad }
550 1.57 riastrad
551 1.57 riastrad static inline void
552 1.57 riastrad vq_sync_uring_avail(struct virtio_softc *sc, struct virtqueue *vq, int ops)
553 1.57 riastrad {
554 1.57 riastrad uint16_t hdrlen = offsetof(struct vring_used, ring);
555 1.64 jakllsch size_t payloadlen = vq->vq_num * sizeof(struct vring_used_elem);
556 1.57 riastrad size_t availlen = sizeof(uint16_t);
557 1.57 riastrad
558 1.57 riastrad if ((sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX) == 0)
559 1.57 riastrad return;
560 1.57 riastrad bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
561 1.57 riastrad vq->vq_usedoffset + hdrlen + payloadlen, availlen, ops);
562 1.1 hannken }
563 1.1 hannken
564 1.1 hannken static inline void
565 1.1 hannken vq_sync_indirect(struct virtio_softc *sc, struct virtqueue *vq, int slot,
566 1.57 riastrad int ops)
567 1.1 hannken {
568 1.57 riastrad int offset = vq->vq_indirectoffset +
569 1.57 riastrad sizeof(struct vring_desc) * vq->vq_maxnsegs * slot;
570 1.1 hannken
571 1.1 hannken bus_dmamap_sync(sc->sc_dmat, vq->vq_dmamap,
572 1.57 riastrad offset, sizeof(struct vring_desc) * vq->vq_maxnsegs, ops);
573 1.1 hannken }
574 1.1 hannken
575 1.41 yamaguch bool
576 1.41 yamaguch virtio_vq_is_enqueued(struct virtio_softc *sc, struct virtqueue *vq)
577 1.37 yamaguch {
578 1.37 yamaguch
579 1.37 yamaguch if (vq->vq_queued) {
580 1.37 yamaguch vq->vq_queued = 0;
581 1.57 riastrad vq_sync_aring_all(sc, vq, BUS_DMASYNC_POSTWRITE);
582 1.37 yamaguch }
583 1.37 yamaguch
584 1.57 riastrad vq_sync_uring_header(sc, vq, BUS_DMASYNC_POSTREAD);
585 1.57 riastrad if (vq->vq_used_idx == virtio_rw16(sc, vq->vq_used->idx))
586 1.57 riastrad return 0;
587 1.57 riastrad vq_sync_uring_payload(sc, vq, BUS_DMASYNC_POSTREAD);
588 1.57 riastrad return 1;
589 1.37 yamaguch }
590 1.37 yamaguch
591 1.56 riastrad /*
592 1.43 reinoud * Increase the event index in order to delay interrupts.
593 1.43 reinoud */
594 1.43 reinoud int
595 1.43 reinoud virtio_postpone_intr(struct virtio_softc *sc, struct virtqueue *vq,
596 1.59 riastrad uint16_t nslots)
597 1.43 reinoud {
598 1.43 reinoud uint16_t idx, nused;
599 1.43 reinoud
600 1.43 reinoud idx = vq->vq_used_idx + nslots;
601 1.43 reinoud
602 1.43 reinoud /* set the new event index: avail_ring->used_event = idx */
603 1.43 reinoud *vq->vq_used_event = virtio_rw16(sc, idx);
604 1.57 riastrad vq_sync_aring_used(vq->vq_owner, vq, BUS_DMASYNC_PREWRITE);
605 1.43 reinoud vq->vq_queued++;
606 1.43 reinoud
607 1.43 reinoud nused = (uint16_t)
608 1.59 riastrad (virtio_rw16(sc, vq->vq_used->idx) - vq->vq_used_idx);
609 1.43 reinoud KASSERT(nused <= vq->vq_num);
610 1.43 reinoud
611 1.43 reinoud return nslots < nused;
612 1.43 reinoud }
613 1.43 reinoud
614 1.43 reinoud /*
615 1.43 reinoud * Postpone interrupt until 3/4 of the available descriptors have been
616 1.43 reinoud * consumed.
617 1.43 reinoud */
618 1.43 reinoud int
619 1.43 reinoud virtio_postpone_intr_smart(struct virtio_softc *sc, struct virtqueue *vq)
620 1.43 reinoud {
621 1.43 reinoud uint16_t nslots;
622 1.43 reinoud
623 1.43 reinoud nslots = (uint16_t)
624 1.59 riastrad (virtio_rw16(sc, vq->vq_avail->idx) - vq->vq_used_idx) * 3 / 4;
625 1.43 reinoud
626 1.43 reinoud return virtio_postpone_intr(sc, vq, nslots);
627 1.43 reinoud }
628 1.43 reinoud
629 1.43 reinoud /*
630 1.43 reinoud * Postpone interrupt until all of the available descriptors have been
631 1.43 reinoud * consumed.
632 1.43 reinoud */
633 1.43 reinoud int
634 1.43 reinoud virtio_postpone_intr_far(struct virtio_softc *sc, struct virtqueue *vq)
635 1.43 reinoud {
636 1.43 reinoud uint16_t nslots;
637 1.43 reinoud
638 1.43 reinoud nslots = (uint16_t)
639 1.59 riastrad (virtio_rw16(sc, vq->vq_avail->idx) - vq->vq_used_idx);
640 1.43 reinoud
641 1.43 reinoud return virtio_postpone_intr(sc, vq, nslots);
642 1.43 reinoud }
643 1.43 reinoud
644 1.1 hannken /*
645 1.1 hannken * Start/stop vq interrupt. No guarantee.
646 1.1 hannken */
647 1.1 hannken void
648 1.1 hannken virtio_stop_vq_intr(struct virtio_softc *sc, struct virtqueue *vq)
649 1.1 hannken {
650 1.57 riastrad
651 1.43 reinoud if (sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX) {
652 1.43 reinoud /*
653 1.43 reinoud * No way to disable the interrupt completely with
654 1.43 reinoud * RingEventIdx. Instead advance used_event by half the
655 1.43 reinoud * possible value. This won't happen soon and is far enough in
656 1.43 reinoud * the past to not trigger a spurios interrupt.
657 1.43 reinoud */
658 1.43 reinoud *vq->vq_used_event = virtio_rw16(sc, vq->vq_used_idx + 0x8000);
659 1.57 riastrad vq_sync_aring_used(sc, vq, BUS_DMASYNC_PREWRITE);
660 1.43 reinoud } else {
661 1.57 riastrad vq->vq_avail->flags |=
662 1.57 riastrad virtio_rw16(sc, VRING_AVAIL_F_NO_INTERRUPT);
663 1.57 riastrad vq_sync_aring_header(sc, vq, BUS_DMASYNC_PREWRITE);
664 1.43 reinoud }
665 1.1 hannken vq->vq_queued++;
666 1.1 hannken }
667 1.1 hannken
668 1.43 reinoud int
669 1.1 hannken virtio_start_vq_intr(struct virtio_softc *sc, struct virtqueue *vq)
670 1.1 hannken {
671 1.57 riastrad
672 1.43 reinoud if (sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX) {
673 1.43 reinoud /*
674 1.43 reinoud * If event index feature is negotiated, enabling interrupts
675 1.43 reinoud * is done through setting the latest consumed index in the
676 1.43 reinoud * used_event field
677 1.43 reinoud */
678 1.43 reinoud *vq->vq_used_event = virtio_rw16(sc, vq->vq_used_idx);
679 1.57 riastrad vq_sync_aring_used(sc, vq, BUS_DMASYNC_PREWRITE);
680 1.43 reinoud } else {
681 1.57 riastrad vq->vq_avail->flags &=
682 1.57 riastrad ~virtio_rw16(sc, VRING_AVAIL_F_NO_INTERRUPT);
683 1.57 riastrad vq_sync_aring_header(sc, vq, BUS_DMASYNC_PREWRITE);
684 1.43 reinoud }
685 1.1 hannken vq->vq_queued++;
686 1.43 reinoud
687 1.57 riastrad vq_sync_uring_header(sc, vq, BUS_DMASYNC_POSTREAD);
688 1.57 riastrad if (vq->vq_used_idx == virtio_rw16(sc, vq->vq_used->idx))
689 1.57 riastrad return 0;
690 1.57 riastrad vq_sync_uring_payload(sc, vq, BUS_DMASYNC_POSTREAD);
691 1.57 riastrad return 1;
692 1.1 hannken }
693 1.1 hannken
694 1.1 hannken /*
695 1.1 hannken * Initialize vq structure.
696 1.1 hannken */
697 1.67 yamaguch /*
698 1.67 yamaguch * Reset virtqueue parameters
699 1.67 yamaguch */
700 1.1 hannken static void
701 1.67 yamaguch virtio_reset_vq(struct virtio_softc *sc, struct virtqueue *vq)
702 1.1 hannken {
703 1.1 hannken int i, j;
704 1.1 hannken int vq_size = vq->vq_num;
705 1.1 hannken
706 1.1 hannken memset(vq->vq_vaddr, 0, vq->vq_bytesize);
707 1.1 hannken
708 1.1 hannken /* build the indirect descriptor chain */
709 1.1 hannken if (vq->vq_indirect != NULL) {
710 1.1 hannken struct vring_desc *vd;
711 1.1 hannken
712 1.1 hannken for (i = 0; i < vq_size; i++) {
713 1.1 hannken vd = vq->vq_indirect;
714 1.1 hannken vd += vq->vq_maxnsegs * i;
715 1.59 riastrad for (j = 0; j < vq->vq_maxnsegs - 1; j++) {
716 1.43 reinoud vd[j].next = virtio_rw16(sc, j + 1);
717 1.23 martin }
718 1.1 hannken }
719 1.1 hannken }
720 1.1 hannken
721 1.1 hannken /* free slot management */
722 1.1 hannken SIMPLEQ_INIT(&vq->vq_freelist);
723 1.1 hannken for (i = 0; i < vq_size; i++) {
724 1.59 riastrad SIMPLEQ_INSERT_TAIL(&vq->vq_freelist, &vq->vq_entries[i],
725 1.59 riastrad qe_list);
726 1.1 hannken vq->vq_entries[i].qe_index = i;
727 1.1 hannken }
728 1.1 hannken
729 1.1 hannken /* enqueue/dequeue status */
730 1.1 hannken vq->vq_avail_idx = 0;
731 1.1 hannken vq->vq_used_idx = 0;
732 1.1 hannken vq->vq_queued = 0;
733 1.57 riastrad vq_sync_uring_all(sc, vq, BUS_DMASYNC_PREREAD);
734 1.1 hannken vq->vq_queued++;
735 1.1 hannken }
736 1.48 skrll
737 1.67 yamaguch /* Initialize vq */
738 1.67 yamaguch void
739 1.67 yamaguch virtio_init_vq_vqdone(struct virtio_softc *sc, struct virtqueue *vq,
740 1.67 yamaguch int index, int (*vq_done)(struct virtqueue *))
741 1.67 yamaguch {
742 1.67 yamaguch
743 1.67 yamaguch virtio_init_vq(sc, vq, index, virtio_vq_done, vq);
744 1.67 yamaguch vq->vq_done = vq_done;
745 1.67 yamaguch }
746 1.67 yamaguch
747 1.67 yamaguch void
748 1.67 yamaguch virtio_init_vq(struct virtio_softc *sc, struct virtqueue *vq, int index,
749 1.70 riastrad int (*func)(void *), void *arg)
750 1.67 yamaguch {
751 1.67 yamaguch
752 1.67 yamaguch memset(vq, 0, sizeof(*vq));
753 1.67 yamaguch
754 1.67 yamaguch vq->vq_owner = sc;
755 1.67 yamaguch vq->vq_num = sc->sc_ops->read_queue_size(sc, index);
756 1.67 yamaguch vq->vq_index = index;
757 1.70 riastrad vq->vq_intrhand = func;
758 1.67 yamaguch vq->vq_intrhand_arg = arg;
759 1.67 yamaguch }
760 1.67 yamaguch
761 1.1 hannken /*
762 1.1 hannken * Allocate/free a vq.
763 1.1 hannken */
764 1.1 hannken int
765 1.67 yamaguch virtio_alloc_vq(struct virtio_softc *sc, struct virtqueue *vq,
766 1.15 msaitoh int maxsegsize, int maxnsegs, const char *name)
767 1.1 hannken {
768 1.67 yamaguch bus_size_t size_desc, size_avail, size_used, size_indirect;
769 1.67 yamaguch bus_size_t allocsize = 0, size_desc_avail;
770 1.43 reinoud int rsegs, r, hdrlen;
771 1.67 yamaguch unsigned int vq_num;
772 1.61 skrll #define VIRTQUEUE_ALIGN(n) roundup(n, VIRTIO_PAGE_SIZE)
773 1.1 hannken
774 1.67 yamaguch vq_num = vq->vq_num;
775 1.1 hannken
776 1.67 yamaguch if (vq_num == 0) {
777 1.1 hannken aprint_error_dev(sc->sc_dev,
778 1.59 riastrad "virtqueue not exist, index %d for %s\n",
779 1.67 yamaguch vq->vq_index, name);
780 1.1 hannken goto err;
781 1.1 hannken }
782 1.43 reinoud
783 1.43 reinoud hdrlen = sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX ? 3 : 2;
784 1.43 reinoud
785 1.67 yamaguch size_desc = sizeof(vq->vq_desc[0]) * vq_num;
786 1.67 yamaguch size_avail = sizeof(uint16_t) * hdrlen
787 1.72 riastrad + sizeof(vq->vq_avail[0].ring[0]) * vq_num;
788 1.67 yamaguch size_used = sizeof(uint16_t) *hdrlen
789 1.72 riastrad + sizeof(vq->vq_used[0].ring[0]) * vq_num;
790 1.67 yamaguch size_indirect = (sc->sc_indirect && maxnsegs >= MINSEG_INDIRECT) ?
791 1.67 yamaguch sizeof(struct vring_desc) * maxnsegs * vq_num : 0;
792 1.67 yamaguch
793 1.67 yamaguch size_desc_avail = VIRTQUEUE_ALIGN(size_desc + size_avail);
794 1.67 yamaguch size_used = VIRTQUEUE_ALIGN(size_used);
795 1.67 yamaguch
796 1.67 yamaguch allocsize = size_desc_avail + size_used + size_indirect;
797 1.1 hannken
798 1.1 hannken /* alloc and map the memory */
799 1.1 hannken r = bus_dmamem_alloc(sc->sc_dmat, allocsize, VIRTIO_PAGE_SIZE, 0,
800 1.59 riastrad &vq->vq_segs[0], 1, &rsegs, BUS_DMA_WAITOK);
801 1.1 hannken if (r != 0) {
802 1.1 hannken aprint_error_dev(sc->sc_dev,
803 1.59 riastrad "virtqueue %d for %s allocation failed, "
804 1.67 yamaguch "error code %d\n", vq->vq_index, name, r);
805 1.1 hannken goto err;
806 1.1 hannken }
807 1.67 yamaguch
808 1.43 reinoud r = bus_dmamem_map(sc->sc_dmat, &vq->vq_segs[0], rsegs, allocsize,
809 1.59 riastrad &vq->vq_vaddr, BUS_DMA_WAITOK);
810 1.1 hannken if (r != 0) {
811 1.1 hannken aprint_error_dev(sc->sc_dev,
812 1.59 riastrad "virtqueue %d for %s map failed, "
813 1.67 yamaguch "error code %d\n", vq->vq_index, name, r);
814 1.1 hannken goto err;
815 1.1 hannken }
816 1.67 yamaguch
817 1.1 hannken r = bus_dmamap_create(sc->sc_dmat, allocsize, 1, allocsize, 0,
818 1.59 riastrad BUS_DMA_WAITOK, &vq->vq_dmamap);
819 1.1 hannken if (r != 0) {
820 1.1 hannken aprint_error_dev(sc->sc_dev,
821 1.59 riastrad "virtqueue %d for %s dmamap creation failed, "
822 1.67 yamaguch "error code %d\n", vq->vq_index, name, r);
823 1.1 hannken goto err;
824 1.1 hannken }
825 1.67 yamaguch
826 1.1 hannken r = bus_dmamap_load(sc->sc_dmat, vq->vq_dmamap,
827 1.59 riastrad vq->vq_vaddr, allocsize, NULL, BUS_DMA_WAITOK);
828 1.1 hannken if (r != 0) {
829 1.1 hannken aprint_error_dev(sc->sc_dev,
830 1.59 riastrad "virtqueue %d for %s dmamap load failed, "
831 1.67 yamaguch "error code %d\n", vq->vq_index, name, r);
832 1.1 hannken goto err;
833 1.1 hannken }
834 1.1 hannken
835 1.1 hannken vq->vq_bytesize = allocsize;
836 1.1 hannken vq->vq_maxsegsize = maxsegsize;
837 1.1 hannken vq->vq_maxnsegs = maxnsegs;
838 1.1 hannken
839 1.67 yamaguch #define VIRTIO_PTR(base, offset) (void *)((intptr_t)(base) + (offset))
840 1.67 yamaguch /* initialize vring pointers */
841 1.67 yamaguch vq->vq_desc = VIRTIO_PTR(vq->vq_vaddr, 0);
842 1.67 yamaguch vq->vq_availoffset = size_desc;
843 1.67 yamaguch vq->vq_avail = VIRTIO_PTR(vq->vq_vaddr, vq->vq_availoffset);
844 1.67 yamaguch vq->vq_used_event = VIRTIO_PTR(vq->vq_avail,
845 1.67 yamaguch offsetof(struct vring_avail, ring[vq_num]));
846 1.67 yamaguch vq->vq_usedoffset = size_desc_avail;
847 1.67 yamaguch vq->vq_used = VIRTIO_PTR(vq->vq_vaddr, vq->vq_usedoffset);
848 1.67 yamaguch vq->vq_avail_event = VIRTIO_PTR(vq->vq_used,
849 1.67 yamaguch offsetof(struct vring_used, ring[vq_num]));
850 1.67 yamaguch
851 1.67 yamaguch if (size_indirect > 0) {
852 1.67 yamaguch vq->vq_indirectoffset = size_desc_avail + size_used;
853 1.67 yamaguch vq->vq_indirect = VIRTIO_PTR(vq->vq_vaddr,
854 1.67 yamaguch vq->vq_indirectoffset);
855 1.67 yamaguch }
856 1.67 yamaguch #undef VIRTIO_PTR
857 1.67 yamaguch
858 1.1 hannken /* free slot management */
859 1.67 yamaguch vq->vq_entries = kmem_zalloc(sizeof(struct vq_entry) * vq_num,
860 1.59 riastrad KM_SLEEP);
861 1.67 yamaguch
862 1.67 yamaguch mutex_init(&vq->vq_freelist_lock, MUTEX_SPIN, sc->sc_ipl);
863 1.67 yamaguch mutex_init(&vq->vq_aring_lock, MUTEX_SPIN, sc->sc_ipl);
864 1.67 yamaguch mutex_init(&vq->vq_uring_lock, MUTEX_SPIN, sc->sc_ipl);
865 1.67 yamaguch
866 1.67 yamaguch virtio_reset_vq(sc, vq);
867 1.1 hannken
868 1.1 hannken aprint_verbose_dev(sc->sc_dev,
869 1.71 nakayama "allocated %" PRIuBUSSIZE " byte for virtqueue %d for %s, "
870 1.71 nakayama "size %d\n", allocsize, vq->vq_index, name, vq_num);
871 1.67 yamaguch if (size_indirect > 0)
872 1.1 hannken aprint_verbose_dev(sc->sc_dev,
873 1.71 nakayama "using %" PRIuBUSSIZE " byte (%d entries) indirect "
874 1.71 nakayama "descriptors\n", size_indirect, maxnsegs * vq_num);
875 1.22 jdolecek
876 1.1 hannken return 0;
877 1.1 hannken
878 1.1 hannken err:
879 1.67 yamaguch sc->sc_ops->setup_queue(sc, vq->vq_index, 0);
880 1.1 hannken if (vq->vq_dmamap)
881 1.1 hannken bus_dmamap_destroy(sc->sc_dmat, vq->vq_dmamap);
882 1.1 hannken if (vq->vq_vaddr)
883 1.1 hannken bus_dmamem_unmap(sc->sc_dmat, vq->vq_vaddr, allocsize);
884 1.1 hannken if (vq->vq_segs[0].ds_addr)
885 1.1 hannken bus_dmamem_free(sc->sc_dmat, &vq->vq_segs[0], 1);
886 1.1 hannken memset(vq, 0, sizeof(*vq));
887 1.1 hannken
888 1.1 hannken return -1;
889 1.1 hannken }
890 1.1 hannken
891 1.1 hannken int
892 1.1 hannken virtio_free_vq(struct virtio_softc *sc, struct virtqueue *vq)
893 1.1 hannken {
894 1.1 hannken struct vq_entry *qe;
895 1.1 hannken int i = 0;
896 1.1 hannken
897 1.68 yamaguch if (vq->vq_vaddr == NULL)
898 1.68 yamaguch return 0;
899 1.68 yamaguch
900 1.1 hannken /* device must be already deactivated */
901 1.1 hannken /* confirm the vq is empty */
902 1.1 hannken SIMPLEQ_FOREACH(qe, &vq->vq_freelist, qe_list) {
903 1.1 hannken i++;
904 1.1 hannken }
905 1.1 hannken if (i != vq->vq_num) {
906 1.1 hannken printf("%s: freeing non-empty vq, index %d\n",
907 1.59 riastrad device_xname(sc->sc_dev), vq->vq_index);
908 1.1 hannken return EBUSY;
909 1.1 hannken }
910 1.1 hannken
911 1.1 hannken /* tell device that there's no virtqueue any longer */
912 1.31 jakllsch sc->sc_ops->setup_queue(sc, vq->vq_index, 0);
913 1.1 hannken
914 1.57 riastrad vq_sync_aring_all(sc, vq, BUS_DMASYNC_POSTWRITE);
915 1.57 riastrad
916 1.14 christos kmem_free(vq->vq_entries, sizeof(*vq->vq_entries) * vq->vq_num);
917 1.1 hannken bus_dmamap_unload(sc->sc_dmat, vq->vq_dmamap);
918 1.1 hannken bus_dmamap_destroy(sc->sc_dmat, vq->vq_dmamap);
919 1.1 hannken bus_dmamem_unmap(sc->sc_dmat, vq->vq_vaddr, vq->vq_bytesize);
920 1.1 hannken bus_dmamem_free(sc->sc_dmat, &vq->vq_segs[0], 1);
921 1.1 hannken mutex_destroy(&vq->vq_freelist_lock);
922 1.1 hannken mutex_destroy(&vq->vq_uring_lock);
923 1.1 hannken mutex_destroy(&vq->vq_aring_lock);
924 1.1 hannken memset(vq, 0, sizeof(*vq));
925 1.1 hannken
926 1.1 hannken return 0;
927 1.1 hannken }
928 1.1 hannken
929 1.1 hannken /*
930 1.1 hannken * Free descriptor management.
931 1.1 hannken */
932 1.1 hannken static struct vq_entry *
933 1.1 hannken vq_alloc_entry(struct virtqueue *vq)
934 1.1 hannken {
935 1.1 hannken struct vq_entry *qe;
936 1.1 hannken
937 1.1 hannken mutex_enter(&vq->vq_freelist_lock);
938 1.1 hannken if (SIMPLEQ_EMPTY(&vq->vq_freelist)) {
939 1.1 hannken mutex_exit(&vq->vq_freelist_lock);
940 1.1 hannken return NULL;
941 1.1 hannken }
942 1.1 hannken qe = SIMPLEQ_FIRST(&vq->vq_freelist);
943 1.1 hannken SIMPLEQ_REMOVE_HEAD(&vq->vq_freelist, qe_list);
944 1.1 hannken mutex_exit(&vq->vq_freelist_lock);
945 1.1 hannken
946 1.1 hannken return qe;
947 1.1 hannken }
948 1.1 hannken
949 1.1 hannken static void
950 1.1 hannken vq_free_entry(struct virtqueue *vq, struct vq_entry *qe)
951 1.1 hannken {
952 1.1 hannken mutex_enter(&vq->vq_freelist_lock);
953 1.1 hannken SIMPLEQ_INSERT_TAIL(&vq->vq_freelist, qe, qe_list);
954 1.1 hannken mutex_exit(&vq->vq_freelist_lock);
955 1.1 hannken
956 1.1 hannken return;
957 1.1 hannken }
958 1.1 hannken
959 1.1 hannken /*
960 1.1 hannken * Enqueue several dmamaps as a single request.
961 1.1 hannken */
962 1.1 hannken /*
963 1.1 hannken * Typical usage:
964 1.1 hannken * <queue size> number of followings are stored in arrays
965 1.1 hannken * - command blocks (in dmamem) should be pre-allocated and mapped
966 1.1 hannken * - dmamaps for command blocks should be pre-allocated and loaded
967 1.1 hannken * - dmamaps for payload should be pre-allocated
968 1.1 hannken * r = virtio_enqueue_prep(sc, vq, &slot); // allocate a slot
969 1.1 hannken * if (r) // currently 0 or EAGAIN
970 1.59 riastrad * return r;
971 1.1 hannken * r = bus_dmamap_load(dmat, dmamap_payload[slot], data, count, ..);
972 1.1 hannken * if (r) {
973 1.59 riastrad * virtio_enqueue_abort(sc, vq, slot);
974 1.59 riastrad * return r;
975 1.1 hannken * }
976 1.48 skrll * r = virtio_enqueue_reserve(sc, vq, slot,
977 1.59 riastrad * dmamap_payload[slot]->dm_nsegs + 1);
978 1.1 hannken * // ^ +1 for command
979 1.1 hannken * if (r) { // currently 0 or EAGAIN
980 1.59 riastrad * bus_dmamap_unload(dmat, dmamap_payload[slot]);
981 1.59 riastrad * return r; // do not call abort()
982 1.1 hannken * }
983 1.1 hannken * <setup and prepare commands>
984 1.1 hannken * bus_dmamap_sync(dmat, dmamap_cmd[slot],... BUS_DMASYNC_PREWRITE);
985 1.1 hannken * bus_dmamap_sync(dmat, dmamap_payload[slot],...);
986 1.1 hannken * virtio_enqueue(sc, vq, slot, dmamap_cmd[slot], false);
987 1.1 hannken * virtio_enqueue(sc, vq, slot, dmamap_payload[slot], iswrite);
988 1.1 hannken * virtio_enqueue_commit(sc, vq, slot, true);
989 1.1 hannken */
990 1.1 hannken
991 1.1 hannken /*
992 1.1 hannken * enqueue_prep: allocate a slot number
993 1.1 hannken */
994 1.1 hannken int
995 1.1 hannken virtio_enqueue_prep(struct virtio_softc *sc, struct virtqueue *vq, int *slotp)
996 1.1 hannken {
997 1.1 hannken struct vq_entry *qe1;
998 1.1 hannken
999 1.1 hannken KASSERT(slotp != NULL);
1000 1.1 hannken
1001 1.1 hannken qe1 = vq_alloc_entry(vq);
1002 1.1 hannken if (qe1 == NULL)
1003 1.1 hannken return EAGAIN;
1004 1.1 hannken /* next slot is not allocated yet */
1005 1.1 hannken qe1->qe_next = -1;
1006 1.1 hannken *slotp = qe1->qe_index;
1007 1.1 hannken
1008 1.1 hannken return 0;
1009 1.1 hannken }
1010 1.1 hannken
1011 1.1 hannken /*
1012 1.1 hannken * enqueue_reserve: allocate remaining slots and build the descriptor chain.
1013 1.1 hannken */
1014 1.1 hannken int
1015 1.1 hannken virtio_enqueue_reserve(struct virtio_softc *sc, struct virtqueue *vq,
1016 1.59 riastrad int slot, int nsegs)
1017 1.1 hannken {
1018 1.1 hannken int indirect;
1019 1.1 hannken struct vq_entry *qe1 = &vq->vq_entries[slot];
1020 1.1 hannken
1021 1.1 hannken KASSERT(qe1->qe_next == -1);
1022 1.1 hannken KASSERT(1 <= nsegs && nsegs <= vq->vq_num);
1023 1.1 hannken
1024 1.1 hannken if ((vq->vq_indirect != NULL) &&
1025 1.1 hannken (nsegs >= MINSEG_INDIRECT) &&
1026 1.1 hannken (nsegs <= vq->vq_maxnsegs))
1027 1.1 hannken indirect = 1;
1028 1.1 hannken else
1029 1.1 hannken indirect = 0;
1030 1.1 hannken qe1->qe_indirect = indirect;
1031 1.1 hannken
1032 1.1 hannken if (indirect) {
1033 1.1 hannken struct vring_desc *vd;
1034 1.43 reinoud uint64_t addr;
1035 1.1 hannken int i;
1036 1.1 hannken
1037 1.1 hannken vd = &vq->vq_desc[qe1->qe_index];
1038 1.43 reinoud addr = vq->vq_dmamap->dm_segs[0].ds_addr
1039 1.59 riastrad + vq->vq_indirectoffset;
1040 1.43 reinoud addr += sizeof(struct vring_desc)
1041 1.59 riastrad * vq->vq_maxnsegs * qe1->qe_index;
1042 1.43 reinoud vd->addr = virtio_rw64(sc, addr);
1043 1.43 reinoud vd->len = virtio_rw32(sc, sizeof(struct vring_desc) * nsegs);
1044 1.43 reinoud vd->flags = virtio_rw16(sc, VRING_DESC_F_INDIRECT);
1045 1.1 hannken
1046 1.1 hannken vd = vq->vq_indirect;
1047 1.1 hannken vd += vq->vq_maxnsegs * qe1->qe_index;
1048 1.1 hannken qe1->qe_desc_base = vd;
1049 1.1 hannken
1050 1.59 riastrad for (i = 0; i < nsegs - 1; i++) {
1051 1.43 reinoud vd[i].flags = virtio_rw16(sc, VRING_DESC_F_NEXT);
1052 1.1 hannken }
1053 1.43 reinoud vd[i].flags = virtio_rw16(sc, 0);
1054 1.1 hannken qe1->qe_next = 0;
1055 1.1 hannken
1056 1.1 hannken return 0;
1057 1.1 hannken } else {
1058 1.1 hannken struct vring_desc *vd;
1059 1.1 hannken struct vq_entry *qe;
1060 1.1 hannken int i, s;
1061 1.1 hannken
1062 1.1 hannken vd = &vq->vq_desc[0];
1063 1.1 hannken qe1->qe_desc_base = vd;
1064 1.1 hannken qe1->qe_next = qe1->qe_index;
1065 1.1 hannken s = slot;
1066 1.1 hannken for (i = 0; i < nsegs - 1; i++) {
1067 1.1 hannken qe = vq_alloc_entry(vq);
1068 1.1 hannken if (qe == NULL) {
1069 1.43 reinoud vd[s].flags = virtio_rw16(sc, 0);
1070 1.1 hannken virtio_enqueue_abort(sc, vq, slot);
1071 1.1 hannken return EAGAIN;
1072 1.1 hannken }
1073 1.43 reinoud vd[s].flags = virtio_rw16(sc, VRING_DESC_F_NEXT);
1074 1.43 reinoud vd[s].next = virtio_rw16(sc, qe->qe_index);
1075 1.1 hannken s = qe->qe_index;
1076 1.1 hannken }
1077 1.43 reinoud vd[s].flags = virtio_rw16(sc, 0);
1078 1.1 hannken
1079 1.1 hannken return 0;
1080 1.1 hannken }
1081 1.1 hannken }
1082 1.1 hannken
1083 1.1 hannken /*
1084 1.1 hannken * enqueue: enqueue a single dmamap.
1085 1.1 hannken */
1086 1.1 hannken int
1087 1.1 hannken virtio_enqueue(struct virtio_softc *sc, struct virtqueue *vq, int slot,
1088 1.59 riastrad bus_dmamap_t dmamap, bool write)
1089 1.1 hannken {
1090 1.1 hannken struct vq_entry *qe1 = &vq->vq_entries[slot];
1091 1.1 hannken struct vring_desc *vd = qe1->qe_desc_base;
1092 1.1 hannken int i;
1093 1.1 hannken int s = qe1->qe_next;
1094 1.1 hannken
1095 1.1 hannken KASSERT(s >= 0);
1096 1.1 hannken KASSERT(dmamap->dm_nsegs > 0);
1097 1.1 hannken
1098 1.1 hannken for (i = 0; i < dmamap->dm_nsegs; i++) {
1099 1.43 reinoud vd[s].addr = virtio_rw64(sc, dmamap->dm_segs[i].ds_addr);
1100 1.43 reinoud vd[s].len = virtio_rw32(sc, dmamap->dm_segs[i].ds_len);
1101 1.1 hannken if (!write)
1102 1.43 reinoud vd[s].flags |= virtio_rw16(sc, VRING_DESC_F_WRITE);
1103 1.43 reinoud s = virtio_rw16(sc, vd[s].next);
1104 1.1 hannken }
1105 1.1 hannken qe1->qe_next = s;
1106 1.1 hannken
1107 1.1 hannken return 0;
1108 1.1 hannken }
1109 1.1 hannken
1110 1.1 hannken int
1111 1.1 hannken virtio_enqueue_p(struct virtio_softc *sc, struct virtqueue *vq, int slot,
1112 1.59 riastrad bus_dmamap_t dmamap, bus_addr_t start, bus_size_t len,
1113 1.59 riastrad bool write)
1114 1.1 hannken {
1115 1.1 hannken struct vq_entry *qe1 = &vq->vq_entries[slot];
1116 1.1 hannken struct vring_desc *vd = qe1->qe_desc_base;
1117 1.1 hannken int s = qe1->qe_next;
1118 1.1 hannken
1119 1.1 hannken KASSERT(s >= 0);
1120 1.1 hannken KASSERT(dmamap->dm_nsegs == 1); /* XXX */
1121 1.59 riastrad KASSERT(dmamap->dm_segs[0].ds_len > start);
1122 1.59 riastrad KASSERT(dmamap->dm_segs[0].ds_len >= start + len);
1123 1.1 hannken
1124 1.43 reinoud vd[s].addr = virtio_rw64(sc, dmamap->dm_segs[0].ds_addr + start);
1125 1.43 reinoud vd[s].len = virtio_rw32(sc, len);
1126 1.1 hannken if (!write)
1127 1.43 reinoud vd[s].flags |= virtio_rw16(sc, VRING_DESC_F_WRITE);
1128 1.43 reinoud qe1->qe_next = virtio_rw16(sc, vd[s].next);
1129 1.1 hannken
1130 1.1 hannken return 0;
1131 1.1 hannken }
1132 1.1 hannken
1133 1.1 hannken /*
1134 1.1 hannken * enqueue_commit: add it to the aring.
1135 1.1 hannken */
1136 1.1 hannken int
1137 1.1 hannken virtio_enqueue_commit(struct virtio_softc *sc, struct virtqueue *vq, int slot,
1138 1.59 riastrad bool notifynow)
1139 1.1 hannken {
1140 1.1 hannken struct vq_entry *qe1;
1141 1.1 hannken
1142 1.1 hannken if (slot < 0) {
1143 1.1 hannken mutex_enter(&vq->vq_aring_lock);
1144 1.1 hannken goto notify;
1145 1.1 hannken }
1146 1.1 hannken vq_sync_descs(sc, vq, BUS_DMASYNC_PREWRITE);
1147 1.1 hannken qe1 = &vq->vq_entries[slot];
1148 1.1 hannken if (qe1->qe_indirect)
1149 1.1 hannken vq_sync_indirect(sc, vq, slot, BUS_DMASYNC_PREWRITE);
1150 1.1 hannken mutex_enter(&vq->vq_aring_lock);
1151 1.43 reinoud vq->vq_avail->ring[(vq->vq_avail_idx++) % vq->vq_num] =
1152 1.57 riastrad virtio_rw16(sc, slot);
1153 1.1 hannken
1154 1.1 hannken notify:
1155 1.1 hannken if (notifynow) {
1156 1.43 reinoud uint16_t o, n, t;
1157 1.43 reinoud uint16_t flags;
1158 1.57 riastrad
1159 1.65 jakllsch o = virtio_rw16(sc, vq->vq_avail->idx) - 1;
1160 1.43 reinoud n = vq->vq_avail_idx;
1161 1.43 reinoud
1162 1.57 riastrad /*
1163 1.57 riastrad * Prepare for `device->CPU' (host->guest) transfer
1164 1.57 riastrad * into the buffer. This must happen before we commit
1165 1.57 riastrad * the vq->vq_avail->idx update to ensure we're not
1166 1.57 riastrad * still using the buffer in case program-prior loads
1167 1.57 riastrad * or stores in it get delayed past the store to
1168 1.57 riastrad * vq->vq_avail->idx.
1169 1.57 riastrad */
1170 1.57 riastrad vq_sync_uring_all(sc, vq, BUS_DMASYNC_PREREAD);
1171 1.57 riastrad
1172 1.57 riastrad /* ensure payload is published, then avail idx */
1173 1.57 riastrad vq_sync_aring_payload(sc, vq, BUS_DMASYNC_PREWRITE);
1174 1.43 reinoud vq->vq_avail->idx = virtio_rw16(sc, vq->vq_avail_idx);
1175 1.57 riastrad vq_sync_aring_header(sc, vq, BUS_DMASYNC_PREWRITE);
1176 1.1 hannken vq->vq_queued++;
1177 1.43 reinoud
1178 1.43 reinoud if (sc->sc_active_features & VIRTIO_F_RING_EVENT_IDX) {
1179 1.57 riastrad vq_sync_uring_avail(sc, vq, BUS_DMASYNC_POSTREAD);
1180 1.43 reinoud t = virtio_rw16(sc, *vq->vq_avail_event) + 1;
1181 1.43 reinoud if ((uint16_t) (n - t) < (uint16_t) (n - o))
1182 1.43 reinoud sc->sc_ops->kick(sc, vq->vq_index);
1183 1.43 reinoud } else {
1184 1.57 riastrad vq_sync_uring_header(sc, vq, BUS_DMASYNC_POSTREAD);
1185 1.43 reinoud flags = virtio_rw16(sc, vq->vq_used->flags);
1186 1.43 reinoud if (!(flags & VRING_USED_F_NO_NOTIFY))
1187 1.43 reinoud sc->sc_ops->kick(sc, vq->vq_index);
1188 1.43 reinoud }
1189 1.1 hannken }
1190 1.1 hannken mutex_exit(&vq->vq_aring_lock);
1191 1.1 hannken
1192 1.1 hannken return 0;
1193 1.1 hannken }
1194 1.1 hannken
1195 1.1 hannken /*
1196 1.1 hannken * enqueue_abort: rollback.
1197 1.1 hannken */
1198 1.1 hannken int
1199 1.1 hannken virtio_enqueue_abort(struct virtio_softc *sc, struct virtqueue *vq, int slot)
1200 1.1 hannken {
1201 1.1 hannken struct vq_entry *qe = &vq->vq_entries[slot];
1202 1.1 hannken struct vring_desc *vd;
1203 1.1 hannken int s;
1204 1.1 hannken
1205 1.1 hannken if (qe->qe_next < 0) {
1206 1.1 hannken vq_free_entry(vq, qe);
1207 1.1 hannken return 0;
1208 1.1 hannken }
1209 1.1 hannken
1210 1.1 hannken s = slot;
1211 1.1 hannken vd = &vq->vq_desc[0];
1212 1.43 reinoud while (virtio_rw16(sc, vd[s].flags) & VRING_DESC_F_NEXT) {
1213 1.43 reinoud s = virtio_rw16(sc, vd[s].next);
1214 1.1 hannken vq_free_entry(vq, qe);
1215 1.1 hannken qe = &vq->vq_entries[s];
1216 1.1 hannken }
1217 1.1 hannken vq_free_entry(vq, qe);
1218 1.1 hannken return 0;
1219 1.1 hannken }
1220 1.1 hannken
1221 1.1 hannken /*
1222 1.1 hannken * Dequeue a request.
1223 1.1 hannken */
1224 1.1 hannken /*
1225 1.1 hannken * dequeue: dequeue a request from uring; dmamap_sync for uring is
1226 1.1 hannken * already done in the interrupt handler.
1227 1.1 hannken */
1228 1.1 hannken int
1229 1.1 hannken virtio_dequeue(struct virtio_softc *sc, struct virtqueue *vq,
1230 1.59 riastrad int *slotp, int *lenp)
1231 1.1 hannken {
1232 1.1 hannken uint16_t slot, usedidx;
1233 1.1 hannken struct vq_entry *qe;
1234 1.1 hannken
1235 1.43 reinoud if (vq->vq_used_idx == virtio_rw16(sc, vq->vq_used->idx))
1236 1.1 hannken return ENOENT;
1237 1.1 hannken mutex_enter(&vq->vq_uring_lock);
1238 1.1 hannken usedidx = vq->vq_used_idx++;
1239 1.1 hannken mutex_exit(&vq->vq_uring_lock);
1240 1.1 hannken usedidx %= vq->vq_num;
1241 1.43 reinoud slot = virtio_rw32(sc, vq->vq_used->ring[usedidx].id);
1242 1.1 hannken qe = &vq->vq_entries[slot];
1243 1.1 hannken
1244 1.1 hannken if (qe->qe_indirect)
1245 1.1 hannken vq_sync_indirect(sc, vq, slot, BUS_DMASYNC_POSTWRITE);
1246 1.1 hannken
1247 1.1 hannken if (slotp)
1248 1.1 hannken *slotp = slot;
1249 1.1 hannken if (lenp)
1250 1.43 reinoud *lenp = virtio_rw32(sc, vq->vq_used->ring[usedidx].len);
1251 1.1 hannken
1252 1.1 hannken return 0;
1253 1.1 hannken }
1254 1.1 hannken
1255 1.1 hannken /*
1256 1.1 hannken * dequeue_commit: complete dequeue; the slot is recycled for future use.
1257 1.1 hannken * if you forget to call this the slot will be leaked.
1258 1.1 hannken */
1259 1.1 hannken int
1260 1.1 hannken virtio_dequeue_commit(struct virtio_softc *sc, struct virtqueue *vq, int slot)
1261 1.1 hannken {
1262 1.1 hannken struct vq_entry *qe = &vq->vq_entries[slot];
1263 1.1 hannken struct vring_desc *vd = &vq->vq_desc[0];
1264 1.1 hannken int s = slot;
1265 1.1 hannken
1266 1.43 reinoud while (virtio_rw16(sc, vd[s].flags) & VRING_DESC_F_NEXT) {
1267 1.43 reinoud s = virtio_rw16(sc, vd[s].next);
1268 1.1 hannken vq_free_entry(vq, qe);
1269 1.1 hannken qe = &vq->vq_entries[s];
1270 1.1 hannken }
1271 1.1 hannken vq_free_entry(vq, qe);
1272 1.1 hannken
1273 1.1 hannken return 0;
1274 1.1 hannken }
1275 1.18 pgoyette
1276 1.22 jdolecek /*
1277 1.22 jdolecek * Attach a child, fill all the members.
1278 1.22 jdolecek */
1279 1.22 jdolecek void
1280 1.48 skrll virtio_child_attach_start(struct virtio_softc *sc, device_t child, int ipl,
1281 1.66 yamaguch uint64_t req_features, const char *feat_bits)
1282 1.22 jdolecek {
1283 1.43 reinoud char buf[1024];
1284 1.22 jdolecek
1285 1.22 jdolecek sc->sc_child = child;
1286 1.22 jdolecek sc->sc_ipl = ipl;
1287 1.22 jdolecek
1288 1.43 reinoud virtio_negotiate_features(sc, req_features);
1289 1.43 reinoud snprintb(buf, sizeof(buf), feat_bits, sc->sc_active_features);
1290 1.43 reinoud aprint_normal(": features: %s\n", buf);
1291 1.22 jdolecek aprint_naive("\n");
1292 1.22 jdolecek }
1293 1.22 jdolecek
1294 1.66 yamaguch int
1295 1.66 yamaguch virtio_child_attach_finish(struct virtio_softc *sc,
1296 1.66 yamaguch struct virtqueue *vqs, size_t nvqs,
1297 1.67 yamaguch virtio_callback config_change,
1298 1.66 yamaguch int req_flags)
1299 1.37 yamaguch {
1300 1.69 yamaguch size_t i;
1301 1.66 yamaguch int r;
1302 1.39 yamaguch
1303 1.66 yamaguch #ifdef DIAGNOSTIC
1304 1.66 yamaguch KASSERT(nvqs > 0);
1305 1.66 yamaguch #define VIRTIO_ASSERT_FLAGS (VIRTIO_F_INTR_SOFTINT | VIRTIO_F_INTR_PERVQ)
1306 1.66 yamaguch KASSERT((req_flags & VIRTIO_ASSERT_FLAGS) != VIRTIO_ASSERT_FLAGS);
1307 1.66 yamaguch #undef VIRTIO_ASSERT_FLAGS
1308 1.66 yamaguch
1309 1.69 yamaguch for (i = 0; i < nvqs; i++){
1310 1.69 yamaguch KASSERT(vqs[i].vq_index == i);
1311 1.69 yamaguch KASSERT(vqs[i].vq_intrhand != NULL);
1312 1.69 yamaguch KASSERT(vqs[i].vq_done == NULL ||
1313 1.69 yamaguch vqs[i].vq_intrhand == virtio_vq_done);
1314 1.66 yamaguch }
1315 1.66 yamaguch #endif
1316 1.66 yamaguch
1317 1.66 yamaguch sc->sc_finished_called = true;
1318 1.37 yamaguch
1319 1.37 yamaguch sc->sc_vqs = vqs;
1320 1.66 yamaguch sc->sc_nvqs = nvqs;
1321 1.66 yamaguch sc->sc_config_change = config_change;
1322 1.67 yamaguch sc->sc_intrhand = virtio_vq_intr;
1323 1.66 yamaguch sc->sc_flags = req_flags;
1324 1.37 yamaguch
1325 1.69 yamaguch /* set the vq address */
1326 1.69 yamaguch for (i = 0; i < nvqs; i++) {
1327 1.69 yamaguch sc->sc_ops->setup_queue(sc, vqs[i].vq_index,
1328 1.69 yamaguch vqs[i].vq_dmamap->dm_segs[0].ds_addr);
1329 1.69 yamaguch }
1330 1.69 yamaguch
1331 1.50 yamaguch r = sc->sc_ops->alloc_interrupts(sc);
1332 1.50 yamaguch if (r != 0) {
1333 1.59 riastrad aprint_error_dev(sc->sc_dev,
1334 1.59 riastrad "failed to allocate interrupts\n");
1335 1.50 yamaguch goto fail;
1336 1.50 yamaguch }
1337 1.50 yamaguch
1338 1.51 yamaguch r = sc->sc_ops->setup_interrupts(sc, 0);
1339 1.22 jdolecek if (r != 0) {
1340 1.22 jdolecek aprint_error_dev(sc->sc_dev, "failed to setup interrupts\n");
1341 1.52 yamaguch goto fail;
1342 1.31 jakllsch }
1343 1.31 jakllsch
1344 1.31 jakllsch KASSERT(sc->sc_soft_ih == NULL);
1345 1.43 reinoud if (sc->sc_flags & VIRTIO_F_INTR_SOFTINT) {
1346 1.48 skrll u_int flags = SOFTINT_NET;
1347 1.43 reinoud if (sc->sc_flags & VIRTIO_F_INTR_MPSAFE)
1348 1.31 jakllsch flags |= SOFTINT_MPSAFE;
1349 1.31 jakllsch
1350 1.59 riastrad sc->sc_soft_ih = softint_establish(flags, virtio_soft_intr,
1351 1.59 riastrad sc);
1352 1.31 jakllsch if (sc->sc_soft_ih == NULL) {
1353 1.31 jakllsch sc->sc_ops->free_interrupts(sc);
1354 1.31 jakllsch aprint_error_dev(sc->sc_dev,
1355 1.31 jakllsch "failed to establish soft interrupt\n");
1356 1.31 jakllsch goto fail;
1357 1.31 jakllsch }
1358 1.22 jdolecek }
1359 1.22 jdolecek
1360 1.22 jdolecek virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_DRIVER_OK);
1361 1.31 jakllsch return 0;
1362 1.22 jdolecek
1363 1.31 jakllsch fail:
1364 1.37 yamaguch if (sc->sc_soft_ih) {
1365 1.37 yamaguch softint_disestablish(sc->sc_soft_ih);
1366 1.37 yamaguch sc->sc_soft_ih = NULL;
1367 1.37 yamaguch }
1368 1.37 yamaguch
1369 1.52 yamaguch sc->sc_ops->free_interrupts(sc);
1370 1.52 yamaguch
1371 1.31 jakllsch virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
1372 1.31 jakllsch return 1;
1373 1.22 jdolecek }
1374 1.22 jdolecek
1375 1.22 jdolecek void
1376 1.22 jdolecek virtio_child_detach(struct virtio_softc *sc)
1377 1.22 jdolecek {
1378 1.22 jdolecek sc->sc_child = NULL;
1379 1.22 jdolecek sc->sc_vqs = NULL;
1380 1.22 jdolecek
1381 1.22 jdolecek virtio_device_reset(sc);
1382 1.22 jdolecek
1383 1.31 jakllsch sc->sc_ops->free_interrupts(sc);
1384 1.31 jakllsch
1385 1.31 jakllsch if (sc->sc_soft_ih) {
1386 1.31 jakllsch softint_disestablish(sc->sc_soft_ih);
1387 1.31 jakllsch sc->sc_soft_ih = NULL;
1388 1.31 jakllsch }
1389 1.22 jdolecek }
1390 1.22 jdolecek
1391 1.22 jdolecek void
1392 1.22 jdolecek virtio_child_attach_failed(struct virtio_softc *sc)
1393 1.22 jdolecek {
1394 1.22 jdolecek virtio_child_detach(sc);
1395 1.22 jdolecek
1396 1.22 jdolecek virtio_set_status(sc, VIRTIO_CONFIG_DEVICE_STATUS_FAILED);
1397 1.22 jdolecek
1398 1.22 jdolecek sc->sc_child = VIRTIO_CHILD_FAILED;
1399 1.22 jdolecek }
1400 1.22 jdolecek
1401 1.22 jdolecek bus_dma_tag_t
1402 1.22 jdolecek virtio_dmat(struct virtio_softc *sc)
1403 1.22 jdolecek {
1404 1.22 jdolecek return sc->sc_dmat;
1405 1.22 jdolecek }
1406 1.22 jdolecek
1407 1.22 jdolecek device_t
1408 1.22 jdolecek virtio_child(struct virtio_softc *sc)
1409 1.22 jdolecek {
1410 1.22 jdolecek return sc->sc_child;
1411 1.22 jdolecek }
1412 1.22 jdolecek
1413 1.22 jdolecek int
1414 1.22 jdolecek virtio_intrhand(struct virtio_softc *sc)
1415 1.22 jdolecek {
1416 1.54 uwe return (*sc->sc_intrhand)(sc);
1417 1.22 jdolecek }
1418 1.22 jdolecek
1419 1.43 reinoud uint64_t
1420 1.22 jdolecek virtio_features(struct virtio_softc *sc)
1421 1.22 jdolecek {
1422 1.43 reinoud return sc->sc_active_features;
1423 1.22 jdolecek }
1424 1.22 jdolecek
1425 1.35 jakllsch int
1426 1.43 reinoud virtio_attach_failed(struct virtio_softc *sc)
1427 1.35 jakllsch {
1428 1.43 reinoud device_t self = sc->sc_dev;
1429 1.35 jakllsch
1430 1.43 reinoud /* no error if its not connected, but its failed */
1431 1.43 reinoud if (sc->sc_childdevid == 0)
1432 1.43 reinoud return 1;
1433 1.36 jmcneill
1434 1.43 reinoud if (sc->sc_child == NULL) {
1435 1.43 reinoud aprint_error_dev(self,
1436 1.59 riastrad "no matching child driver; not configured\n");
1437 1.43 reinoud return 1;
1438 1.43 reinoud }
1439 1.35 jakllsch
1440 1.43 reinoud if (sc->sc_child == VIRTIO_CHILD_FAILED) {
1441 1.43 reinoud aprint_error_dev(self, "virtio configuration failed\n");
1442 1.43 reinoud return 1;
1443 1.43 reinoud }
1444 1.44 reinoud
1445 1.44 reinoud /* sanity check */
1446 1.44 reinoud if (!sc->sc_finished_called) {
1447 1.44 reinoud aprint_error_dev(self, "virtio internal error, child driver "
1448 1.59 riastrad "signaled OK but didn't initialize interrupts\n");
1449 1.44 reinoud return 1;
1450 1.44 reinoud }
1451 1.44 reinoud
1452 1.43 reinoud return 0;
1453 1.43 reinoud }
1454 1.43 reinoud
1455 1.43 reinoud void
1456 1.43 reinoud virtio_print_device_type(device_t self, int id, int revision)
1457 1.43 reinoud {
1458 1.58 riastrad aprint_normal_dev(self, "%s device (id %d, rev. 0x%02x)\n",
1459 1.58 riastrad (id < NDEVNAMES ? virtio_device_name[id] : "Unknown"),
1460 1.58 riastrad id,
1461 1.58 riastrad revision);
1462 1.35 jakllsch }
1463 1.35 jakllsch
1464 1.43 reinoud
1465 1.32 jakllsch MODULE(MODULE_CLASS_DRIVER, virtio, NULL);
1466 1.48 skrll
1467 1.18 pgoyette #ifdef _MODULE
1468 1.18 pgoyette #include "ioconf.c"
1469 1.18 pgoyette #endif
1470 1.48 skrll
1471 1.18 pgoyette static int
1472 1.18 pgoyette virtio_modcmd(modcmd_t cmd, void *opaque)
1473 1.18 pgoyette {
1474 1.18 pgoyette int error = 0;
1475 1.48 skrll
1476 1.18 pgoyette #ifdef _MODULE
1477 1.18 pgoyette switch (cmd) {
1478 1.18 pgoyette case MODULE_CMD_INIT:
1479 1.48 skrll error = config_init_component(cfdriver_ioconf_virtio,
1480 1.48 skrll cfattach_ioconf_virtio, cfdata_ioconf_virtio);
1481 1.18 pgoyette break;
1482 1.18 pgoyette case MODULE_CMD_FINI:
1483 1.48 skrll error = config_fini_component(cfdriver_ioconf_virtio,
1484 1.18 pgoyette cfattach_ioconf_virtio, cfdata_ioconf_virtio);
1485 1.18 pgoyette break;
1486 1.18 pgoyette default:
1487 1.18 pgoyette error = ENOTTY;
1488 1.18 pgoyette break;
1489 1.18 pgoyette }
1490 1.18 pgoyette #endif
1491 1.48 skrll
1492 1.48 skrll return error;
1493 1.18 pgoyette }
1494