Home | History | Annotate | Line # | Download | only in libsa
chdsk.c revision 1.2.6.1 
      1 /*	$NetBSD: chdsk.c,v 1.2.6.1 2011/04/21 01:41:31 rmind 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 
     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