linux-imx

/*

 * Copyright (C) 1999-2002  Andre Hedrick <andre@linux-ide.org>

 * Copyright (C) 2007       MontaVista Software, Inc. <source@mvista.com>

 *

 */

​

#include <linux/module.h>

#include <linux/types.h>

#include <linux/pci.h>

#include <linux/ide.h>

#include <linux/init.h>

​

#include <asm/io.h>

​

#define DRV_NAME "aec62xx"

​

struct chipset_bus_clock_list_entry {

    u8 xfer_speed;

    u8 chipset_settings;

    u8 ultra_settings;

};

​

static const struct chipset_bus_clock_list_entry aec6xxx_33_base [] = {

    {   XFER_UDMA_6,    0x31,   0x07    },

    {   XFER_UDMA_5,    0x31,   0x06    },

    {   XFER_UDMA_4,    0x31,   0x05    },

    {   XFER_UDMA_3,    0x31,   0x04    },

    {   XFER_UDMA_2,    0x31,   0x03    },

    {   XFER_UDMA_1,    0x31,   0x02    },

    {   XFER_UDMA_0,    0x31,   0x01    },

​

    {   XFER_MW_DMA_2,  0x31,   0x00    },

    {   XFER_MW_DMA_1,  0x31,   0x00    },

    {   XFER_MW_DMA_0,  0x0a,   0x00    },

    {   XFER_PIO_4, 0x31,   0x00    },

    {   XFER_PIO_3, 0x33,   0x00    },

    {   XFER_PIO_2, 0x08,   0x00    },

    {   XFER_PIO_1, 0x0a,   0x00    },

    {   XFER_PIO_0, 0x00,   0x00    },

    {   0,      0x00,   0x00    }

};

​

static const struct chipset_bus_clock_list_entry aec6xxx_34_base [] = {

    {   XFER_UDMA_6,    0x41,   0x06    },

    {   XFER_UDMA_5,    0x41,   0x05    },

    {   XFER_UDMA_4,    0x41,   0x04    },

    {   XFER_UDMA_3,    0x41,   0x03    },

    {   XFER_UDMA_2,    0x41,   0x02    },

    {   XFER_UDMA_1,    0x41,   0x01    },

    {   XFER_UDMA_0,    0x41,   0x01    },

​

    {   XFER_MW_DMA_2,  0x41,   0x00    },

    {   XFER_MW_DMA_1,  0x42,   0x00    },

    {   XFER_MW_DMA_0,  0x7a,   0x00    },

    {   XFER_PIO_4, 0x41,   0x00    },

    {   XFER_PIO_3, 0x43,   0x00    },

    {   XFER_PIO_2, 0x78,   0x00    },

    {   XFER_PIO_1, 0x7a,   0x00    },

    {   XFER_PIO_0, 0x70,   0x00    },

    {   0,      0x00,   0x00    }

};

​

/*

 * TO DO: active tuning and correction of cards without a bios.

 */

static u8 pci_bus_clock_list (u8 speed, struct chipset_bus_clock_list_entry * chipset_table)

{

    for ( ; chipset_table->xfer_speed ; chipset_table++)

        if (chipset_table->xfer_speed == speed) {

            return chipset_table->chipset_settings;

        }

    return chipset_table->chipset_settings;

}

​

static u8 pci_bus_clock_list_ultra (u8 speed, struct chipset_bus_clock_list_entry * chipset_table)

{

    for ( ; chipset_table->xfer_speed ; chipset_table++)

        if (chipset_table->xfer_speed == speed) {

            return chipset_table->ultra_settings;

        }

    return chipset_table->ultra_settings;

}

​

static void aec6210_set_mode(ide_hwif_t *hwif, ide_drive_t *drive)

{

    struct pci_dev *dev = to_pci_dev(hwif->dev);

    struct ide_host *host   = pci_get_drvdata(dev);

    struct chipset_bus_clock_list_entry *bus_clock = host->host_priv;

    u16 d_conf      = 0;

    u8 ultra = 0, ultra_conf = 0;

    u8 tmp0 = 0, tmp1 = 0, tmp2 = 0;

    const u8 speed = drive->dma_mode;