mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-16 00:34:20 +08:00
070224339b
Acked-by: Sergei Shtylyov <sshtylyov@ru.mvista.com> Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>
284 lines
7.2 KiB
C
284 lines
7.2 KiB
C
/*
|
|
* IDE tuning and bus mastering support for the CS5510/CS5520
|
|
* chipsets
|
|
*
|
|
* The CS5510/CS5520 are slightly unusual devices. Unlike the
|
|
* typical IDE controllers they do bus mastering with the drive in
|
|
* PIO mode and smarter silicon.
|
|
*
|
|
* The practical upshot of this is that we must always tune the
|
|
* drive for the right PIO mode. We must also ignore all the blacklists
|
|
* and the drive bus mastering DMA information.
|
|
*
|
|
* *** This driver is strictly experimental ***
|
|
*
|
|
* (c) Copyright Red Hat Inc 2002
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2, or (at your option) any
|
|
* later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* For the avoidance of doubt the "preferred form" of this code is one which
|
|
* is in an open non patent encumbered format. Where cryptographic key signing
|
|
* forms part of the process of creating an executable the information
|
|
* including keys needed to generate an equivalently functional executable
|
|
* are deemed to be part of the source code.
|
|
*
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/blkdev.h>
|
|
#include <linux/hdreg.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
#include <linux/init.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/ide.h>
|
|
#include <linux/dma-mapping.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/irq.h>
|
|
|
|
struct pio_clocks
|
|
{
|
|
int address;
|
|
int assert;
|
|
int recovery;
|
|
};
|
|
|
|
static struct pio_clocks cs5520_pio_clocks[]={
|
|
{3, 6, 11},
|
|
{2, 5, 6},
|
|
{1, 4, 3},
|
|
{1, 3, 2},
|
|
{1, 2, 1}
|
|
};
|
|
|
|
static int cs5520_tune_chipset(ide_drive_t *drive, u8 xferspeed)
|
|
{
|
|
ide_hwif_t *hwif = HWIF(drive);
|
|
struct pci_dev *pdev = hwif->pci_dev;
|
|
u8 speed = min((u8)XFER_PIO_4, xferspeed);
|
|
int pio = speed;
|
|
u8 reg;
|
|
int controller = drive->dn > 1 ? 1 : 0;
|
|
int error;
|
|
|
|
switch(speed)
|
|
{
|
|
case XFER_PIO_4:
|
|
case XFER_PIO_3:
|
|
case XFER_PIO_2:
|
|
case XFER_PIO_1:
|
|
case XFER_PIO_0:
|
|
pio -= XFER_PIO_0;
|
|
break;
|
|
default:
|
|
pio = 0;
|
|
printk(KERN_ERR "cs55x0: bad ide timing.\n");
|
|
}
|
|
|
|
printk("PIO clocking = %d\n", pio);
|
|
|
|
/* FIXME: if DMA = 1 do we need to set the DMA bit here ? */
|
|
|
|
/* 8bit CAT/CRT - 8bit command timing for channel */
|
|
pci_write_config_byte(pdev, 0x62 + controller,
|
|
(cs5520_pio_clocks[pio].recovery << 4) |
|
|
(cs5520_pio_clocks[pio].assert));
|
|
|
|
/* 0x64 - 16bit Primary, 0x68 - 16bit Secondary */
|
|
|
|
/* FIXME: should these use address ? */
|
|
/* Data read timing */
|
|
pci_write_config_byte(pdev, 0x64 + 4*controller + (drive->dn&1),
|
|
(cs5520_pio_clocks[pio].recovery << 4) |
|
|
(cs5520_pio_clocks[pio].assert));
|
|
/* Write command timing */
|
|
pci_write_config_byte(pdev, 0x66 + 4*controller + (drive->dn&1),
|
|
(cs5520_pio_clocks[pio].recovery << 4) |
|
|
(cs5520_pio_clocks[pio].assert));
|
|
|
|
/* Set the DMA enable/disable flag */
|
|
reg = inb(hwif->dma_base + 0x02 + 8*controller);
|
|
reg |= 1<<((drive->dn&1)+5);
|
|
outb(reg, hwif->dma_base + 0x02 + 8*controller);
|
|
|
|
error = ide_config_drive_speed(drive, speed);
|
|
/* ATAPI is harder so leave it for now */
|
|
if(!error && drive->media == ide_disk)
|
|
error = hwif->ide_dma_on(drive);
|
|
|
|
return error;
|
|
}
|
|
|
|
static void cs5520_tune_drive(ide_drive_t *drive, u8 pio)
|
|
{
|
|
pio = ide_get_best_pio_mode(drive, pio, 4);
|
|
cs5520_tune_chipset(drive, (XFER_PIO_0 + pio));
|
|
}
|
|
|
|
static int cs5520_config_drive_xfer_rate(ide_drive_t *drive)
|
|
{
|
|
/* Tune the drive for PIO modes up to PIO 4 */
|
|
cs5520_tune_drive(drive, 255);
|
|
|
|
/* Then tell the core to use DMA operations */
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* We provide a callback for our nonstandard DMA location
|
|
*/
|
|
|
|
static void __devinit cs5520_init_setup_dma(struct pci_dev *dev, ide_pci_device_t *d, ide_hwif_t *hwif)
|
|
{
|
|
unsigned long bmide = pci_resource_start(dev, 2); /* Not the usual 4 */
|
|
if(hwif->mate && hwif->mate->dma_base) /* Second channel at primary + 8 */
|
|
bmide += 8;
|
|
ide_setup_dma(hwif, bmide, 8);
|
|
}
|
|
|
|
/*
|
|
* We wrap the DMA activate to set the vdma flag. This is needed
|
|
* so that the IDE DMA layer issues PIO not DMA commands over the
|
|
* DMA channel
|
|
*/
|
|
|
|
static int cs5520_dma_on(ide_drive_t *drive)
|
|
{
|
|
drive->vdma = 1;
|
|
return 0;
|
|
}
|
|
|
|
static void __devinit init_hwif_cs5520(ide_hwif_t *hwif)
|
|
{
|
|
hwif->tuneproc = &cs5520_tune_drive;
|
|
hwif->speedproc = &cs5520_tune_chipset;
|
|
hwif->ide_dma_check = &cs5520_config_drive_xfer_rate;
|
|
hwif->ide_dma_on = &cs5520_dma_on;
|
|
|
|
if(!noautodma)
|
|
hwif->autodma = 1;
|
|
|
|
if(!hwif->dma_base)
|
|
{
|
|
hwif->drives[0].autotune = 1;
|
|
hwif->drives[1].autotune = 1;
|
|
return;
|
|
}
|
|
|
|
hwif->atapi_dma = 0;
|
|
hwif->ultra_mask = 0;
|
|
hwif->swdma_mask = 0;
|
|
hwif->mwdma_mask = 0;
|
|
|
|
hwif->drives[0].autodma = hwif->autodma;
|
|
hwif->drives[1].autodma = hwif->autodma;
|
|
}
|
|
|
|
#define DECLARE_CS_DEV(name_str) \
|
|
{ \
|
|
.name = name_str, \
|
|
.init_setup_dma = cs5520_init_setup_dma, \
|
|
.init_hwif = init_hwif_cs5520, \
|
|
.autodma = AUTODMA, \
|
|
.bootable = ON_BOARD, \
|
|
.host_flags = IDE_HFLAG_ISA_PORTS, \
|
|
.pio_mask = ATA_PIO4, \
|
|
}
|
|
|
|
static ide_pci_device_t cyrix_chipsets[] __devinitdata = {
|
|
/* 0 */ DECLARE_CS_DEV("Cyrix 5510"),
|
|
/* 1 */ DECLARE_CS_DEV("Cyrix 5520")
|
|
};
|
|
|
|
/*
|
|
* The 5510/5520 are a bit weird. They don't quite set up the way
|
|
* the PCI helper layer expects so we must do much of the set up
|
|
* work longhand.
|
|
*/
|
|
|
|
static int __devinit cs5520_init_one(struct pci_dev *dev, const struct pci_device_id *id)
|
|
{
|
|
ide_hwif_t *hwif = NULL, *mate = NULL;
|
|
ata_index_t index;
|
|
ide_pci_device_t *d = &cyrix_chipsets[id->driver_data];
|
|
|
|
ide_setup_pci_noise(dev, d);
|
|
|
|
/* We must not grab the entire device, it has 'ISA' space in its
|
|
BARS too and we will freak out other bits of the kernel */
|
|
if (pci_enable_device_bars(dev, 1<<2)) {
|
|
printk(KERN_WARNING "%s: Unable to enable 55x0.\n", d->name);
|
|
return -ENODEV;
|
|
}
|
|
pci_set_master(dev);
|
|
if (pci_set_dma_mask(dev, DMA_32BIT_MASK)) {
|
|
printk(KERN_WARNING "cs5520: No suitable DMA available.\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
index.all = 0xf0f0;
|
|
|
|
/*
|
|
* Now the chipset is configured we can let the core
|
|
* do all the device setup for us
|
|
*/
|
|
|
|
ide_pci_setup_ports(dev, d, 14, &index);
|
|
|
|
if ((index.b.low & 0xf0) != 0xf0)
|
|
hwif = &ide_hwifs[index.b.low];
|
|
if ((index.b.high & 0xf0) != 0xf0)
|
|
mate = &ide_hwifs[index.b.high];
|
|
|
|
if (hwif)
|
|
probe_hwif_init(hwif);
|
|
if (mate)
|
|
probe_hwif_init(mate);
|
|
|
|
if (hwif)
|
|
ide_proc_register_port(hwif);
|
|
if (mate)
|
|
ide_proc_register_port(mate);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct pci_device_id cs5520_pci_tbl[] = {
|
|
{ PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5510, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
|
|
{ PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5520, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
|
|
{ 0, },
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, cs5520_pci_tbl);
|
|
|
|
static struct pci_driver driver = {
|
|
.name = "Cyrix_IDE",
|
|
.id_table = cs5520_pci_tbl,
|
|
.probe = cs5520_init_one,
|
|
};
|
|
|
|
static int __init cs5520_ide_init(void)
|
|
{
|
|
return ide_pci_register_driver(&driver);
|
|
}
|
|
|
|
module_init(cs5520_ide_init);
|
|
|
|
MODULE_AUTHOR("Alan Cox");
|
|
MODULE_DESCRIPTION("PCI driver module for Cyrix 5510/5520 IDE");
|
|
MODULE_LICENSE("GPL");
|