root/sys/arch/luna68k/stand/boot/sd.c
/*      $NetBSD: sd.c,v 1.13 2023/06/24 07:02:11 tsutsui Exp $  */

/*
 * Copyright (c) 1992 OMRON Corporation.
 *
 * This code is derived from software contributed to Berkeley by
 * OMRON Corporation.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *      This product includes software developed by the University of
 *      California, Berkeley and its contributors.
 * 4. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 *      @(#)sd.c        8.1 (Berkeley) 6/10/93
 */
/*
 * Copyright (c) 1992, 1993
 *      The Regents of the University of California.  All rights reserved.
 *
 * This code is derived from software contributed to Berkeley by
 * OMRON Corporation.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 *      @(#)sd.c        8.1 (Berkeley) 6/10/93
 */

/*
 * sd.c -- SCSI DISK device driver
 * by A.Fujita, FEB-26-1992
 */


/*
 * SCSI CCS (Command Command Set) disk driver.
 */
#include <sys/param.h>
#include <sys/disklabel.h>
#include <luna68k/stand/boot/samachdep.h>
#include <luna68k/stand/boot/scsireg.h>

struct  sd_softc {
        int     sc_unit;
        uint    sc_ctlr;
        uint    sc_tgt;
        uint    sc_lun;
        int     sc_part;
        uint    sc_bshift;      /* convert device blocks to DEV_BSIZE blks */
        uint    sc_blks;        /* number of blocks on device */
        int     sc_blksize;     /* device block size in bytes */
        struct disklabel sc_label;
};

static int sdident(struct sd_softc *);
static struct sd_softc *sdinit(uint);

static int
sdident(struct sd_softc *sc)
{
        struct scsi_inquiry inqbuf;
        uint32_t capbuf[2];
        int i;

        if (!scident(sc->sc_ctlr, sc->sc_tgt, sc->sc_lun, &inqbuf, capbuf))
                return -1;

        sc->sc_blks    = capbuf[0];
        sc->sc_blksize = capbuf[1];

        if (sc->sc_blksize != DEV_BSIZE) {
                if (sc->sc_blksize < DEV_BSIZE) {
                        return -1;
                }
                for (i = sc->sc_blksize; i > DEV_BSIZE; i >>= 1)
                        ++sc->sc_bshift;
                sc->sc_blks <<= sc->sc_bshift;
        }
        return inqbuf.type;
}

static struct sd_softc *
sdinit(uint unit)
{
        struct sd_softc *sc;
        struct disklabel *lp;
        char *msg;
        int type;

#ifdef DEBUG
        printf("sdinit: unit = %d\n", unit);
#endif
        sc = alloc(sizeof *sc);
        memset(sc, 0, sizeof *sc);

        sc->sc_unit = unit;
        sc->sc_ctlr = CTLR(unit);
        sc->sc_tgt  = TARGET(unit);
        sc->sc_lun  = 0;        /* XXX no LUN support yet */
        type = sdident(sc);
        if (type < 0)
                return NULL;

        /*
         * Use the default sizes until we've read the label,
         * or longer if there isn't one there.
         */
        lp = &sc->sc_label;

        if (lp->d_secpercyl == 0) {
                lp->d_secsize = DEV_BSIZE;
                lp->d_nsectors = 32;
                lp->d_ntracks = 20;
                lp->d_secpercyl = 32*20;
                lp->d_npartitions = 1;
                lp->d_partitions[0].p_offset = 0;
                lp->d_partitions[0].p_size = LABELSECTOR + 1;
        }

        /*
         * read disklabel
         */
        msg = readdisklabel(sc->sc_ctlr, sc->sc_tgt, lp);
        if (msg != NULL)
                printf("sd(%d): %s\n", unit, msg);

        return sc;
}

int
sdopen(struct open_file *f, ...)
{
        va_list ap;
        struct sd_softc *sc;
        int unit, part;

        va_start(ap, f);
        unit = va_arg(ap, int);
        part = va_arg(ap, int);
        va_end(ap);

        if (unit < 0 || CTLR(unit) >= 2 || TARGET(unit) >= 7)
                return -1;
        if (part < 0 || part >= MAXPARTITIONS)
                return -1;

        sc = sdinit(unit);
        if (sc == NULL)
                return -1;

        sc->sc_part = part;
        f->f_devdata = (void *)sc;

        return 0;
}

int
sdclose(struct open_file *f)
{
        struct sd_softc *sc = f->f_devdata;

        dealloc(sc, sizeof *sc);
        f->f_devdata = NULL;

        return 0;
}

static struct scsi_generic_cdb cdb_read = {
        10,
        { CMD_READ_EXT,  0, 0, 0, 0, 0, 0, 0, 0, 0 }
};

static struct scsi_generic_cdb cdb_write = {
        10,
        { CMD_WRITE_EXT, 0, 0, 0, 0, 0, 0, 0, 0, 0 }
};

int
sdstrategy(void *devdata, int func, daddr_t dblk, size_t size, void *v_buf,
    size_t *rsize)
{
        struct sd_softc *sc;
        struct disklabel *lp;
        uint8_t *buf;
        struct scsi_generic_cdb *cdb;
        daddr_t blk;
        u_int nblk;
        int stat;
#ifdef DEBUG
        int i;
#endif

        sc = devdata;
        if (sc == NULL)
                return -1;

        buf = v_buf;
        lp = &sc->sc_label;
        blk = dblk + (lp->d_partitions[sc->sc_part].p_offset >> sc->sc_bshift);
        nblk = size >> sc->sc_bshift;

        if (func == F_READ)
                cdb = &cdb_read;
        else
                cdb = &cdb_write;

        cdb->cdb[2] = (blk & 0xff000000) >> 24;
        cdb->cdb[3] = (blk & 0x00ff0000) >> 16;
        cdb->cdb[4] = (blk & 0x0000ff00) >>  8;
        cdb->cdb[5] = (blk & 0x000000ff);

        cdb->cdb[7] = ((nblk >> DEV_BSHIFT) & 0xff00) >> 8;
        cdb->cdb[8] = ((nblk >> DEV_BSHIFT) & 0x00ff);

#ifdef DEBUG
        printf("sdstrategy: unit = %d\n", sc->sc_unit);
        printf("sdstrategy: blk = %lu (0x%lx), nblk = %u (0x%x)\n",
            (u_long)blk, (long)blk, nblk, nblk);
        for (i = 0; i < 10; i++)
                printf("sdstrategy: cdb[%d] = 0x%x\n", i, cdb->cdb[i]);
        printf("sdstrategy: ctlr = %d, target = %d\n", sc->sc_ctlr, sc->sc_tgt);
#endif
        stat = scsi_immed_command(sc->sc_ctlr, sc->sc_tgt, sc->sc_lun,
            cdb, buf, size);
        if (stat != 0)
                return EIO;

        if (rsize)
                *rsize = size;

        return 0;
}