Home | History | Annotate | Line # | Download | only in libsa
chdsk.c revision 1.3 
      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 
     36 int
     37 changedisk_hook(struct open_file *f)
     38 {
     39 	if (strcmp(f->f_dev->dv_name, "fd") == 0) {
     40 		struct fd_softc *sc = f->f_devdata;
     41 		int drive[2];
     42 
     43 		drive[0] = 0x90 << 8;
     44 		drive[1] = 0x91 << 8;
     45 
     46 		/* unlock current unit */
     47 		IOCS_B_DRVCHK(drive[sc->unit], 3);
     48 		/* eject current */
     49 		IOCS_B_DRVCHK(drive[sc->unit], 1);
     50 		awaitkey_1sec();
     51 		/* prompt both */
     52 		IOCS_B_DRVCHK(drive[0], 4);
     53 		IOCS_B_DRVCHK(drive[1], 4);
     54 		/* poll for medium */
     55 		for (;;) {
     56 			if ((IOCS_B_DRVCHK(drive[0], 0) & 2)) {
     57 				sc->unit = 0;
     58 				break;
     59 			}
     60 			if ((IOCS_B_DRVCHK(drive[1], 0) & 2)) {
     61 				sc->unit = 1;
     62 				break;
     63 			}
     64 			awaitkey_1sec();
     65 		}
     66 		/* prompt off */
     67 		IOCS_B_DRVCHK(drive[0], 5);
     68 		IOCS_B_DRVCHK(drive[1], 5);
     69 		/* lock new unit */
     70 		IOCS_B_DRVCHK(drive[sc->unit], 2);
     71 	}
     72 
     73 	return 0;
     74 }
     75