|
@@ -2,13 +2,14 @@
|
|
|
* pata_pdc202xx_old.c - Promise PDC202xx PATA for new ATA layer
|
|
|
* (C) 2005 Red Hat Inc
|
|
|
* Alan Cox <alan@redhat.com>
|
|
|
+ * (C) 2007 Bartlomiej Zolnierkiewicz
|
|
|
*
|
|
|
* Based in part on linux/drivers/ide/pci/pdc202xx_old.c
|
|
|
*
|
|
|
* First cut with LBA48/ATAPI
|
|
|
*
|
|
|
* TODO:
|
|
|
- * Channel interlock/reset on both required ?
|
|
|
+ * Channel interlock/reset on both required
|
|
|
*/
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
@@ -21,7 +22,7 @@
|
|
|
#include <linux/libata.h>
|
|
|
|
|
|
#define DRV_NAME "pata_pdc202xx_old"
|
|
|
-#define DRV_VERSION "0.3.0"
|
|
|
+#define DRV_VERSION "0.4.0"
|
|
|
|
|
|
/**
|
|
|
* pdc2024x_pre_reset - probe begin
|
|
@@ -76,7 +77,7 @@ static void pdc2026x_error_handler(struct ata_port *ap)
|
|
|
static void pdc202xx_configure_piomode(struct ata_port *ap, struct ata_device *adev, int pio)
|
|
|
{
|
|
|
struct pci_dev *pdev = to_pci_dev(ap->host->dev);
|
|
|
- int port = 0x60 + 4 * ap->port_no + 2 * adev->devno;
|
|
|
+ int port = 0x60 + 8 * ap->port_no + 4 * adev->devno;
|
|
|
static u16 pio_timing[5] = {
|
|
|
0x0913, 0x050C , 0x0308, 0x0206, 0x0104
|
|
|
};
|
|
@@ -85,7 +86,7 @@ static void pdc202xx_configure_piomode(struct ata_port *ap, struct ata_device *a
|
|
|
pci_read_config_byte(pdev, port, &r_ap);
|
|
|
pci_read_config_byte(pdev, port + 1, &r_bp);
|
|
|
r_ap &= ~0x3F; /* Preserve ERRDY_EN, SYNC_IN */
|
|
|
- r_bp &= ~0x07;
|
|
|
+ r_bp &= ~0x1F;
|
|
|
r_ap |= (pio_timing[pio] >> 8);
|
|
|
r_bp |= (pio_timing[pio] & 0xFF);
|
|
|
|
|
@@ -123,7 +124,7 @@ static void pdc202xx_set_piomode(struct ata_port *ap, struct ata_device *adev)
|
|
|
static void pdc202xx_set_dmamode(struct ata_port *ap, struct ata_device *adev)
|
|
|
{
|
|
|
struct pci_dev *pdev = to_pci_dev(ap->host->dev);
|
|
|
- int port = 0x60 + 4 * ap->port_no + 2 * adev->devno;
|
|
|
+ int port = 0x60 + 8 * ap->port_no + 4 * adev->devno;
|
|
|
static u8 udma_timing[6][2] = {
|
|
|
{ 0x60, 0x03 }, /* 33 Mhz Clock */
|
|
|
{ 0x40, 0x02 },
|
|
@@ -132,12 +133,17 @@ static void pdc202xx_set_dmamode(struct ata_port *ap, struct ata_device *adev)
|
|
|
{ 0x20, 0x01 },
|
|
|
{ 0x20, 0x01 }
|
|
|
};
|
|
|
+ static u8 mdma_timing[3][2] = {
|
|
|
+ { 0x60, 0x03 },
|
|
|
+ { 0x60, 0x04 },
|
|
|
+ { 0xe0, 0x0f },
|
|
|
+ };
|
|
|
u8 r_bp, r_cp;
|
|
|
|
|
|
pci_read_config_byte(pdev, port + 1, &r_bp);
|
|
|
pci_read_config_byte(pdev, port + 2, &r_cp);
|
|
|
|
|
|
- r_bp &= ~0xF0;
|
|
|
+ r_bp &= ~0xE0;
|
|
|
r_cp &= ~0x0F;
|
|
|
|
|
|
if (adev->dma_mode >= XFER_UDMA_0) {
|
|
@@ -147,8 +153,8 @@ static void pdc202xx_set_dmamode(struct ata_port *ap, struct ata_device *adev)
|
|
|
|
|
|
} else {
|
|
|
int speed = adev->dma_mode - XFER_MW_DMA_0;
|
|
|
- r_bp |= 0x60;
|
|
|
- r_cp |= (5 - speed);
|
|
|
+ r_bp |= mdma_timing[speed][0];
|
|
|
+ r_cp |= mdma_timing[speed][1];
|
|
|
}
|
|
|
pci_write_config_byte(pdev, port + 1, r_bp);
|
|
|
pci_write_config_byte(pdev, port + 2, r_cp);
|