mscp_disk.c revision 1.76 1 /* $NetBSD: mscp_disk.c,v 1.76 2012/10/27 17:18:26 chs Exp $ */
2 /*
3 * Copyright (c) 1988 Regents of the University of California.
4 * All rights reserved.
5 *
6 * This code is derived from software contributed to Berkeley by
7 * Chris Torek.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. Neither the name of the University nor the names of its contributors
18 * may be used to endorse or promote products derived from this software
19 * without specific prior written permission.
20 *
21 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 * SUCH DAMAGE.
32 *
33 * @(#)uda.c 7.32 (Berkeley) 2/13/91
34 */
35
36 /*
37 * Copyright (c) 1996 Ludd, University of Lule}, Sweden.
38 *
39 * This code is derived from software contributed to Berkeley by
40 * Chris Torek.
41 *
42 * Redistribution and use in source and binary forms, with or without
43 * modification, are permitted provided that the following conditions
44 * are met:
45 * 1. Redistributions of source code must retain the above copyright
46 * notice, this list of conditions and the following disclaimer.
47 * 2. Redistributions in binary form must reproduce the above copyright
48 * notice, this list of conditions and the following disclaimer in the
49 * documentation and/or other materials provided with the distribution.
50 * 3. All advertising materials mentioning features or use of this software
51 * must display the following acknowledgement:
52 * This product includes software developed by the University of
53 * California, Berkeley and its contributors.
54 * 4. Neither the name of the University nor the names of its contributors
55 * may be used to endorse or promote products derived from this software
56 * without specific prior written permission.
57 *
58 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
59 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
60 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
61 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
62 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
63 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
64 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
65 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
66 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
67 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
68 * SUCH DAMAGE.
69 *
70 * @(#)uda.c 7.32 (Berkeley) 2/13/91
71 */
72
73 /*
74 * RA disk device driver
75 * RX MSCP floppy disk device driver
76 * RRD MSCP CD device driver
77 */
78
79 /*
80 * TODO
81 * write bad block forwarding code
82 */
83
84 #include <sys/cdefs.h>
85 __KERNEL_RCSID(0, "$NetBSD: mscp_disk.c,v 1.76 2012/10/27 17:18:26 chs Exp $");
86
87 #include <sys/param.h>
88 #include <sys/buf.h>
89 #include <sys/bufq.h>
90 #include <sys/device.h>
91 #include <sys/disk.h>
92 #include <sys/disklabel.h>
93 #include <sys/ioctl.h>
94 #include <sys/stat.h>
95 #include <sys/fcntl.h>
96 #include <sys/reboot.h>
97 #include <sys/proc.h>
98 #include <sys/systm.h>
99 #include <sys/conf.h>
100
101 #include <ufs/ufs/dinode.h>
102 #include <ufs/ffs/fs.h>
103
104 #include <sys/bus.h>
105 #include <sys/cpu.h>
106
107 #include <dev/mscp/mscp.h>
108 #include <dev/mscp/mscpreg.h>
109 #include <dev/mscp/mscpvar.h>
110
111 #include "locators.h"
112 #include "ioconf.h"
113 #include "ra.h"
114
115 /*
116 * Drive status, per drive
117 */
118 struct ra_softc {
119 device_t ra_dev; /* Autoconf struct */
120 struct disk ra_disk;
121 int ra_state; /* open/closed state */
122 u_long ra_mediaid; /* media id */
123 int ra_hwunit; /* Hardware unit number */
124 int ra_havelabel; /* true if we have a label */
125 int ra_wlabel; /* label sector is currently writable */
126 };
127
128 #define rx_softc ra_softc
129 #define racd_softc ra_softc
130
131 void raattach(device_t, device_t, void *);
132 int rx_putonline(struct rx_softc *);
133 void rrmakelabel(struct disklabel *, long);
134 int ra_putonline(dev_t, struct ra_softc *);
135 static inline struct ra_softc *mscp_device_lookup(dev_t);
136
137 #if NRA
138
139 int ramatch(device_t, cfdata_t, void *);
140
141 CFATTACH_DECL_NEW(ra, sizeof(struct ra_softc),
142 ramatch, raattach, NULL, NULL);
143
144 #endif /* NRA */
145
146 #if NRA || NRACD || NRX
147
148 dev_type_open(raopen);
149 dev_type_close(raclose);
150 dev_type_read(raread);
151 dev_type_write(rawrite);
152 dev_type_ioctl(raioctl);
153 dev_type_strategy(rastrategy);
154 dev_type_dump(radump);
155 dev_type_size(rasize);
156
157 #if NRA
158
159 const struct bdevsw ra_bdevsw = {
160 raopen, raclose, rastrategy, raioctl, radump, rasize, D_DISK
161 };
162
163 const struct cdevsw ra_cdevsw = {
164 raopen, raclose, raread, rawrite, raioctl,
165 nostop, notty, nopoll, nommap, nokqfilter, D_DISK
166 };
167
168 static struct dkdriver radkdriver = {
169 rastrategy, minphys
170 };
171
172 /*
173 * More driver definitions, for generic MSCP code.
174 */
175
176 int
177 ramatch(device_t parent, cfdata_t cf, void *aux)
178 {
179 struct drive_attach_args *da = aux;
180 struct mscp *mp = da->da_mp;
181
182 if ((da->da_typ & MSCPBUS_DISK) == 0)
183 return 0;
184 if (cf->cf_loc[MSCPBUSCF_DRIVE] != MSCPBUSCF_DRIVE_DEFAULT &&
185 cf->cf_loc[MSCPBUSCF_DRIVE] != mp->mscp_unit)
186 return 0;
187 /*
188 * Check if this disk is a floppy (RX) or cd (RRD)
189 * Seems to be a safe way to test it per Chris Torek.
190 */
191 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) == 'X' - '@')
192 return 0;
193 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) == 'R' - '@')
194 return 0;
195 return 1;
196 }
197
198 #endif /* NRA */
199
200 /*
201 * Open a drive.
202 */
203 /*ARGSUSED*/
204 int
205 raopen(dev_t dev, int flag, int fmt, struct lwp *l)
206 {
207 struct ra_softc *ra = mscp_device_lookup(dev);
208 int error, part, mask;
209 /*
210 * Make sure this is a reasonable open request.
211 */
212 if (!ra)
213 return ENXIO;
214
215 part = DISKPART(dev);
216
217 mutex_enter(&ra->ra_disk.dk_openlock);
218
219 /*
220 * If there are wedges, and this is not RAW_PART, then we
221 * need to fail.
222 */
223 if (ra->ra_disk.dk_nwedges != 0 && part != RAW_PART) {
224 error = EBUSY;
225 goto bad1;
226 }
227
228 /*
229 * If this is the first open; we must first try to put
230 * the disk online (and read the label).
231 */
232 if (ra->ra_state == DK_CLOSED) {
233 if (ra_putonline(dev, ra) == MSCP_FAILED) {
234 error = ENXIO;
235 goto bad1;
236 }
237 }
238
239 /* If the disk has no label; allow writing everywhere */
240 if (ra->ra_havelabel == 0)
241 ra->ra_wlabel = 1;
242
243 if (part >= ra->ra_disk.dk_label->d_npartitions) {
244 error = ENXIO;
245 goto bad1;
246 }
247
248 /*
249 * Wait for the state to settle
250 */
251 #if notyet
252 while (ra->ra_state != DK_OPEN)
253 if ((error = tsleep((void *)ra, (PZERO + 1) | PCATCH,
254 devopn, 0))) {
255 splx(s);
256 return (error);
257 }
258 #endif
259
260 mask = 1 << part;
261
262 switch (fmt) {
263 case S_IFCHR:
264 ra->ra_disk.dk_copenmask |= mask;
265 break;
266 case S_IFBLK:
267 ra->ra_disk.dk_bopenmask |= mask;
268 break;
269 }
270 ra->ra_disk.dk_openmask |= mask;
271 error = 0;
272 bad1:
273 mutex_exit(&ra->ra_disk.dk_openlock);
274 return (error);
275 }
276
277 /* ARGSUSED */
278 int
279 raclose(dev_t dev, int flags, int fmt, struct lwp *l)
280 {
281 struct ra_softc *ra = mscp_device_lookup(dev);
282 int mask = (1 << DISKPART(dev));
283
284 mutex_enter(&ra->ra_disk.dk_openlock);
285
286 switch (fmt) {
287 case S_IFCHR:
288 ra->ra_disk.dk_copenmask &= ~mask;
289 break;
290 case S_IFBLK:
291 ra->ra_disk.dk_bopenmask &= ~mask;
292 break;
293 }
294 ra->ra_disk.dk_openmask =
295 ra->ra_disk.dk_copenmask | ra->ra_disk.dk_bopenmask;
296
297 /*
298 * Should wait for I/O to complete on this partition even if
299 * others are open, but wait for work on blkflush().
300 */
301 #if notyet
302 if (ra->ra_openpart == 0) {
303 s = spluba();
304 while (bufq_peek(udautab[unit]) != NULL)
305 (void) tsleep(&udautab[unit], PZERO - 1,
306 "raclose", 0);
307 splx(s);
308 ra->ra_state = DK_CLOSED;
309 ra->ra_wlabel = 0;
310 }
311 #endif
312 mutex_exit(&ra->ra_disk.dk_openlock);
313 return (0);
314 }
315
316 /*
317 * Queue a transfer request, and if possible, hand it to the controller.
318 */
319 void
320 rastrategy(struct buf *bp)
321 {
322 struct ra_softc *ra = mscp_device_lookup(bp->b_dev);
323 int unit;
324 int b;
325
326 /*
327 * Make sure this is a reasonable drive to use.
328 */
329 unit = DISKUNIT(bp->b_dev);
330 if (ra == NULL) {
331 bp->b_error = ENXIO;
332 goto done;
333 }
334 /*
335 * If drive is open `raw' or reading label, let it at it.
336 */
337 if (ra->ra_state == DK_RDLABEL) {
338 /* Make some statistics... /bqt */
339 b = splbio();
340 disk_busy(&ra->ra_disk);
341 splx(b);
342 mscp_strategy(bp, device_parent(ra->ra_dev));
343 return;
344 }
345
346 /* If disk is not online, try to put it online */
347 if (ra->ra_state == DK_CLOSED)
348 if (ra_putonline(bp->b_dev, ra) == MSCP_FAILED) {
349 bp->b_error = EIO;
350 goto done;
351 }
352
353 /*
354 * Determine the size of the transfer, and make sure it is
355 * within the boundaries of the partition.
356 */
357 if (bounds_check_with_label(&ra->ra_disk, bp, ra->ra_wlabel) <= 0)
358 goto done;
359
360 /* Make some statistics... /bqt */
361 b = splbio();
362 disk_busy(&ra->ra_disk);
363 splx(b);
364 mscp_strategy(bp, device_parent(ra->ra_dev));
365 return;
366
367 done:
368 biodone(bp);
369 }
370
371 int
372 raread(dev_t dev, struct uio *uio, int flags)
373 {
374
375 return (physio(rastrategy, NULL, dev, B_READ, minphys, uio));
376 }
377
378 int
379 rawrite(dev_t dev, struct uio *uio, int flags)
380 {
381
382 return (physio(rastrategy, NULL, dev, B_WRITE, minphys, uio));
383 }
384
385 /*
386 * I/O controls.
387 */
388 int
389 raioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
390 {
391 struct disklabel *lp, *tp;
392 struct ra_softc *ra = mscp_device_lookup(dev);
393 int error = 0;
394 #ifdef __HAVE_OLD_DISKLABEL
395 struct disklabel newlabel;
396 #endif
397
398 lp = ra->ra_disk.dk_label;
399
400 switch (cmd) {
401
402 case DIOCGDINFO:
403 memcpy(data, lp, sizeof (struct disklabel));
404 break;
405 #ifdef __HAVE_OLD_DISKLABEL
406 case ODIOCGDINFO:
407 memcpy(&newlabel, lp, sizeof newlabel);
408 if (newlabel.d_npartitions > OLDMAXPARTITIONS)
409 return ENOTTY;
410 memcpy(data, &newlabel, sizeof (struct olddisklabel));
411 break;
412 #endif
413
414 case DIOCGPART:
415 ((struct partinfo *)data)->disklab = lp;
416 ((struct partinfo *)data)->part =
417 &lp->d_partitions[DISKPART(dev)];
418 break;
419
420 case DIOCWDINFO:
421 case DIOCSDINFO:
422 #ifdef __HAVE_OLD_DISKLABEL
423 case ODIOCWDINFO:
424 case ODIOCSDINFO:
425 if (cmd == ODIOCSDINFO || cmd == ODIOCWDINFO) {
426 memset(&newlabel, 0, sizeof newlabel);
427 memcpy(&newlabel, data, sizeof (struct olddisklabel));
428 tp = &newlabel;
429 } else
430 #endif
431 tp = (struct disklabel *)data;
432
433 if ((flag & FWRITE) == 0)
434 error = EBADF;
435 else {
436 mutex_enter(&ra->ra_disk.dk_openlock);
437 error = setdisklabel(lp, tp, 0, 0);
438 if ((error == 0) && (cmd == DIOCWDINFO
439 #ifdef __HAVE_OLD_DISKLABEL
440 || cmd == ODIOCWDINFO
441 #endif
442 )) {
443 ra->ra_wlabel = 1;
444 error = writedisklabel(dev, rastrategy, lp,0);
445 ra->ra_wlabel = 0;
446 }
447 mutex_exit(&ra->ra_disk.dk_openlock);
448 }
449 break;
450
451 case DIOCWLABEL:
452 if ((flag & FWRITE) == 0)
453 error = EBADF;
454 else
455 ra->ra_wlabel = 1;
456 break;
457
458 case DIOCGDEFLABEL:
459 #ifdef __HAVE_OLD_DISKLABEL
460 case ODIOCGDEFLABEL:
461 if (cmd == ODIOCGDEFLABEL)
462 tp = &newlabel;
463 else
464 #endif
465 tp = (struct disklabel *)data;
466 memset(tp, 0, sizeof(struct disklabel));
467 tp->d_secsize = lp->d_secsize;
468 tp->d_nsectors = lp->d_nsectors;
469 tp->d_ntracks = lp->d_ntracks;
470 tp->d_ncylinders = lp->d_ncylinders;
471 tp->d_secpercyl = lp->d_secpercyl;
472 tp->d_secperunit = lp->d_secperunit;
473 tp->d_type = DTYPE_MSCP;
474 tp->d_rpm = 3600;
475 rrmakelabel(tp, ra->ra_mediaid);
476 #ifdef __HAVE_OLD_DISKLABEL
477 if (cmd == ODIOCGDEFLABEL) {
478 if (tp->d_npartitions > OLDMAXPARTITIONS)
479 return ENOTTY;
480 memcpy(data, tp, sizeof (struct olddisklabel));
481 }
482 #endif
483 break;
484
485 case DIOCAWEDGE:
486 {
487 struct dkwedge_info *dkw = (void *) data;
488
489 if ((flag & FWRITE) == 0)
490 return (EBADF);
491
492 /* If the ioctl happens here, the parent is us. */
493 strlcpy(dkw->dkw_parent, device_xname(ra->ra_dev),
494 sizeof(dkw->dkw_parent));
495 return (dkwedge_add(dkw));
496 }
497
498 case DIOCDWEDGE:
499 {
500 struct dkwedge_info *dkw = (void *) data;
501
502 if ((flag & FWRITE) == 0)
503 return (EBADF);
504
505 /* If the ioctl happens here, the parent is us. */
506 strlcpy(dkw->dkw_parent, device_xname(ra->ra_dev),
507 sizeof(dkw->dkw_parent));
508 return (dkwedge_del(dkw));
509 }
510
511 case DIOCLWEDGES:
512 {
513 struct dkwedge_list *dkwl = (void *) data;
514
515 return (dkwedge_list(&ra->ra_disk, dkwl, l));
516 }
517
518 default:
519 error = ENOTTY;
520 break;
521 }
522 return (error);
523 }
524
525 int
526 radump(dev_t dev, daddr_t blkno, void *va, size_t size)
527 {
528 return ENXIO;
529 }
530
531 /*
532 * Return the size of a partition, if known, or -1 if not.
533 */
534 int
535 rasize(dev_t dev)
536 {
537 struct ra_softc *ra = mscp_device_lookup(dev);
538
539 if (!ra)
540 return -1;
541
542 if (ra->ra_state == DK_CLOSED)
543 if (ra_putonline(dev, ra) == MSCP_FAILED)
544 return -1;
545
546 return ra->ra_disk.dk_label->d_partitions[DISKPART(dev)].p_size *
547 (ra->ra_disk.dk_label->d_secsize / DEV_BSIZE);
548 }
549
550 #endif /* NRA || NRACD || NRX */
551
552 #if NRX
553
554 int rxmatch(device_t, cfdata_t, void *);
555
556 CFATTACH_DECL_NEW(rx, sizeof(struct rx_softc),
557 rxmatch, raattach, NULL, NULL);
558
559 dev_type_open(rxopen);
560 dev_type_read(rxread);
561 dev_type_write(rxwrite);
562 dev_type_ioctl(rxioctl);
563 dev_type_strategy(rxstrategy);
564 dev_type_dump(radump);
565 dev_type_size(rxsize);
566
567 const struct bdevsw rx_bdevsw = {
568 rxopen, nullclose, rxstrategy, rxioctl, radump, rxsize, D_DISK
569 };
570
571 const struct cdevsw rx_cdevsw = {
572 rxopen, nullclose, rxread, rxwrite, rxioctl,
573 nostop, notty, nopoll, nommap, nokqfilter, D_DISK
574 };
575
576 static struct dkdriver rxdkdriver = {
577 rxstrategy, minphys
578 };
579
580 /*
581 * More driver definitions, for generic MSCP code.
582 */
583
584 int
585 rxmatch(device_t parent, cfdata_t cf, void *aux)
586 {
587 struct drive_attach_args *da = aux;
588 struct mscp *mp = da->da_mp;
589
590 if ((da->da_typ & MSCPBUS_DISK) == 0)
591 return 0;
592 if (cf->cf_loc[MSCPBUSCF_DRIVE] != MSCPBUSCF_DRIVE_DEFAULT &&
593 cf->cf_loc[MSCPBUSCF_DRIVE] != mp->mscp_unit)
594 return 0;
595 /*
596 * Check if this disk is a floppy (RX)
597 * Seems to be a safe way to test it per Chris Torek.
598 */
599 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) == 'X' - '@')
600 return 1;
601 return 0;
602 }
603
604 #endif /* NRX */
605
606 #if NRACD
607
608 /* Use almost all ra* routines for racd */
609
610 int racdmatch(device_t, cfdata_t, void *);
611
612 CFATTACH_DECL_NEW(racd, sizeof(struct racd_softc),
613 racdmatch, raattach, NULL, NULL);
614
615 dev_type_open(raopen);
616 dev_type_read(raread);
617 dev_type_write(rawrite);
618 dev_type_ioctl(raioctl);
619 dev_type_strategy(rastrategy);
620 dev_type_dump(radump);
621 dev_type_size(rasize);
622
623 const struct bdevsw racd_bdevsw = {
624 raopen, nullclose, rastrategy, raioctl, radump, rasize, D_DISK
625 };
626
627 const struct cdevsw racd_cdevsw = {
628 raopen, nullclose, raread, rawrite, raioctl,
629 nostop, notty, nopoll, nommap, nokqfilter, D_DISK
630 };
631
632 static struct dkdriver racddkdriver = {
633 rastrategy, minphys
634 };
635
636 /*
637 * More driver definitions, for generic MSCP code.
638 */
639
640 int
641 racdmatch(device_t parent, cfdata_t cf, void *aux)
642 {
643 struct drive_attach_args *da = aux;
644 struct mscp *mp = da->da_mp;
645
646 if ((da->da_typ & MSCPBUS_DISK) == 0)
647 return 0;
648 if (cf->cf_loc[MSCPBUSCF_DRIVE] != MSCPBUSCF_DRIVE_DEFAULT &&
649 cf->cf_loc[MSCPBUSCF_DRIVE] != mp->mscp_unit)
650 return 0;
651 /*
652 * Check if this disk is a CD (RRD)
653 */
654 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) == 'R' - '@')
655 return 1;
656 return 0;
657 }
658
659 #endif /* NRACD */
660
661 /*
662 * The attach routine only checks and prints drive type.
663 * Bringing the disk online is done when the disk is accessed
664 * the first time.
665 */
666 void
667 raattach(device_t parent, device_t self, void *aux)
668 {
669 struct rx_softc *rx = device_private(self);
670 struct drive_attach_args *da = aux;
671 struct mscp *mp = da->da_mp;
672 struct mscp_softc *mi = device_private(parent);
673 struct disklabel *dl;
674
675 rx->ra_dev = self;
676 rx->ra_mediaid = mp->mscp_guse.guse_mediaid;
677 rx->ra_state = DK_CLOSED;
678 rx->ra_hwunit = mp->mscp_unit;
679 mi->mi_dp[mp->mscp_unit] = self;
680
681 #if NRX
682 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) == 'X' - '@')
683 disk_init((struct disk *)&rx->ra_disk, device_xname(rx->ra_dev),
684 &rxdkdriver);
685 #endif
686 #if NRACD
687 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) == 'R' - '@')
688 disk_init((struct disk *)&rx->ra_disk, device_xname(rx->ra_dev),
689 &racddkdriver);
690 #endif
691 #if NRA
692 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) != 'X' - '@' &&
693 MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) != 'R' - '@')
694 disk_init((struct disk *)&rx->ra_disk, device_xname(rx->ra_dev),
695 &radkdriver);
696 #endif
697 disk_attach(&rx->ra_disk);
698
699 /* Fill in what we know. The actual size is gotten later */
700 dl = rx->ra_disk.dk_label;
701
702 dl->d_secsize = DEV_BSIZE;
703 dl->d_nsectors = mp->mscp_guse.guse_nspt;
704 dl->d_ntracks = mp->mscp_guse.guse_ngpc * mp->mscp_guse.guse_group;
705 dl->d_secpercyl = dl->d_nsectors * dl->d_ntracks;
706 disk_printtype(mp->mscp_unit, mp->mscp_guse.guse_mediaid);
707 #ifdef DEBUG
708 printf("%s: nspt %d group %d ngpc %d rct %d nrpt %d nrct %d\n",
709 device_xname(self), mp->mscp_guse.guse_nspt, mp->mscp_guse.guse_group,
710 mp->mscp_guse.guse_ngpc, mp->mscp_guse.guse_rctsize,
711 mp->mscp_guse.guse_nrpt, mp->mscp_guse.guse_nrct);
712 #endif
713 if (MSCP_MID_ECH(1, mp->mscp_guse.guse_mediaid) != 'X' - '@') {
714 /*
715 * XXX We should try to discover wedges here, but
716 * XXX that would mean being able to do I/O. Should
717 * XXX use config_defer() here.
718 */
719 }
720 }
721
722 /*
723 * (Try to) put the drive online. This is done the first time the
724 * drive is opened, or if it har fallen offline.
725 */
726 int
727 rx_putonline(struct rx_softc *rx)
728 {
729 struct mscp *mp;
730 struct mscp_softc *mi = device_private(device_parent(rx->ra_dev));
731 volatile int i;
732
733 rx->ra_state = DK_CLOSED;
734 mp = mscp_getcp(mi, MSCP_WAIT);
735 mp->mscp_opcode = M_OP_ONLINE;
736 mp->mscp_unit = rx->ra_hwunit;
737 mp->mscp_cmdref = 1;
738 *mp->mscp_addr |= MSCP_OWN | MSCP_INT;
739
740 /* Poll away */
741 i = bus_space_read_2(mi->mi_iot, mi->mi_iph, 0);
742 if (tsleep(&rx->ra_state, PRIBIO, "rxonline", 100*100))
743 rx->ra_state = DK_CLOSED;
744
745 if (rx->ra_state == DK_CLOSED)
746 return MSCP_FAILED;
747
748 return MSCP_DONE;
749 }
750
751 #if NRX
752
753 /*
754 * Open a drive.
755 */
756 /*ARGSUSED*/
757 int
758 rxopen(dev_t dev, int flag, int fmt, struct lwp *l)
759 {
760 struct rx_softc *rx;
761 int unit;
762
763 /*
764 * Make sure this is a reasonable open request.
765 */
766 unit = DISKUNIT(dev);
767 rx = device_lookup_private(&rx_cd, unit);
768 if (!rx)
769 return ENXIO;
770
771 /*
772 * If this is the first open; we must first try to put
773 * the disk online (and read the label).
774 */
775 if (rx->ra_state == DK_CLOSED)
776 if (rx_putonline(rx) == MSCP_FAILED)
777 return ENXIO;
778
779 return 0;
780 }
781
782 /*
783 * Queue a transfer request, and if possible, hand it to the controller.
784 *
785 * This routine is broken into two so that the internal version
786 * udastrat1() can be called by the (nonexistent, as yet) bad block
787 * revectoring routine.
788 */
789 void
790 rxstrategy(struct buf *bp)
791 {
792 int unit;
793 struct rx_softc *rx;
794 int b;
795
796 /*
797 * Make sure this is a reasonable drive to use.
798 */
799 unit = DISKUNIT(bp->b_dev);
800 if ((rx = device_lookup_private(&rx_cd, unit)) == NULL) {
801 bp->b_error = ENXIO;
802 goto done;
803 }
804
805 /* If disk is not online, try to put it online */
806 if (rx->ra_state == DK_CLOSED)
807 if (rx_putonline(rx) == MSCP_FAILED) {
808 bp->b_error = EIO;
809 goto done;
810 }
811
812 /*
813 * Determine the size of the transfer, and make sure it is
814 * within the boundaries of the partition.
815 */
816 if (bp->b_blkno >= rx->ra_disk.dk_label->d_secperunit) {
817 bp->b_resid = bp->b_bcount;
818 goto done;
819 }
820
821 /* Make some statistics... /bqt */
822 b = splbio();
823 disk_busy(&rx->ra_disk);
824 splx(b);
825 mscp_strategy(bp, device_parent(rx->ra_dev));
826 return;
827
828 done:
829 biodone(bp);
830 }
831
832 int
833 rxread(dev_t dev, struct uio *uio, int flag)
834 {
835
836 return (physio(rxstrategy, NULL, dev, B_READ, minphys, uio));
837 }
838
839 int
840 rxwrite(dev_t dev, struct uio *uio, int flag)
841 {
842
843 return (physio(rxstrategy, NULL, dev, B_WRITE, minphys, uio));
844 }
845
846 /*
847 * I/O controls.
848 */
849 int
850 rxioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
851 {
852 int unit = DISKUNIT(dev);
853 struct disklabel *lp;
854 struct rx_softc *rx = device_lookup_private(&rx_cd, unit);
855 int error = 0;
856
857 lp = rx->ra_disk.dk_label;
858
859 switch (cmd) {
860
861 case DIOCGDINFO:
862 memcpy(data, lp, sizeof (struct disklabel));
863 break;
864
865 case DIOCGPART:
866 ((struct partinfo *)data)->disklab = lp;
867 ((struct partinfo *)data)->part =
868 &lp->d_partitions[DISKPART(dev)];
869 break;
870
871
872 case DIOCWDINFO:
873 case DIOCSDINFO:
874 case DIOCWLABEL:
875 break;
876
877 default:
878 error = ENOTTY;
879 break;
880 }
881 return (error);
882 }
883
884 int
885 rxsize(dev_t dev)
886 {
887
888 return -1;
889 }
890
891 #endif /* NRX */
892
893 void rrdgram(device_t, struct mscp *, struct mscp_softc *);
894 void rriodone(device_t, struct buf *);
895 int rronline(device_t, struct mscp *);
896 int rrgotstatus(device_t, struct mscp *);
897 void rrreplace(device_t, struct mscp *);
898 int rrioerror(device_t, struct mscp *, struct buf *);
899 void rrfillin(struct buf *, struct mscp *);
900 void rrbb(device_t, struct mscp *, struct buf *);
901
902
903 struct mscp_device ra_device = {
904 rrdgram,
905 rriodone,
906 rronline,
907 rrgotstatus,
908 rrreplace,
909 rrioerror,
910 rrbb,
911 rrfillin,
912 };
913
914 /*
915 * Handle an error datagram.
916 * This can come from an unconfigured drive as well.
917 */
918 void
919 rrdgram(device_t usc, struct mscp *mp, struct mscp_softc *mi)
920 {
921 if (mscp_decodeerror(usc == NULL?"unconf disk" : device_xname(usc), mp, mi))
922 return;
923 /*
924 * SDI status information bytes 10 and 11 are the microprocessor
925 * error code and front panel code respectively. These vary per
926 * drive type and are printed purely for field service information.
927 */
928 if (mp->mscp_format == M_FM_SDI)
929 printf("\tsdi uproc error code 0x%x, front panel code 0x%x\n",
930 mp->mscp_erd.erd_sdistat[10],
931 mp->mscp_erd.erd_sdistat[11]);
932 }
933
934
935 void
936 rriodone(device_t usc, struct buf *bp)
937 {
938 struct ra_softc *ra = device_private(usc);
939
940 disk_unbusy(&ra->ra_disk, bp->b_bcount, (bp->b_flags & B_READ));
941
942 biodone(bp);
943 }
944
945 /*
946 * A drive came on line. Check its type and size. Return DONE if
947 * we think the drive is truly on line. In any case, awaken anyone
948 * sleeping on the drive on-line-ness.
949 */
950 int
951 rronline(device_t usc, struct mscp *mp)
952 {
953 struct ra_softc *ra = device_private(usc);
954 struct disklabel *dl;
955
956 wakeup((void *)&ra->ra_state);
957 if ((mp->mscp_status & M_ST_MASK) != M_ST_SUCCESS) {
958 aprint_error_dev(usc, "attempt to bring on line failed: ");
959 mscp_printevent(mp);
960 return (MSCP_FAILED);
961 }
962
963 ra->ra_state = DK_OPEN;
964
965 dl = ra->ra_disk.dk_label;
966 dl->d_secperunit = (daddr_t)mp->mscp_onle.onle_unitsize;
967
968 if (dl->d_secpercyl) {
969 dl->d_ncylinders = dl->d_secperunit/dl->d_secpercyl;
970 dl->d_type = DTYPE_MSCP;
971 dl->d_rpm = 3600;
972 } else {
973 dl->d_type = DTYPE_FLOPPY;
974 dl->d_rpm = 300;
975 }
976 rrmakelabel(dl, ra->ra_mediaid);
977
978 return (MSCP_DONE);
979 }
980
981 void
982 rrmakelabel(struct disklabel *dl, long type)
983 {
984 int n, p = 0;
985
986 dl->d_bbsize = BBSIZE;
987 dl->d_sbsize = SBLOCKSIZE;
988
989 /* Create the disk name for disklabel. Phew... */
990 dl->d_typename[p++] = MSCP_MID_CHAR(2, type);
991 dl->d_typename[p++] = MSCP_MID_CHAR(1, type);
992 if (MSCP_MID_ECH(0, type))
993 dl->d_typename[p++] = MSCP_MID_CHAR(0, type);
994 n = MSCP_MID_NUM(type);
995 if (n > 99) {
996 dl->d_typename[p++] = '1';
997 n -= 100;
998 }
999 if (n > 9) {
1000 dl->d_typename[p++] = (n / 10) + '0';
1001 n %= 10;
1002 }
1003 dl->d_typename[p++] = n + '0';
1004 dl->d_typename[p] = 0;
1005 dl->d_npartitions = MAXPARTITIONS;
1006 dl->d_partitions[0].p_size = dl->d_partitions[2].p_size =
1007 dl->d_secperunit;
1008 dl->d_partitions[0].p_offset = dl->d_partitions[2].p_offset = 0;
1009 dl->d_interleave = dl->d_headswitch = 1;
1010 dl->d_magic = dl->d_magic2 = DISKMAGIC;
1011 dl->d_checksum = dkcksum(dl);
1012 }
1013
1014 /*
1015 * We got some (configured) unit's status. Return DONE if it succeeded.
1016 */
1017 int
1018 rrgotstatus(device_t usc, struct mscp *mp)
1019 {
1020 if ((mp->mscp_status & M_ST_MASK) != M_ST_SUCCESS) {
1021 aprint_error_dev(usc, "attempt to get status failed: ");
1022 mscp_printevent(mp);
1023 return (MSCP_FAILED);
1024 }
1025 /* record for (future) bad block forwarding and whatever else */
1026 #ifdef notyet
1027 uda_rasave(ui->ui_unit, mp, 1);
1028 #endif
1029 return (MSCP_DONE);
1030 }
1031
1032 /*
1033 * A replace operation finished.
1034 */
1035 /*ARGSUSED*/
1036 void
1037 rrreplace(device_t usc, struct mscp *mp)
1038 {
1039
1040 panic("udareplace");
1041 }
1042
1043 /*
1044 * A transfer failed. We get a chance to fix or restart it.
1045 * Need to write the bad block forwaring code first....
1046 */
1047 /*ARGSUSED*/
1048 int
1049 rrioerror(device_t usc, struct mscp *mp, struct buf *bp)
1050 {
1051 struct ra_softc *ra = device_private(usc);
1052 int code = mp->mscp_event;
1053
1054 switch (code & M_ST_MASK) {
1055 /* The unit has fallen offline. Try to figure out why. */
1056 case M_ST_OFFLINE:
1057 bp->b_error = EIO;
1058 ra->ra_state = DK_CLOSED;
1059 if (code & M_OFFLINE_UNMOUNTED)
1060 aprint_error_dev(usc, "not mounted/spun down\n");
1061 if (code & M_OFFLINE_DUPLICATE)
1062 aprint_error_dev(usc, "duplicate unit number!!!\n");
1063 return MSCP_DONE;
1064
1065 case M_ST_AVAILABLE:
1066 ra->ra_state = DK_CLOSED; /* Force another online */
1067 return MSCP_DONE;
1068
1069 default:
1070 printf("%s:", device_xname(usc));
1071 break;
1072 }
1073 return (MSCP_FAILED);
1074 }
1075
1076 /*
1077 * Fill in disk addresses in a mscp packet waiting for transfer.
1078 */
1079 void
1080 rrfillin(struct buf *bp, struct mscp *mp)
1081 {
1082 struct ra_softc *ra;
1083 struct disklabel *lp;
1084 int part = DISKPART(bp->b_dev);
1085
1086 ra = mscp_device_lookup(bp->b_dev);
1087 lp = ra->ra_disk.dk_label;
1088
1089 mp->mscp_seq.seq_lbn = lp->d_partitions[part].p_offset + bp->b_blkno;
1090 mp->mscp_unit = ra->ra_hwunit;
1091 mp->mscp_seq.seq_bytecount = bp->b_bcount;
1092 }
1093
1094 /*
1095 * A bad block related operation finished.
1096 */
1097 /*ARGSUSED*/
1098 void
1099 rrbb(device_t usc, struct mscp *mp, struct buf *bp)
1100 {
1101
1102 panic("udabb");
1103 }
1104
1105 /*
1106 * (Try to) put the drive online. This is done the first time the
1107 * drive is opened, or if it has fallen offline.
1108 */
1109 int
1110 ra_putonline(dev_t dev, struct ra_softc *ra)
1111 {
1112 struct disklabel *dl;
1113 const char *msg;
1114
1115 if (rx_putonline(ra) != MSCP_DONE)
1116 return MSCP_FAILED;
1117
1118 dl = ra->ra_disk.dk_label;
1119
1120 ra->ra_state = DK_RDLABEL;
1121 printf("%s", device_xname(ra->ra_dev));
1122 if ((msg = readdisklabel(
1123 MAKEDISKDEV(major(dev), device_unit(ra->ra_dev), RAW_PART),
1124 rastrategy, dl, NULL)) == NULL) {
1125 ra->ra_havelabel = 1;
1126 ra->ra_state = DK_OPEN;
1127 }
1128 #if NRACD
1129 else if (cdevsw_lookup(dev) == &racd_cdevsw) {
1130 dl->d_partitions[0].p_offset = 0;
1131 dl->d_partitions[0].p_size = dl->d_secperunit;
1132 dl->d_partitions[0].p_fstype = FS_ISO9660;
1133 }
1134 #endif /* NRACD */
1135 else {
1136 printf(": %s", msg);
1137 }
1138
1139 printf(": size %d sectors\n", dl->d_secperunit);
1140
1141 return MSCP_DONE;
1142 }
1143
1144
1145 static inline struct ra_softc *
1146 mscp_device_lookup(dev_t dev)
1147 {
1148 struct ra_softc *ra;
1149 int unit;
1150
1151 unit = DISKUNIT(dev);
1152 #if NRA
1153 if (cdevsw_lookup(dev) == &ra_cdevsw)
1154 ra = device_lookup_private(&ra_cd, unit);
1155 else
1156 #endif
1157 #if NRACD
1158 if (cdevsw_lookup(dev) == &racd_cdevsw)
1159 ra = device_lookup_private(&racd_cd, unit);
1160 else
1161 #endif
1162 #if NRX
1163 if (cdevsw_lookup(dev) == &rx_cdevsw)
1164 ra = device_lookup_private(&rx_cd, unit);
1165 else
1166 #endif
1167 panic("mscp_device_lookup: unexpected major %"PRIu32" unit %u",
1168 major(dev), unit);
1169 return ra;
1170 }
1171