1/*	$NetBSD: chdsk.c,v 1.3 2011/04/07 13:38:21 isaki 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
36int
37changedisk_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