rumpblk.c revision 1.47 1 1.47 tls /* $NetBSD: rumpblk.c,v 1.47 2011/11/19 22:51:31 tls 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.29 pooka *
44 1.29 pooka * However, it is quite costly in writing large amounts of
45 1.29 pooka * file data, since old contents cannot merely be overwritten, but
46 1.29 pooka * must be paged in first before replacing (i.e. r/m/w). Ideally,
47 1.29 pooka * we should use directio. The problem is that directio can fail
48 1.29 pooka * silently causing improper file system semantics (i.e. unflushed
49 1.29 pooka * data). Therefore, default to mmap for now. Even so, directio
50 1.29 pooka * _should_ be safe and can be enabled by compiling this module
51 1.29 pooka * with -DHAS_DIRECTIO.
52 1.1 pooka */
53 1.1 pooka
54 1.1 pooka #include <sys/cdefs.h>
55 1.47 tls __KERNEL_RCSID(0, "$NetBSD: rumpblk.c,v 1.47 2011/11/19 22:51:31 tls Exp $");
56 1.1 pooka
57 1.1 pooka #include <sys/param.h>
58 1.1 pooka #include <sys/buf.h>
59 1.1 pooka #include <sys/conf.h>
60 1.16 pooka #include <sys/condvar.h>
61 1.1 pooka #include <sys/disklabel.h>
62 1.18 pooka #include <sys/evcnt.h>
63 1.1 pooka #include <sys/fcntl.h>
64 1.1 pooka #include <sys/kmem.h>
65 1.1 pooka #include <sys/malloc.h>
66 1.16 pooka #include <sys/queue.h>
67 1.1 pooka #include <sys/stat.h>
68 1.47 tls #include <sys/cprng.h>
69 1.1 pooka
70 1.1 pooka #include <rump/rumpuser.h>
71 1.1 pooka
72 1.1 pooka #include "rump_private.h"
73 1.1 pooka #include "rump_vfs_private.h"
74 1.1 pooka
75 1.45 pooka /*
76 1.45 pooka * O_DIRECT is the fastest alternative, but since it falls back to
77 1.45 pooka * non-direct writes silently, I am not sure it will always be 100% safe.
78 1.45 pooka * Use it and play with it, but do that with caution.
79 1.45 pooka */
80 1.45 pooka #if 0
81 1.45 pooka #define HAS_ODIRECT
82 1.45 pooka #endif
83 1.45 pooka
84 1.16 pooka #if 0
85 1.16 pooka #define DPRINTF(x) printf x
86 1.16 pooka #else
87 1.16 pooka #define DPRINTF(x)
88 1.16 pooka #endif
89 1.16 pooka
90 1.19 pooka /* Default: 16 x 1MB windows */
91 1.19 pooka unsigned memwinsize = (1<<20);
92 1.19 pooka unsigned memwincnt = 16;
93 1.19 pooka
94 1.36 pooka #define STARTWIN(off) ((off) & ~((off_t)memwinsize-1))
95 1.16 pooka #define INWIN(win,off) ((win)->win_off == STARTWIN(off))
96 1.41 pooka #define WINSIZE(rblk, win) (MIN((rblk->rblk_hostsize-win->win_off), \
97 1.41 pooka memwinsize))
98 1.16 pooka #define WINVALID(win) ((win)->win_off != (off_t)-1)
99 1.16 pooka #define WINVALIDATE(win) ((win)->win_off = (off_t)-1)
100 1.16 pooka struct blkwin {
101 1.16 pooka off_t win_off;
102 1.16 pooka void *win_mem;
103 1.16 pooka int win_refcnt;
104 1.16 pooka
105 1.16 pooka TAILQ_ENTRY(blkwin) win_lru;
106 1.16 pooka };
107 1.16 pooka
108 1.1 pooka #define RUMPBLK_SIZE 16
109 1.1 pooka static struct rblkdev {
110 1.1 pooka char *rblk_path;
111 1.1 pooka int rblk_fd;
112 1.45 pooka int rblk_mode;
113 1.20 pooka #ifdef HAS_ODIRECT
114 1.20 pooka int rblk_dfd;
115 1.20 pooka #endif
116 1.26 pooka uint64_t rblk_size;
117 1.27 pooka uint64_t rblk_hostoffset;
118 1.41 pooka uint64_t rblk_hostsize;
119 1.27 pooka int rblk_ftype;
120 1.16 pooka
121 1.16 pooka /* for mmap */
122 1.16 pooka int rblk_mmflags;
123 1.16 pooka kmutex_t rblk_memmtx;
124 1.16 pooka kcondvar_t rblk_memcv;
125 1.16 pooka TAILQ_HEAD(winlru, blkwin) rblk_lruq;
126 1.16 pooka bool rblk_waiting;
127 1.1 pooka
128 1.31 pooka struct disklabel rblk_label;
129 1.1 pooka } minors[RUMPBLK_SIZE];
130 1.1 pooka
131 1.20 pooka static struct evcnt ev_io_total;
132 1.20 pooka static struct evcnt ev_io_async;
133 1.20 pooka
134 1.20 pooka static struct evcnt ev_memblk_hits;
135 1.20 pooka static struct evcnt ev_memblk_busy;
136 1.20 pooka
137 1.20 pooka static struct evcnt ev_bwrite_total;
138 1.20 pooka static struct evcnt ev_bwrite_async;
139 1.20 pooka static struct evcnt ev_bread_total;
140 1.18 pooka
141 1.1 pooka dev_type_open(rumpblk_open);
142 1.1 pooka dev_type_close(rumpblk_close);
143 1.1 pooka dev_type_read(rumpblk_read);
144 1.1 pooka dev_type_write(rumpblk_write);
145 1.1 pooka dev_type_ioctl(rumpblk_ioctl);
146 1.1 pooka dev_type_strategy(rumpblk_strategy);
147 1.3 pooka dev_type_strategy(rumpblk_strategy_fail);
148 1.1 pooka dev_type_dump(rumpblk_dump);
149 1.1 pooka dev_type_size(rumpblk_size);
150 1.1 pooka
151 1.1 pooka static const struct bdevsw rumpblk_bdevsw = {
152 1.1 pooka rumpblk_open, rumpblk_close, rumpblk_strategy, rumpblk_ioctl,
153 1.1 pooka nodump, nosize, D_DISK
154 1.1 pooka };
155 1.1 pooka
156 1.3 pooka static const struct bdevsw rumpblk_bdevsw_fail = {
157 1.3 pooka rumpblk_open, rumpblk_close, rumpblk_strategy_fail, rumpblk_ioctl,
158 1.3 pooka nodump, nosize, D_DISK
159 1.3 pooka };
160 1.3 pooka
161 1.1 pooka static const struct cdevsw rumpblk_cdevsw = {
162 1.1 pooka rumpblk_open, rumpblk_close, rumpblk_read, rumpblk_write,
163 1.1 pooka rumpblk_ioctl, nostop, notty, nopoll, nommap, nokqfilter, D_DISK
164 1.1 pooka };
165 1.1 pooka
166 1.45 pooka static int backend_open(struct rblkdev *, const char *);
167 1.45 pooka static int backend_close(struct rblkdev *);
168 1.45 pooka
169 1.3 pooka /* fail every n out of BLKFAIL_MAX */
170 1.3 pooka #define BLKFAIL_MAX 10000
171 1.3 pooka static int blkfail;
172 1.3 pooka static unsigned randstate;
173 1.24 pooka static kmutex_t rumpblk_lock;
174 1.37 pooka static int sectshift = DEV_BSHIFT;
175 1.1 pooka
176 1.31 pooka static void
177 1.31 pooka makedefaultlabel(struct disklabel *lp, off_t size, int part)
178 1.31 pooka {
179 1.31 pooka int i;
180 1.31 pooka
181 1.31 pooka memset(lp, 0, sizeof(*lp));
182 1.31 pooka
183 1.31 pooka lp->d_secperunit = size;
184 1.37 pooka lp->d_secsize = 1 << sectshift;
185 1.37 pooka lp->d_nsectors = size >> sectshift;
186 1.31 pooka lp->d_ntracks = 1;
187 1.31 pooka lp->d_ncylinders = 1;
188 1.31 pooka lp->d_secpercyl = lp->d_nsectors;
189 1.31 pooka
190 1.31 pooka /* oh dear oh dear */
191 1.31 pooka strncpy(lp->d_typename, "rumpd", sizeof(lp->d_typename));
192 1.31 pooka strncpy(lp->d_packname, "fictitious", sizeof(lp->d_packname));
193 1.31 pooka
194 1.31 pooka lp->d_type = DTYPE_RUMPD;
195 1.31 pooka lp->d_rpm = 11;
196 1.31 pooka lp->d_interleave = 1;
197 1.31 pooka lp->d_flags = 0;
198 1.31 pooka
199 1.31 pooka /* XXX: RAW_PART handling? */
200 1.31 pooka for (i = 0; i < part; i++) {
201 1.31 pooka lp->d_partitions[i].p_fstype = FS_UNUSED;
202 1.31 pooka }
203 1.37 pooka lp->d_partitions[part].p_size = size >> sectshift;
204 1.31 pooka lp->d_npartitions = part+1;
205 1.31 pooka /* XXX: file system type? */
206 1.31 pooka
207 1.31 pooka lp->d_magic = DISKMAGIC;
208 1.31 pooka lp->d_magic2 = DISKMAGIC;
209 1.31 pooka lp->d_checksum = 0; /* XXX */
210 1.31 pooka }
211 1.31 pooka
212 1.16 pooka static struct blkwin *
213 1.16 pooka getwindow(struct rblkdev *rblk, off_t off, int *wsize, int *error)
214 1.16 pooka {
215 1.16 pooka struct blkwin *win;
216 1.16 pooka
217 1.16 pooka mutex_enter(&rblk->rblk_memmtx);
218 1.16 pooka retry:
219 1.16 pooka /* search for window */
220 1.16 pooka TAILQ_FOREACH(win, &rblk->rblk_lruq, win_lru) {
221 1.16 pooka if (INWIN(win, off) && WINVALID(win))
222 1.16 pooka break;
223 1.16 pooka }
224 1.16 pooka
225 1.16 pooka /* found? return */
226 1.16 pooka if (win) {
227 1.20 pooka ev_memblk_hits.ev_count++;
228 1.16 pooka TAILQ_REMOVE(&rblk->rblk_lruq, win, win_lru);
229 1.16 pooka goto good;
230 1.16 pooka }
231 1.16 pooka
232 1.16 pooka /*
233 1.16 pooka * Else, create new window. If the least recently used is not
234 1.16 pooka * currently in use, reuse that. Otherwise we need to wait.
235 1.16 pooka */
236 1.16 pooka win = TAILQ_LAST(&rblk->rblk_lruq, winlru);
237 1.16 pooka if (win->win_refcnt == 0) {
238 1.16 pooka TAILQ_REMOVE(&rblk->rblk_lruq, win, win_lru);
239 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
240 1.16 pooka
241 1.16 pooka if (WINVALID(win)) {
242 1.16 pooka DPRINTF(("win %p, unmap mem %p, off 0x%" PRIx64 "\n",
243 1.16 pooka win, win->win_mem, win->win_off));
244 1.16 pooka rumpuser_unmap(win->win_mem, WINSIZE(rblk, win));
245 1.16 pooka WINVALIDATE(win);
246 1.16 pooka }
247 1.16 pooka
248 1.16 pooka win->win_off = STARTWIN(off);
249 1.16 pooka win->win_mem = rumpuser_filemmap(rblk->rblk_fd, win->win_off,
250 1.16 pooka WINSIZE(rblk, win), rblk->rblk_mmflags, error);
251 1.16 pooka DPRINTF(("win %p, off 0x%" PRIx64 ", mem %p\n",
252 1.16 pooka win, win->win_off, win->win_mem));
253 1.16 pooka
254 1.16 pooka mutex_enter(&rblk->rblk_memmtx);
255 1.16 pooka if (win->win_mem == NULL) {
256 1.16 pooka WINVALIDATE(win);
257 1.16 pooka TAILQ_INSERT_TAIL(&rblk->rblk_lruq, win, win_lru);
258 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
259 1.16 pooka return NULL;
260 1.16 pooka }
261 1.16 pooka } else {
262 1.16 pooka DPRINTF(("memwin wait\n"));
263 1.20 pooka ev_memblk_busy.ev_count++;
264 1.18 pooka
265 1.16 pooka rblk->rblk_waiting = true;
266 1.16 pooka cv_wait(&rblk->rblk_memcv, &rblk->rblk_memmtx);
267 1.16 pooka goto retry;
268 1.16 pooka }
269 1.16 pooka
270 1.16 pooka good:
271 1.16 pooka KASSERT(win);
272 1.16 pooka win->win_refcnt++;
273 1.16 pooka TAILQ_INSERT_HEAD(&rblk->rblk_lruq, win, win_lru);
274 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
275 1.19 pooka *wsize = MIN(*wsize, memwinsize - (off-win->win_off));
276 1.16 pooka KASSERT(*wsize);
277 1.16 pooka
278 1.16 pooka return win;
279 1.16 pooka }
280 1.16 pooka
281 1.16 pooka static void
282 1.16 pooka putwindow(struct rblkdev *rblk, struct blkwin *win)
283 1.16 pooka {
284 1.16 pooka
285 1.16 pooka mutex_enter(&rblk->rblk_memmtx);
286 1.16 pooka if (--win->win_refcnt == 0 && rblk->rblk_waiting) {
287 1.16 pooka rblk->rblk_waiting = false;
288 1.42 pooka cv_broadcast(&rblk->rblk_memcv);
289 1.16 pooka }
290 1.16 pooka KASSERT(win->win_refcnt >= 0);
291 1.16 pooka mutex_exit(&rblk->rblk_memmtx);
292 1.16 pooka }
293 1.16 pooka
294 1.16 pooka static void
295 1.16 pooka wincleanup(struct rblkdev *rblk)
296 1.16 pooka {
297 1.16 pooka struct blkwin *win;
298 1.16 pooka
299 1.16 pooka while ((win = TAILQ_FIRST(&rblk->rblk_lruq)) != NULL) {
300 1.16 pooka TAILQ_REMOVE(&rblk->rblk_lruq, win, win_lru);
301 1.16 pooka if (WINVALID(win)) {
302 1.16 pooka DPRINTF(("cleanup win %p addr %p\n",
303 1.16 pooka win, win->win_mem));
304 1.16 pooka rumpuser_unmap(win->win_mem, WINSIZE(rblk, win));
305 1.16 pooka }
306 1.16 pooka kmem_free(win, sizeof(*win));
307 1.16 pooka }
308 1.16 pooka rblk->rblk_mmflags = 0;
309 1.16 pooka }
310 1.16 pooka
311 1.1 pooka int
312 1.8 cegger rumpblk_init(void)
313 1.1 pooka {
314 1.3 pooka char buf[64];
315 1.38 pooka devmajor_t rumpblkmaj = RUMPBLK_DEVMAJOR;
316 1.19 pooka unsigned tmp;
317 1.16 pooka int error, i;
318 1.3 pooka
319 1.24 pooka mutex_init(&rumpblk_lock, MUTEX_DEFAULT, IPL_NONE);
320 1.24 pooka
321 1.3 pooka if (rumpuser_getenv("RUMP_BLKFAIL", buf, sizeof(buf), &error) == 0) {
322 1.3 pooka blkfail = strtoul(buf, NULL, 10);
323 1.3 pooka /* fail everything */
324 1.3 pooka if (blkfail > BLKFAIL_MAX)
325 1.3 pooka blkfail = BLKFAIL_MAX;
326 1.3 pooka if (rumpuser_getenv("RUMP_BLKFAIL_SEED", buf, sizeof(buf),
327 1.3 pooka &error) == 0) {
328 1.3 pooka randstate = strtoul(buf, NULL, 10);
329 1.3 pooka } else {
330 1.47 tls randstate = cprng_fast32();
331 1.3 pooka }
332 1.22 pooka printf("rumpblk: FAULT INJECTION ACTIVE! fail %d/%d. "
333 1.22 pooka "seed %u\n", blkfail, BLKFAIL_MAX, randstate);
334 1.3 pooka } else {
335 1.3 pooka blkfail = 0;
336 1.3 pooka }
337 1.1 pooka
338 1.19 pooka if (rumpuser_getenv("RUMP_BLKWINSIZE", buf, sizeof(buf), &error) == 0) {
339 1.19 pooka printf("rumpblk: ");
340 1.19 pooka tmp = strtoul(buf, NULL, 10);
341 1.19 pooka if (tmp && !(tmp & (tmp-1)))
342 1.19 pooka memwinsize = tmp;
343 1.19 pooka else
344 1.19 pooka printf("invalid RUMP_BLKWINSIZE %d, ", tmp);
345 1.19 pooka printf("using %d for memwinsize\n", memwinsize);
346 1.19 pooka }
347 1.19 pooka if (rumpuser_getenv("RUMP_BLKWINCOUNT", buf, sizeof(buf), &error) == 0){
348 1.19 pooka printf("rumpblk: ");
349 1.19 pooka tmp = strtoul(buf, NULL, 10);
350 1.19 pooka if (tmp)
351 1.19 pooka memwincnt = tmp;
352 1.19 pooka else
353 1.19 pooka printf("invalid RUMP_BLKWINCOUNT %d, ", tmp);
354 1.19 pooka printf("using %d for memwincount\n", memwincnt);
355 1.19 pooka }
356 1.37 pooka if (rumpuser_getenv("RUMP_BLKSECTSHIFT", buf, sizeof(buf), &error)==0){
357 1.37 pooka printf("rumpblk: ");
358 1.37 pooka tmp = strtoul(buf, NULL, 10);
359 1.37 pooka if (tmp >= DEV_BSHIFT)
360 1.37 pooka sectshift = tmp;
361 1.37 pooka else
362 1.37 pooka printf("RUMP_BLKSECTSHIFT must be least %d (now %d), ",
363 1.37 pooka DEV_BSHIFT, tmp);
364 1.37 pooka printf("using %d for sector shift (size %d)\n",
365 1.37 pooka sectshift, 1<<sectshift);
366 1.37 pooka }
367 1.19 pooka
368 1.16 pooka memset(minors, 0, sizeof(minors));
369 1.16 pooka for (i = 0; i < RUMPBLK_SIZE; i++) {
370 1.16 pooka mutex_init(&minors[i].rblk_memmtx, MUTEX_DEFAULT, IPL_NONE);
371 1.16 pooka cv_init(&minors[i].rblk_memcv, "rblkmcv");
372 1.46 pooka minors[i].rblk_fd = -1;
373 1.16 pooka }
374 1.16 pooka
375 1.20 pooka evcnt_attach_dynamic(&ev_io_total, EVCNT_TYPE_MISC, NULL,
376 1.39 pooka "rumpblk", "I/O reqs");
377 1.20 pooka evcnt_attach_dynamic(&ev_io_async, EVCNT_TYPE_MISC, NULL,
378 1.39 pooka "rumpblk", "async I/O");
379 1.20 pooka
380 1.20 pooka evcnt_attach_dynamic(&ev_bread_total, EVCNT_TYPE_MISC, NULL,
381 1.39 pooka "rumpblk", "bytes read");
382 1.20 pooka evcnt_attach_dynamic(&ev_bwrite_total, EVCNT_TYPE_MISC, NULL,
383 1.39 pooka "rumpblk", "bytes written");
384 1.20 pooka evcnt_attach_dynamic(&ev_bwrite_async, EVCNT_TYPE_MISC, NULL,
385 1.39 pooka "rumpblk", "bytes written async");
386 1.20 pooka
387 1.20 pooka evcnt_attach_dynamic(&ev_memblk_hits, EVCNT_TYPE_MISC, NULL,
388 1.39 pooka "rumpblk", "window hits");
389 1.20 pooka evcnt_attach_dynamic(&ev_memblk_busy, EVCNT_TYPE_MISC, NULL,
390 1.39 pooka "rumpblk", "all windows busy");
391 1.18 pooka
392 1.3 pooka if (blkfail) {
393 1.38 pooka return devsw_attach("rumpblk",
394 1.38 pooka &rumpblk_bdevsw_fail, &rumpblkmaj,
395 1.38 pooka &rumpblk_cdevsw, &rumpblkmaj);
396 1.3 pooka } else {
397 1.38 pooka return devsw_attach("rumpblk",
398 1.38 pooka &rumpblk_bdevsw, &rumpblkmaj,
399 1.38 pooka &rumpblk_cdevsw, &rumpblkmaj);
400 1.3 pooka }
401 1.1 pooka }
402 1.1 pooka
403 1.1 pooka int
404 1.27 pooka rumpblk_register(const char *path, devminor_t *dmin,
405 1.27 pooka uint64_t offset, uint64_t size)
406 1.1 pooka {
407 1.27 pooka struct rblkdev *rblk;
408 1.24 pooka uint64_t flen;
409 1.1 pooka size_t len;
410 1.30 pooka int ftype, error, i;
411 1.24 pooka
412 1.27 pooka /* devices might not report correct size unless they're open */
413 1.30 pooka if (rumpuser_getfileinfo(path, &flen, &ftype, &error) == -1)
414 1.27 pooka return error;
415 1.27 pooka
416 1.24 pooka /* verify host file is of supported type */
417 1.24 pooka if (!(ftype == RUMPUSER_FT_REG
418 1.24 pooka || ftype == RUMPUSER_FT_BLK
419 1.24 pooka || ftype == RUMPUSER_FT_CHR))
420 1.24 pooka return EINVAL;
421 1.1 pooka
422 1.24 pooka mutex_enter(&rumpblk_lock);
423 1.24 pooka for (i = 0; i < RUMPBLK_SIZE; i++) {
424 1.24 pooka if (minors[i].rblk_path&&strcmp(minors[i].rblk_path, path)==0) {
425 1.24 pooka mutex_exit(&rumpblk_lock);
426 1.24 pooka *dmin = i;
427 1.24 pooka return 0;
428 1.24 pooka }
429 1.24 pooka }
430 1.1 pooka
431 1.1 pooka for (i = 0; i < RUMPBLK_SIZE; i++)
432 1.1 pooka if (minors[i].rblk_path == NULL)
433 1.1 pooka break;
434 1.24 pooka if (i == RUMPBLK_SIZE) {
435 1.24 pooka mutex_exit(&rumpblk_lock);
436 1.24 pooka return EBUSY;
437 1.24 pooka }
438 1.1 pooka
439 1.27 pooka rblk = &minors[i];
440 1.45 pooka rblk->rblk_path = __UNCONST("taken");
441 1.45 pooka mutex_exit(&rumpblk_lock);
442 1.45 pooka
443 1.1 pooka len = strlen(path);
444 1.27 pooka rblk->rblk_path = malloc(len + 1, M_TEMP, M_WAITOK);
445 1.27 pooka strcpy(rblk->rblk_path, path);
446 1.27 pooka rblk->rblk_hostoffset = offset;
447 1.33 pooka if (size != RUMPBLK_SIZENOTSET) {
448 1.27 pooka KASSERT(size + offset <= flen);
449 1.27 pooka rblk->rblk_size = size;
450 1.27 pooka } else {
451 1.27 pooka KASSERT(offset < flen);
452 1.27 pooka rblk->rblk_size = flen - offset;
453 1.27 pooka }
454 1.41 pooka rblk->rblk_hostsize = flen;
455 1.27 pooka rblk->rblk_ftype = ftype;
456 1.31 pooka makedefaultlabel(&rblk->rblk_label, rblk->rblk_size, i);
457 1.45 pooka
458 1.45 pooka if ((error = backend_open(rblk, path)) != 0) {
459 1.45 pooka memset(&rblk->rblk_label, 0, sizeof(rblk->rblk_label));
460 1.45 pooka free(rblk->rblk_path, M_TEMP);
461 1.45 pooka rblk->rblk_path = NULL;
462 1.45 pooka return error;
463 1.45 pooka }
464 1.24 pooka
465 1.24 pooka *dmin = i;
466 1.24 pooka return 0;
467 1.1 pooka }
468 1.1 pooka
469 1.40 pooka /*
470 1.40 pooka * Unregister rumpblk. It's the callers responsibility to make
471 1.40 pooka * sure it's no longer in use.
472 1.40 pooka */
473 1.40 pooka int
474 1.40 pooka rumpblk_deregister(const char *path)
475 1.40 pooka {
476 1.40 pooka struct rblkdev *rblk;
477 1.40 pooka int i;
478 1.40 pooka
479 1.40 pooka mutex_enter(&rumpblk_lock);
480 1.40 pooka for (i = 0; i < RUMPBLK_SIZE; i++) {
481 1.40 pooka if (minors[i].rblk_path&&strcmp(minors[i].rblk_path, path)==0) {
482 1.40 pooka break;
483 1.40 pooka }
484 1.40 pooka }
485 1.40 pooka mutex_exit(&rumpblk_lock);
486 1.40 pooka
487 1.40 pooka if (i == RUMPBLK_SIZE)
488 1.40 pooka return ENOENT;
489 1.40 pooka
490 1.40 pooka rblk = &minors[i];
491 1.45 pooka backend_close(rblk);
492 1.40 pooka
493 1.40 pooka wincleanup(rblk);
494 1.40 pooka free(rblk->rblk_path, M_TEMP);
495 1.45 pooka memset(&rblk->rblk_label, 0, sizeof(rblk->rblk_label));
496 1.40 pooka rblk->rblk_path = NULL;
497 1.40 pooka
498 1.40 pooka return 0;
499 1.40 pooka }
500 1.40 pooka
501 1.45 pooka static int
502 1.45 pooka backend_open(struct rblkdev *rblk, const char *path)
503 1.1 pooka {
504 1.1 pooka int error, fd;
505 1.1 pooka
506 1.46 pooka KASSERT(rblk->rblk_fd == -1);
507 1.45 pooka fd = rumpuser_open(path, O_RDWR, &error);
508 1.45 pooka if (error) {
509 1.45 pooka fd = rumpuser_open(path, O_RDONLY, &error);
510 1.45 pooka if (error)
511 1.45 pooka return error;
512 1.45 pooka rblk->rblk_mode = FREAD;
513 1.27 pooka
514 1.45 pooka #ifdef HAS_ODIRECT
515 1.45 pooka rblk->rblk_dfd = rumpuser_open(path,
516 1.45 pooka O_RDONLY | O_DIRECT, &error);
517 1.45 pooka if (error) {
518 1.45 pooka close(fd);
519 1.45 pooka return error;
520 1.45 pooka }
521 1.45 pooka #endif
522 1.45 pooka } else {
523 1.45 pooka rblk->rblk_mode = FREAD|FWRITE;
524 1.1 pooka
525 1.20 pooka #ifdef HAS_ODIRECT
526 1.45 pooka rblk->rblk_dfd = rumpuser_open(path,
527 1.45 pooka O_RDWR | O_DIRECT, &error);
528 1.45 pooka if (error) {
529 1.45 pooka close(fd);
530 1.45 pooka return error;
531 1.45 pooka }
532 1.20 pooka #endif
533 1.45 pooka }
534 1.20 pooka
535 1.27 pooka if (rblk->rblk_ftype == RUMPUSER_FT_REG) {
536 1.45 pooka uint64_t fsize= rblk->rblk_hostsize, off= rblk->rblk_hostoffset;
537 1.16 pooka struct blkwin *win;
538 1.16 pooka int i, winsize;
539 1.16 pooka
540 1.1 pooka /*
541 1.16 pooka * Use mmap to access a regular file. Allocate and
542 1.16 pooka * cache initial windows here. Failure to allocate one
543 1.16 pooka * means fallback to read/write i/o.
544 1.1 pooka */
545 1.9 pooka
546 1.16 pooka rblk->rblk_mmflags = 0;
547 1.45 pooka if (rblk->rblk_mode & FREAD)
548 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_READ;
549 1.45 pooka if (rblk->rblk_mode & FWRITE) {
550 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_WRITE;
551 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_SHARED;
552 1.16 pooka }
553 1.16 pooka
554 1.16 pooka TAILQ_INIT(&rblk->rblk_lruq);
555 1.16 pooka rblk->rblk_fd = fd;
556 1.16 pooka
557 1.28 pooka for (i = 0; i < memwincnt && off + i*memwinsize < fsize; i++) {
558 1.16 pooka win = kmem_zalloc(sizeof(*win), KM_SLEEP);
559 1.16 pooka WINVALIDATE(win);
560 1.16 pooka TAILQ_INSERT_TAIL(&rblk->rblk_lruq, win, win_lru);
561 1.16 pooka
562 1.16 pooka /*
563 1.16 pooka * Allocate first windows. Here we just generally
564 1.16 pooka * make sure a) we can mmap at all b) we have the
565 1.16 pooka * necessary VA available
566 1.16 pooka */
567 1.29 pooka winsize = memwinsize;
568 1.28 pooka win = getwindow(rblk, off + i*memwinsize, &winsize,
569 1.28 pooka &error);
570 1.16 pooka if (win) {
571 1.16 pooka putwindow(rblk, win);
572 1.16 pooka } else {
573 1.16 pooka wincleanup(rblk);
574 1.16 pooka break;
575 1.12 pooka }
576 1.9 pooka }
577 1.35 pooka } else {
578 1.35 pooka rblk->rblk_fd = fd;
579 1.1 pooka }
580 1.1 pooka
581 1.16 pooka KASSERT(rblk->rblk_fd != -1);
582 1.1 pooka return 0;
583 1.1 pooka }
584 1.1 pooka
585 1.45 pooka static int
586 1.45 pooka backend_close(struct rblkdev *rblk)
587 1.1 pooka {
588 1.1 pooka int dummy;
589 1.1 pooka
590 1.16 pooka if (rblk->rblk_mmflags)
591 1.16 pooka wincleanup(rblk);
592 1.16 pooka rumpuser_fsync(rblk->rblk_fd, &dummy);
593 1.1 pooka rumpuser_close(rblk->rblk_fd, &dummy);
594 1.1 pooka rblk->rblk_fd = -1;
595 1.45 pooka #ifdef HAS_ODIRECT
596 1.45 pooka if (rblk->rblk_dfd != -1) {
597 1.45 pooka rumpuser_close(rblk->rblk_dfd, &dummy);
598 1.45 pooka rblk->rblk_dfd = -1;
599 1.45 pooka }
600 1.45 pooka #endif
601 1.45 pooka
602 1.45 pooka return 0;
603 1.45 pooka }
604 1.45 pooka
605 1.45 pooka int
606 1.45 pooka rumpblk_open(dev_t dev, int flag, int fmt, struct lwp *l)
607 1.45 pooka {
608 1.45 pooka struct rblkdev *rblk = &minors[minor(dev)];
609 1.45 pooka
610 1.45 pooka if (rblk->rblk_fd == -1)
611 1.45 pooka return ENXIO;
612 1.45 pooka
613 1.45 pooka if (((flag & (FREAD|FWRITE)) & ~rblk->rblk_mode) != 0) {
614 1.45 pooka return EACCES;
615 1.45 pooka }
616 1.45 pooka
617 1.45 pooka return 0;
618 1.45 pooka }
619 1.45 pooka
620 1.45 pooka int
621 1.45 pooka rumpblk_close(dev_t dev, int flag, int fmt, struct lwp *l)
622 1.45 pooka {
623 1.1 pooka
624 1.1 pooka return 0;
625 1.1 pooka }
626 1.1 pooka
627 1.1 pooka int
628 1.1 pooka rumpblk_ioctl(dev_t dev, u_long xfer, void *addr, int flag, struct lwp *l)
629 1.1 pooka {
630 1.31 pooka devminor_t dmin = minor(dev);
631 1.31 pooka struct rblkdev *rblk = &minors[dmin];
632 1.31 pooka struct partinfo *pi;
633 1.31 pooka int error = 0;
634 1.31 pooka
635 1.31 pooka /* well, me should support a few more, but we don't for now */
636 1.31 pooka switch (xfer) {
637 1.31 pooka case DIOCGDINFO:
638 1.31 pooka *(struct disklabel *)addr = rblk->rblk_label;
639 1.31 pooka break;
640 1.31 pooka
641 1.31 pooka case DIOCGPART:
642 1.31 pooka pi = addr;
643 1.31 pooka pi->part = &rblk->rblk_label.d_partitions[DISKPART(dmin)];
644 1.31 pooka pi->disklab = &rblk->rblk_label;
645 1.31 pooka break;
646 1.32 pooka
647 1.32 pooka /* it's synced enough along the write path */
648 1.32 pooka case DIOCCACHESYNC:
649 1.32 pooka break;
650 1.32 pooka
651 1.31 pooka default:
652 1.31 pooka error = ENOTTY;
653 1.31 pooka break;
654 1.1 pooka }
655 1.1 pooka
656 1.31 pooka return error;
657 1.1 pooka }
658 1.1 pooka
659 1.25 pooka static int
660 1.25 pooka do_physio(dev_t dev, struct uio *uio, int which)
661 1.25 pooka {
662 1.25 pooka void (*strat)(struct buf *);
663 1.25 pooka
664 1.25 pooka if (blkfail)
665 1.25 pooka strat = rumpblk_strategy_fail;
666 1.25 pooka else
667 1.25 pooka strat = rumpblk_strategy;
668 1.25 pooka
669 1.25 pooka return physio(strat, NULL, dev, which, minphys, uio);
670 1.25 pooka }
671 1.25 pooka
672 1.1 pooka int
673 1.1 pooka rumpblk_read(dev_t dev, struct uio *uio, int flags)
674 1.1 pooka {
675 1.1 pooka
676 1.25 pooka return do_physio(dev, uio, B_READ);
677 1.1 pooka }
678 1.1 pooka
679 1.1 pooka int
680 1.1 pooka rumpblk_write(dev_t dev, struct uio *uio, int flags)
681 1.1 pooka {
682 1.1 pooka
683 1.25 pooka return do_physio(dev, uio, B_WRITE);
684 1.1 pooka }
685 1.1 pooka
686 1.3 pooka static void
687 1.3 pooka dostrategy(struct buf *bp)
688 1.1 pooka {
689 1.1 pooka struct rblkdev *rblk = &minors[minor(bp->b_dev)];
690 1.1 pooka off_t off;
691 1.21 pooka int async = bp->b_flags & B_ASYNC;
692 1.21 pooka int error;
693 1.1 pooka
694 1.44 pooka if (bp->b_bcount % (1<<sectshift) != 0) {
695 1.44 pooka rump_biodone(bp, 0, EINVAL);
696 1.44 pooka return;
697 1.44 pooka }
698 1.44 pooka
699 1.20 pooka /* collect statistics */
700 1.20 pooka ev_io_total.ev_count++;
701 1.20 pooka if (async)
702 1.20 pooka ev_io_async.ev_count++;
703 1.20 pooka if (BUF_ISWRITE(bp)) {
704 1.20 pooka ev_bwrite_total.ev_count += bp->b_bcount;
705 1.20 pooka if (async)
706 1.20 pooka ev_bwrite_async.ev_count += bp->b_bcount;
707 1.20 pooka } else {
708 1.20 pooka ev_bread_total.ev_count++;
709 1.20 pooka }
710 1.20 pooka
711 1.44 pooka /*
712 1.44 pooka * b_blkno is always in terms of DEV_BSIZE, and since we need
713 1.44 pooka * to translate to a byte offset for the host read, this
714 1.44 pooka * calculation does not need sectshift.
715 1.44 pooka */
716 1.44 pooka off = bp->b_blkno << DEV_BSHIFT;
717 1.44 pooka
718 1.11 pooka /*
719 1.11 pooka * Do bounds checking if we're working on a file. Otherwise
720 1.11 pooka * invalid file systems might attempt to read beyond EOF. This
721 1.11 pooka * is bad(tm) especially on mmapped images. This is essentially
722 1.11 pooka * the kernel bounds_check() routines.
723 1.11 pooka */
724 1.27 pooka if (off + bp->b_bcount > rblk->rblk_size) {
725 1.11 pooka int64_t sz = rblk->rblk_size - off;
726 1.11 pooka
727 1.11 pooka /* EOF */
728 1.11 pooka if (sz == 0) {
729 1.11 pooka rump_biodone(bp, 0, 0);
730 1.11 pooka return;
731 1.11 pooka }
732 1.11 pooka /* beyond EOF ==> error */
733 1.11 pooka if (sz < 0) {
734 1.11 pooka rump_biodone(bp, 0, EINVAL);
735 1.11 pooka return;
736 1.11 pooka }
737 1.11 pooka
738 1.11 pooka /* truncate to device size */
739 1.11 pooka bp->b_bcount = sz;
740 1.11 pooka }
741 1.11 pooka
742 1.34 pooka off += rblk->rblk_hostoffset;
743 1.1 pooka DPRINTF(("rumpblk_strategy: 0x%x bytes %s off 0x%" PRIx64
744 1.20 pooka " (0x%" PRIx64 " - 0x%" PRIx64 "), %ssync\n",
745 1.16 pooka bp->b_bcount, BUF_ISREAD(bp) ? "READ" : "WRITE",
746 1.20 pooka off, off, (off + bp->b_bcount), async ? "a" : ""));
747 1.1 pooka
748 1.16 pooka /* mmap? handle here and return */
749 1.16 pooka if (rblk->rblk_mmflags) {
750 1.16 pooka struct blkwin *win;
751 1.16 pooka int winsize, iodone;
752 1.16 pooka uint8_t *ioaddr, *bufaddr;
753 1.16 pooka
754 1.16 pooka for (iodone = 0; iodone < bp->b_bcount;
755 1.16 pooka iodone += winsize, off += winsize) {
756 1.16 pooka winsize = bp->b_bcount - iodone;
757 1.16 pooka win = getwindow(rblk, off, &winsize, &error);
758 1.16 pooka if (win == NULL) {
759 1.16 pooka rump_biodone(bp, iodone, error);
760 1.16 pooka return;
761 1.16 pooka }
762 1.16 pooka
763 1.16 pooka ioaddr = (uint8_t *)win->win_mem + (off-STARTWIN(off));
764 1.16 pooka bufaddr = (uint8_t *)bp->b_data + iodone;
765 1.11 pooka
766 1.16 pooka DPRINTF(("strat: %p off 0x%" PRIx64
767 1.16 pooka ", ioaddr %p (%p)/buf %p\n", win,
768 1.16 pooka win->win_off, ioaddr, win->win_mem, bufaddr));
769 1.16 pooka if (BUF_ISREAD(bp)) {
770 1.16 pooka memcpy(bufaddr, ioaddr, winsize);
771 1.16 pooka } else {
772 1.16 pooka memcpy(ioaddr, bufaddr, winsize);
773 1.16 pooka }
774 1.16 pooka
775 1.16 pooka /* synchronous write, sync bits back to disk */
776 1.16 pooka if (BUF_ISWRITE(bp) && !async) {
777 1.16 pooka rumpuser_memsync(ioaddr, winsize, &error);
778 1.16 pooka }
779 1.16 pooka putwindow(rblk, win);
780 1.9 pooka }
781 1.9 pooka
782 1.9 pooka rump_biodone(bp, bp->b_bcount, 0);
783 1.9 pooka return;
784 1.9 pooka }
785 1.9 pooka
786 1.1 pooka /*
787 1.1 pooka * Do I/O. We have different paths for async and sync I/O.
788 1.1 pooka * Async I/O is done by passing a request to rumpuser where
789 1.1 pooka * it is executed. The rumpuser routine then calls
790 1.1 pooka * biodone() to signal any waiters in the kernel. I/O's are
791 1.1 pooka * executed in series. Technically executing them in parallel
792 1.1 pooka * would produce better results, but then we'd need either
793 1.1 pooka * more threads or posix aio. Maybe worth investigating
794 1.1 pooka * this later.
795 1.14 pooka *
796 1.14 pooka * Using bufq here might be a good idea.
797 1.1 pooka */
798 1.20 pooka
799 1.13 pooka if (rump_threads) {
800 1.1 pooka struct rumpuser_aio *rua;
801 1.20 pooka int op, fd;
802 1.20 pooka
803 1.20 pooka fd = rblk->rblk_fd;
804 1.20 pooka if (BUF_ISREAD(bp)) {
805 1.20 pooka op = RUA_OP_READ;
806 1.20 pooka } else {
807 1.20 pooka op = RUA_OP_WRITE;
808 1.20 pooka if (!async) {
809 1.20 pooka /* O_DIRECT not fully automatic yet */
810 1.20 pooka #ifdef HAS_ODIRECT
811 1.37 pooka if ((off & ((1<<sectshift)-1)) == 0
812 1.37 pooka && ((intptr_t)bp->b_data
813 1.37 pooka & ((1<<sectshift)-1)) == 0
814 1.37 pooka && (bp->b_bcount & ((1<<sectshift)-1)) == 0)
815 1.20 pooka fd = rblk->rblk_dfd;
816 1.20 pooka else
817 1.20 pooka #endif
818 1.20 pooka op |= RUA_OP_SYNC;
819 1.20 pooka }
820 1.20 pooka }
821 1.1 pooka
822 1.1 pooka rumpuser_mutex_enter(&rumpuser_aio_mtx);
823 1.20 pooka while ((rumpuser_aio_head+1) % N_AIOS == rumpuser_aio_tail) {
824 1.13 pooka rumpuser_cv_wait(&rumpuser_aio_cv, &rumpuser_aio_mtx);
825 1.20 pooka }
826 1.1 pooka
827 1.2 pooka rua = &rumpuser_aios[rumpuser_aio_head];
828 1.2 pooka KASSERT(rua->rua_bp == NULL);
829 1.20 pooka rua->rua_fd = fd;
830 1.2 pooka rua->rua_data = bp->b_data;
831 1.2 pooka rua->rua_dlen = bp->b_bcount;
832 1.2 pooka rua->rua_off = off;
833 1.2 pooka rua->rua_bp = bp;
834 1.20 pooka rua->rua_op = op;
835 1.2 pooka
836 1.1 pooka /* insert into queue & signal */
837 1.6 pooka rumpuser_aio_head = (rumpuser_aio_head+1) % N_AIOS;
838 1.1 pooka rumpuser_cv_signal(&rumpuser_aio_cv);
839 1.1 pooka rumpuser_mutex_exit(&rumpuser_aio_mtx);
840 1.1 pooka } else {
841 1.1 pooka if (BUF_ISREAD(bp)) {
842 1.1 pooka rumpuser_read_bio(rblk->rblk_fd, bp->b_data,
843 1.1 pooka bp->b_bcount, off, rump_biodone, bp);
844 1.1 pooka } else {
845 1.1 pooka rumpuser_write_bio(rblk->rblk_fd, bp->b_data,
846 1.1 pooka bp->b_bcount, off, rump_biodone, bp);
847 1.1 pooka }
848 1.20 pooka if (BUF_ISWRITE(bp) && !async)
849 1.20 pooka rumpuser_fsync(rblk->rblk_fd, &error);
850 1.1 pooka }
851 1.1 pooka }
852 1.3 pooka
853 1.3 pooka void
854 1.3 pooka rumpblk_strategy(struct buf *bp)
855 1.3 pooka {
856 1.3 pooka
857 1.3 pooka dostrategy(bp);
858 1.3 pooka }
859 1.3 pooka
860 1.3 pooka /*
861 1.4 pooka * Simple random number generator. This is private so that we can
862 1.4 pooka * very repeatedly control which blocks will fail.
863 1.4 pooka *
864 1.3 pooka * <mlelstv> pooka, rand()
865 1.3 pooka * <mlelstv> [paste]
866 1.3 pooka */
867 1.3 pooka static unsigned
868 1.3 pooka gimmerand(void)
869 1.3 pooka {
870 1.3 pooka
871 1.3 pooka return (randstate = randstate * 1103515245 + 12345) % (0x80000000L);
872 1.3 pooka }
873 1.3 pooka
874 1.3 pooka /*
875 1.3 pooka * Block device with very simple fault injection. Fails every
876 1.3 pooka * n out of BLKFAIL_MAX I/O with EIO. n is determined by the env
877 1.3 pooka * variable RUMP_BLKFAIL.
878 1.3 pooka */
879 1.3 pooka void
880 1.3 pooka rumpblk_strategy_fail(struct buf *bp)
881 1.3 pooka {
882 1.3 pooka
883 1.3 pooka if (gimmerand() % BLKFAIL_MAX >= blkfail) {
884 1.3 pooka dostrategy(bp);
885 1.3 pooka } else {
886 1.3 pooka printf("block fault injection: failing I/O on block %lld\n",
887 1.3 pooka (long long)bp->b_blkno);
888 1.3 pooka bp->b_error = EIO;
889 1.3 pooka biodone(bp);
890 1.3 pooka }
891 1.3 pooka }
892