ld_virtio.c revision 1.18 1 1.18 jakllsch /* $NetBSD: ld_virtio.c,v 1.18 2018/06/03 19:47:35 jakllsch Exp $ */
2 1.1 hannken
3 1.1 hannken /*
4 1.1 hannken * Copyright (c) 2010 Minoura Makoto.
5 1.1 hannken * All rights reserved.
6 1.1 hannken *
7 1.1 hannken * Redistribution and use in source and binary forms, with or without
8 1.1 hannken * modification, are permitted provided that the following conditions
9 1.1 hannken * are met:
10 1.1 hannken * 1. Redistributions of source code must retain the above copyright
11 1.1 hannken * notice, this list of conditions and the following disclaimer.
12 1.1 hannken * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 hannken * notice, this list of conditions and the following disclaimer in the
14 1.1 hannken * documentation and/or other materials provided with the distribution.
15 1.1 hannken *
16 1.1 hannken * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 hannken * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 hannken * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 hannken * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 hannken * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 1.1 hannken * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 1.1 hannken * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 1.1 hannken * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 1.1 hannken * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 1.1 hannken * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 1.1 hannken */
27 1.1 hannken
28 1.1 hannken #include <sys/cdefs.h>
29 1.18 jakllsch __KERNEL_RCSID(0, "$NetBSD: ld_virtio.c,v 1.18 2018/06/03 19:47:35 jakllsch Exp $");
30 1.1 hannken
31 1.1 hannken #include <sys/param.h>
32 1.1 hannken #include <sys/systm.h>
33 1.1 hannken #include <sys/kernel.h>
34 1.1 hannken #include <sys/buf.h>
35 1.11 jdolecek #include <sys/bufq.h>
36 1.1 hannken #include <sys/bus.h>
37 1.1 hannken #include <sys/device.h>
38 1.1 hannken #include <sys/disk.h>
39 1.1 hannken #include <sys/mutex.h>
40 1.12 pgoyette #include <sys/module.h>
41 1.1 hannken
42 1.1 hannken #include <dev/pci/pcidevs.h>
43 1.1 hannken #include <dev/pci/pcireg.h>
44 1.1 hannken #include <dev/pci/pcivar.h>
45 1.1 hannken
46 1.1 hannken #include <dev/ldvar.h>
47 1.1 hannken #include <dev/pci/virtioreg.h>
48 1.1 hannken #include <dev/pci/virtiovar.h>
49 1.1 hannken
50 1.12 pgoyette #include "ioconf.h"
51 1.12 pgoyette
52 1.1 hannken /*
53 1.1 hannken * ld_virtioreg:
54 1.1 hannken */
55 1.1 hannken /* Configuration registers */
56 1.1 hannken #define VIRTIO_BLK_CONFIG_CAPACITY 0 /* 64bit */
57 1.1 hannken #define VIRTIO_BLK_CONFIG_SIZE_MAX 8 /* 32bit */
58 1.1 hannken #define VIRTIO_BLK_CONFIG_SEG_MAX 12 /* 32bit */
59 1.1 hannken #define VIRTIO_BLK_CONFIG_GEOMETRY_C 16 /* 16bit */
60 1.1 hannken #define VIRTIO_BLK_CONFIG_GEOMETRY_H 18 /* 8bit */
61 1.1 hannken #define VIRTIO_BLK_CONFIG_GEOMETRY_S 19 /* 8bit */
62 1.1 hannken #define VIRTIO_BLK_CONFIG_BLK_SIZE 20 /* 32bit */
63 1.18 jakllsch #define VIRTIO_BLK_CONFIG_WRITEBACK 32 /* 8bit */
64 1.1 hannken
65 1.1 hannken /* Feature bits */
66 1.1 hannken #define VIRTIO_BLK_F_BARRIER (1<<0)
67 1.1 hannken #define VIRTIO_BLK_F_SIZE_MAX (1<<1)
68 1.1 hannken #define VIRTIO_BLK_F_SEG_MAX (1<<2)
69 1.1 hannken #define VIRTIO_BLK_F_GEOMETRY (1<<4)
70 1.1 hannken #define VIRTIO_BLK_F_RO (1<<5)
71 1.1 hannken #define VIRTIO_BLK_F_BLK_SIZE (1<<6)
72 1.1 hannken #define VIRTIO_BLK_F_SCSI (1<<7)
73 1.1 hannken #define VIRTIO_BLK_F_FLUSH (1<<9)
74 1.18 jakllsch #define VIRTIO_BLK_F_TOPOLOGY (1<<10)
75 1.18 jakllsch #define VIRTIO_BLK_F_CONFIG_WCE (1<<11)
76 1.1 hannken
77 1.17 jakllsch /*
78 1.9 christos * Each block request uses at least two segments - one for the header
79 1.9 christos * and one for the status.
80 1.17 jakllsch */
81 1.9 christos #define VIRTIO_BLK_MIN_SEGMENTS 2
82 1.9 christos
83 1.9 christos #define VIRTIO_BLK_FLAG_BITS \
84 1.9 christos VIRTIO_COMMON_FLAG_BITS \
85 1.18 jakllsch "\x0c""CONFIG_WCE" \
86 1.18 jakllsch "\x0b""TOPOLOGY" \
87 1.9 christos "\x0a""FLUSH" \
88 1.9 christos "\x08""SCSI" \
89 1.9 christos "\x07""BLK_SIZE" \
90 1.9 christos "\x06""RO" \
91 1.9 christos "\x05""GEOMETRY" \
92 1.9 christos "\x03""SEG_MAX" \
93 1.9 christos "\x02""SIZE_MAX" \
94 1.9 christos "\x01""BARRIER"
95 1.9 christos
96 1.1 hannken /* Command */
97 1.1 hannken #define VIRTIO_BLK_T_IN 0
98 1.1 hannken #define VIRTIO_BLK_T_OUT 1
99 1.18 jakllsch #define VIRTIO_BLK_T_FLUSH 4
100 1.1 hannken #define VIRTIO_BLK_T_BARRIER 0x80000000
101 1.1 hannken
102 1.1 hannken /* Status */
103 1.1 hannken #define VIRTIO_BLK_S_OK 0
104 1.1 hannken #define VIRTIO_BLK_S_IOERR 1
105 1.18 jakllsch #define VIRTIO_BLK_S_UNSUPP 2
106 1.1 hannken
107 1.1 hannken /* Request header structure */
108 1.1 hannken struct virtio_blk_req_hdr {
109 1.1 hannken uint32_t type; /* VIRTIO_BLK_T_* */
110 1.1 hannken uint32_t ioprio;
111 1.1 hannken uint64_t sector;
112 1.1 hannken } __packed;
113 1.1 hannken /* 512*virtio_blk_req_hdr.sector byte payload and 1 byte status follows */
114 1.1 hannken
115 1.1 hannken
116 1.1 hannken /*
117 1.1 hannken * ld_virtiovar:
118 1.1 hannken */
119 1.1 hannken struct virtio_blk_req {
120 1.1 hannken struct virtio_blk_req_hdr vr_hdr;
121 1.1 hannken uint8_t vr_status;
122 1.1 hannken struct buf *vr_bp;
123 1.1 hannken bus_dmamap_t vr_cmdsts;
124 1.1 hannken bus_dmamap_t vr_payload;
125 1.1 hannken };
126 1.1 hannken
127 1.1 hannken struct ld_virtio_softc {
128 1.1 hannken struct ld_softc sc_ld;
129 1.1 hannken device_t sc_dev;
130 1.1 hannken
131 1.1 hannken struct virtio_softc *sc_virtio;
132 1.9 christos struct virtqueue sc_vq;
133 1.1 hannken
134 1.1 hannken struct virtio_blk_req *sc_reqs;
135 1.9 christos bus_dma_segment_t sc_reqs_seg;
136 1.1 hannken
137 1.1 hannken int sc_readonly;
138 1.1 hannken };
139 1.1 hannken
140 1.1 hannken static int ld_virtio_match(device_t, cfdata_t, void *);
141 1.1 hannken static void ld_virtio_attach(device_t, device_t, void *);
142 1.1 hannken static int ld_virtio_detach(device_t, int);
143 1.1 hannken
144 1.1 hannken CFATTACH_DECL_NEW(ld_virtio, sizeof(struct ld_virtio_softc),
145 1.1 hannken ld_virtio_match, ld_virtio_attach, ld_virtio_detach, NULL);
146 1.1 hannken
147 1.1 hannken static int
148 1.1 hannken ld_virtio_match(device_t parent, cfdata_t match, void *aux)
149 1.1 hannken {
150 1.15 jdolecek struct virtio_attach_args *va = aux;
151 1.1 hannken
152 1.1 hannken if (va->sc_childdevid == PCI_PRODUCT_VIRTIO_BLOCK)
153 1.1 hannken return 1;
154 1.1 hannken
155 1.1 hannken return 0;
156 1.1 hannken }
157 1.1 hannken
158 1.1 hannken static int ld_virtio_vq_done(struct virtqueue *);
159 1.1 hannken static int ld_virtio_dump(struct ld_softc *, void *, int, int);
160 1.1 hannken static int ld_virtio_start(struct ld_softc *, struct buf *);
161 1.1 hannken
162 1.1 hannken static int
163 1.1 hannken ld_virtio_alloc_reqs(struct ld_virtio_softc *sc, int qsize)
164 1.1 hannken {
165 1.1 hannken int allocsize, r, rsegs, i;
166 1.1 hannken struct ld_softc *ld = &sc->sc_ld;
167 1.1 hannken void *vaddr;
168 1.1 hannken
169 1.1 hannken allocsize = sizeof(struct virtio_blk_req) * qsize;
170 1.15 jdolecek r = bus_dmamem_alloc(virtio_dmat(sc->sc_virtio), allocsize, 0, 0,
171 1.9 christos &sc->sc_reqs_seg, 1, &rsegs, BUS_DMA_NOWAIT);
172 1.1 hannken if (r != 0) {
173 1.1 hannken aprint_error_dev(sc->sc_dev,
174 1.1 hannken "DMA memory allocation failed, size %d, "
175 1.1 hannken "error code %d\n", allocsize, r);
176 1.1 hannken goto err_none;
177 1.1 hannken }
178 1.15 jdolecek r = bus_dmamem_map(virtio_dmat(sc->sc_virtio),
179 1.9 christos &sc->sc_reqs_seg, 1, allocsize,
180 1.1 hannken &vaddr, BUS_DMA_NOWAIT);
181 1.1 hannken if (r != 0) {
182 1.1 hannken aprint_error_dev(sc->sc_dev,
183 1.1 hannken "DMA memory map failed, "
184 1.1 hannken "error code %d\n", r);
185 1.1 hannken goto err_dmamem_alloc;
186 1.1 hannken }
187 1.1 hannken sc->sc_reqs = vaddr;
188 1.1 hannken memset(vaddr, 0, allocsize);
189 1.1 hannken for (i = 0; i < qsize; i++) {
190 1.1 hannken struct virtio_blk_req *vr = &sc->sc_reqs[i];
191 1.15 jdolecek r = bus_dmamap_create(virtio_dmat(sc->sc_virtio),
192 1.1 hannken offsetof(struct virtio_blk_req, vr_bp),
193 1.1 hannken 1,
194 1.1 hannken offsetof(struct virtio_blk_req, vr_bp),
195 1.1 hannken 0,
196 1.1 hannken BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW,
197 1.1 hannken &vr->vr_cmdsts);
198 1.1 hannken if (r != 0) {
199 1.1 hannken aprint_error_dev(sc->sc_dev,
200 1.1 hannken "command dmamap creation failed, "
201 1.1 hannken "error code %d\n", r);
202 1.1 hannken goto err_reqs;
203 1.1 hannken }
204 1.15 jdolecek r = bus_dmamap_load(virtio_dmat(sc->sc_virtio), vr->vr_cmdsts,
205 1.1 hannken &vr->vr_hdr,
206 1.1 hannken offsetof(struct virtio_blk_req, vr_bp),
207 1.1 hannken NULL, BUS_DMA_NOWAIT);
208 1.1 hannken if (r != 0) {
209 1.1 hannken aprint_error_dev(sc->sc_dev,
210 1.1 hannken "command dmamap load failed, "
211 1.1 hannken "error code %d\n", r);
212 1.1 hannken goto err_reqs;
213 1.1 hannken }
214 1.15 jdolecek r = bus_dmamap_create(virtio_dmat(sc->sc_virtio),
215 1.1 hannken ld->sc_maxxfer,
216 1.9 christos (ld->sc_maxxfer / NBPG) +
217 1.9 christos VIRTIO_BLK_MIN_SEGMENTS,
218 1.2 hannken ld->sc_maxxfer,
219 1.1 hannken 0,
220 1.1 hannken BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW,
221 1.1 hannken &vr->vr_payload);
222 1.1 hannken if (r != 0) {
223 1.1 hannken aprint_error_dev(sc->sc_dev,
224 1.1 hannken "payload dmamap creation failed, "
225 1.1 hannken "error code %d\n", r);
226 1.1 hannken goto err_reqs;
227 1.1 hannken }
228 1.1 hannken }
229 1.1 hannken return 0;
230 1.1 hannken
231 1.1 hannken err_reqs:
232 1.1 hannken for (i = 0; i < qsize; i++) {
233 1.1 hannken struct virtio_blk_req *vr = &sc->sc_reqs[i];
234 1.1 hannken if (vr->vr_cmdsts) {
235 1.15 jdolecek bus_dmamap_destroy(virtio_dmat(sc->sc_virtio),
236 1.1 hannken vr->vr_cmdsts);
237 1.1 hannken vr->vr_cmdsts = 0;
238 1.1 hannken }
239 1.1 hannken if (vr->vr_payload) {
240 1.15 jdolecek bus_dmamap_destroy(virtio_dmat(sc->sc_virtio),
241 1.1 hannken vr->vr_payload);
242 1.1 hannken vr->vr_payload = 0;
243 1.1 hannken }
244 1.1 hannken }
245 1.15 jdolecek bus_dmamem_unmap(virtio_dmat(sc->sc_virtio), sc->sc_reqs, allocsize);
246 1.1 hannken err_dmamem_alloc:
247 1.15 jdolecek bus_dmamem_free(virtio_dmat(sc->sc_virtio), &sc->sc_reqs_seg, 1);
248 1.1 hannken err_none:
249 1.1 hannken return -1;
250 1.1 hannken }
251 1.1 hannken
252 1.1 hannken static void
253 1.1 hannken ld_virtio_attach(device_t parent, device_t self, void *aux)
254 1.1 hannken {
255 1.1 hannken struct ld_virtio_softc *sc = device_private(self);
256 1.1 hannken struct ld_softc *ld = &sc->sc_ld;
257 1.1 hannken struct virtio_softc *vsc = device_private(parent);
258 1.1 hannken uint32_t features;
259 1.9 christos int qsize, maxxfersize, maxnsegs;
260 1.1 hannken
261 1.15 jdolecek if (virtio_child(vsc) != NULL) {
262 1.1 hannken aprint_normal(": child already attached for %s; "
263 1.10 msaitoh "something wrong...\n", device_xname(parent));
264 1.1 hannken return;
265 1.1 hannken }
266 1.1 hannken
267 1.1 hannken sc->sc_dev = self;
268 1.1 hannken sc->sc_virtio = vsc;
269 1.1 hannken
270 1.15 jdolecek virtio_child_attach_start(vsc, self, IPL_BIO, &sc->sc_vq,
271 1.15 jdolecek NULL, virtio_vq_intr, 0,
272 1.15 jdolecek (VIRTIO_BLK_F_SIZE_MAX | VIRTIO_BLK_F_SEG_MAX |
273 1.15 jdolecek VIRTIO_BLK_F_GEOMETRY | VIRTIO_BLK_F_RO | VIRTIO_BLK_F_BLK_SIZE),
274 1.15 jdolecek VIRTIO_BLK_FLAG_BITS);
275 1.15 jdolecek
276 1.15 jdolecek features = virtio_features(vsc);
277 1.15 jdolecek
278 1.1 hannken if (features & VIRTIO_BLK_F_RO)
279 1.1 hannken sc->sc_readonly = 1;
280 1.1 hannken else
281 1.1 hannken sc->sc_readonly = 0;
282 1.1 hannken
283 1.3 hannken if (features & VIRTIO_BLK_F_BLK_SIZE) {
284 1.3 hannken ld->sc_secsize = virtio_read_device_config_4(vsc,
285 1.3 hannken VIRTIO_BLK_CONFIG_BLK_SIZE);
286 1.9 christos } else
287 1.9 christos ld->sc_secsize = 512;
288 1.9 christos
289 1.9 christos /* At least genfs_io assumes maxxfer == MAXPHYS. */
290 1.9 christos if (features & VIRTIO_BLK_F_SIZE_MAX) {
291 1.1 hannken maxxfersize = virtio_read_device_config_4(vsc,
292 1.9 christos VIRTIO_BLK_CONFIG_SIZE_MAX);
293 1.9 christos if (maxxfersize < MAXPHYS) {
294 1.9 christos aprint_error_dev(sc->sc_dev,
295 1.9 christos "Too small SIZE_MAX %dK minimum is %dK\n",
296 1.9 christos maxxfersize / 1024, MAXPHYS / 1024);
297 1.9 christos // goto err;
298 1.9 christos maxxfersize = MAXPHYS;
299 1.9 christos } else if (maxxfersize > MAXPHYS) {
300 1.9 christos aprint_normal_dev(sc->sc_dev,
301 1.9 christos "Clip SEG_MAX from %dK to %dK\n",
302 1.9 christos maxxfersize / 1024,
303 1.9 christos MAXPHYS / 1024);
304 1.1 hannken maxxfersize = MAXPHYS;
305 1.9 christos }
306 1.9 christos } else
307 1.9 christos maxxfersize = MAXPHYS;
308 1.9 christos
309 1.9 christos if (features & VIRTIO_BLK_F_SEG_MAX) {
310 1.9 christos maxnsegs = virtio_read_device_config_4(vsc,
311 1.9 christos VIRTIO_BLK_CONFIG_SEG_MAX);
312 1.9 christos if (maxnsegs < VIRTIO_BLK_MIN_SEGMENTS) {
313 1.9 christos aprint_error_dev(sc->sc_dev,
314 1.9 christos "Too small SEG_MAX %d minimum is %d\n",
315 1.9 christos maxnsegs, VIRTIO_BLK_MIN_SEGMENTS);
316 1.9 christos maxnsegs = maxxfersize / NBPG;
317 1.9 christos // goto err;
318 1.9 christos }
319 1.9 christos } else
320 1.9 christos maxnsegs = maxxfersize / NBPG;
321 1.9 christos
322 1.9 christos /* 2 for the minimum size */
323 1.9 christos maxnsegs += VIRTIO_BLK_MIN_SEGMENTS;
324 1.1 hannken
325 1.9 christos if (virtio_alloc_vq(vsc, &sc->sc_vq, 0, maxxfersize, maxnsegs,
326 1.9 christos "I/O request") != 0) {
327 1.1 hannken goto err;
328 1.1 hannken }
329 1.9 christos qsize = sc->sc_vq.vq_num;
330 1.9 christos sc->sc_vq.vq_done = ld_virtio_vq_done;
331 1.1 hannken
332 1.15 jdolecek if (virtio_child_attach_finish(vsc) != 0)
333 1.15 jdolecek goto err;
334 1.15 jdolecek
335 1.1 hannken ld->sc_dv = self;
336 1.1 hannken ld->sc_secperunit = virtio_read_device_config_8(vsc,
337 1.1 hannken VIRTIO_BLK_CONFIG_CAPACITY);
338 1.1 hannken ld->sc_maxxfer = maxxfersize;
339 1.1 hannken if (features & VIRTIO_BLK_F_GEOMETRY) {
340 1.1 hannken ld->sc_ncylinders = virtio_read_device_config_2(vsc,
341 1.1 hannken VIRTIO_BLK_CONFIG_GEOMETRY_C);
342 1.1 hannken ld->sc_nheads = virtio_read_device_config_1(vsc,
343 1.1 hannken VIRTIO_BLK_CONFIG_GEOMETRY_H);
344 1.1 hannken ld->sc_nsectors = virtio_read_device_config_1(vsc,
345 1.1 hannken VIRTIO_BLK_CONFIG_GEOMETRY_S);
346 1.1 hannken }
347 1.1 hannken ld->sc_maxqueuecnt = qsize;
348 1.1 hannken
349 1.1 hannken if (ld_virtio_alloc_reqs(sc, qsize) < 0)
350 1.1 hannken goto err;
351 1.1 hannken
352 1.1 hannken ld->sc_dump = ld_virtio_dump;
353 1.1 hannken ld->sc_start = ld_virtio_start;
354 1.1 hannken
355 1.16 mlelstv ld->sc_flags = LDF_ENABLED | LDF_MPSAFE;
356 1.11 jdolecek ldattach(ld, BUFQ_DISK_DEFAULT_STRAT);
357 1.1 hannken
358 1.1 hannken return;
359 1.1 hannken
360 1.1 hannken err:
361 1.15 jdolecek virtio_child_attach_failed(vsc);
362 1.1 hannken return;
363 1.1 hannken }
364 1.1 hannken
365 1.1 hannken static int
366 1.1 hannken ld_virtio_start(struct ld_softc *ld, struct buf *bp)
367 1.1 hannken {
368 1.1 hannken /* splbio */
369 1.1 hannken struct ld_virtio_softc *sc = device_private(ld->sc_dv);
370 1.1 hannken struct virtio_softc *vsc = sc->sc_virtio;
371 1.9 christos struct virtqueue *vq = &sc->sc_vq;
372 1.1 hannken struct virtio_blk_req *vr;
373 1.1 hannken int r;
374 1.1 hannken int isread = (bp->b_flags & B_READ);
375 1.1 hannken int slot;
376 1.1 hannken
377 1.1 hannken if (sc->sc_readonly && !isread)
378 1.1 hannken return EIO;
379 1.1 hannken
380 1.1 hannken r = virtio_enqueue_prep(vsc, vq, &slot);
381 1.1 hannken if (r != 0)
382 1.1 hannken return r;
383 1.9 christos
384 1.1 hannken vr = &sc->sc_reqs[slot];
385 1.9 christos KASSERT(vr->vr_bp == NULL);
386 1.9 christos
387 1.15 jdolecek r = bus_dmamap_load(virtio_dmat(vsc), vr->vr_payload,
388 1.1 hannken bp->b_data, bp->b_bcount, NULL,
389 1.1 hannken ((isread?BUS_DMA_READ:BUS_DMA_WRITE)
390 1.1 hannken |BUS_DMA_NOWAIT));
391 1.9 christos if (r != 0) {
392 1.9 christos aprint_error_dev(sc->sc_dev,
393 1.9 christos "payload dmamap failed, error code %d\n", r);
394 1.9 christos virtio_enqueue_abort(vsc, vq, slot);
395 1.1 hannken return r;
396 1.9 christos }
397 1.1 hannken
398 1.9 christos r = virtio_enqueue_reserve(vsc, vq, slot, vr->vr_payload->dm_nsegs +
399 1.9 christos VIRTIO_BLK_MIN_SEGMENTS);
400 1.1 hannken if (r != 0) {
401 1.15 jdolecek bus_dmamap_unload(virtio_dmat(vsc), vr->vr_payload);
402 1.1 hannken return r;
403 1.1 hannken }
404 1.1 hannken
405 1.1 hannken vr->vr_bp = bp;
406 1.1 hannken vr->vr_hdr.type = isread?VIRTIO_BLK_T_IN:VIRTIO_BLK_T_OUT;
407 1.1 hannken vr->vr_hdr.ioprio = 0;
408 1.1 hannken vr->vr_hdr.sector = bp->b_rawblkno * sc->sc_ld.sc_secsize / 512;
409 1.1 hannken
410 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
411 1.1 hannken 0, sizeof(struct virtio_blk_req_hdr),
412 1.1 hannken BUS_DMASYNC_PREWRITE);
413 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
414 1.1 hannken 0, bp->b_bcount,
415 1.1 hannken isread?BUS_DMASYNC_PREREAD:BUS_DMASYNC_PREWRITE);
416 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
417 1.1 hannken offsetof(struct virtio_blk_req, vr_status),
418 1.1 hannken sizeof(uint8_t),
419 1.1 hannken BUS_DMASYNC_PREREAD);
420 1.1 hannken
421 1.1 hannken virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
422 1.1 hannken 0, sizeof(struct virtio_blk_req_hdr),
423 1.1 hannken true);
424 1.1 hannken virtio_enqueue(vsc, vq, slot, vr->vr_payload, !isread);
425 1.1 hannken virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
426 1.1 hannken offsetof(struct virtio_blk_req, vr_status),
427 1.1 hannken sizeof(uint8_t),
428 1.1 hannken false);
429 1.1 hannken virtio_enqueue_commit(vsc, vq, slot, true);
430 1.1 hannken
431 1.1 hannken return 0;
432 1.1 hannken }
433 1.1 hannken
434 1.1 hannken static void
435 1.1 hannken ld_virtio_vq_done1(struct ld_virtio_softc *sc, struct virtio_softc *vsc,
436 1.1 hannken struct virtqueue *vq, int slot)
437 1.1 hannken {
438 1.1 hannken struct virtio_blk_req *vr = &sc->sc_reqs[slot];
439 1.1 hannken struct buf *bp = vr->vr_bp;
440 1.1 hannken
441 1.9 christos vr->vr_bp = NULL;
442 1.9 christos
443 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
444 1.1 hannken 0, sizeof(struct virtio_blk_req_hdr),
445 1.1 hannken BUS_DMASYNC_POSTWRITE);
446 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
447 1.1 hannken 0, bp->b_bcount,
448 1.1 hannken (bp->b_flags & B_READ)?BUS_DMASYNC_POSTREAD
449 1.1 hannken :BUS_DMASYNC_POSTWRITE);
450 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
451 1.1 hannken sizeof(struct virtio_blk_req_hdr), sizeof(uint8_t),
452 1.1 hannken BUS_DMASYNC_POSTREAD);
453 1.1 hannken
454 1.1 hannken if (vr->vr_status != VIRTIO_BLK_S_OK) {
455 1.1 hannken bp->b_error = EIO;
456 1.1 hannken bp->b_resid = bp->b_bcount;
457 1.1 hannken } else {
458 1.1 hannken bp->b_error = 0;
459 1.1 hannken bp->b_resid = 0;
460 1.1 hannken }
461 1.1 hannken
462 1.1 hannken virtio_dequeue_commit(vsc, vq, slot);
463 1.1 hannken
464 1.1 hannken lddone(&sc->sc_ld, bp);
465 1.1 hannken }
466 1.1 hannken
467 1.1 hannken static int
468 1.1 hannken ld_virtio_vq_done(struct virtqueue *vq)
469 1.1 hannken {
470 1.1 hannken struct virtio_softc *vsc = vq->vq_owner;
471 1.15 jdolecek struct ld_virtio_softc *sc = device_private(virtio_child(vsc));
472 1.1 hannken int r = 0;
473 1.1 hannken int slot;
474 1.1 hannken
475 1.1 hannken again:
476 1.1 hannken if (virtio_dequeue(vsc, vq, &slot, NULL))
477 1.1 hannken return r;
478 1.1 hannken r = 1;
479 1.1 hannken
480 1.1 hannken ld_virtio_vq_done1(sc, vsc, vq, slot);
481 1.1 hannken goto again;
482 1.1 hannken }
483 1.1 hannken
484 1.1 hannken static int
485 1.1 hannken ld_virtio_dump(struct ld_softc *ld, void *data, int blkno, int blkcnt)
486 1.1 hannken {
487 1.1 hannken struct ld_virtio_softc *sc = device_private(ld->sc_dv);
488 1.1 hannken struct virtio_softc *vsc = sc->sc_virtio;
489 1.9 christos struct virtqueue *vq = &sc->sc_vq;
490 1.1 hannken struct virtio_blk_req *vr;
491 1.1 hannken int slot, r;
492 1.1 hannken
493 1.1 hannken if (sc->sc_readonly)
494 1.1 hannken return EIO;
495 1.1 hannken
496 1.1 hannken r = virtio_enqueue_prep(vsc, vq, &slot);
497 1.1 hannken if (r != 0) {
498 1.1 hannken if (r == EAGAIN) { /* no free slot; dequeue first */
499 1.1 hannken delay(100);
500 1.1 hannken ld_virtio_vq_done(vq);
501 1.1 hannken r = virtio_enqueue_prep(vsc, vq, &slot);
502 1.1 hannken if (r != 0)
503 1.1 hannken return r;
504 1.1 hannken }
505 1.1 hannken return r;
506 1.1 hannken }
507 1.1 hannken vr = &sc->sc_reqs[slot];
508 1.15 jdolecek r = bus_dmamap_load(virtio_dmat(vsc), vr->vr_payload,
509 1.1 hannken data, blkcnt*ld->sc_secsize, NULL,
510 1.1 hannken BUS_DMA_WRITE|BUS_DMA_NOWAIT);
511 1.1 hannken if (r != 0)
512 1.1 hannken return r;
513 1.1 hannken
514 1.17 jakllsch r = virtio_enqueue_reserve(vsc, vq, slot, vr->vr_payload->dm_nsegs +
515 1.9 christos VIRTIO_BLK_MIN_SEGMENTS);
516 1.1 hannken if (r != 0) {
517 1.15 jdolecek bus_dmamap_unload(virtio_dmat(vsc), vr->vr_payload);
518 1.1 hannken return r;
519 1.1 hannken }
520 1.1 hannken
521 1.1 hannken vr->vr_bp = (void*)0xdeadbeef;
522 1.1 hannken vr->vr_hdr.type = VIRTIO_BLK_T_OUT;
523 1.1 hannken vr->vr_hdr.ioprio = 0;
524 1.1 hannken vr->vr_hdr.sector = (daddr_t) blkno * ld->sc_secsize / 512;
525 1.1 hannken
526 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
527 1.1 hannken 0, sizeof(struct virtio_blk_req_hdr),
528 1.1 hannken BUS_DMASYNC_PREWRITE);
529 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
530 1.1 hannken 0, blkcnt*ld->sc_secsize,
531 1.1 hannken BUS_DMASYNC_PREWRITE);
532 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
533 1.1 hannken offsetof(struct virtio_blk_req, vr_status),
534 1.1 hannken sizeof(uint8_t),
535 1.1 hannken BUS_DMASYNC_PREREAD);
536 1.1 hannken
537 1.1 hannken virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
538 1.1 hannken 0, sizeof(struct virtio_blk_req_hdr),
539 1.1 hannken true);
540 1.1 hannken virtio_enqueue(vsc, vq, slot, vr->vr_payload, true);
541 1.1 hannken virtio_enqueue_p(vsc, vq, slot, vr->vr_cmdsts,
542 1.1 hannken offsetof(struct virtio_blk_req, vr_status),
543 1.1 hannken sizeof(uint8_t),
544 1.1 hannken false);
545 1.1 hannken virtio_enqueue_commit(vsc, vq, slot, true);
546 1.1 hannken
547 1.1 hannken for ( ; ; ) {
548 1.1 hannken int dslot;
549 1.1 hannken
550 1.1 hannken r = virtio_dequeue(vsc, vq, &dslot, NULL);
551 1.1 hannken if (r != 0)
552 1.1 hannken continue;
553 1.1 hannken if (dslot != slot) {
554 1.1 hannken ld_virtio_vq_done1(sc, vsc, vq, dslot);
555 1.1 hannken continue;
556 1.1 hannken } else
557 1.1 hannken break;
558 1.1 hannken }
559 1.17 jakllsch
560 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
561 1.1 hannken 0, sizeof(struct virtio_blk_req_hdr),
562 1.1 hannken BUS_DMASYNC_POSTWRITE);
563 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_payload,
564 1.1 hannken 0, blkcnt*ld->sc_secsize,
565 1.1 hannken BUS_DMASYNC_POSTWRITE);
566 1.15 jdolecek bus_dmamap_sync(virtio_dmat(vsc), vr->vr_cmdsts,
567 1.1 hannken offsetof(struct virtio_blk_req, vr_status),
568 1.1 hannken sizeof(uint8_t),
569 1.1 hannken BUS_DMASYNC_POSTREAD);
570 1.1 hannken if (vr->vr_status == VIRTIO_BLK_S_OK)
571 1.1 hannken r = 0;
572 1.1 hannken else
573 1.1 hannken r = EIO;
574 1.1 hannken virtio_dequeue_commit(vsc, vq, slot);
575 1.1 hannken
576 1.1 hannken return r;
577 1.1 hannken }
578 1.1 hannken
579 1.1 hannken static int
580 1.1 hannken ld_virtio_detach(device_t self, int flags)
581 1.1 hannken {
582 1.1 hannken struct ld_virtio_softc *sc = device_private(self);
583 1.1 hannken struct ld_softc *ld = &sc->sc_ld;
584 1.15 jdolecek bus_dma_tag_t dmat = virtio_dmat(sc->sc_virtio);
585 1.1 hannken int r, i, qsize;
586 1.1 hannken
587 1.9 christos qsize = sc->sc_vq.vq_num;
588 1.1 hannken r = ldbegindetach(ld, flags);
589 1.1 hannken if (r != 0)
590 1.1 hannken return r;
591 1.1 hannken virtio_reset(sc->sc_virtio);
592 1.9 christos virtio_free_vq(sc->sc_virtio, &sc->sc_vq);
593 1.1 hannken
594 1.1 hannken for (i = 0; i < qsize; i++) {
595 1.1 hannken bus_dmamap_destroy(dmat,
596 1.1 hannken sc->sc_reqs[i].vr_cmdsts);
597 1.1 hannken bus_dmamap_destroy(dmat,
598 1.1 hannken sc->sc_reqs[i].vr_payload);
599 1.1 hannken }
600 1.1 hannken bus_dmamem_unmap(dmat, sc->sc_reqs,
601 1.1 hannken sizeof(struct virtio_blk_req) * qsize);
602 1.9 christos bus_dmamem_free(dmat, &sc->sc_reqs_seg, 1);
603 1.1 hannken
604 1.1 hannken ldenddetach(ld);
605 1.1 hannken
606 1.15 jdolecek virtio_child_detach(sc->sc_virtio);
607 1.15 jdolecek
608 1.1 hannken return 0;
609 1.1 hannken }
610 1.12 pgoyette
611 1.12 pgoyette MODULE(MODULE_CLASS_DRIVER, ld_virtio, "ld,virtio");
612 1.12 pgoyette
613 1.12 pgoyette #ifdef _MODULE
614 1.12 pgoyette /*
615 1.12 pgoyette * XXX Don't allow ioconf.c to redefine the "struct cfdriver ld_cd"
616 1.12 pgoyette * XXX it will be defined in the common-code module
617 1.12 pgoyette */
618 1.12 pgoyette #undef CFDRIVER_DECL
619 1.12 pgoyette #define CFDRIVER_DECL(name, class, attr)
620 1.12 pgoyette #include "ioconf.c"
621 1.12 pgoyette #endif
622 1.17 jakllsch
623 1.12 pgoyette static int
624 1.12 pgoyette ld_virtio_modcmd(modcmd_t cmd, void *opaque)
625 1.12 pgoyette {
626 1.12 pgoyette #ifdef _MODULE
627 1.12 pgoyette /*
628 1.12 pgoyette * We ignore the cfdriver_vec[] that ioconf provides, since
629 1.12 pgoyette * the cfdrivers are attached already.
630 1.12 pgoyette */
631 1.12 pgoyette static struct cfdriver * const no_cfdriver_vec[] = { NULL };
632 1.12 pgoyette #endif
633 1.12 pgoyette int error = 0;
634 1.17 jakllsch
635 1.12 pgoyette #ifdef _MODULE
636 1.12 pgoyette switch (cmd) {
637 1.12 pgoyette case MODULE_CMD_INIT:
638 1.12 pgoyette error = config_init_component(no_cfdriver_vec,
639 1.12 pgoyette cfattach_ioconf_ld_virtio, cfdata_ioconf_ld_virtio);
640 1.12 pgoyette break;
641 1.12 pgoyette case MODULE_CMD_FINI:
642 1.12 pgoyette error = config_fini_component(no_cfdriver_vec,
643 1.12 pgoyette cfattach_ioconf_ld_virtio, cfdata_ioconf_ld_virtio);
644 1.12 pgoyette break;
645 1.12 pgoyette default:
646 1.12 pgoyette error = ENOTTY;
647 1.12 pgoyette break;
648 1.12 pgoyette }
649 1.12 pgoyette #endif
650 1.12 pgoyette
651 1.12 pgoyette return error;
652 1.12 pgoyette }
653