1 /* $NetBSD: chdsk.c,v 1.4 2011/04/11 14:00:02 tsutsui Exp $ */
2
3 /*
4 * Copyright (c) 2001 MINOURA Makoto.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 */
27
28 #include <lib/libsa/stand.h>
29 #include <lib/libkern/libkern.h>
30
31 #include "libx68k.h"
32 #include "iocs.h"
33 #include "fdvar.h"
34 #include "consio.h"
35
36 int
changedisk_hook(struct open_file * f)37 changedisk_hook(struct open_file *f)
38 {
39
40 if (strcmp(f->f_dev->dv_name, "fd") == 0) {
41 struct fd_softc *sc = f->f_devdata;
42 int drive[2];
43
44 drive[0] = 0x90 << 8;
45 drive[1] = 0x91 << 8;
46
47 /* unlock current unit */
48 IOCS_B_DRVCHK(drive[sc->unit], 3);
49 /* eject current */
50 IOCS_B_DRVCHK(drive[sc->unit], 1);
51 awaitkey_1sec();
52 /* prompt both */
53 IOCS_B_DRVCHK(drive[0], 4);
54 IOCS_B_DRVCHK(drive[1], 4);
55 /* poll for medium */
56 for (;;) {
57 if ((IOCS_B_DRVCHK(drive[0], 0) & 2)) {
58 sc->unit = 0;
59 break;
60 }
61 if ((IOCS_B_DRVCHK(drive[1], 0) & 2)) {
62 sc->unit = 1;
63 break;
64 }
65 awaitkey_1sec();
66 }
67 /* prompt off */
68 IOCS_B_DRVCHK(drive[0], 5);
69 IOCS_B_DRVCHK(drive[1], 5);
70 /* lock new unit */
71 IOCS_B_DRVCHK(drive[sc->unit], 2);
72 }
73
74 return 0;
75 }
76