rumpblk.c revision 1.49 1 1.49 pooka /* $NetBSD: rumpblk.c,v 1.49 2013/04/29 12:56:03 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.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.49 pooka __KERNEL_RCSID(0, "$NetBSD: rumpblk.c,v 1.49 2013/04/29 12:56:03 pooka 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.49 pooka fd = rumpuser_open(path,
508 1.49 pooka RUMPUSER_OPEN_RDWR | RUMPUSER_OPEN_BIO, &error);
509 1.45 pooka if (error) {
510 1.49 pooka fd = rumpuser_open(path,
511 1.49 pooka RUMPUSER_OPEN_RDONLY | RUMPUSER_OPEN_BIO, &error);
512 1.45 pooka if (error)
513 1.45 pooka return error;
514 1.45 pooka rblk->rblk_mode = FREAD;
515 1.27 pooka
516 1.45 pooka #ifdef HAS_ODIRECT
517 1.45 pooka rblk->rblk_dfd = rumpuser_open(path,
518 1.48 pooka RUMPUSER_OPEN_RDONLY | RUMPUSER_OPEN_DIRECT, &error);
519 1.45 pooka if (error) {
520 1.45 pooka close(fd);
521 1.45 pooka return error;
522 1.45 pooka }
523 1.45 pooka #endif
524 1.45 pooka } else {
525 1.45 pooka rblk->rblk_mode = FREAD|FWRITE;
526 1.1 pooka
527 1.20 pooka #ifdef HAS_ODIRECT
528 1.45 pooka rblk->rblk_dfd = rumpuser_open(path,
529 1.48 pooka RUMPUSER_OPEN_RDWR | RUMPUSER_OPEN_DIRECT, &error);
530 1.45 pooka if (error) {
531 1.45 pooka close(fd);
532 1.45 pooka return error;
533 1.45 pooka }
534 1.20 pooka #endif
535 1.45 pooka }
536 1.20 pooka
537 1.27 pooka if (rblk->rblk_ftype == RUMPUSER_FT_REG) {
538 1.45 pooka uint64_t fsize= rblk->rblk_hostsize, off= rblk->rblk_hostoffset;
539 1.16 pooka struct blkwin *win;
540 1.16 pooka int i, winsize;
541 1.16 pooka
542 1.1 pooka /*
543 1.16 pooka * Use mmap to access a regular file. Allocate and
544 1.16 pooka * cache initial windows here. Failure to allocate one
545 1.16 pooka * means fallback to read/write i/o.
546 1.1 pooka */
547 1.9 pooka
548 1.16 pooka rblk->rblk_mmflags = 0;
549 1.45 pooka if (rblk->rblk_mode & FREAD)
550 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_READ;
551 1.45 pooka if (rblk->rblk_mode & FWRITE) {
552 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_WRITE;
553 1.16 pooka rblk->rblk_mmflags |= RUMPUSER_FILEMMAP_SHARED;
554 1.16 pooka }
555 1.16 pooka
556 1.16 pooka TAILQ_INIT(&rblk->rblk_lruq);
557 1.16 pooka rblk->rblk_fd = fd;
558 1.16 pooka
559 1.28 pooka for (i = 0; i < memwincnt && off + i*memwinsize < fsize; i++) {
560 1.16 pooka win = kmem_zalloc(sizeof(*win), KM_SLEEP);
561 1.16 pooka WINVALIDATE(win);
562 1.16 pooka TAILQ_INSERT_TAIL(&rblk->rblk_lruq, win, win_lru);
563 1.16 pooka
564 1.16 pooka /*
565 1.16 pooka * Allocate first windows. Here we just generally
566 1.16 pooka * make sure a) we can mmap at all b) we have the
567 1.16 pooka * necessary VA available
568 1.16 pooka */
569 1.29 pooka winsize = memwinsize;
570 1.28 pooka win = getwindow(rblk, off + i*memwinsize, &winsize,
571 1.28 pooka &error);
572 1.16 pooka if (win) {
573 1.16 pooka putwindow(rblk, win);
574 1.16 pooka } else {
575 1.16 pooka wincleanup(rblk);
576 1.16 pooka break;
577 1.12 pooka }
578 1.9 pooka }
579 1.35 pooka } else {
580 1.35 pooka rblk->rblk_fd = fd;
581 1.1 pooka }
582 1.1 pooka
583 1.16 pooka KASSERT(rblk->rblk_fd != -1);
584 1.1 pooka return 0;
585 1.1 pooka }
586 1.1 pooka
587 1.45 pooka static int
588 1.45 pooka backend_close(struct rblkdev *rblk)
589 1.1 pooka {
590 1.1 pooka int dummy;
591 1.1 pooka
592 1.16 pooka if (rblk->rblk_mmflags)
593 1.16 pooka wincleanup(rblk);
594 1.16 pooka rumpuser_fsync(rblk->rblk_fd, &dummy);
595 1.1 pooka rumpuser_close(rblk->rblk_fd, &dummy);
596 1.1 pooka rblk->rblk_fd = -1;
597 1.45 pooka #ifdef HAS_ODIRECT
598 1.45 pooka if (rblk->rblk_dfd != -1) {
599 1.45 pooka rumpuser_close(rblk->rblk_dfd, &dummy);
600 1.45 pooka rblk->rblk_dfd = -1;
601 1.45 pooka }
602 1.45 pooka #endif
603 1.45 pooka
604 1.45 pooka return 0;
605 1.45 pooka }
606 1.45 pooka
607 1.45 pooka int
608 1.45 pooka rumpblk_open(dev_t dev, int flag, int fmt, struct lwp *l)
609 1.45 pooka {
610 1.45 pooka struct rblkdev *rblk = &minors[minor(dev)];
611 1.45 pooka
612 1.45 pooka if (rblk->rblk_fd == -1)
613 1.45 pooka return ENXIO;
614 1.45 pooka
615 1.45 pooka if (((flag & (FREAD|FWRITE)) & ~rblk->rblk_mode) != 0) {
616 1.45 pooka return EACCES;
617 1.45 pooka }
618 1.45 pooka
619 1.45 pooka return 0;
620 1.45 pooka }
621 1.45 pooka
622 1.45 pooka int
623 1.45 pooka rumpblk_close(dev_t dev, int flag, int fmt, struct lwp *l)
624 1.45 pooka {
625 1.1 pooka
626 1.1 pooka return 0;
627 1.1 pooka }
628 1.1 pooka
629 1.1 pooka int
630 1.1 pooka rumpblk_ioctl(dev_t dev, u_long xfer, void *addr, int flag, struct lwp *l)
631 1.1 pooka {
632 1.31 pooka devminor_t dmin = minor(dev);
633 1.31 pooka struct rblkdev *rblk = &minors[dmin];
634 1.31 pooka struct partinfo *pi;
635 1.31 pooka int error = 0;
636 1.31 pooka
637 1.31 pooka /* well, me should support a few more, but we don't for now */
638 1.31 pooka switch (xfer) {
639 1.31 pooka case DIOCGDINFO:
640 1.31 pooka *(struct disklabel *)addr = rblk->rblk_label;
641 1.31 pooka break;
642 1.31 pooka
643 1.31 pooka case DIOCGPART:
644 1.31 pooka pi = addr;
645 1.31 pooka pi->part = &rblk->rblk_label.d_partitions[DISKPART(dmin)];
646 1.31 pooka pi->disklab = &rblk->rblk_label;
647 1.31 pooka break;
648 1.32 pooka
649 1.32 pooka /* it's synced enough along the write path */
650 1.32 pooka case DIOCCACHESYNC:
651 1.32 pooka break;
652 1.32 pooka
653 1.31 pooka default:
654 1.31 pooka error = ENOTTY;
655 1.31 pooka break;
656 1.1 pooka }
657 1.1 pooka
658 1.31 pooka return error;
659 1.1 pooka }
660 1.1 pooka
661 1.25 pooka static int
662 1.25 pooka do_physio(dev_t dev, struct uio *uio, int which)
663 1.25 pooka {
664 1.25 pooka void (*strat)(struct buf *);
665 1.25 pooka
666 1.25 pooka if (blkfail)
667 1.25 pooka strat = rumpblk_strategy_fail;
668 1.25 pooka else
669 1.25 pooka strat = rumpblk_strategy;
670 1.25 pooka
671 1.25 pooka return physio(strat, NULL, dev, which, minphys, uio);
672 1.25 pooka }
673 1.25 pooka
674 1.1 pooka int
675 1.1 pooka rumpblk_read(dev_t dev, struct uio *uio, int flags)
676 1.1 pooka {
677 1.1 pooka
678 1.25 pooka return do_physio(dev, uio, B_READ);
679 1.1 pooka }
680 1.1 pooka
681 1.1 pooka int
682 1.1 pooka rumpblk_write(dev_t dev, struct uio *uio, int flags)
683 1.1 pooka {
684 1.1 pooka
685 1.25 pooka return do_physio(dev, uio, B_WRITE);
686 1.1 pooka }
687 1.1 pooka
688 1.3 pooka static void
689 1.3 pooka dostrategy(struct buf *bp)
690 1.1 pooka {
691 1.1 pooka struct rblkdev *rblk = &minors[minor(bp->b_dev)];
692 1.1 pooka off_t off;
693 1.21 pooka int async = bp->b_flags & B_ASYNC;
694 1.49 pooka int error, op;
695 1.1 pooka
696 1.44 pooka if (bp->b_bcount % (1<<sectshift) != 0) {
697 1.44 pooka rump_biodone(bp, 0, EINVAL);
698 1.44 pooka return;
699 1.44 pooka }
700 1.44 pooka
701 1.20 pooka /* collect statistics */
702 1.20 pooka ev_io_total.ev_count++;
703 1.20 pooka if (async)
704 1.20 pooka ev_io_async.ev_count++;
705 1.20 pooka if (BUF_ISWRITE(bp)) {
706 1.20 pooka ev_bwrite_total.ev_count += bp->b_bcount;
707 1.20 pooka if (async)
708 1.20 pooka ev_bwrite_async.ev_count += bp->b_bcount;
709 1.20 pooka } else {
710 1.20 pooka ev_bread_total.ev_count++;
711 1.20 pooka }
712 1.20 pooka
713 1.44 pooka /*
714 1.44 pooka * b_blkno is always in terms of DEV_BSIZE, and since we need
715 1.44 pooka * to translate to a byte offset for the host read, this
716 1.44 pooka * calculation does not need sectshift.
717 1.44 pooka */
718 1.44 pooka off = bp->b_blkno << DEV_BSHIFT;
719 1.44 pooka
720 1.11 pooka /*
721 1.11 pooka * Do bounds checking if we're working on a file. Otherwise
722 1.11 pooka * invalid file systems might attempt to read beyond EOF. This
723 1.11 pooka * is bad(tm) especially on mmapped images. This is essentially
724 1.11 pooka * the kernel bounds_check() routines.
725 1.11 pooka */
726 1.27 pooka if (off + bp->b_bcount > rblk->rblk_size) {
727 1.11 pooka int64_t sz = rblk->rblk_size - off;
728 1.11 pooka
729 1.11 pooka /* EOF */
730 1.11 pooka if (sz == 0) {
731 1.11 pooka rump_biodone(bp, 0, 0);
732 1.11 pooka return;
733 1.11 pooka }
734 1.11 pooka /* beyond EOF ==> error */
735 1.11 pooka if (sz < 0) {
736 1.11 pooka rump_biodone(bp, 0, EINVAL);
737 1.11 pooka return;
738 1.11 pooka }
739 1.11 pooka
740 1.11 pooka /* truncate to device size */
741 1.11 pooka bp->b_bcount = sz;
742 1.11 pooka }
743 1.11 pooka
744 1.34 pooka off += rblk->rblk_hostoffset;
745 1.1 pooka DPRINTF(("rumpblk_strategy: 0x%x bytes %s off 0x%" PRIx64
746 1.20 pooka " (0x%" PRIx64 " - 0x%" PRIx64 "), %ssync\n",
747 1.16 pooka bp->b_bcount, BUF_ISREAD(bp) ? "READ" : "WRITE",
748 1.20 pooka off, off, (off + bp->b_bcount), async ? "a" : ""));
749 1.1 pooka
750 1.16 pooka /* mmap? handle here and return */
751 1.16 pooka if (rblk->rblk_mmflags) {
752 1.16 pooka struct blkwin *win;
753 1.16 pooka int winsize, iodone;
754 1.16 pooka uint8_t *ioaddr, *bufaddr;
755 1.16 pooka
756 1.16 pooka for (iodone = 0; iodone < bp->b_bcount;
757 1.16 pooka iodone += winsize, off += winsize) {
758 1.16 pooka winsize = bp->b_bcount - iodone;
759 1.16 pooka win = getwindow(rblk, off, &winsize, &error);
760 1.16 pooka if (win == NULL) {
761 1.16 pooka rump_biodone(bp, iodone, error);
762 1.16 pooka return;
763 1.16 pooka }
764 1.16 pooka
765 1.16 pooka ioaddr = (uint8_t *)win->win_mem + (off-STARTWIN(off));
766 1.16 pooka bufaddr = (uint8_t *)bp->b_data + iodone;
767 1.11 pooka
768 1.16 pooka DPRINTF(("strat: %p off 0x%" PRIx64
769 1.16 pooka ", ioaddr %p (%p)/buf %p\n", win,
770 1.16 pooka win->win_off, ioaddr, win->win_mem, bufaddr));
771 1.16 pooka if (BUF_ISREAD(bp)) {
772 1.16 pooka memcpy(bufaddr, ioaddr, winsize);
773 1.16 pooka } else {
774 1.16 pooka memcpy(ioaddr, bufaddr, winsize);
775 1.16 pooka }
776 1.16 pooka
777 1.16 pooka /* synchronous write, sync bits back to disk */
778 1.16 pooka if (BUF_ISWRITE(bp) && !async) {
779 1.16 pooka rumpuser_memsync(ioaddr, winsize, &error);
780 1.16 pooka }
781 1.16 pooka putwindow(rblk, win);
782 1.9 pooka }
783 1.9 pooka
784 1.9 pooka rump_biodone(bp, bp->b_bcount, 0);
785 1.1 pooka } else {
786 1.49 pooka op = BUF_ISREAD(bp) ? RUMPUSER_BIO_READ : RUMPUSER_BIO_WRITE;
787 1.20 pooka if (BUF_ISWRITE(bp) && !async)
788 1.49 pooka op |= RUMPUSER_BIO_SYNC;
789 1.49 pooka
790 1.49 pooka rumpuser_bio(rblk->rblk_fd, op, bp->b_data, bp->b_bcount, off,
791 1.49 pooka rump_biodone, bp);
792 1.1 pooka }
793 1.1 pooka }
794 1.3 pooka
795 1.3 pooka void
796 1.3 pooka rumpblk_strategy(struct buf *bp)
797 1.3 pooka {
798 1.3 pooka
799 1.3 pooka dostrategy(bp);
800 1.3 pooka }
801 1.3 pooka
802 1.3 pooka /*
803 1.4 pooka * Simple random number generator. This is private so that we can
804 1.4 pooka * very repeatedly control which blocks will fail.
805 1.4 pooka *
806 1.3 pooka * <mlelstv> pooka, rand()
807 1.3 pooka * <mlelstv> [paste]
808 1.3 pooka */
809 1.3 pooka static unsigned
810 1.3 pooka gimmerand(void)
811 1.3 pooka {
812 1.3 pooka
813 1.3 pooka return (randstate = randstate * 1103515245 + 12345) % (0x80000000L);
814 1.3 pooka }
815 1.3 pooka
816 1.3 pooka /*
817 1.3 pooka * Block device with very simple fault injection. Fails every
818 1.3 pooka * n out of BLKFAIL_MAX I/O with EIO. n is determined by the env
819 1.3 pooka * variable RUMP_BLKFAIL.
820 1.3 pooka */
821 1.3 pooka void
822 1.3 pooka rumpblk_strategy_fail(struct buf *bp)
823 1.3 pooka {
824 1.3 pooka
825 1.3 pooka if (gimmerand() % BLKFAIL_MAX >= blkfail) {
826 1.3 pooka dostrategy(bp);
827 1.3 pooka } else {
828 1.3 pooka printf("block fault injection: failing I/O on block %lld\n",
829 1.3 pooka (long long)bp->b_blkno);
830 1.3 pooka bp->b_error = EIO;
831 1.3 pooka biodone(bp);
832 1.3 pooka }
833 1.3 pooka }
834