rl.c revision 1.39 1 1.39 drochner /* $NetBSD: rl.c,v 1.39 2008/06/11 17:27:59 drochner 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.39 drochner __KERNEL_RCSID(0, "$NetBSD: rl.c,v 1.39 2008/06/11 17:27:59 drochner 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.38 matt rlopen, rlclose, rlstrategy, rlioctl, rldump, rlpsize, D_DISK
100 1.13 gehenna };
101 1.13 gehenna
102 1.13 gehenna const struct cdevsw rl_cdevsw = {
103 1.13 gehenna rlopen, rlclose, rlread, rlwrite, rlioctl,
104 1.17 jdolecek nostop, notty, nopoll, nommap, nokqfilter, D_DISK
105 1.13 gehenna };
106 1.13 gehenna
107 1.1 ragge #define MAXRLXFER (RL_BPS * RL_SPT)
108 1.1 ragge
109 1.1 ragge #define RL_WREG(reg, val) \
110 1.1 ragge bus_space_write_2(sc->sc_iot, sc->sc_ioh, (reg), (val))
111 1.1 ragge #define RL_RREG(reg) \
112 1.1 ragge bus_space_read_2(sc->sc_iot, sc->sc_ioh, (reg))
113 1.1 ragge
114 1.38 matt static const char * const rlstates[] = {
115 1.11 ragge "drive not loaded",
116 1.11 ragge "drive spinning up",
117 1.11 ragge "drive brushes out",
118 1.11 ragge "drive loading heads",
119 1.11 ragge "drive seeking",
120 1.11 ragge "drive ready",
121 1.11 ragge "drive unloading heads",
122 1.11 ragge "drive spun down",
123 1.11 ragge };
124 1.11 ragge
125 1.38 matt static const struct dkdriver rldkdriver = {
126 1.22 thorpej rlstrategy, minphys
127 1.22 thorpej };
128 1.22 thorpej
129 1.25 ragge static const char *
130 1.11 ragge rlstate(struct rlc_softc *sc, int unit)
131 1.11 ragge {
132 1.11 ragge int i = 0;
133 1.11 ragge
134 1.11 ragge do {
135 1.11 ragge RL_WREG(RL_DA, RLDA_GS);
136 1.11 ragge RL_WREG(RL_CS, RLCS_GS|(unit << RLCS_USHFT));
137 1.11 ragge waitcrdy(sc);
138 1.11 ragge } while (((RL_RREG(RL_CS) & RLCS_ERR) != 0) && i++ < 10);
139 1.11 ragge if (i == 10)
140 1.11 ragge return NULL;
141 1.11 ragge i = RL_RREG(RL_MP) & RLMP_STATUS;
142 1.11 ragge return rlstates[i];
143 1.11 ragge }
144 1.11 ragge
145 1.1 ragge void
146 1.1 ragge waitcrdy(struct rlc_softc *sc)
147 1.1 ragge {
148 1.1 ragge int i;
149 1.1 ragge
150 1.1 ragge for (i = 0; i < 1000; i++) {
151 1.1 ragge DELAY(10000);
152 1.1 ragge if (RL_RREG(RL_CS) & RLCS_CRDY)
153 1.1 ragge return;
154 1.1 ragge }
155 1.38 matt aprint_error_dev(sc->sc_dev, "never got ready\n"); /* ?panic? */
156 1.1 ragge }
157 1.1 ragge
158 1.1 ragge int
159 1.1 ragge rlcprint(void *aux, const char *name)
160 1.1 ragge {
161 1.1 ragge struct rlc_attach_args *ra = aux;
162 1.1 ragge
163 1.1 ragge if (name)
164 1.18 thorpej aprint_normal("RL0%d at %s",
165 1.18 thorpej ra->type & RLMP_DT ? '2' : '1', name);
166 1.18 thorpej aprint_normal(" drive %d", ra->hwid);
167 1.1 ragge return UNCONF;
168 1.1 ragge }
169 1.1 ragge
170 1.1 ragge /*
171 1.1 ragge * Force the controller to interrupt.
172 1.1 ragge */
173 1.1 ragge int
174 1.38 matt rlcmatch(device_t parent, cfdata_t cf, void *aux)
175 1.1 ragge {
176 1.1 ragge struct uba_attach_args *ua = aux;
177 1.1 ragge struct rlc_softc ssc, *sc = &ssc;
178 1.1 ragge int i;
179 1.1 ragge
180 1.1 ragge sc->sc_iot = ua->ua_iot;
181 1.1 ragge sc->sc_ioh = ua->ua_ioh;
182 1.1 ragge /* Force interrupt by issuing a "Get Status" command */
183 1.1 ragge RL_WREG(RL_DA, RLDA_GS);
184 1.1 ragge RL_WREG(RL_CS, RLCS_GS|RLCS_IE);
185 1.1 ragge
186 1.1 ragge for (i = 0; i < 100; i++) {
187 1.1 ragge DELAY(100000);
188 1.1 ragge if (RL_RREG(RL_CS) & RLCS_CRDY)
189 1.1 ragge return 1;
190 1.1 ragge }
191 1.1 ragge return 0;
192 1.1 ragge }
193 1.1 ragge
194 1.1 ragge void
195 1.38 matt rlcattach(device_t parent, device_t self, void *aux)
196 1.1 ragge {
197 1.30 thorpej struct rlc_softc *sc = device_private(self);
198 1.1 ragge struct uba_attach_args *ua = aux;
199 1.1 ragge struct rlc_attach_args ra;
200 1.1 ragge int i, error;
201 1.1 ragge
202 1.38 matt sc->sc_dev = self;
203 1.38 matt sc->sc_uh = device_private(parent);
204 1.1 ragge sc->sc_iot = ua->ua_iot;
205 1.1 ragge sc->sc_ioh = ua->ua_ioh;
206 1.1 ragge sc->sc_dmat = ua->ua_dmat;
207 1.4 matt uba_intr_establish(ua->ua_icookie, ua->ua_cvec,
208 1.4 matt rlcintr, sc, &sc->sc_intrcnt);
209 1.5 matt evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, ua->ua_evcnt,
210 1.38 matt device_xname(sc->sc_dev), "intr");
211 1.11 ragge uba_reset_establish(rlcreset, self);
212 1.11 ragge
213 1.1 ragge printf("\n");
214 1.1 ragge
215 1.1 ragge /*
216 1.24 simonb * The RL11 can only have one transfer going at a time,
217 1.1 ragge * and max transfer size is one track, so only one dmamap
218 1.1 ragge * is needed.
219 1.1 ragge */
220 1.1 ragge error = bus_dmamap_create(sc->sc_dmat, MAXRLXFER, 1, MAXRLXFER, 0,
221 1.1 ragge BUS_DMA_ALLOCNOW, &sc->sc_dmam);
222 1.1 ragge if (error) {
223 1.38 matt aprint_error(": Failed to allocate DMA map, error %d\n", error);
224 1.1 ragge return;
225 1.1 ragge }
226 1.26 yamt bufq_alloc(&sc->sc_q, "disksort", BUFQ_SORT_CYLINDER);
227 1.1 ragge for (i = 0; i < RL_MAXDPC; i++) {
228 1.1 ragge waitcrdy(sc);
229 1.1 ragge RL_WREG(RL_DA, RLDA_GS|RLDA_RST);
230 1.1 ragge RL_WREG(RL_CS, RLCS_GS|(i << RLCS_USHFT));
231 1.1 ragge waitcrdy(sc);
232 1.1 ragge ra.type = RL_RREG(RL_MP);
233 1.1 ragge ra.hwid = i;
234 1.1 ragge if ((RL_RREG(RL_CS) & RLCS_ERR) == 0)
235 1.38 matt config_found(sc->sc_dev, &ra, rlcprint);
236 1.1 ragge }
237 1.1 ragge }
238 1.1 ragge
239 1.1 ragge int
240 1.38 matt rlmatch(device_t parent, cfdata_t cf, void *aux)
241 1.1 ragge {
242 1.1 ragge struct rlc_attach_args *ra = aux;
243 1.1 ragge
244 1.1 ragge if (cf->cf_loc[RLCCF_DRIVE] != RLCCF_DRIVE_DEFAULT &&
245 1.1 ragge cf->cf_loc[RLCCF_DRIVE] != ra->hwid)
246 1.1 ragge return 0;
247 1.1 ragge return 1;
248 1.1 ragge }
249 1.1 ragge
250 1.1 ragge void
251 1.38 matt rlattach(device_t parent, device_t self, void *aux)
252 1.1 ragge {
253 1.30 thorpej struct rl_softc *rc = device_private(self);
254 1.1 ragge struct rlc_attach_args *ra = aux;
255 1.1 ragge struct disklabel *dl;
256 1.1 ragge
257 1.38 matt rc->rc_dev = self;
258 1.38 matt rc->rc_rlc = device_private(parent);
259 1.1 ragge rc->rc_hwid = ra->hwid;
260 1.38 matt disk_init(&rc->rc_disk, device_xname(rc->rc_dev), &rldkdriver);
261 1.1 ragge disk_attach(&rc->rc_disk);
262 1.1 ragge dl = rc->rc_disk.dk_label;
263 1.1 ragge dl->d_npartitions = 3;
264 1.1 ragge strcpy(dl->d_typename, "RL01");
265 1.1 ragge if (ra->type & RLMP_DT)
266 1.1 ragge dl->d_typename[3] = '2';
267 1.1 ragge dl->d_secsize = DEV_BSIZE; /* XXX - wrong, but OK for now */
268 1.1 ragge dl->d_nsectors = RL_SPT/2;
269 1.1 ragge dl->d_ntracks = RL_SPD;
270 1.1 ragge dl->d_ncylinders = ra->type & RLMP_DT ? RL_TPS02 : RL_TPS01;
271 1.1 ragge dl->d_secpercyl = dl->d_nsectors * dl->d_ntracks;
272 1.1 ragge dl->d_secperunit = dl->d_ncylinders * dl->d_secpercyl;
273 1.1 ragge dl->d_partitions[0].p_size = dl->d_partitions[2].p_size =
274 1.1 ragge dl->d_secperunit;
275 1.1 ragge dl->d_partitions[0].p_offset = dl->d_partitions[2].p_offset = 0;
276 1.1 ragge dl->d_interleave = dl->d_headswitch = 1;
277 1.1 ragge dl->d_bbsize = BBSIZE;
278 1.19 he dl->d_sbsize = SBLOCKSIZE;
279 1.1 ragge dl->d_rpm = 2400;
280 1.1 ragge dl->d_type = DTYPE_DEC;
281 1.38 matt printf(": %s, %s\n", dl->d_typename, rlstate(rc->rc_rlc, ra->hwid));
282 1.22 thorpej
283 1.22 thorpej /*
284 1.22 thorpej * XXX We should try to discovery wedges here, but
285 1.22 thorpej * XXX that would mean loading up the pack and being
286 1.22 thorpej * XXX able to do I/O. Should use config_defer() here.
287 1.22 thorpej */
288 1.1 ragge }
289 1.1 ragge
290 1.1 ragge int
291 1.27 christos rlopen(dev_t dev, int flag, int fmt, struct lwp *l)
292 1.1 ragge {
293 1.38 matt struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
294 1.38 matt struct rlc_softc *sc;
295 1.38 matt int error, part, mask;
296 1.1 ragge struct disklabel *dl;
297 1.20 dsl const char *msg;
298 1.11 ragge
299 1.1 ragge /*
300 1.1 ragge * Make sure this is a reasonable open request.
301 1.1 ragge */
302 1.38 matt if (rc == NULL)
303 1.1 ragge return ENXIO;
304 1.1 ragge
305 1.38 matt sc = rc->rc_rlc;
306 1.22 thorpej part = DISKPART(dev);
307 1.22 thorpej
308 1.34 ad mutex_enter(&rc->rc_disk.dk_openlock);
309 1.22 thorpej
310 1.22 thorpej /*
311 1.22 thorpej * If there are wedges, and this is not RAW_PART, then we
312 1.22 thorpej * need to fail.
313 1.22 thorpej */
314 1.22 thorpej if (rc->rc_disk.dk_nwedges != 0 && part != RAW_PART) {
315 1.22 thorpej error = EBUSY;
316 1.22 thorpej goto bad1;
317 1.22 thorpej }
318 1.22 thorpej
319 1.11 ragge /* Check that the disk actually is useable */
320 1.11 ragge msg = rlstate(sc, rc->rc_hwid);
321 1.11 ragge if (msg == NULL || msg == rlstates[RLMP_UNLOAD] ||
322 1.22 thorpej msg == rlstates[RLMP_SPUNDOWN]) {
323 1.22 thorpej error = ENXIO;
324 1.22 thorpej goto bad1;
325 1.22 thorpej }
326 1.1 ragge /*
327 1.1 ragge * If this is the first open; read in where on the disk we are.
328 1.1 ragge */
329 1.1 ragge dl = rc->rc_disk.dk_label;
330 1.1 ragge if (rc->rc_state == DK_CLOSED) {
331 1.1 ragge u_int16_t mp;
332 1.13 gehenna int maj;
333 1.1 ragge RL_WREG(RL_CS, RLCS_RHDR|(rc->rc_hwid << RLCS_USHFT));
334 1.1 ragge waitcrdy(sc);
335 1.1 ragge mp = RL_RREG(RL_MP);
336 1.1 ragge rc->rc_head = ((mp & RLMP_HS) == RLMP_HS);
337 1.1 ragge rc->rc_cyl = (mp >> 7) & 0777;
338 1.1 ragge rc->rc_state = DK_OPEN;
339 1.1 ragge /* Get disk label */
340 1.13 gehenna maj = cdevsw_lookup_major(&rl_cdevsw);
341 1.13 gehenna if ((msg = readdisklabel(MAKEDISKDEV(maj,
342 1.38 matt device_unit(rc->rc_dev), RAW_PART), rlstrategy, dl, NULL)))
343 1.38 matt aprint_normal_dev(rc->rc_dev, "%s", msg);
344 1.38 matt aprint_normal_dev(rc->rc_dev, "size %d sectors\n",
345 1.38 matt dl->d_secperunit);
346 1.1 ragge }
347 1.22 thorpej if (part >= dl->d_npartitions) {
348 1.22 thorpej error = ENXIO;
349 1.22 thorpej goto bad1;
350 1.22 thorpej }
351 1.1 ragge
352 1.1 ragge mask = 1 << part;
353 1.1 ragge switch (fmt) {
354 1.1 ragge case S_IFCHR:
355 1.1 ragge rc->rc_disk.dk_copenmask |= mask;
356 1.1 ragge break;
357 1.1 ragge case S_IFBLK:
358 1.1 ragge rc->rc_disk.dk_bopenmask |= mask;
359 1.1 ragge break;
360 1.1 ragge }
361 1.1 ragge rc->rc_disk.dk_openmask |= mask;
362 1.34 ad error = 0;
363 1.22 thorpej bad1:
364 1.34 ad mutex_exit(&rc->rc_disk.dk_openlock);
365 1.22 thorpej return (error);
366 1.1 ragge }
367 1.1 ragge
368 1.1 ragge int
369 1.27 christos rlclose(dev_t dev, int flag, int fmt, struct lwp *l)
370 1.1 ragge {
371 1.34 ad int unit = DISKUNIT(dev);
372 1.39 drochner struct rl_softc *rc = device_lookup_private(&rl_cd, unit);
373 1.1 ragge int mask = (1 << DISKPART(dev));
374 1.1 ragge
375 1.34 ad mutex_enter(&rc->rc_disk.dk_openlock);
376 1.22 thorpej
377 1.1 ragge switch (fmt) {
378 1.1 ragge case S_IFCHR:
379 1.1 ragge rc->rc_disk.dk_copenmask &= ~mask;
380 1.1 ragge break;
381 1.1 ragge case S_IFBLK:
382 1.1 ragge rc->rc_disk.dk_bopenmask &= ~mask;
383 1.1 ragge break;
384 1.1 ragge }
385 1.1 ragge rc->rc_disk.dk_openmask =
386 1.1 ragge rc->rc_disk.dk_copenmask | rc->rc_disk.dk_bopenmask;
387 1.1 ragge
388 1.1 ragge if (rc->rc_disk.dk_openmask == 0)
389 1.1 ragge rc->rc_state = DK_CLOSED; /* May change pack */
390 1.34 ad mutex_exit(&rc->rc_disk.dk_openlock);
391 1.1 ragge return 0;
392 1.1 ragge }
393 1.1 ragge
394 1.1 ragge void
395 1.1 ragge rlstrategy(struct buf *bp)
396 1.1 ragge {
397 1.38 matt struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(bp->b_dev));
398 1.1 ragge struct disklabel *lp;
399 1.38 matt int s;
400 1.38 matt
401 1.38 matt if (rc == NULL || rc->rc_state != DK_OPEN) /* How did we end up here at all? */
402 1.1 ragge panic("rlstrategy: state impossible");
403 1.1 ragge
404 1.1 ragge lp = rc->rc_disk.dk_label;
405 1.38 matt if (bounds_check_with_label(&rc->rc_disk, bp, 1) <= 0)
406 1.1 ragge goto done;
407 1.1 ragge
408 1.1 ragge if (bp->b_bcount == 0)
409 1.1 ragge goto done;
410 1.1 ragge
411 1.1 ragge bp->b_rawblkno =
412 1.1 ragge bp->b_blkno + lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
413 1.1 ragge bp->b_cylinder = bp->b_rawblkno / lp->d_secpercyl;
414 1.1 ragge
415 1.8 thorpej s = splbio();
416 1.38 matt BUFQ_PUT(rc->rc_rlc->sc_q, bp);
417 1.38 matt rlcstart(rc->rc_rlc, 0);
418 1.1 ragge splx(s);
419 1.1 ragge return;
420 1.1 ragge
421 1.1 ragge done: biodone(bp);
422 1.1 ragge }
423 1.1 ragge
424 1.1 ragge int
425 1.31 christos rlioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
426 1.1 ragge {
427 1.39 drochner struct rl_softc *rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
428 1.1 ragge struct disklabel *lp = rc->rc_disk.dk_label;
429 1.1 ragge int err = 0;
430 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
431 1.6 fvdl struct disklabel newlabel;
432 1.6 fvdl #endif
433 1.1 ragge
434 1.1 ragge switch (cmd) {
435 1.1 ragge case DIOCGDINFO:
436 1.1 ragge bcopy(lp, addr, sizeof (struct disklabel));
437 1.1 ragge break;
438 1.1 ragge
439 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
440 1.6 fvdl case ODIOCGDINFO:
441 1.6 fvdl newlabel = *lp;
442 1.6 fvdl if (newlabel.d_npartitions > OLDMAXPARTITIONS)
443 1.7 fvdl return ENOTTY;
444 1.6 fvdl bcopy(&newlabel, addr, sizeof (struct olddisklabel));
445 1.6 fvdl break;
446 1.6 fvdl #endif
447 1.6 fvdl
448 1.1 ragge case DIOCGPART:
449 1.1 ragge ((struct partinfo *)addr)->disklab = lp;
450 1.1 ragge ((struct partinfo *)addr)->part =
451 1.1 ragge &lp->d_partitions[DISKPART(dev)];
452 1.1 ragge break;
453 1.1 ragge
454 1.1 ragge case DIOCSDINFO:
455 1.1 ragge case DIOCWDINFO:
456 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
457 1.6 fvdl case ODIOCWDINFO:
458 1.6 fvdl case ODIOCSDINFO:
459 1.6 fvdl #endif
460 1.6 fvdl {
461 1.6 fvdl struct disklabel *tp;
462 1.6 fvdl
463 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
464 1.6 fvdl if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
465 1.6 fvdl memset(&newlabel, 0, sizeof newlabel);
466 1.6 fvdl memcpy(&newlabel, addr, sizeof (struct olddisklabel));
467 1.6 fvdl tp = &newlabel;
468 1.6 fvdl } else
469 1.6 fvdl #endif
470 1.6 fvdl tp = (struct disklabel *)addr;
471 1.6 fvdl
472 1.1 ragge if ((flag & FWRITE) == 0)
473 1.1 ragge err = EBADF;
474 1.22 thorpej else {
475 1.34 ad mutex_enter(&rc->rc_disk.dk_openlock);
476 1.6 fvdl err = ((
477 1.6 fvdl #ifdef __HAVE_OLD_DISKLABEL
478 1.6 fvdl cmd == ODIOCSDINFO ||
479 1.6 fvdl #endif
480 1.6 fvdl cmd == DIOCSDINFO) ?
481 1.6 fvdl setdisklabel(lp, tp, 0, 0) :
482 1.1 ragge writedisklabel(dev, rlstrategy, lp, 0));
483 1.34 ad mutex_exit(&rc->rc_disk.dk_openlock);
484 1.22 thorpej }
485 1.1 ragge break;
486 1.6 fvdl }
487 1.1 ragge
488 1.1 ragge case DIOCWLABEL:
489 1.1 ragge if ((flag & FWRITE) == 0)
490 1.1 ragge err = EBADF;
491 1.1 ragge break;
492 1.1 ragge
493 1.38 matt case DIOCAWEDGE: {
494 1.24 simonb struct dkwedge_info *dkw = (void *) addr;
495 1.22 thorpej
496 1.22 thorpej if ((flag & FWRITE) == 0)
497 1.22 thorpej return (EBADF);
498 1.22 thorpej
499 1.22 thorpej /* If the ioctl happens here, the parent is us. */
500 1.38 matt strcpy(dkw->dkw_parent, device_xname(rc->rc_dev));
501 1.38 matt return dkwedge_add(dkw);
502 1.38 matt }
503 1.24 simonb
504 1.38 matt case DIOCDWEDGE: {
505 1.24 simonb struct dkwedge_info *dkw = (void *) addr;
506 1.22 thorpej
507 1.22 thorpej if ((flag & FWRITE) == 0)
508 1.22 thorpej return (EBADF);
509 1.22 thorpej
510 1.22 thorpej /* If the ioctl happens here, the parent is us. */
511 1.38 matt strcpy(dkw->dkw_parent, device_xname(rc->rc_dev));
512 1.38 matt return dkwedge_del(dkw);
513 1.38 matt }
514 1.24 simonb
515 1.38 matt case DIOCLWEDGES: {
516 1.24 simonb struct dkwedge_list *dkwl = (void *) addr;
517 1.22 thorpej
518 1.38 matt return dkwedge_list(&rc->rc_disk, dkwl, l);
519 1.38 matt }
520 1.22 thorpej
521 1.1 ragge default:
522 1.1 ragge err = ENOTTY;
523 1.38 matt break;
524 1.1 ragge }
525 1.1 ragge return err;
526 1.1 ragge }
527 1.1 ragge
528 1.1 ragge int
529 1.38 matt rlpsize(dev_t dev)
530 1.1 ragge {
531 1.38 matt struct rl_softc * const rc = device_lookup_private(&rl_cd, DISKUNIT(dev));
532 1.1 ragge struct disklabel *dl;
533 1.38 matt int size;
534 1.1 ragge
535 1.38 matt if (rc == NULL)
536 1.1 ragge return -1;
537 1.1 ragge dl = rc->rc_disk.dk_label;
538 1.1 ragge size = dl->d_partitions[DISKPART(dev)].p_size *
539 1.1 ragge (dl->d_secsize / DEV_BSIZE);
540 1.1 ragge return size;
541 1.1 ragge }
542 1.1 ragge
543 1.1 ragge int
544 1.31 christos rldump(dev_t dev, daddr_t blkno, void *va, size_t size)
545 1.1 ragge {
546 1.1 ragge /* Not likely... */
547 1.1 ragge return 0;
548 1.1 ragge }
549 1.1 ragge
550 1.1 ragge int
551 1.1 ragge rlread(dev_t dev, struct uio *uio, int ioflag)
552 1.1 ragge {
553 1.1 ragge return (physio(rlstrategy, NULL, dev, B_READ, minphys, uio));
554 1.1 ragge }
555 1.1 ragge
556 1.1 ragge int
557 1.1 ragge rlwrite(dev_t dev, struct uio *uio, int ioflag)
558 1.1 ragge {
559 1.1 ragge return (physio(rlstrategy, NULL, dev, B_WRITE, minphys, uio));
560 1.1 ragge }
561 1.1 ragge
562 1.38 matt static const char * const rlerr[] = {
563 1.1 ragge "no",
564 1.1 ragge "operation incomplete",
565 1.1 ragge "read data CRC",
566 1.1 ragge "header CRC",
567 1.1 ragge "data late",
568 1.1 ragge "header not found",
569 1.1 ragge "",
570 1.1 ragge "",
571 1.9 wiz "non-existent memory",
572 1.1 ragge "memory parity error",
573 1.1 ragge "",
574 1.1 ragge "",
575 1.1 ragge "",
576 1.1 ragge "",
577 1.1 ragge "",
578 1.1 ragge "",
579 1.1 ragge };
580 1.1 ragge
581 1.1 ragge void
582 1.1 ragge rlcintr(void *arg)
583 1.1 ragge {
584 1.1 ragge struct rlc_softc *sc = arg;
585 1.1 ragge struct buf *bp;
586 1.1 ragge u_int16_t cs;
587 1.1 ragge
588 1.1 ragge bp = sc->sc_active;
589 1.1 ragge if (bp == 0) {
590 1.38 matt aprint_error_dev(sc->sc_dev, "strange interrupt\n");
591 1.1 ragge return;
592 1.1 ragge }
593 1.1 ragge bus_dmamap_unload(sc->sc_dmat, sc->sc_dmam);
594 1.1 ragge sc->sc_active = 0;
595 1.1 ragge cs = RL_RREG(RL_CS);
596 1.1 ragge if (cs & RLCS_ERR) {
597 1.1 ragge int error = (cs & RLCS_ERRMSK) >> 10;
598 1.1 ragge
599 1.38 matt aprint_error_dev(sc->sc_dev, "%s\n", rlerr[error]);
600 1.1 ragge bp->b_error = EIO;
601 1.1 ragge bp->b_resid = bp->b_bcount;
602 1.1 ragge sc->sc_bytecnt = 0;
603 1.1 ragge }
604 1.1 ragge if (sc->sc_bytecnt == 0) /* Finished transfer */
605 1.1 ragge biodone(bp);
606 1.1 ragge rlcstart(sc, sc->sc_bytecnt ? bp : 0);
607 1.1 ragge }
608 1.1 ragge
609 1.1 ragge /*
610 1.24 simonb * Start routine. First position the disk to the given position,
611 1.1 ragge * then start reading/writing. An optimization would be to be able
612 1.1 ragge * to handle overlapping seeks between disks.
613 1.1 ragge */
614 1.1 ragge void
615 1.1 ragge rlcstart(struct rlc_softc *sc, struct buf *ob)
616 1.1 ragge {
617 1.1 ragge struct disklabel *lp;
618 1.1 ragge struct rl_softc *rc;
619 1.1 ragge struct buf *bp;
620 1.1 ragge int bn, cn, sn, tn, blks, err;
621 1.1 ragge
622 1.1 ragge if (sc->sc_active)
623 1.1 ragge return; /* Already doing something */
624 1.1 ragge
625 1.1 ragge if (ob == 0) {
626 1.26 yamt bp = BUFQ_GET(sc->sc_q);
627 1.1 ragge if (bp == NULL)
628 1.1 ragge return; /* Nothing to do */
629 1.3 thorpej sc->sc_bufaddr = bp->b_data;
630 1.1 ragge sc->sc_diskblk = bp->b_rawblkno;
631 1.1 ragge sc->sc_bytecnt = bp->b_bcount;
632 1.1 ragge bp->b_resid = 0;
633 1.1 ragge } else
634 1.1 ragge bp = ob;
635 1.1 ragge sc->sc_active = bp;
636 1.1 ragge
637 1.39 drochner rc = device_lookup_private(&rl_cd, DISKUNIT(bp->b_dev));
638 1.1 ragge bn = sc->sc_diskblk;
639 1.1 ragge lp = rc->rc_disk.dk_label;
640 1.1 ragge if (bn) {
641 1.1 ragge cn = bn / lp->d_secpercyl;
642 1.1 ragge sn = bn % lp->d_secpercyl;
643 1.1 ragge tn = sn / lp->d_nsectors;
644 1.1 ragge sn = sn % lp->d_nsectors;
645 1.1 ragge } else
646 1.1 ragge cn = sn = tn = 0;
647 1.1 ragge
648 1.1 ragge /*
649 1.1 ragge * Check if we have to position disk first.
650 1.1 ragge */
651 1.1 ragge if (rc->rc_cyl != cn || rc->rc_head != tn) {
652 1.1 ragge u_int16_t da = RLDA_SEEK;
653 1.1 ragge if (cn > rc->rc_cyl)
654 1.1 ragge da |= ((cn - rc->rc_cyl) << RLDA_CYLSHFT) | RLDA_DIR;
655 1.1 ragge else
656 1.1 ragge da |= ((rc->rc_cyl - cn) << RLDA_CYLSHFT);
657 1.1 ragge if (tn)
658 1.1 ragge da |= RLDA_HSSEEK;
659 1.1 ragge waitcrdy(sc);
660 1.1 ragge RL_WREG(RL_DA, da);
661 1.1 ragge RL_WREG(RL_CS, RLCS_SEEK | (rc->rc_hwid << RLCS_USHFT));
662 1.1 ragge waitcrdy(sc);
663 1.1 ragge rc->rc_cyl = cn;
664 1.1 ragge rc->rc_head = tn;
665 1.1 ragge }
666 1.1 ragge RL_WREG(RL_DA, (cn << RLDA_CYLSHFT) | (tn ? RLDA_HSRW : 0) | (sn << 1));
667 1.1 ragge blks = sc->sc_bytecnt/DEV_BSIZE;
668 1.1 ragge
669 1.1 ragge if (sn + blks > RL_SPT/2)
670 1.1 ragge blks = RL_SPT/2 - sn;
671 1.1 ragge RL_WREG(RL_MP, -(blks*DEV_BSIZE)/2);
672 1.1 ragge err = bus_dmamap_load(sc->sc_dmat, sc->sc_dmam, sc->sc_bufaddr,
673 1.11 ragge (blks*DEV_BSIZE), (bp->b_flags & B_PHYS ? bp->b_proc : 0),
674 1.11 ragge BUS_DMA_NOWAIT);
675 1.1 ragge if (err)
676 1.1 ragge panic("%s: bus_dmamap_load failed: %d",
677 1.38 matt device_xname(sc->sc_dev), err);
678 1.1 ragge RL_WREG(RL_BA, (sc->sc_dmam->dm_segs[0].ds_addr & 0xffff));
679 1.1 ragge
680 1.1 ragge /* Count up vars */
681 1.33 christos sc->sc_bufaddr = (char *)sc->sc_bufaddr + (blks*DEV_BSIZE);
682 1.1 ragge sc->sc_diskblk += blks;
683 1.1 ragge sc->sc_bytecnt -= (blks*DEV_BSIZE);
684 1.1 ragge
685 1.1 ragge if (bp->b_flags & B_READ)
686 1.1 ragge RL_WREG(RL_CS, RLCS_IE|RLCS_RD|(rc->rc_hwid << RLCS_USHFT));
687 1.1 ragge else
688 1.1 ragge RL_WREG(RL_CS, RLCS_IE|RLCS_WD|(rc->rc_hwid << RLCS_USHFT));
689 1.2 ragge }
690 1.2 ragge
691 1.11 ragge /*
692 1.11 ragge * Called once per controller when an ubareset occurs.
693 1.11 ragge * Retracts all disks and restarts active transfers.
694 1.11 ragge */
695 1.2 ragge void
696 1.38 matt rlcreset(device_t dev)
697 1.2 ragge {
698 1.38 matt struct rlc_softc *sc = device_private(dev);
699 1.11 ragge struct rl_softc *rc;
700 1.11 ragge int i;
701 1.2 ragge u_int16_t mp;
702 1.2 ragge
703 1.11 ragge for (i = 0; i < rl_cd.cd_ndevs; i++) {
704 1.38 matt if ((rc = device_lookup_private(&rl_cd, i)) == NULL)
705 1.11 ragge continue;
706 1.11 ragge if (rc->rc_state != DK_OPEN)
707 1.11 ragge continue;
708 1.38 matt if (rc->rc_rlc != sc)
709 1.38 matt continue;
710 1.11 ragge
711 1.11 ragge RL_WREG(RL_CS, RLCS_RHDR|(rc->rc_hwid << RLCS_USHFT));
712 1.11 ragge waitcrdy(sc);
713 1.11 ragge mp = RL_RREG(RL_MP);
714 1.11 ragge rc->rc_head = ((mp & RLMP_HS) == RLMP_HS);
715 1.11 ragge rc->rc_cyl = (mp >> 7) & 0777;
716 1.11 ragge }
717 1.2 ragge if (sc->sc_active == 0)
718 1.2 ragge return;
719 1.2 ragge
720 1.26 yamt BUFQ_PUT(sc->sc_q, sc->sc_active);
721 1.2 ragge sc->sc_active = 0;
722 1.2 ragge rlcstart(sc, 0);
723 1.1 ragge }
724