root/sys/dev/disk/nata/chipsets/ata-cyrix.c
/*-
 * Copyright (c) 1998 - 2008 Søren Schmidt <sos@FreeBSD.org>
 * All rights reserved.
 *
 * 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,
 *    without modification, immediately at the beginning of the file.
 * 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.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
 */

/* local prototypes */
static int ata_cyrix_chipinit(device_t dev);
static void ata_cyrix_setmode(device_t dev, int mode);

/*
 * Cyrix chipset support functions
 */
int
ata_cyrix_ident(device_t dev)
{
    struct ata_pci_controller *ctlr = device_get_softc(dev);

    if (pci_get_devid(dev) == ATA_CYRIX_5530) {
        device_set_desc(dev, "Cyrix 5530 ATA33 controller");
        ctlr->chipinit = ata_cyrix_chipinit;
        return 0;
    }
    return ENXIO;
}

static int
ata_cyrix_chipinit(device_t dev)
{
    struct ata_pci_controller *ctlr = device_get_softc(dev);

    if (ata_setup_interrupt(dev, ata_generic_intr))
        return ENXIO;

    ctlr->setmode = ata_cyrix_setmode;
    return 0;
}

static void
ata_cyrix_setmode(device_t dev, int mode)
{
        struct ata_pci_controller *ctlr = device_get_softc(GRANDPARENT(dev));
        struct ata_channel *ch = device_get_softc(device_get_parent(dev));
        struct ata_device *atadev = device_get_softc(dev);
        int devno = (ch->unit << 1) + atadev->unit;
        int error;
        static const uint32_t piotiming[] =
            { 0x00009172, 0x00012171, 0x00020080, 0x00032010, 0x00040010 };
        static const uint32_t dmatiming[] =
            { 0x00077771, 0x00012121, 0x00002020 };
        static const uint32_t udmatiming[] =
            { 0x00921250, 0x00911140, 0x00911030 };

    mode = ata_limit_mode(dev, mode, ATA_UDMA2);

    error = ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode);

    if (bootverbose)
        device_printf(dev, "%ssetting %s on Cyrix chip\n",
                      (error) ? "FAILURE " : "", ata_mode2str(mode));

    if (!error) {
        /* dont try to set the mode if we dont have the resource */
        if (ctlr->r_res1) {
            ch->dma->alignment = 16;
            ch->dma->max_iosize = 64 * DEV_BSIZE;

            if (mode >= ATA_UDMA0) {
                ATA_OUTL(ch->r_io[ATA_BMCMD_PORT].res,
                         0x24 + (devno << 3), udmatiming[mode & ATA_MODE_MASK]);
            }
            else if (mode >= ATA_WDMA0) {
                ATA_OUTL(ch->r_io[ATA_BMCMD_PORT].res,
                         0x24 + (devno << 3), dmatiming[mode & ATA_MODE_MASK]);
            }
            else {
                ATA_OUTL(ch->r_io[ATA_BMCMD_PORT].res,
                         0x20 + (devno << 3), piotiming[mode & ATA_MODE_MASK]);
            }
        }
        atadev->mode = mode;
    }
}