sys/arch/x68k/stand/libsa/fd.c

   1 /*      $NetBSD: fd.c,v 1.4 2007/11/11 05:20:27 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 <sys/param.h>
  29 #include <sys/disklabel.h>
  30 #include <machine/stdarg.h>
  31 #include <lib/libsa/stand.h>
  32
  33 #include "libx68k.h"
  34 #include "fdvar.h"
  35 #include "iocs.h"
  36
  37 /* fdopen(struct open_file *f, int id, int part) */
  38 int
  39 fdopen(struct open_file *f, ...)
  40 {
  41         int error;
  42         struct fd_softc *sc;
  43         struct fdfmt fdfmt;
  44         int id, part;
  45         va_list ap;
  46
  47         va_start(ap, f);
  48         id   = va_arg(ap, int);
  49         part = va_arg(ap, int);
  50         va_end(ap);
  51
  52         if (id < 0 || id > 3)
  53                 return ENXIO;
  54         sc = alloc(sizeof (struct fd_softc));
  55
  56         /* lock the medium */
  57         error = IOCS_B_DRVCHK((0x90 + id) << 8, 2);
  58         if ((error & 2) == 0)
  59                 return ENXIO;
  60
  61         /* detect the sector size */
  62         error = IOCS_B_RECALI((0x90 + id) << 8);
  63         error = fd_check_format(id, 0, &sc->fmt);
  64         if (error < 0) {
  65                 IOCS_B_DRVCHK((0x90 + id) << 8, 3); /* unlock */
  66                 dealloc(sc, sizeof(struct fd_softc));
  67                 return -error;
  68         }
  69
  70         /* check the second side */
  71         error = fd_check_format(id, 1, &fdfmt);
  72         if (error == 0)         /* valid second side; set the #heads */
  73                 sc->fmt.maxsec.H = fdfmt.maxsec.H;
  74
  75         sc->unit = id;
  76         f->f_devdata = sc;
  77
  78         return 0;
  79 }
  80
  81 int
  82 fdclose(struct open_file *f)
  83 {
  84         struct fd_softc *sc = f->f_devdata;
  85
  86         IOCS_B_DRVCHK((0x90 + sc->unit) << 8, 3);
  87         dealloc(sc, sizeof(struct fd_softc));
  88         return 0;
  89 }
  90
  91 int
  92 fdstrategy(void *arg, int rw, daddr_t dblk, size_t size,
  93            void *buf, size_t *rsize)
  94 {
  95         struct fd_softc *sc = arg;
  96         int cyl, head, sect;
  97         int nhead, nsect;
  98         int error, nbytes;
  99
 100         if (size == 0) {
 101                 if (rsize)
 102                         *rsize = 0;
 103                 return 0;
 104         }
 105         nbytes = howmany(size, 128 << sc->fmt.minsec.N)
 106                 * (128 << sc->fmt.minsec.N);
 107
 108         nhead = sc->fmt.maxsec.H - sc->fmt.minsec.H + 1;
 109         nsect = sc->fmt.maxsec.R - sc->fmt.minsec.R + 1;
 110
 111         sect =  dblk % nsect + sc->fmt.minsec.R;
 112         head = (dblk / nsect) % nhead + sc->fmt.minsec.H;
 113         cyl = (dblk / nsect) / nhead + sc->fmt.minsec.C;
 114
 115         error = IOCS_B_READ((sc->unit+0x90)*256 + 0x70,
 116                             ((sc->fmt.minsec.N << 24) |
 117                              (cyl << 16) |
 118                              (head << 8) |
 119                              (sect)),
 120                             nbytes,
 121                             buf);
 122         if (error & 0xf8ffff00) {
 123                 nbytes = 0;
 124                 error = EIO;
 125         } else {
 126                 error = 0;
 127         }
 128
 129         if (rsize)
 130                 *rsize = nbytes;
 131         return error;
 132 }