rumpblk.c revision 1.26 1 1.26 pooka /* $NetBSD: rumpblk.c,v 1.26 2009/10/06 13:05:44 pooka Exp $ */
2 1.1 pooka
3 1.1 pooka /*
4 1.1 pooka * Copyright (c) 2009 Antti Kantee. All Rights Reserved.
5 1.1 pooka *
6 1.1 pooka * Development of this software was supported by the
7 1.1 pooka * Finnish Cultural Foundation.
8 1.1 pooka *
9 1.1 pooka * Redistribution and use in source and binary forms, with or without
10 1.1 pooka * modification, are permitted provided that the following conditions
11 1.1 pooka * are met:
12 1.1 pooka * 1. Redistributions of source code must retain the above copyright
13 1.1 pooka * notice, this list of conditions and the following disclaimer.
14 1.1 pooka * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 pooka * notice, this list of conditions and the following disclaimer in the
16 1.1 pooka * documentation and/or other materials provided with the distribution.
17 1.1 pooka *
18 1.1 pooka * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
19 1.1 pooka * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
20 1.1 pooka * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
21 1.1 pooka * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22 1.1 pooka * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23 1.1 pooka * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
24 1.1 pooka * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 1.1 pooka * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 1.1 pooka * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27 1.1 pooka * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28 1.1 pooka * SUCH DAMAGE.
29 1.1 pooka */
30 1.1 pooka
31 1.1 pooka /*
32 1.1 pooka * Block device emulation. Presents a block device interface and
33 1.1 pooka * uses rumpuser system calls to satisfy I/O requests.
34 1.16 pooka *
35 1.16 pooka * We provide fault injection. The driver can be made to fail
36 1.16 pooka * I/O occasionally.
37 1.16 pooka *
38 1.16 pooka * The driver also provides an optimization for regular files by
39 1.16 pooka * using memory-mapped I/O. This avoids kernel access for every
40 1.16 pooka * I/O operation. It also gives finer-grained control of how to
41 1.16 pooka * flush data. Additionally, in case the rump kernel dumps core,
42 1.16 pooka * we get way less carnage.
43 1.1 pooka */
44 1.1 pooka
45 1.1 pooka #include <sys/cdefs.h>
46 1.26 pooka __KERNEL_RCSID(0, "$NetBSD: rumpblk.c,v 1.26 2009/10/06 13:05:44 pooka Exp $");
47 1.1 pooka
48 1.1 pooka #include <sys/param.h>
49 1.1 pooka #include <sys/buf.h>
50 1.1 pooka #include <sys/conf.h>
51 1.16 pooka #include <sys/condvar.h>
52 1.1 pooka #include <sys/disklabel.h>
53 1.18 pooka #include <sys/evcnt.h>
54 1.1 pooka #include <sys/fcntl.h>
55 1.1 pooka #include <sys/kmem.h>
56 1.1 pooka #include <sys/malloc.h>
57 1.16 pooka #include <sys/queue.h>
58 1.1 pooka #include <sys/stat.h>
59 1.1 pooka
60 1.1 pooka #include <rump/rumpuser.h>
61 1.1 pooka
62 1.1 pooka #include "rump_private.h"
63 1.1 pooka #include "rump_vfs_private.h"
64 1.1 pooka
65 1.16 pooka #if 0
66 1.16 pooka #define DPRINTF(x) printf x
67 1.16 pooka #else
68 1.16 pooka #define DPRINTF(x)
69 1.16 pooka #endif
70 1.16 pooka
71 1.19 pooka /* Default: 16 x 1MB windows */
72 1.19 pooka unsigned memwinsize = (1<<20);
73 1.19 pooka unsigned memwincnt = 16;
74 1.19 pooka
75 1.19 pooka #define STARTWIN(off) ((off) & ~(memwinsize-1))
76 1.16 pooka #define INWIN(win,off) ((win)->win_off == STARTWIN(off))
77 1.19 pooka #define WINSIZE(rblk, win) (MIN((rblk->rblk_size-win->win_off),memwinsize))
78 1.16 pooka #define WINVALID(win) ((win)->win_off != (off_t)-1)
79 1.16 pooka #define WINVALIDATE(win) ((win)->win_off = (off_t)-1)
80 1.16 pooka struct blkwin {
81 1.16 pooka off_t win_off;
82 1.16 pooka void *win_mem;
83 1.16 pooka int win_refcnt;
84 1.16 pooka
85 1.16 pooka TAILQ_ENTRY(blkwin) win_lru;
86 1.16 pooka };
87 1.16 pooka
88 1.1 pooka #define RUMPBLK_SIZE 16
89 1.1 pooka static struct rblkdev {
90 1.1 pooka char *rblk_path;
91 1.1 pooka int rblk_fd;
92 1.25 pooka int rblk_opencnt;
93 1.20 pooka #ifdef HAS_ODIRECT
94 1.20 pooka int rblk_dfd;
95 1.20 pooka #endif
96 1.26 pooka uint64_t rblk_size;
97 1.16 pooka
98 1.16 pooka /* for mmap */
99 1.16 pooka int rblk_mmflags;
100 1.16 pooka kmutex_t rblk_memmtx;
101 1.16 pooka kcondvar_t rblk_memcv;
102 1.16 pooka TAILQ_HEAD(winlru, blkwin) rblk_lruq;
103 1.16 pooka bool rblk_waiting;
104 1.1 pooka
105 1.1 pooka struct partition *rblk_curpi;
106 1.1 pooka struct partition rblk_pi;
107 1.1 pooka struct disklabel rblk_dl;
108 1.1 pooka } minors[RUMPBLK_SIZE];
109 1.1 pooka
110 1.20 pooka static struct evcnt ev_io_total;
111 1.20 pooka static struct evcnt ev_io_async;
112 1.20 pooka
113 1.20 pooka static struct evcnt ev_memblk_hits;
114 1.20 pooka static struct evcnt ev_memblk_busy;
115 1.20 pooka
116 1.20 pooka static struct evcnt ev_bwrite_total;
117 1.20 pooka static struct evcnt ev_bwrite_async;
118 1.20 pooka static struct evcnt ev_bread_total;
119 1.18 pooka
120 1.1 pooka dev_type_open(rumpblk_open);
121 1.1 pooka dev_type_close(rumpblk_close);
122 1.1 pooka dev_type_read(rumpblk_read);
123 1.1 pooka dev_type_write(rumpblk_write);
124 1.1 pooka dev_type_ioctl(rumpblk_ioctl);
125 1.1 pooka dev_type_strategy(rumpblk_strategy);
126 1.3 pooka dev_type_strategy(rumpblk_strategy_fail);
127 1.1 pooka dev_type_dump(rumpblk_dump);
128 1.1 pooka dev_type_size(rumpblk_size);
129 1.1 pooka
130 1.1 pooka static const struct bdevsw rumpblk_bdevsw = {
131 1.1 pooka rumpblk_open, rumpblk_close, rumpblk_strategy, rumpblk_ioctl,
132 1.1 pooka nodump, nosize, D_DISK
133 1.1 pooka };
134 1.1 pooka
135 1.3 pooka static const struct bdevsw rumpblk_bdevsw_fail = {
136 1.3 pooka rumpblk_open, rumpblk_close, rumpblk_strategy_fail, rumpblk_ioctl,
137 1.3 pooka nodump, nosize, D_DISK
138 1.3 pooka };
139 1.3 pooka
140 1.1 pooka static const struct cdevsw rumpblk_cdevsw = {
141 1.1 pooka rumpblk_open, rumpblk_close, rumpblk_read, rumpblk_write,
142 1.1 pooka rumpblk_ioctl, nostop, notty, nopoll, nommap, nokqfilter, D_DISK
143 1.1 pooka };
144 1.1 pooka
145 1.3 pooka /* fail every n out of BLKFAIL_MAX */
146 1.3 pooka #define BLKFAIL_MAX 10000
147 1.3 pooka static int blkfail;
148 1.3 pooka static unsigned randstate;
149 1.24 pooka static kmutex_t rumpblk_lock;
150 1.1 pooka
151 1.16 pooka static struct blkwin *
152 1.16 pooka getwindow(struct rblkdev *rblk, off_t off, int *wsize, int *error)
153 1.16 pooka {
154 1.16 pooka struct blkwin *win;
155 1.16 pooka
156 1.16 pooka mutex_enter(&rblk->rblk_memmtx);
157 1.16 pooka retry:
158 1.16 pooka /* search for window */
159 1.16 pooka TAILQ_FOREACH(win, &rblk->rblk_lruq, win_lru) {
160 1.16 pooka if (INWIN(win, off) && WINVALID(win))
161 1.16 pooka break;
162 1.16 pooka }
163 1.16 pooka
164 1.16 pooka /* found? return */
165 1.16 pooka if (win) {
166 1.20 pooka ev_memblk_hits.ev_count++;
167 1.16 pooka TAILQ_REMOVE(&rblk->rblk_lruq, win, win_lru);
168 1.16 pooka goto good;
169 1.16 pooka }
170 1.16 pooka
171 1.16 pooka /*
172 1.16 pooka * Else, create new window. If the least recently used is not
173 1.16 pooka * currently in use, reuse that. Otherwise we need to wait.
174 1.16 pooka */
175 1.16 pooka win = TAILQ_LAST(&rblk->rblk_lruq, winlru);
176 1.16 pooka if (win->win_refcnt == 0) {
177 1.16 pooka TAILQ_REMOVE(&rblk->rblk_lruq, win, win_lru);
178 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
179 1.16 pooka
180 1.16 pooka if (WINVALID(win)) {
181 1.16 pooka DPRINTF(("win %p, unmap mem %p, off 0x%" PRIx64 "\n",
182 1.16 pooka win, win->win_mem, win->win_off));
183 1.16 pooka rumpuser_unmap(win->win_mem, WINSIZE(rblk, win));
184 1.16 pooka WINVALIDATE(win);
185 1.16 pooka }
186 1.16 pooka
187 1.16 pooka win->win_off = STARTWIN(off);
188 1.16 pooka win->win_mem = rumpuser_filemmap(rblk->rblk_fd, win->win_off,
189 1.16 pooka WINSIZE(rblk, win), rblk->rblk_mmflags, error);
190 1.16 pooka DPRINTF(("win %p, off 0x%" PRIx64 ", mem %p\n",
191 1.16 pooka win, win->win_off, win->win_mem));
192 1.16 pooka
193 1.16 pooka mutex_enter(&rblk->rblk_memmtx);
194 1.16 pooka if (win->win_mem == NULL) {
195 1.16 pooka WINVALIDATE(win);
196 1.16 pooka TAILQ_INSERT_TAIL(&rblk->rblk_lruq, win, win_lru);
197 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
198 1.16 pooka return NULL;
199 1.16 pooka }
200 1.16 pooka } else {
201 1.16 pooka DPRINTF(("memwin wait\n"));
202 1.20 pooka ev_memblk_busy.ev_count++;
203 1.18 pooka
204 1.16 pooka rblk->rblk_waiting = true;
205 1.16 pooka cv_wait(&rblk->rblk_memcv, &rblk->rblk_memmtx);
206 1.16 pooka goto retry;
207 1.16 pooka }
208 1.16 pooka
209 1.16 pooka good:
210 1.16 pooka KASSERT(win);
211 1.16 pooka win->win_refcnt++;
212 1.16 pooka TAILQ_INSERT_HEAD(&rblk->rblk_lruq, win, win_lru);
213 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
214 1.19 pooka *wsize = MIN(*wsize, memwinsize - (off-win->win_off));
215 1.16 pooka KASSERT(*wsize);
216 1.16 pooka
217 1.16 pooka return win;
218 1.16 pooka }
219 1.16 pooka
220 1.16 pooka static void
221 1.16 pooka putwindow(struct rblkdev *rblk, struct blkwin *win)
222 1.16 pooka {
223 1.16 pooka
224 1.16 pooka mutex_enter(&rblk->rblk_memmtx);
225 1.16 pooka if (--win->win_refcnt == 0 && rblk->rblk_waiting) {
226 1.16 pooka rblk->rblk_waiting = false;
227 1.16 pooka cv_signal(&rblk->rblk_memcv);
228 1.16 pooka }
229 1.16 pooka KASSERT(win->win_refcnt >= 0);
230 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
231 1.16 pooka }
232 1.16 pooka
233 1.16 pooka static void
234 1.16 pooka wincleanup(struct rblkdev *rblk)
235 1.16 pooka {
236 1.16 pooka struct blkwin *win;
237 1.16 pooka
238 1.16 pooka while ((win = TAILQ_FIRST(&rblk->rblk_lruq)) != NULL) {
239 1.16 pooka TAILQ_REMOVE(&rblk->rblk_lruq, win, win_lru);
240 1.16 pooka if (WINVALID(win)) {
241 1.16 pooka DPRINTF(("cleanup win %p addr %p\n",
242 1.16 pooka win, win->win_mem));
243 1.16 pooka rumpuser_unmap(win->win_mem, WINSIZE(rblk, win));
244 1.16 pooka }
245 1.16 pooka kmem_free(win, sizeof(*win));
246 1.16 pooka }
247 1.16 pooka rblk->rblk_mmflags = 0;
248 1.16 pooka }
249 1.16 pooka
250 1.1 pooka int
251 1.8 cegger rumpblk_init(void)
252 1.1 pooka {
253 1.3 pooka char buf[64];
254 1.1 pooka int rumpblk = RUMPBLK;
255 1.19 pooka unsigned tmp;
256 1.16 pooka int error, i;
257 1.3 pooka
258 1.24 pooka mutex_init(&rumpblk_lock, MUTEX_DEFAULT, IPL_NONE);
259 1.24 pooka
260 1.3 pooka if (rumpuser_getenv("RUMP_BLKFAIL", buf, sizeof(buf), &error) == 0) {
261 1.3 pooka blkfail = strtoul(buf, NULL, 10);
262 1.3 pooka /* fail everything */
263 1.3 pooka if (blkfail > BLKFAIL_MAX)
264 1.3 pooka blkfail = BLKFAIL_MAX;
265 1.3 pooka if (rumpuser_getenv("RUMP_BLKFAIL_SEED", buf, sizeof(buf),
266 1.3 pooka &error) == 0) {
267 1.3 pooka randstate = strtoul(buf, NULL, 10);
268 1.3 pooka } else {
269 1.23 pooka randstate = arc4random();
270 1.3 pooka }
271 1.22 pooka printf("rumpblk: FAULT INJECTION ACTIVE! fail %d/%d. "
272 1.22 pooka "seed %u\n", blkfail, BLKFAIL_MAX, randstate);
273 1.3 pooka } else {
274 1.3 pooka blkfail = 0;
275 1.3 pooka }
276 1.1 pooka
277 1.19 pooka if (rumpuser_getenv("RUMP_BLKWINSIZE", buf, sizeof(buf), &error) == 0) {
278 1.19 pooka printf("rumpblk: ");
279 1.19 pooka tmp = strtoul(buf, NULL, 10);
280 1.19 pooka if (tmp && !(tmp & (tmp-1)))
281 1.19 pooka memwinsize = tmp;
282 1.19 pooka else
283 1.19 pooka printf("invalid RUMP_BLKWINSIZE %d, ", tmp);
284 1.19 pooka printf("using %d for memwinsize\n", memwinsize);
285 1.19 pooka }
286 1.19 pooka if (rumpuser_getenv("RUMP_BLKWINCOUNT", buf, sizeof(buf), &error) == 0){
287 1.19 pooka printf("rumpblk: ");
288 1.19 pooka tmp = strtoul(buf, NULL, 10);
289 1.19 pooka if (tmp)
290 1.19 pooka memwincnt = tmp;
291 1.19 pooka else
292 1.19 pooka printf("invalid RUMP_BLKWINCOUNT %d, ", tmp);
293 1.19 pooka printf("using %d for memwincount\n", memwincnt);
294 1.19 pooka }
295 1.19 pooka
296 1.16 pooka memset(minors, 0, sizeof(minors));
297 1.16 pooka for (i = 0; i < RUMPBLK_SIZE; i++) {
298 1.16 pooka mutex_init(&minors[i].rblk_memmtx, MUTEX_DEFAULT, IPL_NONE);
299 1.16 pooka cv_init(&minors[i].rblk_memcv, "rblkmcv");
300 1.16 pooka }
301 1.16 pooka
302 1.20 pooka evcnt_attach_dynamic(&ev_io_total, EVCNT_TYPE_MISC, NULL,
303 1.20 pooka "rumpblk", "rumpblk I/O reqs");
304 1.20 pooka evcnt_attach_dynamic(&ev_io_async, EVCNT_TYPE_MISC, NULL,
305 1.20 pooka "rumpblk", "rumpblk async I/O");
306 1.20 pooka
307 1.20 pooka evcnt_attach_dynamic(&ev_bread_total, EVCNT_TYPE_MISC, NULL,
308 1.20 pooka "rumpblk", "rumpblk bytes read");
309 1.20 pooka evcnt_attach_dynamic(&ev_bwrite_total, EVCNT_TYPE_MISC, NULL,
310 1.20 pooka "rumpblk", "rumpblk bytes written");
311 1.20 pooka evcnt_attach_dynamic(&ev_bwrite_async, EVCNT_TYPE_MISC, NULL,
312 1.20 pooka "rumpblk", "rumpblk bytes written async");
313 1.20 pooka
314 1.20 pooka evcnt_attach_dynamic(&ev_memblk_hits, EVCNT_TYPE_MISC, NULL,
315 1.18 pooka "rumpblk", "memblk window hits");
316 1.20 pooka evcnt_attach_dynamic(&ev_memblk_busy, EVCNT_TYPE_MISC, NULL,
317 1.18 pooka "rumpblk", "memblk all windows busy");
318 1.18 pooka
319 1.3 pooka if (blkfail) {
320 1.3 pooka return devsw_attach("rumpblk", &rumpblk_bdevsw_fail, &rumpblk,
321 1.3 pooka &rumpblk_cdevsw, &rumpblk);
322 1.3 pooka } else {
323 1.3 pooka return devsw_attach("rumpblk", &rumpblk_bdevsw, &rumpblk,
324 1.3 pooka &rumpblk_cdevsw, &rumpblk);
325 1.3 pooka }
326 1.1 pooka }
327 1.1 pooka
328 1.24 pooka /* XXX: no deregister */
329 1.1 pooka int
330 1.24 pooka rumpblk_register(const char *path, devminor_t *dmin)
331 1.1 pooka {
332 1.24 pooka uint64_t flen;
333 1.1 pooka size_t len;
334 1.24 pooka int ftype, error, i;
335 1.24 pooka
336 1.24 pooka if (rumpuser_getfileinfo(path, &flen, &ftype, &error))
337 1.24 pooka return error;
338 1.24 pooka /* verify host file is of supported type */
339 1.24 pooka if (!(ftype == RUMPUSER_FT_REG
340 1.24 pooka || ftype == RUMPUSER_FT_BLK
341 1.24 pooka || ftype == RUMPUSER_FT_CHR))
342 1.24 pooka return EINVAL;
343 1.1 pooka
344 1.24 pooka mutex_enter(&rumpblk_lock);
345 1.24 pooka for (i = 0; i < RUMPBLK_SIZE; i++) {
346 1.24 pooka if (minors[i].rblk_path&&strcmp(minors[i].rblk_path, path)==0) {
347 1.24 pooka mutex_exit(&rumpblk_lock);
348 1.24 pooka *dmin = i;
349 1.24 pooka return 0;
350 1.24 pooka }
351 1.24 pooka }
352 1.1 pooka
353 1.1 pooka for (i = 0; i < RUMPBLK_SIZE; i++)
354 1.1 pooka if (minors[i].rblk_path == NULL)
355 1.1 pooka break;
356 1.24 pooka if (i == RUMPBLK_SIZE) {
357 1.24 pooka mutex_exit(&rumpblk_lock);
358 1.24 pooka return EBUSY;
359 1.24 pooka }
360 1.1 pooka
361 1.1 pooka len = strlen(path);
362 1.10 uebayasi minors[i].rblk_path = malloc(len + 1, M_TEMP, M_WAITOK);
363 1.1 pooka strcpy(minors[i].rblk_path, path);
364 1.1 pooka minors[i].rblk_fd = -1;
365 1.24 pooka mutex_exit(&rumpblk_lock);
366 1.24 pooka
367 1.24 pooka *dmin = i;
368 1.24 pooka return 0;
369 1.1 pooka }
370 1.1 pooka
371 1.1 pooka int
372 1.1 pooka rumpblk_open(dev_t dev, int flag, int fmt, struct lwp *l)
373 1.1 pooka {
374 1.1 pooka struct rblkdev *rblk = &minors[minor(dev)];
375 1.5 pooka uint64_t fsize;
376 1.9 pooka int ft, dummy;
377 1.1 pooka int error, fd;
378 1.1 pooka
379 1.25 pooka if (rblk->rblk_fd != -1)
380 1.25 pooka return 0; /* XXX: refcount, open mode */
381 1.1 pooka fd = rumpuser_open(rblk->rblk_path, OFLAGS(flag), &error);
382 1.1 pooka if (error)
383 1.1 pooka return error;
384 1.1 pooka
385 1.9 pooka if (rumpuser_getfileinfo(rblk->rblk_path, &fsize, &ft, &error) == -1) {
386 1.9 pooka rumpuser_close(fd, &dummy);
387 1.9 pooka return error;
388 1.9 pooka }
389 1.9 pooka
390 1.20 pooka #ifdef HAS_ODIRECT
391 1.20 pooka rblk->rblk_dfd = rumpuser_open(rblk->rblk_path,
392 1.20 pooka OFLAGS(flag) | O_DIRECT, &error);
393 1.20 pooka if (error)
394 1.20 pooka return error;
395 1.20 pooka #endif
396 1.20 pooka
397 1.9 pooka if (ft == RUMPUSER_FT_REG) {
398 1.16 pooka struct blkwin *win;
399 1.16 pooka int i, winsize;
400 1.16 pooka
401 1.1 pooka /*
402 1.16 pooka * Use mmap to access a regular file. Allocate and
403 1.16 pooka * cache initial windows here. Failure to allocate one
404 1.16 pooka * means fallback to read/write i/o.
405 1.1 pooka */
406 1.9 pooka
407 1.16 pooka rblk->rblk_mmflags = 0;
408 1.16 pooka if (flag & FREAD)
409 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_READ;
410 1.16 pooka if (flag & FWRITE) {
411 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_WRITE;
412 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_SHARED;
413 1.16 pooka }
414 1.16 pooka
415 1.16 pooka TAILQ_INIT(&rblk->rblk_lruq);
416 1.16 pooka rblk->rblk_size = fsize;
417 1.16 pooka rblk->rblk_fd = fd;
418 1.16 pooka
419 1.19 pooka for (i = 0; i < memwincnt && i * memwinsize < fsize; i++) {
420 1.16 pooka win = kmem_zalloc(sizeof(*win), KM_SLEEP);
421 1.16 pooka WINVALIDATE(win);
422 1.16 pooka TAILQ_INSERT_TAIL(&rblk->rblk_lruq, win, win_lru);
423 1.16 pooka
424 1.16 pooka /*
425 1.16 pooka * Allocate first windows. Here we just generally
426 1.16 pooka * make sure a) we can mmap at all b) we have the
427 1.16 pooka * necessary VA available
428 1.16 pooka */
429 1.16 pooka winsize = 1;
430 1.19 pooka win = getwindow(rblk, i*memwinsize, &winsize, &error);
431 1.16 pooka if (win) {
432 1.16 pooka putwindow(rblk, win);
433 1.16 pooka } else {
434 1.16 pooka wincleanup(rblk);
435 1.16 pooka break;
436 1.12 pooka }
437 1.9 pooka }
438 1.9 pooka
439 1.1 pooka memset(&rblk->rblk_dl, 0, sizeof(rblk->rblk_dl));
440 1.9 pooka rblk->rblk_pi.p_size = fsize >> DEV_BSHIFT;
441 1.9 pooka rblk->rblk_dl.d_secsize = DEV_BSIZE;
442 1.9 pooka rblk->rblk_curpi = &rblk->rblk_pi;
443 1.9 pooka } else {
444 1.13 pooka if (rumpuser_ioctl(fd, DIOCGDINFO, &rblk->rblk_dl,
445 1.17 pooka &error) == -1) {
446 1.17 pooka KASSERT(error);
447 1.1 pooka rumpuser_close(fd, &dummy);
448 1.1 pooka return error;
449 1.1 pooka }
450 1.9 pooka
451 1.16 pooka rblk->rblk_fd = fd;
452 1.9 pooka rblk->rblk_curpi = &rblk->rblk_dl.d_partitions[0];
453 1.1 pooka }
454 1.1 pooka
455 1.16 pooka KASSERT(rblk->rblk_fd != -1);
456 1.1 pooka return 0;
457 1.1 pooka }
458 1.1 pooka
459 1.1 pooka int
460 1.1 pooka rumpblk_close(dev_t dev, int flag, int fmt, struct lwp *l)
461 1.1 pooka {
462 1.1 pooka struct rblkdev *rblk = &minors[minor(dev)];
463 1.1 pooka int dummy;
464 1.1 pooka
465 1.16 pooka if (rblk->rblk_mmflags)
466 1.16 pooka wincleanup(rblk);
467 1.16 pooka rumpuser_fsync(rblk->rblk_fd, &dummy);
468 1.1 pooka rumpuser_close(rblk->rblk_fd, &dummy);
469 1.1 pooka rblk->rblk_fd = -1;
470 1.1 pooka
471 1.1 pooka return 0;
472 1.1 pooka }
473 1.1 pooka
474 1.1 pooka int
475 1.1 pooka rumpblk_ioctl(dev_t dev, u_long xfer, void *addr, int flag, struct lwp *l)
476 1.1 pooka {
477 1.1 pooka struct rblkdev *rblk = &minors[minor(dev)];
478 1.1 pooka int rv, error;
479 1.1 pooka
480 1.1 pooka if (xfer == DIOCGPART) {
481 1.1 pooka struct partinfo *pi = (struct partinfo *)addr;
482 1.1 pooka
483 1.1 pooka pi->part = rblk->rblk_curpi;
484 1.1 pooka pi->disklab = &rblk->rblk_dl;
485 1.1 pooka
486 1.1 pooka return 0;
487 1.1 pooka }
488 1.1 pooka
489 1.1 pooka rv = rumpuser_ioctl(rblk->rblk_fd, xfer, addr, &error);
490 1.1 pooka if (rv == -1)
491 1.1 pooka return error;
492 1.1 pooka
493 1.1 pooka return 0;
494 1.1 pooka }
495 1.1 pooka
496 1.25 pooka static int
497 1.25 pooka do_physio(dev_t dev, struct uio *uio, int which)
498 1.25 pooka {
499 1.25 pooka void (*strat)(struct buf *);
500 1.25 pooka
501 1.25 pooka if (blkfail)
502 1.25 pooka strat = rumpblk_strategy_fail;
503 1.25 pooka else
504 1.25 pooka strat = rumpblk_strategy;
505 1.25 pooka
506 1.25 pooka return physio(strat, NULL, dev, which, minphys, uio);
507 1.25 pooka }
508 1.25 pooka
509 1.1 pooka int
510 1.1 pooka rumpblk_read(dev_t dev, struct uio *uio, int flags)
511 1.1 pooka {
512 1.1 pooka
513 1.25 pooka return do_physio(dev, uio, B_READ);
514 1.1 pooka }
515 1.1 pooka
516 1.1 pooka int
517 1.1 pooka rumpblk_write(dev_t dev, struct uio *uio, int flags)
518 1.1 pooka {
519 1.1 pooka
520 1.25 pooka return do_physio(dev, uio, B_WRITE);
521 1.1 pooka }
522 1.1 pooka
523 1.3 pooka static void
524 1.3 pooka dostrategy(struct buf *bp)
525 1.1 pooka {
526 1.1 pooka struct rblkdev *rblk = &minors[minor(bp->b_dev)];
527 1.1 pooka off_t off;
528 1.21 pooka int async = bp->b_flags & B_ASYNC;
529 1.21 pooka int error;
530 1.1 pooka
531 1.20 pooka /* collect statistics */
532 1.20 pooka ev_io_total.ev_count++;
533 1.20 pooka if (async)
534 1.20 pooka ev_io_async.ev_count++;
535 1.20 pooka if (BUF_ISWRITE(bp)) {
536 1.20 pooka ev_bwrite_total.ev_count += bp->b_bcount;
537 1.20 pooka if (async)
538 1.20 pooka ev_bwrite_async.ev_count += bp->b_bcount;
539 1.20 pooka } else {
540 1.20 pooka ev_bread_total.ev_count++;
541 1.20 pooka }
542 1.20 pooka
543 1.1 pooka off = bp->b_blkno << DEV_BSHIFT;
544 1.11 pooka /*
545 1.11 pooka * Do bounds checking if we're working on a file. Otherwise
546 1.11 pooka * invalid file systems might attempt to read beyond EOF. This
547 1.11 pooka * is bad(tm) especially on mmapped images. This is essentially
548 1.11 pooka * the kernel bounds_check() routines.
549 1.11 pooka */
550 1.11 pooka if (rblk->rblk_size && off + bp->b_bcount > rblk->rblk_size) {
551 1.11 pooka int64_t sz = rblk->rblk_size - off;
552 1.11 pooka
553 1.11 pooka /* EOF */
554 1.11 pooka if (sz == 0) {
555 1.11 pooka rump_biodone(bp, 0, 0);
556 1.11 pooka return;
557 1.11 pooka }
558 1.11 pooka /* beyond EOF ==> error */
559 1.11 pooka if (sz < 0) {
560 1.11 pooka rump_biodone(bp, 0, EINVAL);
561 1.11 pooka return;
562 1.11 pooka }
563 1.11 pooka
564 1.11 pooka /* truncate to device size */
565 1.11 pooka bp->b_bcount = sz;
566 1.11 pooka }
567 1.11 pooka
568 1.1 pooka DPRINTF(("rumpblk_strategy: 0x%x bytes %s off 0x%" PRIx64
569 1.20 pooka " (0x%" PRIx64 " - 0x%" PRIx64 "), %ssync\n",
570 1.16 pooka bp->b_bcount, BUF_ISREAD(bp) ? "READ" : "WRITE",
571 1.20 pooka off, off, (off + bp->b_bcount), async ? "a" : ""));
572 1.1 pooka
573 1.16 pooka /* mmap? handle here and return */
574 1.16 pooka if (rblk->rblk_mmflags) {
575 1.16 pooka struct blkwin *win;
576 1.16 pooka int winsize, iodone;
577 1.16 pooka uint8_t *ioaddr, *bufaddr;
578 1.16 pooka
579 1.16 pooka for (iodone = 0; iodone < bp->b_bcount;
580 1.16 pooka iodone += winsize, off += winsize) {
581 1.16 pooka winsize = bp->b_bcount - iodone;
582 1.16 pooka win = getwindow(rblk, off, &winsize, &error);
583 1.16 pooka if (win == NULL) {
584 1.16 pooka rump_biodone(bp, iodone, error);
585 1.16 pooka return;
586 1.16 pooka }
587 1.16 pooka
588 1.16 pooka ioaddr = (uint8_t *)win->win_mem + (off-STARTWIN(off));
589 1.16 pooka bufaddr = (uint8_t *)bp->b_data + iodone;
590 1.11 pooka
591 1.16 pooka DPRINTF(("strat: %p off 0x%" PRIx64
592 1.16 pooka ", ioaddr %p (%p)/buf %p\n", win,
593 1.16 pooka win->win_off, ioaddr, win->win_mem, bufaddr));
594 1.16 pooka if (BUF_ISREAD(bp)) {
595 1.16 pooka memcpy(bufaddr, ioaddr, winsize);
596 1.16 pooka } else {
597 1.16 pooka memcpy(ioaddr, bufaddr, winsize);
598 1.16 pooka }
599 1.16 pooka
600 1.16 pooka /* synchronous write, sync bits back to disk */
601 1.16 pooka if (BUF_ISWRITE(bp) && !async) {
602 1.16 pooka rumpuser_memsync(ioaddr, winsize, &error);
603 1.16 pooka }
604 1.16 pooka putwindow(rblk, win);
605 1.9 pooka }
606 1.9 pooka
607 1.9 pooka rump_biodone(bp, bp->b_bcount, 0);
608 1.9 pooka return;
609 1.9 pooka }
610 1.9 pooka
611 1.1 pooka /*
612 1.1 pooka * Do I/O. We have different paths for async and sync I/O.
613 1.1 pooka * Async I/O is done by passing a request to rumpuser where
614 1.1 pooka * it is executed. The rumpuser routine then calls
615 1.1 pooka * biodone() to signal any waiters in the kernel. I/O's are
616 1.1 pooka * executed in series. Technically executing them in parallel
617 1.1 pooka * would produce better results, but then we'd need either
618 1.1 pooka * more threads or posix aio. Maybe worth investigating
619 1.1 pooka * this later.
620 1.14 pooka *
621 1.14 pooka * Using bufq here might be a good idea.
622 1.1 pooka */
623 1.20 pooka
624 1.13 pooka if (rump_threads) {
625 1.1 pooka struct rumpuser_aio *rua;
626 1.20 pooka int op, fd;
627 1.20 pooka
628 1.20 pooka fd = rblk->rblk_fd;
629 1.20 pooka if (BUF_ISREAD(bp)) {
630 1.20 pooka op = RUA_OP_READ;
631 1.20 pooka } else {
632 1.20 pooka op = RUA_OP_WRITE;
633 1.20 pooka if (!async) {
634 1.20 pooka /* O_DIRECT not fully automatic yet */
635 1.20 pooka #ifdef HAS_ODIRECT
636 1.20 pooka if ((off & (DEV_BSIZE-1)) == 0
637 1.20 pooka && ((intptr_t)bp->b_data&(DEV_BSIZE-1)) == 0
638 1.20 pooka && (bp->b_bcount & (DEV_BSIZE-1)) == 0)
639 1.20 pooka fd = rblk->rblk_dfd;
640 1.20 pooka else
641 1.20 pooka #endif
642 1.20 pooka op |= RUA_OP_SYNC;
643 1.20 pooka }
644 1.20 pooka }
645 1.1 pooka
646 1.1 pooka rumpuser_mutex_enter(&rumpuser_aio_mtx);
647 1.20 pooka while ((rumpuser_aio_head+1) % N_AIOS == rumpuser_aio_tail) {
648 1.13 pooka rumpuser_cv_wait(&rumpuser_aio_cv, &rumpuser_aio_mtx);
649 1.20 pooka }
650 1.1 pooka
651 1.2 pooka rua = &rumpuser_aios[rumpuser_aio_head];
652 1.2 pooka KASSERT(rua->rua_bp == NULL);
653 1.20 pooka rua->rua_fd = fd;
654 1.2 pooka rua->rua_data = bp->b_data;
655 1.2 pooka rua->rua_dlen = bp->b_bcount;
656 1.2 pooka rua->rua_off = off;
657 1.2 pooka rua->rua_bp = bp;
658 1.20 pooka rua->rua_op = op;
659 1.2 pooka
660 1.1 pooka /* insert into queue & signal */
661 1.6 pooka rumpuser_aio_head = (rumpuser_aio_head+1) % N_AIOS;
662 1.1 pooka rumpuser_cv_signal(&rumpuser_aio_cv);
663 1.1 pooka rumpuser_mutex_exit(&rumpuser_aio_mtx);
664 1.1 pooka } else {
665 1.1 pooka if (BUF_ISREAD(bp)) {
666 1.1 pooka rumpuser_read_bio(rblk->rblk_fd, bp->b_data,
667 1.1 pooka bp->b_bcount, off, rump_biodone, bp);
668 1.1 pooka } else {
669 1.1 pooka rumpuser_write_bio(rblk->rblk_fd, bp->b_data,
670 1.1 pooka bp->b_bcount, off, rump_biodone, bp);
671 1.1 pooka }
672 1.20 pooka if (BUF_ISWRITE(bp) && !async)
673 1.20 pooka rumpuser_fsync(rblk->rblk_fd, &error);
674 1.1 pooka }
675 1.1 pooka }
676 1.3 pooka
677 1.3 pooka void
678 1.3 pooka rumpblk_strategy(struct buf *bp)
679 1.3 pooka {
680 1.3 pooka
681 1.3 pooka dostrategy(bp);
682 1.3 pooka }
683 1.3 pooka
684 1.3 pooka /*
685 1.4 pooka * Simple random number generator. This is private so that we can
686 1.4 pooka * very repeatedly control which blocks will fail.
687 1.4 pooka *
688 1.3 pooka * <mlelstv> pooka, rand()
689 1.3 pooka * <mlelstv> [paste]
690 1.3 pooka */
691 1.3 pooka static unsigned
692 1.3 pooka gimmerand(void)
693 1.3 pooka {
694 1.3 pooka
695 1.3 pooka return (randstate = randstate * 1103515245 + 12345) % (0x80000000L);
696 1.3 pooka }
697 1.3 pooka
698 1.3 pooka /*
699 1.3 pooka * Block device with very simple fault injection. Fails every
700 1.3 pooka * n out of BLKFAIL_MAX I/O with EIO. n is determined by the env
701 1.3 pooka * variable RUMP_BLKFAIL.
702 1.3 pooka */
703 1.3 pooka void
704 1.3 pooka rumpblk_strategy_fail(struct buf *bp)
705 1.3 pooka {
706 1.3 pooka
707 1.3 pooka if (gimmerand() % BLKFAIL_MAX >= blkfail) {
708 1.3 pooka dostrategy(bp);
709 1.3 pooka } else {
710 1.3 pooka printf("block fault injection: failing I/O on block %lld\n",
711 1.3 pooka (long long)bp->b_blkno);
712 1.3 pooka bp->b_error = EIO;
713 1.3 pooka biodone(bp);
714 1.3 pooka }
715 1.3 pooka }
716