rl.c revision 1.44 1 1.44 dholland /* $NetBSD: rl.c,v 1.44 2014/07/25 08:02:20 dholland Exp $ */
2 1.1 ragge
3 1.1 ragge /*
4 1.1 ragge * Copyright (c) 2000 Ludd, University of Lule}, Sweden. All rights reserved.
5 1.1 ragge *
6 1.1 ragge * Redistribution and use in source and binary forms, with or without
7 1.1 ragge * modification, are permitted provided that the following conditions
8 1.1 ragge * are met:
9 1.1 ragge * 1. Redistributions of source code must retain the above copyright
10 1.1 ragge * notice, this list of conditions and the following disclaimer.
11 1.1 ragge * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 ragge * notice, this list of conditions and the following disclaimer in the
13 1.1 ragge * documentation and/or other materials provided with the distribution.
14 1.1 ragge * 3. All advertising materials mentioning features or use of this software
15 1.1 ragge * must display the following acknowledgement:
16 1.24 simonb * This product includes software developed at Ludd, University of
17 1.1 ragge * Lule}, Sweden and its contributors.
18 1.1 ragge * 4. The name of the author may not be used to endorse or promote products
19 1.1 ragge * derived from this software without specific prior written permission
20 1.1 ragge *
21 1.1 ragge * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.1 ragge * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.1 ragge * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.1 ragge * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.1 ragge * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.1 ragge * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.1 ragge * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.1 ragge * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.1 ragge * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 1.1 ragge * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.1 ragge */
32 1.1 ragge
33 1.1 ragge /*
34 1.1 ragge * RL11/RLV11/RLV12 disk controller driver and
35 1.1 ragge * RL01/RL02 disk device driver.
36 1.1 ragge *
37 1.1 ragge * TODO:
38 1.1 ragge * Handle disk errors more gracefully
39 1.1 ragge * Do overlapping seeks on multiple drives
40 1.1 ragge *
41 1.1 ragge * Implementation comments:
42 1.24 simonb *
43 1.1 ragge */
44 1.10 lukem
45 1.10 lukem #include <sys/cdefs.h>
46 1.44 dholland __KERNEL_RCSID(0, "$NetBSD: rl.c,v 1.44 2014/07/25 08:02:20 dholland Exp $");
47 1.1 ragge
48 1.1 ragge #include <sys/param.h>
49 1.1 ragge #include <sys/device.h>
50 1.1 ragge #include <sys/systm.h>
51 1.1 ragge #include <sys/conf.h>
52 1.1 ragge #include <sys/disk.h>
53 1.1 ragge #include <sys/disklabel.h>
54 1.1 ragge #include <sys/buf.h>
55 1.23 yamt #include <sys/bufq.h>
56 1.1 ragge #include <sys/stat.h>
57 1.1 ragge #include <sys/dkio.h>
58 1.1 ragge #include <sys/fcntl.h>
59 1.17 jdolecek #include <sys/event.h>
60 1.1 ragge
61 1.1 ragge #include <ufs/ufs/dinode.h>
62 1.1 ragge #include <ufs/ffs/fs.h>
63 1.1 ragge
64 1.37 ad #include <sys/bus.h>
65 1.1 ragge
66 1.1 ragge #include <dev/qbus/ubavar.h>
67 1.1 ragge #include <dev/qbus/rlreg.h>
68 1.11 ragge #include <dev/qbus/rlvar.h>
69 1.1 ragge
70 1.1 ragge #include "ioconf.h"
71 1.1 ragge #include "locators.h"
72 1.1 ragge
73 1.38 matt static int rlcmatch(device_t, cfdata_t, void *);
74 1.38 matt static void rlcattach(device_t, device_t, void *);
75 1.1 ragge static int rlcprint(void *, const char *);
76 1.1 ragge static void rlcintr(void *);
77 1.38 matt static int rlmatch(device_t, cfdata_t, void *);
78 1.38 matt static void rlattach(device_t, device_t, void *);
79 1.1 ragge static void rlcstart(struct rlc_softc *, struct buf *);
80 1.1 ragge static void waitcrdy(struct rlc_softc *);
81 1.38 matt static void rlcreset(device_t);
82 1.1 ragge
83 1.38 matt CFATTACH_DECL_NEW(rlc, sizeof(struct rlc_softc),
84 1.16 thorpej rlcmatch, rlcattach, NULL, NULL);
85 1.15 thorpej
86 1.38 matt CFATTACH_DECL_NEW(rl, sizeof(struct rl_softc),
87 1.16 thorpej rlmatch, rlattach, NULL, NULL);
88 1.1 ragge
89 1.38 matt static dev_type_open(rlopen);
90 1.38 matt static dev_type_close(rlclose);
91 1.38 matt static dev_type_read(rlread);
92 1.38 matt static dev_type_write(rlwrite);
93 1.38 matt static dev_type_ioctl(rlioctl);
94 1.38 matt static dev_type_strategy(rlstrategy);
95 1.38 matt static dev_type_dump(rldump);
96 1.38 matt static dev_type_size(rlpsize);
97 1.13 gehenna
98 1.13 gehenna const struct bdevsw rl_bdevsw = {
99 1.43 dholland .d_open = rlopen,
100 1.43 dholland .d_close = rlclose,
101 1.43 dholland .d_strategy = rlstrategy,
102 1.43 dholland .d_ioctl = rlioctl,
103 1.43 dholland .d_dump = rldump,
104 1.43 dholland .d_psize = rlpsize,
105 1.44 dholland .d_discard = nodiscard,
106 1.43 dholland .d_flag = D_DISK
107 1.13 gehenna };
108 1.13 gehenna
109 1.13 gehenna const struct cdevsw rl_cdevsw = {
110 1.43 dholland .d_open = rlopen,
111 1.43 dholland .d_close = rlclose,
112 1.43 dholland .d_read = rlread,
113 1.43 dholland .d_write = rlwrite,
114 1.43 dholland .d_ioctl = rlioctl,
115 1.43 dholland .d_stop = nostop,
116 1.43 dholland .d_tty = notty,
117 1.43 dholland .d_poll = nopoll,
118 1.43 dholland .d_mmap = nommap,
119 1.43 dholland .d_kqfilter = nokqfilter,
120 1.43 dholland .d_flag = D_DISK
121 1.13 gehenna };
122 1.13 gehenna
123 1.1 ragge #define MAXRLXFER (RL_BPS * RL_SPT)
124 1.1 ragge
125 1.1 ragge #define RL_WREG(reg, val) \
126 1.1 ragge bus_space_write_2(sc->sc_iot, sc->sc_ioh, (reg), (val))
127 1.1 ragge #define RL_RREG(reg) \
128 1.1 ragge bus_space_read_2(sc->sc_iot, sc->sc_ioh, (reg))
129 1.1 ragge
130 1.38 matt static const char * const rlstates[] = {
131 1.11 ragge "drive not loaded",
132 1.11 ragge "drive spinning up",
133 1.11 ragge "drive brushes out",
134 1.11 ragge "drive loading heads",
135 1.11 ragge "drive seeking",
136 1.11 ragge "drive ready",
137 1.11 ragge "drive unloading heads",
138 1.11 ragge "drive spun down",
139 1.11 ragge };
140 1.11 ragge
141 1.38 matt static const struct dkdriver rldkdriver = {
142 1.22 thorpej rlstrategy, minphys
143 1.22 thorpej };
144 1.22 thorpej
145 1.25 ragge static const char *
146 1.11 ragge rlstate(struct rlc_softc *sc, int unit)
147 1.11 ragge {
148 1.11 ragge int i = 0;
149 1.11 ragge
150 1.11 ragge do {
151 1.11 ragge RL_WREG(RL_DA, RLDA_GS);
152 1.11 ragge RL_WREG(RL_CS, RLCS_GS|(unit << RLCS_USHFT));
153 1.11 ragge waitcrdy(sc);
154 1.11 ragge } while (((RL_RREG(RL_CS) & RLCS_ERR) != 0) && i++ < 10);
155 1.11 ragge if (i == 10)
156 1.11 ragge return NULL;
157 1.11 ragge i = RL_RREG(RL_MP) & RLMP_STATUS;
158 1.11 ragge return rlstates[i];
159 1.11 ragge }
160 1.11 ragge
161 1.1 ragge void
162 1.1 ragge waitcrdy(struct rlc_softc *sc)
163 1.1 ragge {
164 1.1 ragge int i;
165 1.1 ragge
166 1.1 ragge for (i = 0; i < 1000; i++) {
167 1.1 ragge DELAY(10000);
168 1.1 ragge if (RL_RREG(RL_CS) & RLCS_CRDY)
169 1.1 ragge return;
170 1.1 ragge }
171 1.38 matt aprint_error_dev(sc->sc_dev, "never got ready\n"); /* ?panic? */
172 1.1 ragge }
173 1.1 ragge
174 1.1 ragge int
175 1.1 ragge rlcprint(void *aux, const char *name)
176 1.1 ragge {
177 1.1 ragge struct rlc_attach_args *ra = aux;
178 1.1 ragge
179 1.1 ragge if (name)
180 1.18 thorpej aprint_normal("RL0%d at %s",
181 1.18 thorpej ra->type & RLMP_DT ? '2' : '1', name);
182 1.18 thorpej aprint_normal(" drive %d", ra->hwid);
183 1.1 ragge return UNCONF;
184 1.1 ragge }
185 1.1 ragge
186 1.1 ragge /*
187 1.1 ragge * Force the controller to interrupt.
188 1.1 ragge */
189 1.1 ragge int
190 1.38 matt rlcmatch(device_t parent, cfdata_t cf, void *aux)
191 1.1 ragge {
192 1.1 ragge struct uba_attach_args *ua = aux;
193 1.1 ragge struct rlc_softc ssc, *sc = &ssc;
194 1.1 ragge int i;
195 1.1 ragge
196 1.1 ragge sc->sc_iot = ua->ua_iot;
197 1.1 ragge sc->sc_ioh = ua->ua_ioh;
198 1.1 ragge /* Force interrupt by issuing a "Get Status" command */
199 1.1 ragge RL_WREG(RL_DA, RLDA_GS);
200 1.1 ragge RL_WREG(RL_CS, RLCS_GS|RLCS_IE);
201 1.1 ragge
202 1.1 ragge for (i = 0; i < 100; i++) {
203 1.1 ragge DELAY(100000);
204 1.1 ragge if (RL_RREG(RL_CS) & RLCS_CRDY)
205 1.1 ragge return 1;
206 1.1 ragge }
207 1.1 ragge return 0;
208 1.1 ragge }
209 1.1 ragge
210 1.1 ragge void
211 1.38 matt rlcattach(device_t parent, device_t self, void *aux)
212 1.1 ragge {
213 1.30 thorpej struct rlc_softc *sc = device_private(self);
214 1.1 ragge struct uba_attach_args *ua = aux;
215 1.1 ragge struct rlc_attach_args ra;
216 1.1 ragge int i, error;
217 1.1 ragge
218 1.38 matt sc->sc_dev = self;
219 1.38 matt sc->sc_uh = device_private(parent);
220 1.1 ragge sc->sc_iot = ua->ua_iot;
221 1.1 ragge sc->sc_ioh = ua->ua_ioh;
222 1.1 ragge sc->sc_dmat = ua->ua_dmat;
223 1.4 matt uba_intr_establish(ua->ua_icookie, ua->ua_cvec,
224 1.4 matt rlcintr, sc, &sc->sc_intrcnt);
225 1.5 matt evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
226 1.38 matt device_xname(sc->sc_dev), "intr");
227 1.11 ragge uba_reset_establish(rlcreset, self);
228 1.11 ragge
229 1.1 ragge printf("\n");
230 1.1 ragge
231 1.1 ragge /*
232 1.24 simonb * The RL11 can only have one transfer going at a time,
233 1.1 ragge * and max transfer size is one track, so only one dmamap
234 1.1 ragge * is needed.
235 1.1 ragge */
236 1.1 ragge error = bus_dmamap_create(sc->sc_dmat, MAXRLXFER, 1, MAXRLXFER, 0,
237 1.1 ragge BUS_DMA_ALLOCNOW, &sc->sc_dmam);
238 1.1 ragge if (error) {
239 1.38 matt aprint_error(": Failed to allocate DMA map, error %d\n", error);
240 1.1 ragge return;
241 1.1 ragge }
242 1.26 yamt bufq_alloc(&sc->sc_q, "disksort", BUFQ_SORT_CYLINDER);
243 1.1 ragge for (i = 0; i < RL_MAXDPC; i++) {
244 1.1 ragge waitcrdy(sc);
245 1.1 ragge RL_WREG(RL_DA, RLDA_GS|RLDA_RST);
246 1.1 ragge RL_WREG(RL_CS, RLCS_GS|(i << RLCS_USHFT));
247 1.1 ragge waitcrdy(sc);
248 1.1 ragge ra.type = RL_RREG(RL_MP);
249 1.1 ragge ra.hwid = i;
250 1.1 ragge if ((RL_RREG(RL_CS) & RLCS_ERR) == 0)
251 1.38 matt config_found(sc->sc_dev, &ra, rlcprint);
252 1.1 ragge }
253 1.1 ragge }
254 1.1 ragge
255 1.1 ragge int
256 1.38 matt rlmatch(device_t parent, cfdata_t cf, void *aux)
257 1.1 ragge {
258 1.1 ragge struct rlc_attach_args *ra = aux;
259 1.1 ragge
260 1.1 ragge if (cf->cf_loc[RLCCF_DRIVE] != RLCCF_DRIVE_DEFAULT &&
261 1.1 ragge cf->cf_loc[RLCCF_DRIVE] != ra->hwid)
262 1.1 ragge return 0;
263 1.1 ragge return 1;
264 1.1 ragge }
265 1.1 ragge
266 1.1 ragge void
267 1.38 matt rlattach(device_t parent, device_t self, void *aux)
268 1.1 ragge {
269 1.30 thorpej struct rl_softc *rc = device_private(self);
270 1.1 ragge struct rlc_attach_args *ra = aux;
271 1.1 ragge struct disklabel *dl;
272 1.1 ragge
273 1.38 matt rc->rc_dev = self;
274 1.38 matt rc->rc_rlc = device_private(parent);
275 1.1 ragge rc->rc_hwid = ra->hwid;
276 1.38 matt disk_init(&rc->rc_disk, device_xname(rc->rc_dev), &rldkdriver);
277 1.1 ragge disk_attach(&rc->rc_disk);
278 1.1 ragge dl = rc->rc_disk.dk_label;
279 1.1 ragge dl->d_npartitions = 3;
280 1.1 ragge strcpy(dl->d_typename, "RL01");
281 1.1 ragge if (ra->type & RLMP_DT)
282 1.1 ragge dl->d_typename[3] = '2';
283 1.1 ragge dl->d_secsize = DEV_BSIZE; /* XXX - wrong, but OK for now */
284 1.1 ragge dl->d_nsectors = RL_SPT/2;
285 1.1 ragge dl->d_ntracks = RL_SPD;
286 1.1 ragge dl->d_ncylinders = ra->type & RLMP_DT ? RL_TPS02 : RL_TPS01;
287 1.1 ragge dl->d_secpercyl = dl->d_nsectors * dl->d_ntracks;
288 1.1 ragge dl->d_secperunit = dl->d_ncylinders * dl->d_secpercyl;
289 1.1 ragge dl->d_partitions[0].p_size = dl->d_partitions[2].p_size =
290 1.1 ragge dl->d_secperunit;
291 1.1 ragge dl->d_partitions[0].p_offset = dl->d_partitions[2].p_offset = 0;
292 1.1 ragge dl->d_interleave = dl->d_headswitch = 1;
293 1.1 ragge dl->d_bbsize = BBSIZE;
294 1.19 he dl->d_sbsize = SBLOCKSIZE;
295 1.1 ragge dl->d_rpm = 2400;
296 1.1 ragge dl->d_type = DTYPE_DEC;
297 1.38 matt printf(": %s, %s\n", dl->d_typename, rlstate(rc->rc_rlc, ra->hwid));
298 1.22 thorpej
299 1.22 thorpej /*
300 1.22 thorpej * XXX We should try to discovery wedges here, but
301 1.22 thorpej * XXX that would mean loading up the pack and being
302 1.22 thorpej * XXX able to do I/O. Should use config_defer() here.
303 1.22 thorpej */
304 1.1 ragge }
305 1.1 ragge
306 1.1 ragge int
307 1.27 christos rlopen(dev_t dev, int flag, int fmt, struct lwp *l)
308 1.1 ragge {
309 1.38 matt struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
310 1.38 matt struct rlc_softc *sc;
311 1.38 matt int error, part, mask;
312 1.1 ragge struct disklabel *dl;
313 1.20 dsl const char *msg;
314 1.11 ragge
315 1.1 ragge /*
316 1.1 ragge * Make sure this is a reasonable open request.
317 1.1 ragge */
318 1.38 matt if (rc == NULL)
319 1.1 ragge return ENXIO;
320 1.1 ragge
321 1.38 matt sc = rc->rc_rlc;
322 1.22 thorpej part = DISKPART(dev);
323 1.22 thorpej
324 1.34 ad mutex_enter(&rc->rc_disk.dk_openlock);
325 1.22 thorpej
326 1.22 thorpej /*
327 1.22 thorpej * If there are wedges, and this is not RAW_PART, then we
328 1.22 thorpej * need to fail.
329 1.22 thorpej */
330 1.22 thorpej if (rc->rc_disk.dk_nwedges != 0 && part != RAW_PART) {
331 1.22 thorpej error = EBUSY;
332 1.22 thorpej goto bad1;
333 1.22 thorpej }
334 1.22 thorpej
335 1.11 ragge /* Check that the disk actually is useable */
336 1.11 ragge msg = rlstate(sc, rc->rc_hwid);
337 1.11 ragge if (msg == NULL || msg == rlstates[RLMP_UNLOAD] ||
338 1.22 thorpej msg == rlstates[RLMP_SPUNDOWN]) {
339 1.22 thorpej error = ENXIO;
340 1.22 thorpej goto bad1;
341 1.22 thorpej }
342 1.1 ragge /*
343 1.1 ragge * If this is the first open; read in where on the disk we are.
344 1.1 ragge */
345 1.1 ragge dl = rc->rc_disk.dk_label;
346 1.1 ragge if (rc->rc_state == DK_CLOSED) {
347 1.1 ragge u_int16_t mp;
348 1.13 gehenna int maj;
349 1.1 ragge RL_WREG(RL_CS, RLCS_RHDR|(rc->rc_hwid << RLCS_USHFT));
350 1.1 ragge waitcrdy(sc);
351 1.1 ragge mp = RL_RREG(RL_MP);
352 1.1 ragge rc->rc_head = ((mp & RLMP_HS) == RLMP_HS);
353 1.1 ragge rc->rc_cyl = (mp >> 7) & 0777;
354 1.1 ragge rc->rc_state = DK_OPEN;
355 1.1 ragge /* Get disk label */
356 1.13 gehenna maj = cdevsw_lookup_major(&rl_cdevsw);
357 1.13 gehenna if ((msg = readdisklabel(MAKEDISKDEV(maj,
358 1.38 matt device_unit(rc->rc_dev), RAW_PART), rlstrategy, dl, NULL)))
359 1.38 matt aprint_normal_dev(rc->rc_dev, "%s", msg);
360 1.38 matt aprint_normal_dev(rc->rc_dev, "size %d sectors\n",
361 1.38 matt dl->d_secperunit);
362 1.1 ragge }
363 1.22 thorpej if (part >= dl->d_npartitions) {
364 1.22 thorpej error = ENXIO;
365 1.22 thorpej goto bad1;
366 1.22 thorpej }
367 1.1 ragge
368 1.1 ragge mask = 1 << part;
369 1.1 ragge switch (fmt) {
370 1.1 ragge case S_IFCHR:
371 1.1 ragge rc->rc_disk.dk_copenmask |= mask;
372 1.1 ragge break;
373 1.1 ragge case S_IFBLK:
374 1.1 ragge rc->rc_disk.dk_bopenmask |= mask;
375 1.1 ragge break;
376 1.1 ragge }
377 1.1 ragge rc->rc_disk.dk_openmask |= mask;
378 1.34 ad error = 0;
379 1.22 thorpej bad1:
380 1.34 ad mutex_exit(&rc->rc_disk.dk_openlock);
381 1.22 thorpej return (error);
382 1.1 ragge }
383 1.1 ragge
384 1.1 ragge int
385 1.27 christos rlclose(dev_t dev, int flag, int fmt, struct lwp *l)
386 1.1 ragge {
387 1.34 ad int unit = DISKUNIT(dev);
388 1.39 drochner struct rl_softc *rc = device_lookup_private(&rl_cd, unit);
389 1.1 ragge int mask = (1 << DISKPART(dev));
390 1.1 ragge
391 1.34 ad mutex_enter(&rc->rc_disk.dk_openlock);
392 1.22 thorpej
393 1.1 ragge switch (fmt) {
394 1.1 ragge case S_IFCHR:
395 1.1 ragge rc->rc_disk.dk_copenmask &= ~mask;
396 1.1 ragge break;
397 1.1 ragge case S_IFBLK:
398 1.1 ragge rc->rc_disk.dk_bopenmask &= ~mask;
399 1.1 ragge break;
400 1.1 ragge }
401 1.1 ragge rc->rc_disk.dk_openmask =
402 1.1 ragge rc->rc_disk.dk_copenmask | rc->rc_disk.dk_bopenmask;
403 1.1 ragge
404 1.1 ragge if (rc->rc_disk.dk_openmask == 0)
405 1.1 ragge rc->rc_state = DK_CLOSED; /* May change pack */
406 1.34 ad mutex_exit(&rc->rc_disk.dk_openlock);
407 1.1 ragge return 0;
408 1.1 ragge }
409 1.1 ragge
410 1.1 ragge void
411 1.1 ragge rlstrategy(struct buf *bp)
412 1.1 ragge {
413 1.38 matt struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(bp->b_dev));
414 1.1 ragge struct disklabel *lp;
415 1.38 matt int s;
416 1.38 matt
417 1.38 matt if (rc == NULL || rc->rc_state != DK_OPEN) /* How did we end up here at all? */
418 1.1 ragge panic("rlstrategy: state impossible");
419 1.1 ragge
420 1.1 ragge lp = rc->rc_disk.dk_label;
421 1.38 matt if (bounds_check_with_label(&rc->rc_disk, bp, 1) <= 0)
422 1.1 ragge goto done;
423 1.1 ragge
424 1.1 ragge if (bp->b_bcount == 0)
425 1.1 ragge goto done;
426 1.1 ragge
427 1.1 ragge bp->b_rawblkno =
428 1.1 ragge bp->b_blkno + lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
429 1.1 ragge bp->b_cylinder = bp->b_rawblkno / lp->d_secpercyl;
430 1.1 ragge
431 1.8 thorpej s = splbio();
432 1.40 yamt bufq_put(rc->rc_rlc->sc_q, bp);
433 1.38 matt rlcstart(rc->rc_rlc, 0);
434 1.1 ragge splx(s);
435 1.1 ragge return;
436 1.1 ragge
437 1.1 ragge done: biodone(bp);
438 1.1 ragge }
439 1.1 ragge
440 1.1 ragge int
441 1.31 christos rlioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
442 1.1 ragge {
443 1.39 drochner struct rl_softc *rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
444 1.1 ragge struct disklabel *lp = rc->rc_disk.dk_label;
445 1.1 ragge int err = 0;
446 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
447 1.6 fvdl struct disklabel newlabel;
448 1.6 fvdl #endif
449 1.1 ragge
450 1.1 ragge switch (cmd) {
451 1.1 ragge case DIOCGDINFO:
452 1.42 tsutsui memcpy(addr, lp, sizeof (struct disklabel));
453 1.1 ragge break;
454 1.1 ragge
455 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
456 1.6 fvdl case ODIOCGDINFO:
457 1.6 fvdl newlabel = *lp;
458 1.6 fvdl if (newlabel.d_npartitions > OLDMAXPARTITIONS)
459 1.7 fvdl return ENOTTY;
460 1.42 tsutsui memcpy(addr, &newlabel, sizeof (struct olddisklabel));
461 1.6 fvdl break;
462 1.6 fvdl #endif
463 1.6 fvdl
464 1.1 ragge case DIOCGPART:
465 1.1 ragge ((struct partinfo *)addr)->disklab = lp;
466 1.1 ragge ((struct partinfo *)addr)->part =
467 1.1 ragge &lp->d_partitions[DISKPART(dev)];
468 1.1 ragge break;
469 1.1 ragge
470 1.1 ragge case DIOCSDINFO:
471 1.1 ragge case DIOCWDINFO:
472 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
473 1.6 fvdl case ODIOCWDINFO:
474 1.6 fvdl case ODIOCSDINFO:
475 1.6 fvdl #endif
476 1.6 fvdl {
477 1.6 fvdl struct disklabel *tp;
478 1.6 fvdl
479 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
480 1.6 fvdl if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
481 1.6 fvdl memset(&newlabel, 0, sizeof newlabel);
482 1.6 fvdl memcpy(&newlabel, addr, sizeof (struct olddisklabel));
483 1.6 fvdl tp = &newlabel;
484 1.6 fvdl } else
485 1.6 fvdl #endif
486 1.6 fvdl tp = (struct disklabel *)addr;
487 1.6 fvdl
488 1.1 ragge if ((flag & FWRITE) == 0)
489 1.1 ragge err = EBADF;
490 1.22 thorpej else {
491 1.34 ad mutex_enter(&rc->rc_disk.dk_openlock);
492 1.6 fvdl err = ((
493 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
494 1.6 fvdl cmd == ODIOCSDINFO ||
495 1.6 fvdl #endif
496 1.6 fvdl cmd == DIOCSDINFO) ?
497 1.6 fvdl setdisklabel(lp, tp, 0, 0) :
498 1.1 ragge writedisklabel(dev, rlstrategy, lp, 0));
499 1.34 ad mutex_exit(&rc->rc_disk.dk_openlock);
500 1.22 thorpej }
501 1.1 ragge break;
502 1.6 fvdl }
503 1.1 ragge
504 1.1 ragge case DIOCWLABEL:
505 1.1 ragge if ((flag & FWRITE) == 0)
506 1.1 ragge err = EBADF;
507 1.1 ragge break;
508 1.1 ragge
509 1.38 matt case DIOCAWEDGE: {
510 1.24 simonb struct dkwedge_info *dkw = (void *) addr;
511 1.22 thorpej
512 1.22 thorpej if ((flag & FWRITE) == 0)
513 1.22 thorpej return (EBADF);
514 1.22 thorpej
515 1.22 thorpej /* If the ioctl happens here, the parent is us. */
516 1.38 matt strcpy(dkw->dkw_parent, device_xname(rc->rc_dev));
517 1.38 matt return dkwedge_add(dkw);
518 1.38 matt }
519 1.24 simonb
520 1.38 matt case DIOCDWEDGE: {
521 1.24 simonb struct dkwedge_info *dkw = (void *) addr;
522 1.22 thorpej
523 1.22 thorpej if ((flag & FWRITE) == 0)
524 1.22 thorpej return (EBADF);
525 1.22 thorpej
526 1.22 thorpej /* If the ioctl happens here, the parent is us. */
527 1.38 matt strcpy(dkw->dkw_parent, device_xname(rc->rc_dev));
528 1.38 matt return dkwedge_del(dkw);
529 1.38 matt }
530 1.24 simonb
531 1.38 matt case DIOCLWEDGES: {
532 1.24 simonb struct dkwedge_list *dkwl = (void *) addr;
533 1.22 thorpej
534 1.38 matt return dkwedge_list(&rc->rc_disk, dkwl, l);
535 1.38 matt }
536 1.22 thorpej
537 1.1 ragge default:
538 1.1 ragge err = ENOTTY;
539 1.38 matt break;
540 1.1 ragge }
541 1.1 ragge return err;
542 1.1 ragge }
543 1.1 ragge
544 1.1 ragge int
545 1.38 matt rlpsize(dev_t dev)
546 1.1 ragge {
547 1.38 matt struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
548 1.1 ragge struct disklabel *dl;
549 1.38 matt int size;
550 1.1 ragge
551 1.38 matt if (rc == NULL)
552 1.1 ragge return -1;
553 1.1 ragge dl = rc->rc_disk.dk_label;
554 1.1 ragge size = dl->d_partitions[DISKPART(dev)].p_size *
555 1.1 ragge (dl->d_secsize / DEV_BSIZE);
556 1.1 ragge return size;
557 1.1 ragge }
558 1.1 ragge
559 1.1 ragge int
560 1.31 christos rldump(dev_t dev, daddr_t blkno, void *va, size_t size)
561 1.1 ragge {
562 1.1 ragge /* Not likely... */
563 1.1 ragge return 0;
564 1.1 ragge }
565 1.1 ragge
566 1.1 ragge int
567 1.1 ragge rlread(dev_t dev, struct uio *uio, int ioflag)
568 1.1 ragge {
569 1.1 ragge return (physio(rlstrategy, NULL, dev, B_READ, minphys, uio));
570 1.1 ragge }
571 1.1 ragge
572 1.1 ragge int
573 1.1 ragge rlwrite(dev_t dev, struct uio *uio, int ioflag)
574 1.1 ragge {
575 1.1 ragge return (physio(rlstrategy, NULL, dev, B_WRITE, minphys, uio));
576 1.1 ragge }
577 1.1 ragge
578 1.38 matt static const char * const rlerr[] = {
579 1.1 ragge "no",
580 1.1 ragge "operation incomplete",
581 1.1 ragge "read data CRC",
582 1.1 ragge "header CRC",
583 1.1 ragge "data late",
584 1.1 ragge "header not found",
585 1.1 ragge "",
586 1.1 ragge "",
587 1.9 wiz "non-existent memory",
588 1.1 ragge "memory parity error",
589 1.1 ragge "",
590 1.1 ragge "",
591 1.1 ragge "",
592 1.1 ragge "",
593 1.1 ragge "",
594 1.1 ragge "",
595 1.1 ragge };
596 1.1 ragge
597 1.1 ragge void
598 1.1 ragge rlcintr(void *arg)
599 1.1 ragge {
600 1.1 ragge struct rlc_softc *sc = arg;
601 1.1 ragge struct buf *bp;
602 1.1 ragge u_int16_t cs;
603 1.1 ragge
604 1.1 ragge bp = sc->sc_active;
605 1.1 ragge if (bp == 0) {
606 1.38 matt aprint_error_dev(sc->sc_dev, "strange interrupt\n");
607 1.1 ragge return;
608 1.1 ragge }
609 1.1 ragge bus_dmamap_unload(sc->sc_dmat, sc->sc_dmam);
610 1.1 ragge sc->sc_active = 0;
611 1.1 ragge cs = RL_RREG(RL_CS);
612 1.1 ragge if (cs & RLCS_ERR) {
613 1.1 ragge int error = (cs & RLCS_ERRMSK) >> 10;
614 1.1 ragge
615 1.38 matt aprint_error_dev(sc->sc_dev, "%s\n", rlerr[error]);
616 1.1 ragge bp->b_error = EIO;
617 1.1 ragge bp->b_resid = bp->b_bcount;
618 1.1 ragge sc->sc_bytecnt = 0;
619 1.1 ragge }
620 1.1 ragge if (sc->sc_bytecnt == 0) /* Finished transfer */
621 1.1 ragge biodone(bp);
622 1.1 ragge rlcstart(sc, sc->sc_bytecnt ? bp : 0);
623 1.1 ragge }
624 1.1 ragge
625 1.1 ragge /*
626 1.24 simonb * Start routine. First position the disk to the given position,
627 1.1 ragge * then start reading/writing. An optimization would be to be able
628 1.1 ragge * to handle overlapping seeks between disks.
629 1.1 ragge */
630 1.1 ragge void
631 1.1 ragge rlcstart(struct rlc_softc *sc, struct buf *ob)
632 1.1 ragge {
633 1.1 ragge struct disklabel *lp;
634 1.1 ragge struct rl_softc *rc;
635 1.1 ragge struct buf *bp;
636 1.1 ragge int bn, cn, sn, tn, blks, err;
637 1.1 ragge
638 1.1 ragge if (sc->sc_active)
639 1.1 ragge return; /* Already doing something */
640 1.1 ragge
641 1.1 ragge if (ob == 0) {
642 1.40 yamt bp = bufq_get(sc->sc_q);
643 1.1 ragge if (bp == NULL)
644 1.1 ragge return; /* Nothing to do */
645 1.3 thorpej sc->sc_bufaddr = bp->b_data;
646 1.1 ragge sc->sc_diskblk = bp->b_rawblkno;
647 1.1 ragge sc->sc_bytecnt = bp->b_bcount;
648 1.1 ragge bp->b_resid = 0;
649 1.1 ragge } else
650 1.1 ragge bp = ob;
651 1.1 ragge sc->sc_active = bp;
652 1.1 ragge
653 1.39 drochner rc = device_lookup_private(&rl_cd, DISKUNIT(bp->b_dev));
654 1.1 ragge bn = sc->sc_diskblk;
655 1.1 ragge lp = rc->rc_disk.dk_label;
656 1.1 ragge if (bn) {
657 1.1 ragge cn = bn / lp->d_secpercyl;
658 1.1 ragge sn = bn % lp->d_secpercyl;
659 1.1 ragge tn = sn / lp->d_nsectors;
660 1.1 ragge sn = sn % lp->d_nsectors;
661 1.1 ragge } else
662 1.1 ragge cn = sn = tn = 0;
663 1.1 ragge
664 1.1 ragge /*
665 1.1 ragge * Check if we have to position disk first.
666 1.1 ragge */
667 1.1 ragge if (rc->rc_cyl != cn || rc->rc_head != tn) {
668 1.1 ragge u_int16_t da = RLDA_SEEK;
669 1.1 ragge if (cn > rc->rc_cyl)
670 1.1 ragge da |= ((cn - rc->rc_cyl) << RLDA_CYLSHFT) | RLDA_DIR;
671 1.1 ragge else
672 1.1 ragge da |= ((rc->rc_cyl - cn) << RLDA_CYLSHFT);
673 1.1 ragge if (tn)
674 1.1 ragge da |= RLDA_HSSEEK;
675 1.1 ragge waitcrdy(sc);
676 1.1 ragge RL_WREG(RL_DA, da);
677 1.1 ragge RL_WREG(RL_CS, RLCS_SEEK | (rc->rc_hwid << RLCS_USHFT));
678 1.1 ragge waitcrdy(sc);
679 1.1 ragge rc->rc_cyl = cn;
680 1.1 ragge rc->rc_head = tn;
681 1.1 ragge }
682 1.1 ragge RL_WREG(RL_DA, (cn << RLDA_CYLSHFT) | (tn ? RLDA_HSRW : 0) | (sn << 1));
683 1.1 ragge blks = sc->sc_bytecnt/DEV_BSIZE;
684 1.1 ragge
685 1.1 ragge if (sn + blks > RL_SPT/2)
686 1.1 ragge blks = RL_SPT/2 - sn;
687 1.1 ragge RL_WREG(RL_MP, -(blks*DEV_BSIZE)/2);
688 1.1 ragge err = bus_dmamap_load(sc->sc_dmat, sc->sc_dmam, sc->sc_bufaddr,
689 1.11 ragge (blks*DEV_BSIZE), (bp->b_flags & B_PHYS ? bp->b_proc : 0),
690 1.11 ragge BUS_DMA_NOWAIT);
691 1.1 ragge if (err)
692 1.1 ragge panic("%s: bus_dmamap_load failed: %d",
693 1.38 matt device_xname(sc->sc_dev), err);
694 1.1 ragge RL_WREG(RL_BA, (sc->sc_dmam->dm_segs[0].ds_addr & 0xffff));
695 1.1 ragge
696 1.1 ragge /* Count up vars */
697 1.33 christos sc->sc_bufaddr = (char *)sc->sc_bufaddr + (blks*DEV_BSIZE);
698 1.1 ragge sc->sc_diskblk += blks;
699 1.1 ragge sc->sc_bytecnt -= (blks*DEV_BSIZE);
700 1.1 ragge
701 1.1 ragge if (bp->b_flags & B_READ)
702 1.1 ragge RL_WREG(RL_CS, RLCS_IE|RLCS_RD|(rc->rc_hwid << RLCS_USHFT));
703 1.1 ragge else
704 1.1 ragge RL_WREG(RL_CS, RLCS_IE|RLCS_WD|(rc->rc_hwid << RLCS_USHFT));
705 1.2 ragge }
706 1.2 ragge
707 1.11 ragge /*
708 1.11 ragge * Called once per controller when an ubareset occurs.
709 1.11 ragge * Retracts all disks and restarts active transfers.
710 1.11 ragge */
711 1.2 ragge void
712 1.38 matt rlcreset(device_t dev)
713 1.2 ragge {
714 1.38 matt struct rlc_softc *sc = device_private(dev);
715 1.11 ragge struct rl_softc *rc;
716 1.11 ragge int i;
717 1.2 ragge u_int16_t mp;
718 1.2 ragge
719 1.11 ragge for (i = 0; i < rl_cd.cd_ndevs; i++) {
720 1.38 matt if ((rc = device_lookup_private(&rl_cd, i)) == NULL)
721 1.11 ragge continue;
722 1.11 ragge if (rc->rc_state != DK_OPEN)
723 1.11 ragge continue;
724 1.38 matt if (rc->rc_rlc != sc)
725 1.38 matt continue;
726 1.11 ragge
727 1.11 ragge RL_WREG(RL_CS, RLCS_RHDR|(rc->rc_hwid << RLCS_USHFT));
728 1.11 ragge waitcrdy(sc);
729 1.11 ragge mp = RL_RREG(RL_MP);
730 1.11 ragge rc->rc_head = ((mp & RLMP_HS) == RLMP_HS);
731 1.11 ragge rc->rc_cyl = (mp >> 7) & 0777;
732 1.11 ragge }
733 1.2 ragge if (sc->sc_active == 0)
734 1.2 ragge return;
735 1.2 ragge
736 1.40 yamt bufq_put(sc->sc_q, sc->sc_active);
737 1.2 ragge sc->sc_active = 0;
738 1.2 ragge rlcstart(sc, 0);
739 1.1 ragge }
740