ld_thunkbus.c revision 1.7 1 1.7 jmcneill /* $NetBSD: ld_thunkbus.c,v 1.7 2011/09/03 15:00:28 jmcneill Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2011 Jared D. McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 jmcneill * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 jmcneill * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 jmcneill * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 jmcneill * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 jmcneill * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 jmcneill * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 jmcneill * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 jmcneill * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 jmcneill * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 jmcneill * POSSIBILITY OF SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include <sys/cdefs.h>
30 1.7 jmcneill __KERNEL_RCSID(0, "$NetBSD: ld_thunkbus.c,v 1.7 2011/09/03 15:00:28 jmcneill Exp $");
31 1.1 jmcneill
32 1.1 jmcneill #include <sys/param.h>
33 1.1 jmcneill #include <sys/proc.h>
34 1.1 jmcneill #include <sys/systm.h>
35 1.1 jmcneill #include <sys/device.h>
36 1.1 jmcneill #include <sys/buf.h>
37 1.1 jmcneill #include <sys/disk.h>
38 1.2 jmcneill #include <sys/kmem.h>
39 1.1 jmcneill
40 1.1 jmcneill #include <dev/ldvar.h>
41 1.1 jmcneill
42 1.1 jmcneill #include <machine/mainbus.h>
43 1.1 jmcneill #include <machine/thunk.h>
44 1.1 jmcneill
45 1.1 jmcneill static int ld_thunkbus_match(device_t, cfdata_t, void *);
46 1.1 jmcneill static void ld_thunkbus_attach(device_t, device_t, void *);
47 1.1 jmcneill
48 1.1 jmcneill static int ld_thunkbus_ldstart(struct ld_softc *, struct buf *);
49 1.1 jmcneill static int ld_thunkbus_lddump(struct ld_softc *, void *, int, int);
50 1.1 jmcneill static int ld_thunkbus_ldflush(struct ld_softc *, int);
51 1.1 jmcneill
52 1.3 jmcneill static void ld_thunkbus_sig(int, siginfo_t *, void *);
53 1.3 jmcneill static void ld_thunkbus_complete(void *);
54 1.3 jmcneill
55 1.4 jmcneill struct ld_thunkbus_softc;
56 1.4 jmcneill
57 1.4 jmcneill struct ld_thunkbus_transfer {
58 1.4 jmcneill struct ld_thunkbus_softc *tt_sc;
59 1.4 jmcneill struct aiocb tt_aio;
60 1.4 jmcneill struct buf *tt_bp;
61 1.4 jmcneill };
62 1.2 jmcneill
63 1.1 jmcneill struct ld_thunkbus_softc {
64 1.1 jmcneill struct ld_softc sc_ld;
65 1.1 jmcneill
66 1.1 jmcneill int sc_fd;
67 1.3 jmcneill void *sc_ih;
68 1.3 jmcneill
69 1.4 jmcneill struct ld_thunkbus_transfer sc_tt;
70 1.2 jmcneill };
71 1.2 jmcneill
72 1.1 jmcneill CFATTACH_DECL_NEW(ld_thunkbus, sizeof(struct ld_thunkbus_softc),
73 1.1 jmcneill ld_thunkbus_match, ld_thunkbus_attach, NULL, NULL);
74 1.1 jmcneill
75 1.1 jmcneill static int
76 1.1 jmcneill ld_thunkbus_match(device_t parent, cfdata_t match, void *opaque)
77 1.1 jmcneill {
78 1.1 jmcneill struct thunkbus_attach_args *taa = opaque;
79 1.1 jmcneill
80 1.1 jmcneill if (taa->taa_type != THUNKBUS_TYPE_DISKIMAGE)
81 1.1 jmcneill return 0;
82 1.1 jmcneill
83 1.1 jmcneill return 1;
84 1.1 jmcneill }
85 1.1 jmcneill
86 1.1 jmcneill static void
87 1.1 jmcneill ld_thunkbus_attach(device_t parent, device_t self, void *opaque)
88 1.1 jmcneill {
89 1.1 jmcneill struct ld_thunkbus_softc *sc = device_private(self);
90 1.1 jmcneill struct ld_softc *ld = &sc->sc_ld;
91 1.1 jmcneill struct thunkbus_attach_args *taa = opaque;
92 1.1 jmcneill const char *path = taa->u.diskimage.path;
93 1.2 jmcneill struct sigaction sa;
94 1.5 jmcneill ssize_t size, blksize;
95 1.1 jmcneill
96 1.1 jmcneill ld->sc_dv = self;
97 1.1 jmcneill
98 1.1 jmcneill sc->sc_fd = thunk_open(path, O_RDWR, 0);
99 1.1 jmcneill if (sc->sc_fd == -1) {
100 1.7 jmcneill aprint_error(": couldn't open %s: %d\n", path, thunk_geterrno());
101 1.1 jmcneill return;
102 1.1 jmcneill }
103 1.5 jmcneill if (thunk_fstat_getsize(sc->sc_fd, &size, &blksize) == -1) {
104 1.7 jmcneill aprint_error(": couldn't stat %s: %d\n", path, thunk_geterrno());
105 1.1 jmcneill return;
106 1.1 jmcneill }
107 1.1 jmcneill
108 1.1 jmcneill aprint_naive("\n");
109 1.5 jmcneill aprint_normal(": %s (%lld)\n", path, (long long)size);
110 1.1 jmcneill
111 1.1 jmcneill ld->sc_flags = LDF_ENABLED;
112 1.5 jmcneill ld->sc_maxxfer = blksize;
113 1.2 jmcneill ld->sc_secsize = 512;
114 1.5 jmcneill ld->sc_secperunit = size / ld->sc_secsize;
115 1.1 jmcneill ld->sc_maxqueuecnt = 1;
116 1.1 jmcneill ld->sc_start = ld_thunkbus_ldstart;
117 1.1 jmcneill ld->sc_dump = ld_thunkbus_lddump;
118 1.1 jmcneill ld->sc_flush = ld_thunkbus_ldflush;
119 1.1 jmcneill
120 1.3 jmcneill sc->sc_ih = softint_establish(SOFTINT_BIO,
121 1.3 jmcneill ld_thunkbus_complete, sc);
122 1.3 jmcneill
123 1.2 jmcneill sigemptyset(&sa.sa_mask);
124 1.2 jmcneill sa.sa_flags = SA_RESTART|SA_SIGINFO;
125 1.3 jmcneill sa.sa_sigaction = ld_thunkbus_sig;
126 1.2 jmcneill if (thunk_sigaction(SIGIO, &sa, NULL) == -1)
127 1.7 jmcneill panic("couldn't register SIGIO handler: %d", thunk_geterrno());
128 1.2 jmcneill
129 1.1 jmcneill ldattach(ld);
130 1.1 jmcneill }
131 1.1 jmcneill
132 1.2 jmcneill static void
133 1.3 jmcneill ld_thunkbus_sig(int sig, siginfo_t *info, void *ctx)
134 1.2 jmcneill {
135 1.2 jmcneill struct ld_thunkbus_transfer *tt;
136 1.2 jmcneill struct ld_thunkbus_softc *sc;
137 1.2 jmcneill
138 1.2 jmcneill curcpu()->ci_idepth++;
139 1.2 jmcneill
140 1.2 jmcneill if (info->si_signo == SIGIO) {
141 1.2 jmcneill tt = info->si_value.sival_ptr;
142 1.2 jmcneill sc = tt->tt_sc;
143 1.3 jmcneill softint_schedule(sc->sc_ih);
144 1.3 jmcneill }
145 1.3 jmcneill
146 1.3 jmcneill curcpu()->ci_idepth--;
147 1.3 jmcneill }
148 1.2 jmcneill
149 1.3 jmcneill static void
150 1.3 jmcneill ld_thunkbus_complete(void *arg)
151 1.3 jmcneill {
152 1.3 jmcneill struct ld_thunkbus_softc *sc = arg;
153 1.4 jmcneill struct ld_thunkbus_transfer *tt = &sc->sc_tt;
154 1.3 jmcneill struct buf *bp = tt->tt_bp;
155 1.3 jmcneill
156 1.3 jmcneill if (thunk_aio_error(&tt->tt_aio) == 0 &&
157 1.3 jmcneill thunk_aio_return(&tt->tt_aio) != -1) {
158 1.3 jmcneill bp->b_resid = 0;
159 1.3 jmcneill } else {
160 1.7 jmcneill bp->b_error = thunk_geterrno();
161 1.3 jmcneill bp->b_resid = bp->b_bcount;
162 1.3 jmcneill }
163 1.2 jmcneill
164 1.3 jmcneill if (bp->b_error)
165 1.6 reinoud printf("error!\n");
166 1.2 jmcneill
167 1.3 jmcneill lddone(&sc->sc_ld, bp);
168 1.2 jmcneill }
169 1.2 jmcneill
170 1.1 jmcneill static int
171 1.1 jmcneill ld_thunkbus_ldstart(struct ld_softc *ld, struct buf *bp)
172 1.1 jmcneill {
173 1.1 jmcneill struct ld_thunkbus_softc *sc = (struct ld_thunkbus_softc *)ld;
174 1.4 jmcneill struct ld_thunkbus_transfer *tt = &sc->sc_tt;
175 1.2 jmcneill int error;
176 1.2 jmcneill
177 1.2 jmcneill tt->tt_sc = sc;
178 1.2 jmcneill tt->tt_bp = bp;
179 1.2 jmcneill memset(&tt->tt_aio, 0, sizeof(tt->tt_aio));
180 1.2 jmcneill tt->tt_aio.aio_fildes = sc->sc_fd;
181 1.2 jmcneill tt->tt_aio.aio_buf = bp->b_data;
182 1.2 jmcneill tt->tt_aio.aio_nbytes = bp->b_bcount;
183 1.2 jmcneill tt->tt_aio.aio_offset = bp->b_rawblkno * ld->sc_secsize;
184 1.2 jmcneill
185 1.2 jmcneill tt->tt_aio.aio_sigevent.sigev_notify = SIGEV_SIGNAL;
186 1.2 jmcneill tt->tt_aio.aio_sigevent.sigev_signo = SIGIO;
187 1.2 jmcneill tt->tt_aio.aio_sigevent.sigev_value.sival_ptr = tt;
188 1.2 jmcneill
189 1.2 jmcneill #if 0
190 1.6 reinoud device_printf(sc->sc_ld.sc_dv, "%s addr %p, off=%lld, count=%lld\n",
191 1.2 jmcneill (bp->b_flags & B_READ) ? "rd" : "wr",
192 1.6 reinoud bp->b_data,
193 1.2 jmcneill (long long)bp->b_rawblkno,
194 1.2 jmcneill (long long)bp->b_bcount);
195 1.2 jmcneill #endif
196 1.1 jmcneill
197 1.1 jmcneill if (bp->b_flags & B_READ)
198 1.2 jmcneill error = thunk_aio_read(&tt->tt_aio);
199 1.1 jmcneill else
200 1.2 jmcneill error = thunk_aio_write(&tt->tt_aio);
201 1.1 jmcneill
202 1.7 jmcneill return error == -1 ? thunk_geterrno() : 0;
203 1.1 jmcneill }
204 1.1 jmcneill
205 1.1 jmcneill static int
206 1.1 jmcneill ld_thunkbus_lddump(struct ld_softc *ld, void *data, int blkno, int blkcnt)
207 1.1 jmcneill {
208 1.1 jmcneill struct ld_thunkbus_softc *sc = (struct ld_thunkbus_softc *)ld;
209 1.1 jmcneill ssize_t len;
210 1.1 jmcneill
211 1.1 jmcneill len = thunk_pwrite(sc->sc_fd, data, blkcnt, blkno);
212 1.1 jmcneill if (len == -1)
213 1.7 jmcneill return thunk_geterrno();
214 1.1 jmcneill else if (len != blkcnt) {
215 1.1 jmcneill device_printf(ld->sc_dv, "%s failed (short xfer)\n", __func__);
216 1.1 jmcneill return EIO;
217 1.1 jmcneill }
218 1.1 jmcneill
219 1.1 jmcneill return 0;
220 1.1 jmcneill }
221 1.1 jmcneill
222 1.1 jmcneill static int
223 1.1 jmcneill ld_thunkbus_ldflush(struct ld_softc *ld, int flags)
224 1.1 jmcneill {
225 1.1 jmcneill struct ld_thunkbus_softc *sc = (struct ld_thunkbus_softc *)ld;
226 1.1 jmcneill
227 1.1 jmcneill if (thunk_fsync(sc->sc_fd) == -1)
228 1.7 jmcneill return thunk_geterrno();
229 1.1 jmcneill
230 1.1 jmcneill return 0;
231 1.1 jmcneill }
232 1.1 jmcneill
233