Commit e6423407 authored by Linus Torvalds's avatar Linus Torvalds

Merge branch 'for-2.6.31' of git://git.kernel.org/pub/scm/linux/kernel/git/bart/ide-2.6

* 'for-2.6.31' of git://git.kernel.org/pub/scm/linux/kernel/git/bart/ide-2.6: (34 commits)
  ide-cd: prevent null pointer deref via cdrom_newpc_intr
  ide: BUG() on unknown requests
  ide: filter out invalid DMA xfer mode changes in HDIO_DRIVE_CMD ioctl handler
  ide: do not access ide_drive_t 'drive_data' field directly
  sl82c105: implement test_irq() method
  siimage: implement test_irq() method
  pdc202xx_old: implement test_irq() method (take 2)
  cmd64x: implement test_irq() method
  cmd640: implement test_irq() method
  ide: move ack_intr() method into 'struct ide_port_ops' (take 2)
  ide: move IRQ clearing from ack_intr() method to clear_irq() method (take 2)
  siimage: use ide_dma_test_irq() (take 2)
  cmd64x: implement clear_irq() method (take 2)
  ide: call clear_irq() method in ide_timer_expiry()
  sgiioc4: coding style cleanup
  ide: don't enable IORDY at a probe time
  ide: IORDY handling fixes
  ata: add ata_id_pio_need_iordy() helper (v2)
  ide-tape: fix build issue
  ide: unify interrupt reason checking
  ...
parents 7f818906 39c58f37
...@@ -185,8 +185,7 @@ static void at91_ide_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -185,8 +185,7 @@ static void at91_ide_set_pio_mode(ide_drive_t *drive, const u8 pio)
timing = ide_timing_find_mode(XFER_PIO_0 + pio); timing = ide_timing_find_mode(XFER_PIO_0 + pio);
BUG_ON(!timing); BUG_ON(!timing);
if ((pio > 2 || ata_id_has_iordy(drive->id)) && if (ide_pio_need_iordy(drive, pio))
!(ata_id_is_cfa(drive->id) && pio > 4))
use_iordy = 1; use_iordy = 1;
apply_timings(chipselect, pio, timing, use_iordy); apply_timings(chipselect, pio, timing, use_iordy);
......
...@@ -99,7 +99,7 @@ static const char *buddha_board_name[] = { "Buddha", "Catweasel", "X-Surf" }; ...@@ -99,7 +99,7 @@ static const char *buddha_board_name[] = { "Buddha", "Catweasel", "X-Surf" };
* Check and acknowledge the interrupt status * Check and acknowledge the interrupt status
*/ */
static int buddha_ack_intr(ide_hwif_t *hwif) static int buddha_test_irq(ide_hwif_t *hwif)
{ {
unsigned char ch; unsigned char ch;
...@@ -109,21 +109,16 @@ static int buddha_ack_intr(ide_hwif_t *hwif) ...@@ -109,21 +109,16 @@ static int buddha_ack_intr(ide_hwif_t *hwif)
return 1; return 1;
} }
static int xsurf_ack_intr(ide_hwif_t *hwif) static void xsurf_clear_irq(ide_drive_t *drive)
{ {
unsigned char ch; /*
* X-Surf needs 0 written to IRQ register to ensure ISA bit A11 stays at 0
ch = z_readb(hwif->io_ports.irq_addr); */
/* X-Surf needs a 0 written to IRQ register to ensure ISA bit A11 stays at 0 */ z_writeb(0, drive->hwif->io_ports.irq_addr);
z_writeb(0, hwif->io_ports.irq_addr);
if (!(ch & 0x80))
return 0;
return 1;
} }
static void __init buddha_setup_ports(struct ide_hw *hw, unsigned long base, static void __init buddha_setup_ports(struct ide_hw *hw, unsigned long base,
unsigned long ctl, unsigned long irq_port, unsigned long ctl, unsigned long irq_port)
ide_ack_intr_t *ack_intr)
{ {
int i; int i;
...@@ -138,10 +133,19 @@ static void __init buddha_setup_ports(struct ide_hw *hw, unsigned long base, ...@@ -138,10 +133,19 @@ static void __init buddha_setup_ports(struct ide_hw *hw, unsigned long base,
hw->io_ports.irq_addr = irq_port; hw->io_ports.irq_addr = irq_port;
hw->irq = IRQ_AMIGA_PORTS; hw->irq = IRQ_AMIGA_PORTS;
hw->ack_intr = ack_intr;
} }
static const struct ide_port_ops buddha_port_ops = {
.test_irq = buddha_test_irq,
};
static const struct ide_port_ops xsurf_port_ops = {
.clear_irq = xsurf_clear_irq,
.test_irq = buddha_test_irq,
};
static const struct ide_port_info buddha_port_info = { static const struct ide_port_info buddha_port_info = {
.port_ops = &buddha_port_ops,
.host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_NO_DMA, .host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_NO_DMA,
.irq_flags = IRQF_SHARED, .irq_flags = IRQF_SHARED,
.chipset = ide_generic, .chipset = ide_generic,
...@@ -161,6 +165,7 @@ static int __init buddha_init(void) ...@@ -161,6 +165,7 @@ static int __init buddha_init(void)
while ((z = zorro_find_device(ZORRO_WILDCARD, z))) { while ((z = zorro_find_device(ZORRO_WILDCARD, z))) {
unsigned long board; unsigned long board;
struct ide_hw hw[MAX_NUM_HWIFS], *hws[MAX_NUM_HWIFS]; struct ide_hw hw[MAX_NUM_HWIFS], *hws[MAX_NUM_HWIFS];
struct ide_port_info d = buddha_port_info;
if (z->id == ZORRO_PROD_INDIVIDUAL_COMPUTERS_BUDDHA) { if (z->id == ZORRO_PROD_INDIVIDUAL_COMPUTERS_BUDDHA) {
buddha_num_hwifs = BUDDHA_NUM_HWIFS; buddha_num_hwifs = BUDDHA_NUM_HWIFS;
...@@ -171,6 +176,7 @@ static int __init buddha_init(void) ...@@ -171,6 +176,7 @@ static int __init buddha_init(void)
} else if (z->id == ZORRO_PROD_INDIVIDUAL_COMPUTERS_X_SURF) { } else if (z->id == ZORRO_PROD_INDIVIDUAL_COMPUTERS_X_SURF) {
buddha_num_hwifs = XSURF_NUM_HWIFS; buddha_num_hwifs = XSURF_NUM_HWIFS;
type=BOARD_XSURF; type=BOARD_XSURF;
d.port_ops = &xsurf_port_ops;
} else } else
continue; continue;
...@@ -203,28 +209,24 @@ static int __init buddha_init(void) ...@@ -203,28 +209,24 @@ static int __init buddha_init(void)
for (i = 0; i < buddha_num_hwifs; i++) { for (i = 0; i < buddha_num_hwifs; i++) {
unsigned long base, ctl, irq_port; unsigned long base, ctl, irq_port;
ide_ack_intr_t *ack_intr;
if (type != BOARD_XSURF) { if (type != BOARD_XSURF) {
base = buddha_board + buddha_bases[i]; base = buddha_board + buddha_bases[i];
ctl = base + BUDDHA_CONTROL; ctl = base + BUDDHA_CONTROL;
irq_port = buddha_board + buddha_irqports[i]; irq_port = buddha_board + buddha_irqports[i];
ack_intr = buddha_ack_intr;
} else { } else {
base = buddha_board + xsurf_bases[i]; base = buddha_board + xsurf_bases[i];
/* X-Surf has no CS1* (Control/AltStat) */ /* X-Surf has no CS1* (Control/AltStat) */
ctl = 0; ctl = 0;
irq_port = buddha_board + xsurf_irqports[i]; irq_port = buddha_board + xsurf_irqports[i];
ack_intr = xsurf_ack_intr;
} }
buddha_setup_ports(&hw[i], base, ctl, irq_port, buddha_setup_ports(&hw[i], base, ctl, irq_port);
ack_intr);
hws[i] = &hw[i]; hws[i] = &hw[i];
} }
ide_host_add(&buddha_port_info, hws, i, NULL); ide_host_add(&d, hws, i, NULL);
} }
return 0; return 0;
......
...@@ -153,6 +153,7 @@ static int cmd640_vlb; ...@@ -153,6 +153,7 @@ static int cmd640_vlb;
#define ARTTIM23 0x57 #define ARTTIM23 0x57
#define ARTTIM23_DIS_RA2 0x04 #define ARTTIM23_DIS_RA2 0x04
#define ARTTIM23_DIS_RA3 0x08 #define ARTTIM23_DIS_RA3 0x08
#define ARTTIM23_IDE23INTR 0x10
#define DRWTIM23 0x58 #define DRWTIM23 0x58
#define BRST 0x59 #define BRST 0x59
...@@ -629,12 +630,24 @@ static void cmd640_init_dev(ide_drive_t *drive) ...@@ -629,12 +630,24 @@ static void cmd640_init_dev(ide_drive_t *drive)
#endif /* CONFIG_BLK_DEV_CMD640_ENHANCED */ #endif /* CONFIG_BLK_DEV_CMD640_ENHANCED */
} }
static int cmd640_test_irq(ide_hwif_t *hwif)
{
struct pci_dev *dev = to_pci_dev(hwif->dev);
int irq_reg = hwif->channel ? ARTTIM23 : CFR;
u8 irq_stat, irq_mask = hwif->channel ? ARTTIM23_IDE23INTR :
CFR_IDE01INTR;
pci_read_config_byte(dev, irq_reg, &irq_stat);
return (irq_stat & irq_mask) ? 1 : 0;
}
static const struct ide_port_ops cmd640_port_ops = { static const struct ide_port_ops cmd640_port_ops = {
.init_dev = cmd640_init_dev, .init_dev = cmd640_init_dev,
#ifdef CONFIG_BLK_DEV_CMD640_ENHANCED #ifdef CONFIG_BLK_DEV_CMD640_ENHANCED
.set_pio_mode = cmd640_set_pio_mode, .set_pio_mode = cmd640_set_pio_mode,
#endif #endif
.test_irq = cmd640_test_irq,
}; };
static int pci_conf1(void) static int pci_conf1(void)
......
...@@ -7,7 +7,7 @@ ...@@ -7,7 +7,7 @@
* Copyright (C) 1998 David S. Miller (davem@redhat.com) * Copyright (C) 1998 David S. Miller (davem@redhat.com)
* *
* Copyright (C) 1999-2002 Andre Hedrick <andre@linux-ide.org> * Copyright (C) 1999-2002 Andre Hedrick <andre@linux-ide.org>
* Copyright (C) 2007 MontaVista Software, Inc. <source@mvista.com> * Copyright (C) 2007,2009 MontaVista Software, Inc. <source@mvista.com>
*/ */
#include <linux/module.h> #include <linux/module.h>
...@@ -118,8 +118,9 @@ static void cmd64x_tune_pio(ide_drive_t *drive, const u8 pio) ...@@ -118,8 +118,9 @@ static void cmd64x_tune_pio(ide_drive_t *drive, const u8 pio)
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
struct pci_dev *dev = to_pci_dev(hwif->dev); struct pci_dev *dev = to_pci_dev(hwif->dev);
struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio); struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio);
unsigned long setup_count;
unsigned int cycle_time; unsigned int cycle_time;
u8 setup_count, arttim = 0; u8 arttim = 0;
static const u8 setup_values[] = {0x40, 0x40, 0x40, 0x80, 0, 0xc0}; static const u8 setup_values[] = {0x40, 0x40, 0x40, 0x80, 0, 0xc0};
static const u8 arttim_regs[4] = {ARTTIM0, ARTTIM1, ARTTIM23, ARTTIM23}; static const u8 arttim_regs[4] = {ARTTIM0, ARTTIM1, ARTTIM23, ARTTIM23};
...@@ -140,10 +141,11 @@ static void cmd64x_tune_pio(ide_drive_t *drive, const u8 pio) ...@@ -140,10 +141,11 @@ static void cmd64x_tune_pio(ide_drive_t *drive, const u8 pio)
if (hwif->channel) { if (hwif->channel) {
ide_drive_t *pair = ide_get_pair_dev(drive); ide_drive_t *pair = ide_get_pair_dev(drive);
drive->drive_data = setup_count; ide_set_drivedata(drive, (void *)setup_count);
if (pair) if (pair)
setup_count = max_t(u8, setup_count, pair->drive_data); setup_count = max_t(u8, setup_count,
(unsigned long)ide_get_drivedata(pair));
} }
if (setup_count > 5) /* shouldn't actually happen... */ if (setup_count > 5) /* shouldn't actually happen... */
...@@ -226,11 +228,11 @@ static void cmd64x_set_dma_mode(ide_drive_t *drive, const u8 speed) ...@@ -226,11 +228,11 @@ static void cmd64x_set_dma_mode(ide_drive_t *drive, const u8 speed)
(void) pci_write_config_byte(dev, pciU, regU); (void) pci_write_config_byte(dev, pciU, regU);
} }
static int cmd648_dma_end(ide_drive_t *drive) static void cmd648_clear_irq(ide_drive_t *drive)
{ {
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
unsigned long base = hwif->dma_base - (hwif->channel * 8); struct pci_dev *dev = to_pci_dev(hwif->dev);
int err = ide_dma_end(drive); unsigned long base = pci_resource_start(dev, 4);
u8 irq_mask = hwif->channel ? MRDMODE_INTR_CH1 : u8 irq_mask = hwif->channel ? MRDMODE_INTR_CH1 :
MRDMODE_INTR_CH0; MRDMODE_INTR_CH0;
u8 mrdmode = inb(base + 1); u8 mrdmode = inb(base + 1);
...@@ -238,11 +240,9 @@ static int cmd648_dma_end(ide_drive_t *drive) ...@@ -238,11 +240,9 @@ static int cmd648_dma_end(ide_drive_t *drive)
/* clear the interrupt bit */ /* clear the interrupt bit */
outb((mrdmode & ~(MRDMODE_INTR_CH0 | MRDMODE_INTR_CH1)) | irq_mask, outb((mrdmode & ~(MRDMODE_INTR_CH0 | MRDMODE_INTR_CH1)) | irq_mask,
base + 1); base + 1);
return err;
} }
static int cmd64x_dma_end(ide_drive_t *drive) static void cmd64x_clear_irq(ide_drive_t *drive)
{ {
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
struct pci_dev *dev = to_pci_dev(hwif->dev); struct pci_dev *dev = to_pci_dev(hwif->dev);
...@@ -250,62 +250,40 @@ static int cmd64x_dma_end(ide_drive_t *drive) ...@@ -250,62 +250,40 @@ static int cmd64x_dma_end(ide_drive_t *drive)
u8 irq_mask = hwif->channel ? ARTTIM23_INTR_CH1 : u8 irq_mask = hwif->channel ? ARTTIM23_INTR_CH1 :
CFR_INTR_CH0; CFR_INTR_CH0;
u8 irq_stat = 0; u8 irq_stat = 0;
int err = ide_dma_end(drive);
(void) pci_read_config_byte(dev, irq_reg, &irq_stat); (void) pci_read_config_byte(dev, irq_reg, &irq_stat);
/* clear the interrupt bit */ /* clear the interrupt bit */
(void) pci_write_config_byte(dev, irq_reg, irq_stat | irq_mask); (void) pci_write_config_byte(dev, irq_reg, irq_stat | irq_mask);
return err;
} }
static int cmd648_dma_test_irq(ide_drive_t *drive) static int cmd648_test_irq(ide_hwif_t *hwif)
{ {
ide_hwif_t *hwif = drive->hwif; struct pci_dev *dev = to_pci_dev(hwif->dev);
unsigned long base = hwif->dma_base - (hwif->channel * 8); unsigned long base = pci_resource_start(dev, 4);
u8 irq_mask = hwif->channel ? MRDMODE_INTR_CH1 : u8 irq_mask = hwif->channel ? MRDMODE_INTR_CH1 :
MRDMODE_INTR_CH0; MRDMODE_INTR_CH0;
u8 dma_stat = inb(hwif->dma_base + ATA_DMA_STATUS);
u8 mrdmode = inb(base + 1); u8 mrdmode = inb(base + 1);
#ifdef DEBUG pr_debug("%s: mrdmode: 0x%02x irq_mask: 0x%02x\n",
printk("%s: dma_stat: 0x%02x mrdmode: 0x%02x irq_mask: 0x%02x\n", hwif->name, mrdmode, irq_mask);
drive->name, dma_stat, mrdmode, irq_mask);
#endif
if (!(mrdmode & irq_mask))
return 0;
/* return 1 if INTR asserted */ return (mrdmode & irq_mask) ? 1 : 0;
if (dma_stat & 4)
return 1;
return 0;
} }
static int cmd64x_dma_test_irq(ide_drive_t *drive) static int cmd64x_test_irq(ide_hwif_t *hwif)
{ {
ide_hwif_t *hwif = drive->hwif;
struct pci_dev *dev = to_pci_dev(hwif->dev); struct pci_dev *dev = to_pci_dev(hwif->dev);
int irq_reg = hwif->channel ? ARTTIM23 : CFR; int irq_reg = hwif->channel ? ARTTIM23 : CFR;
u8 irq_mask = hwif->channel ? ARTTIM23_INTR_CH1 : u8 irq_mask = hwif->channel ? ARTTIM23_INTR_CH1 :
CFR_INTR_CH0; CFR_INTR_CH0;
u8 dma_stat = inb(hwif->dma_base + ATA_DMA_STATUS);
u8 irq_stat = 0; u8 irq_stat = 0;
(void) pci_read_config_byte(dev, irq_reg, &irq_stat); (void) pci_read_config_byte(dev, irq_reg, &irq_stat);
#ifdef DEBUG pr_debug("%s: irq_stat: 0x%02x irq_mask: 0x%02x\n",
printk("%s: dma_stat: 0x%02x irq_stat: 0x%02x irq_mask: 0x%02x\n", hwif->name, irq_stat, irq_mask);
drive->name, dma_stat, irq_stat, irq_mask);
#endif
if (!(irq_stat & irq_mask))
return 0;
/* return 1 if INTR asserted */
if (dma_stat & 4)
return 1;
return 0; return (irq_stat & irq_mask) ? 1 : 0;
} }
/* /*
...@@ -370,18 +348,17 @@ static u8 cmd64x_cable_detect(ide_hwif_t *hwif) ...@@ -370,18 +348,17 @@ static u8 cmd64x_cable_detect(ide_hwif_t *hwif)
static const struct ide_port_ops cmd64x_port_ops = { static const struct ide_port_ops cmd64x_port_ops = {
.set_pio_mode = cmd64x_set_pio_mode, .set_pio_mode = cmd64x_set_pio_mode,
.set_dma_mode = cmd64x_set_dma_mode, .set_dma_mode = cmd64x_set_dma_mode,
.clear_irq = cmd64x_clear_irq,
.test_irq = cmd64x_test_irq,
.cable_detect = cmd64x_cable_detect, .cable_detect = cmd64x_cable_detect,
}; };
static const struct ide_dma_ops cmd64x_dma_ops = { static const struct ide_port_ops cmd648_port_ops = {
.dma_host_set = ide_dma_host_set, .set_pio_mode = cmd64x_set_pio_mode,
.dma_setup = ide_dma_setup, .set_dma_mode = cmd64x_set_dma_mode,
.dma_start = ide_dma_start, .clear_irq = cmd648_clear_irq,
.dma_end = cmd64x_dma_end, .test_irq = cmd648_test_irq,
.dma_test_irq = cmd64x_dma_test_irq, .cable_detect = cmd64x_cable_detect,
.dma_lost_irq = ide_dma_lost_irq,
.dma_timer_expiry = ide_dma_sff_timer_expiry,
.dma_sff_read_status = ide_dma_sff_read_status,
}; };
static const struct ide_dma_ops cmd646_rev1_dma_ops = { static const struct ide_dma_ops cmd646_rev1_dma_ops = {
...@@ -395,24 +372,12 @@ static const struct ide_dma_ops cmd646_rev1_dma_ops = { ...@@ -395,24 +372,12 @@ static const struct ide_dma_ops cmd646_rev1_dma_ops = {
.dma_sff_read_status = ide_dma_sff_read_status, .dma_sff_read_status = ide_dma_sff_read_status,
}; };
static const struct ide_dma_ops cmd648_dma_ops = {
.dma_host_set = ide_dma_host_set,
.dma_setup = ide_dma_setup,
.dma_start = ide_dma_start,
.dma_end = cmd648_dma_end,
.dma_test_irq = cmd648_dma_test_irq,
.dma_lost_irq = ide_dma_lost_irq,
.dma_timer_expiry = ide_dma_sff_timer_expiry,
.dma_sff_read_status = ide_dma_sff_read_status,
};
static const struct ide_port_info cmd64x_chipsets[] __devinitdata = { static const struct ide_port_info cmd64x_chipsets[] __devinitdata = {
{ /* 0: CMD643 */ { /* 0: CMD643 */
.name = DRV_NAME, .name = DRV_NAME,
.init_chipset = init_chipset_cmd64x, .init_chipset = init_chipset_cmd64x,
.enablebits = {{0x00,0x00,0x00}, {0x51,0x08,0x08}}, .enablebits = {{0x00,0x00,0x00}, {0x51,0x08,0x08}},
.port_ops = &cmd64x_port_ops, .port_ops = &cmd64x_port_ops,
.dma_ops = &cmd64x_dma_ops,
.host_flags = IDE_HFLAG_CLEAR_SIMPLEX | .host_flags = IDE_HFLAG_CLEAR_SIMPLEX |
IDE_HFLAG_ABUSE_PREFETCH, IDE_HFLAG_ABUSE_PREFETCH,
.pio_mask = ATA_PIO5, .pio_mask = ATA_PIO5,
...@@ -423,8 +388,7 @@ static const struct ide_port_info cmd64x_chipsets[] __devinitdata = { ...@@ -423,8 +388,7 @@ static const struct ide_port_info cmd64x_chipsets[] __devinitdata = {
.name = DRV_NAME, .name = DRV_NAME,
.init_chipset = init_chipset_cmd64x, .init_chipset = init_chipset_cmd64x,
.enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}}, .enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}},
.port_ops = &cmd64x_port_ops, .port_ops = &cmd648_port_ops,
.dma_ops = &cmd648_dma_ops,
.host_flags = IDE_HFLAG_SERIALIZE | .host_flags = IDE_HFLAG_SERIALIZE |
IDE_HFLAG_ABUSE_PREFETCH, IDE_HFLAG_ABUSE_PREFETCH,
.pio_mask = ATA_PIO5, .pio_mask = ATA_PIO5,
...@@ -435,8 +399,7 @@ static const struct ide_port_info cmd64x_chipsets[] __devinitdata = { ...@@ -435,8 +399,7 @@ static const struct ide_port_info cmd64x_chipsets[] __devinitdata = {
.name = DRV_NAME, .name = DRV_NAME,
.init_chipset = init_chipset_cmd64x, .init_chipset = init_chipset_cmd64x,
.enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}}, .enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}},
.port_ops = &cmd64x_port_ops, .port_ops = &cmd648_port_ops,
.dma_ops = &cmd648_dma_ops,
.host_flags = IDE_HFLAG_ABUSE_PREFETCH, .host_flags = IDE_HFLAG_ABUSE_PREFETCH,
.pio_mask = ATA_PIO5, .pio_mask = ATA_PIO5,
.mwdma_mask = ATA_MWDMA2, .mwdma_mask = ATA_MWDMA2,
...@@ -446,8 +409,7 @@ static const struct ide_port_info cmd64x_chipsets[] __devinitdata = { ...@@ -446,8 +409,7 @@ static const struct ide_port_info cmd64x_chipsets[] __devinitdata = {
.name = DRV_NAME, .name = DRV_NAME,
.init_chipset = init_chipset_cmd64x, .init_chipset = init_chipset_cmd64x,
.enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}}, .enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}},
.port_ops = &cmd64x_port_ops, .port_ops = &cmd648_port_ops,
.dma_ops = &cmd648_dma_ops,
.host_flags = IDE_HFLAG_ABUSE_PREFETCH, .host_flags = IDE_HFLAG_ABUSE_PREFETCH,
.pio_mask = ATA_PIO5, .pio_mask = ATA_PIO5,
.mwdma_mask = ATA_MWDMA2, .mwdma_mask = ATA_MWDMA2,
...@@ -484,10 +446,9 @@ static int __devinit cmd64x_init_one(struct pci_dev *dev, const struct pci_devic ...@@ -484,10 +446,9 @@ static int __devinit cmd64x_init_one(struct pci_dev *dev, const struct pci_devic
*/ */
if (dev->revision < 3) { if (dev->revision < 3) {
d.enablebits[0].reg = 0; d.enablebits[0].reg = 0;
d.port_ops = &cmd64x_port_ops;
if (dev->revision == 1) if (dev->revision == 1)
d.dma_ops = &cmd646_rev1_dma_ops; d.dma_ops = &cmd646_rev1_dma_ops;
else
d.dma_ops = &cmd64x_dma_ops;
} }
} }
} }
......
...@@ -146,14 +146,16 @@ static void cs5536_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -146,14 +146,16 @@ static void cs5536_set_pio_mode(ide_drive_t *drive, const u8 pio)
struct pci_dev *pdev = to_pci_dev(drive->hwif->dev); struct pci_dev *pdev = to_pci_dev(drive->hwif->dev);
ide_drive_t *pair = ide_get_pair_dev(drive); ide_drive_t *pair = ide_get_pair_dev(drive);
int cshift = (drive->dn & 1) ? IDE_CAST_D1_SHIFT : IDE_CAST_D0_SHIFT; int cshift = (drive->dn & 1) ? IDE_CAST_D1_SHIFT : IDE_CAST_D0_SHIFT;
unsigned long timings = (unsigned long)ide_get_drivedata(drive);
u32 cast; u32 cast;
u8 cmd_pio = pio; u8 cmd_pio = pio;
if (pair) if (pair)
cmd_pio = min(pio, ide_get_best_pio_mode(pair, 255, 4)); cmd_pio = min(pio, ide_get_best_pio_mode(pair, 255, 4));
drive->drive_data &= (IDE_DRV_MASK << 8); timings &= (IDE_DRV_MASK << 8);
drive->drive_data |= drv_timings[pio]; timings |= drv_timings[pio];
ide_set_drivedata(drive, (void *)timings);
cs5536_program_dtc(drive, drv_timings[pio]); cs5536_program_dtc(drive, drv_timings[pio]);
...@@ -186,6 +188,7 @@ static void cs5536_set_dma_mode(ide_drive_t *drive, const u8 mode) ...@@ -186,6 +188,7 @@ static void cs5536_set_dma_mode(ide_drive_t *drive, const u8 mode)
struct pci_dev *pdev = to_pci_dev(drive->hwif->dev); struct pci_dev *pdev = to_pci_dev(drive->hwif->dev);
int dshift = (drive->dn & 1) ? IDE_D1_SHIFT : IDE_D0_SHIFT; int dshift = (drive->dn & 1) ? IDE_D1_SHIFT : IDE_D0_SHIFT;
unsigned long timings = (unsigned long)ide_get_drivedata(drive);
u32 etc; u32 etc;
cs5536_read(pdev, ETC, &etc); cs5536_read(pdev, ETC, &etc);
...@@ -195,8 +198,9 @@ static void cs5536_set_dma_mode(ide_drive_t *drive, const u8 mode) ...@@ -195,8 +198,9 @@ static void cs5536_set_dma_mode(ide_drive_t *drive, const u8 mode)
etc |= udma_timings[mode - XFER_UDMA_0] << dshift; etc |= udma_timings[mode - XFER_UDMA_0] << dshift;
} else { /* MWDMA */ } else { /* MWDMA */
etc &= ~(IDE_ETC_UDMA_MASK << dshift); etc &= ~(IDE_ETC_UDMA_MASK << dshift);
drive->drive_data &= IDE_DRV_MASK; timings &= IDE_DRV_MASK;
drive->drive_data |= mwdma_timings[mode - XFER_MW_DMA_0] << 8; timings |= mwdma_timings[mode - XFER_MW_DMA_0] << 8;
ide_set_drivedata(drive, (void *)timings);
} }
cs5536_write(pdev, ETC, etc); cs5536_write(pdev, ETC, etc);
...@@ -204,9 +208,11 @@ static void cs5536_set_dma_mode(ide_drive_t *drive, const u8 mode) ...@@ -204,9 +208,11 @@ static void cs5536_set_dma_mode(ide_drive_t *drive, const u8 mode)
static void cs5536_dma_start(ide_drive_t *drive) static void cs5536_dma_start(ide_drive_t *drive)
{ {
unsigned long timings = (unsigned long)ide_get_drivedata(drive);
if (drive->current_speed < XFER_UDMA_0 && if (drive->current_speed < XFER_UDMA_0 &&
(drive->drive_data >> 8) != (drive->drive_data & IDE_DRV_MASK)) (timings >> 8) != (timings & IDE_DRV_MASK))
cs5536_program_dtc(drive, drive->drive_data >> 8); cs5536_program_dtc(drive, timings >> 8);
ide_dma_start(drive); ide_dma_start(drive);
} }
...@@ -214,10 +220,11 @@ static void cs5536_dma_start(ide_drive_t *drive) ...@@ -214,10 +220,11 @@ static void cs5536_dma_start(ide_drive_t *drive)
static int cs5536_dma_end(ide_drive_t *drive) static int cs5536_dma_end(ide_drive_t *drive)
{ {
int ret = ide_dma_end(drive); int ret = ide_dma_end(drive);
unsigned long timings = (unsigned long)ide_get_drivedata(drive);
if (drive->current_speed < XFER_UDMA_0 && if (drive->current_speed < XFER_UDMA_0 &&
(drive->drive_data >> 8) != (drive->drive_data & IDE_DRV_MASK)) (timings >> 8) != (timings & IDE_DRV_MASK))
cs5536_program_dtc(drive, drive->drive_data & IDE_DRV_MASK); cs5536_program_dtc(drive, timings & IDE_DRV_MASK);
return ret; return ret;
} }
......
...@@ -128,7 +128,6 @@ static void __init falconide_setup_ports(struct ide_hw *hw) ...@@ -128,7 +128,6 @@ static void __init falconide_setup_ports(struct ide_hw *hw)
hw->io_ports.ctl_addr = ATA_HD_BASE + ATA_HD_CONTROL; hw->io_ports.ctl_addr = ATA_HD_BASE + ATA_HD_CONTROL;
hw->irq = IRQ_MFP_IDE; hw->irq = IRQ_MFP_IDE;
hw->ack_intr = NULL;
} }
/* /*
......
...@@ -66,7 +66,7 @@ MODULE_PARM_DESC(doubler, "enable support for IDE doublers"); ...@@ -66,7 +66,7 @@ MODULE_PARM_DESC(doubler, "enable support for IDE doublers");
* Check and acknowledge the interrupt status * Check and acknowledge the interrupt status
*/ */
static int gayle_ack_intr_a4000(ide_hwif_t *hwif) static int gayle_test_irq(ide_hwif_t *hwif)
{ {
unsigned char ch; unsigned char ch;
...@@ -76,21 +76,16 @@ static int gayle_ack_intr_a4000(ide_hwif_t *hwif) ...@@ -76,21 +76,16 @@ static int gayle_ack_intr_a4000(ide_hwif_t *hwif)
return 1; return 1;
} }
static int gayle_ack_intr_a1200(ide_hwif_t *hwif) static void gayle_a1200_clear_irq(ide_drive_t *drive)
{ {
unsigned char ch; ide_hwif_t *hwif = drive->hwif;
ch = z_readb(hwif->io_ports.irq_addr);
if (!(ch & GAYLE_IRQ_IDE))
return 0;
(void)z_readb(hwif->io_ports.status_addr); (void)z_readb(hwif->io_ports.status_addr);
z_writeb(0x7c, hwif->io_ports.irq_addr); z_writeb(0x7c, hwif->io_ports.irq_addr);
return 1;
} }
static void __init gayle_setup_ports(struct ide_hw *hw, unsigned long base, static void __init gayle_setup_ports(struct ide_hw *hw, unsigned long base,
unsigned long ctl, unsigned long irq_port, unsigned long ctl, unsigned long irq_port)
ide_ack_intr_t *ack_intr)
{ {
int i; int i;
...@@ -105,9 +100,17 @@ static void __init gayle_setup_ports(struct ide_hw *hw, unsigned long base, ...@@ -105,9 +100,17 @@ static void __init gayle_setup_ports(struct ide_hw *hw, unsigned long base,
hw->io_ports.irq_addr = irq_port; hw->io_ports.irq_addr = irq_port;
hw->irq = IRQ_AMIGA_PORTS; hw->irq = IRQ_AMIGA_PORTS;
hw->ack_intr = ack_intr;
} }
static const struct ide_port_ops gayle_a4000_port_ops = {
.test_irq = gayle_test_irq,
};
static const struct ide_port_ops gayle_a1200_port_ops = {
.clear_irq = gayle_a1200_clear_irq,
.test_irq = gayle_test_irq,
};
static const struct ide_port_info gayle_port_info = { static const struct ide_port_info gayle_port_info = {
.host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_SERIALIZE | .host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_SERIALIZE |
IDE_HFLAG_NO_DMA, IDE_HFLAG_NO_DMA,
...@@ -123,9 +126,9 @@ static int __init gayle_init(void) ...@@ -123,9 +126,9 @@ static int __init gayle_init(void)
{ {
unsigned long phys_base, res_start, res_n; unsigned long phys_base, res_start, res_n;
unsigned long base, ctrlport, irqport; unsigned long base, ctrlport, irqport;
ide_ack_intr_t *ack_intr;
int a4000, i, rc; int a4000, i, rc;
struct ide_hw hw[GAYLE_NUM_HWIFS], *hws[GAYLE_NUM_HWIFS]; struct ide_hw hw[GAYLE_NUM_HWIFS], *hws[GAYLE_NUM_HWIFS];
struct ide_port_info d = gayle_port_info;
if (!MACH_IS_AMIGA) if (!MACH_IS_AMIGA)
return -ENODEV; return -ENODEV;
...@@ -148,11 +151,11 @@ static int __init gayle_init(void) ...@@ -148,11 +151,11 @@ static int __init gayle_init(void)
if (a4000) { if (a4000) {
phys_base = GAYLE_BASE_4000; phys_base = GAYLE_BASE_4000;
irqport = (unsigned long)ZTWO_VADDR(GAYLE_IRQ_4000); irqport = (unsigned long)ZTWO_VADDR(GAYLE_IRQ_4000);
ack_intr = gayle_ack_intr_a4000; d.port_ops = &gayle_a4000_port_ops;
} else { } else {
phys_base = GAYLE_BASE_1200; phys_base = GAYLE_BASE_1200;
irqport = (unsigned long)ZTWO_VADDR(GAYLE_IRQ_1200); irqport = (unsigned long)ZTWO_VADDR(GAYLE_IRQ_1200);
ack_intr = gayle_ack_intr_a1200; d.port_ops = &gayle_a1200_port_ops;
} }
res_start = ((unsigned long)phys_base) & ~(GAYLE_NEXT_PORT-1); res_start = ((unsigned long)phys_base) & ~(GAYLE_NEXT_PORT-1);
...@@ -165,12 +168,12 @@ static int __init gayle_init(void) ...@@ -165,12 +168,12 @@ static int __init gayle_init(void)
base = (unsigned long)ZTWO_VADDR(phys_base + i * GAYLE_NEXT_PORT); base = (unsigned long)ZTWO_VADDR(phys_base + i * GAYLE_NEXT_PORT);
ctrlport = GAYLE_HAS_CONTROL_REG ? (base + GAYLE_CONTROL) : 0; ctrlport = GAYLE_HAS_CONTROL_REG ? (base + GAYLE_CONTROL) : 0;
gayle_setup_ports(&hw[i], base, ctrlport, irqport, ack_intr); gayle_setup_ports(&hw[i], base, ctrlport, irqport);
hws[i] = &hw[i]; hws[i] = &hw[i];
} }
rc = ide_host_add(&gayle_port_info, hws, i, NULL); rc = ide_host_add(&d, hws, i, NULL);
if (rc) if (rc)
release_mem_region(res_start, res_n); release_mem_region(res_start, res_n);
......
...@@ -44,7 +44,12 @@ ...@@ -44,7 +44,12 @@
* bit3 (0x08): "1" 3 cycle time, "0" 2 cycle time (?) * bit3 (0x08): "1" 3 cycle time, "0" 2 cycle time (?)
*/ */
#define HT_CONFIG_PORT 0x3e6 #define HT_CONFIG_PORT 0x3e6
#define HT_CONFIG(drivea) (u8)(((drivea)->drive_data & 0xff00) >> 8)
static inline u8 HT_CONFIG(ide_drive_t *drive)
{
return ((unsigned long)ide_get_drivedata(drive) & 0xff00) >> 8;
}
/* /*
* FIFO + PREFETCH (both a/b-model) * FIFO + PREFETCH (both a/b-model)
*/ */
...@@ -90,7 +95,11 @@ ...@@ -90,7 +95,11 @@
* Active Time for each drive. Smaller value gives higher speed. * Active Time for each drive. Smaller value gives higher speed.
* In case of failures you should probably fall back to a higher value. * In case of failures you should probably fall back to a higher value.
*/ */
#define HT_TIMING(drivea) (u8)((drivea)->drive_data & 0x00ff) static inline u8 HT_TIMING(ide_drive_t *drive)
{
return (unsigned long)ide_get_drivedata(drive) & 0x00ff;
}
#define HT_TIMING_DEFAULT 0xff #define HT_TIMING_DEFAULT 0xff
/* /*
...@@ -242,23 +251,27 @@ static DEFINE_SPINLOCK(ht6560b_lock); ...@@ -242,23 +251,27 @@ static DEFINE_SPINLOCK(ht6560b_lock);
*/ */
static void ht_set_prefetch(ide_drive_t *drive, u8 state) static void ht_set_prefetch(ide_drive_t *drive, u8 state)
{ {
unsigned long flags; unsigned long flags, config;
int t = HT_PREFETCH_MODE << 8; int t = HT_PREFETCH_MODE << 8;
spin_lock_irqsave(&ht6560b_lock, flags); spin_lock_irqsave(&ht6560b_lock, flags);
config = (unsigned long)ide_get_drivedata(drive);
/* /*
* Prefetch mode and unmask irq seems to conflict * Prefetch mode and unmask irq seems to conflict
*/ */
if (state) { if (state) {
drive->drive_data |= t; /* enable prefetch mode */ config |= t; /* enable prefetch mode */
drive->dev_flags |= IDE_DFLAG_NO_UNMASK; drive->dev_flags |= IDE_DFLAG_NO_UNMASK;
drive->dev_flags &= ~IDE_DFLAG_UNMASK; drive->dev_flags &= ~IDE_DFLAG_UNMASK;
} else { } else {
drive->drive_data &= ~t; /* disable prefetch mode */ config &= ~t; /* disable prefetch mode */
drive->dev_flags &= ~IDE_DFLAG_NO_UNMASK; drive->dev_flags &= ~IDE_DFLAG_NO_UNMASK;
} }
ide_set_drivedata(drive, (void *)config);
spin_unlock_irqrestore(&ht6560b_lock, flags); spin_unlock_irqrestore(&ht6560b_lock, flags);
#ifdef DEBUG #ifdef DEBUG
...@@ -268,7 +281,7 @@ static void ht_set_prefetch(ide_drive_t *drive, u8 state) ...@@ -268,7 +281,7 @@ static void ht_set_prefetch(ide_drive_t *drive, u8 state)
static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio) static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio)
{ {
unsigned long flags; unsigned long flags, config;
u8 timing; u8 timing;
switch (pio) { switch (pio) {
...@@ -281,8 +294,10 @@ static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -281,8 +294,10 @@ static void ht6560b_set_pio_mode(ide_drive_t *drive, const u8 pio)
timing = ht_pio2timings(drive, pio); timing = ht_pio2timings(drive, pio);
spin_lock_irqsave(&ht6560b_lock, flags); spin_lock_irqsave(&ht6560b_lock, flags);
drive->drive_data &= 0xff00; config = (unsigned long)ide_get_drivedata(drive);
drive->drive_data |= timing; config &= 0xff00;
config |= timing;
ide_set_drivedata(drive, (void *)config);
spin_unlock_irqrestore(&ht6560b_lock, flags); spin_unlock_irqrestore(&ht6560b_lock, flags);
#ifdef DEBUG #ifdef DEBUG
...@@ -299,7 +314,7 @@ static void __init ht6560b_init_dev(ide_drive_t *drive) ...@@ -299,7 +314,7 @@ static void __init ht6560b_init_dev(ide_drive_t *drive)
if (hwif->channel) if (hwif->channel)
t |= (HT_SECONDARY_IF << 8); t |= (HT_SECONDARY_IF << 8);
drive->drive_data = t; ide_set_drivedata(drive, (void *)t);
} }
static int probe_ht6560b; static int probe_ht6560b;
......
...@@ -187,7 +187,8 @@ static const expansioncard_ops_t icside_ops_arcin_v6 = { ...@@ -187,7 +187,8 @@ static const expansioncard_ops_t icside_ops_arcin_v6 = {
*/ */
static void icside_set_dma_mode(ide_drive_t *drive, const u8 xfer_mode) static void icside_set_dma_mode(ide_drive_t *drive, const u8 xfer_mode)
{ {
int cycle_time, use_dma_info = 0; unsigned long cycle_time;
int use_dma_info = 0;
switch (xfer_mode) { switch (xfer_mode) {
case XFER_MW_DMA_2: case XFER_MW_DMA_2:
...@@ -218,10 +219,11 @@ static void icside_set_dma_mode(ide_drive_t *drive, const u8 xfer_mode) ...@@ -218,10 +219,11 @@ static void icside_set_dma_mode(ide_drive_t *drive, const u8 xfer_mode)
if (use_dma_info && drive->id[ATA_ID_EIDE_DMA_TIME] > cycle_time) if (use_dma_info && drive->id[ATA_ID_EIDE_DMA_TIME] > cycle_time)
cycle_time = drive->id[ATA_ID_EIDE_DMA_TIME]; cycle_time = drive->id[ATA_ID_EIDE_DMA_TIME];
drive->drive_data = cycle_time; ide_set_drivedata(drive, (void *)cycle_time);
printk("%s: %s selected (peak %dMB/s)\n", drive->name, printk("%s: %s selected (peak %dMB/s)\n", drive->name,
ide_xfer_verbose(xfer_mode), 2000 / drive->drive_data); ide_xfer_verbose(xfer_mode),
2000 / (unsigned long)ide_get_drivedata(drive));
} }
static const struct ide_port_ops icside_v6_port_ops = { static const struct ide_port_ops icside_v6_port_ops = {
...@@ -277,7 +279,7 @@ static int icside_dma_setup(ide_drive_t *drive, struct ide_cmd *cmd) ...@@ -277,7 +279,7 @@ static int icside_dma_setup(ide_drive_t *drive, struct ide_cmd *cmd)
/* /*
* Select the correct timing for this drive. * Select the correct timing for this drive.
*/ */
set_dma_speed(ec->dma, drive->drive_data); set_dma_speed(ec->dma, (unsigned long)ide_get_drivedata(drive));
/* /*
* Tell the DMA engine about the SG table and * Tell the DMA engine about the SG table and
......
...@@ -10,6 +10,9 @@ ...@@ -10,6 +10,9 @@
#include <scsi/scsi.h> #include <scsi/scsi.h>
#define DRV_NAME "ide-atapi"
#define PFX DRV_NAME ": "
#ifdef DEBUG #ifdef DEBUG
#define debug_log(fmt, args...) \ #define debug_log(fmt, args...) \
printk(KERN_INFO "ide: " fmt, ## args) printk(KERN_INFO "ide: " fmt, ## args)
...@@ -74,8 +77,6 @@ EXPORT_SYMBOL_GPL(ide_check_atapi_device); ...@@ -74,8 +77,6 @@ EXPORT_SYMBOL_GPL(ide_check_atapi_device);
void ide_init_pc(struct ide_atapi_pc *pc) void ide_init_pc(struct ide_atapi_pc *pc)
{ {
memset(pc, 0, sizeof(*pc)); memset(pc, 0, sizeof(*pc));
pc->buf = pc->pc_buf;
pc->buf_size = IDE_PC_BUFFER_SIZE;
} }
EXPORT_SYMBOL_GPL(ide_init_pc); EXPORT_SYMBOL_GPL(ide_init_pc);
...@@ -84,7 +85,7 @@ EXPORT_SYMBOL_GPL(ide_init_pc); ...@@ -84,7 +85,7 @@ EXPORT_SYMBOL_GPL(ide_init_pc);
* and wait for it to be serviced. * and wait for it to be serviced.
*/ */
int ide_queue_pc_tail(ide_drive_t *drive, struct gendisk *disk, int ide_queue_pc_tail(ide_drive_t *drive, struct gendisk *disk,
struct ide_atapi_pc *pc) struct ide_atapi_pc *pc, void *buf, unsigned int bufflen)
{ {
struct request *rq; struct request *rq;
int error; int error;
...@@ -93,8 +94,8 @@ int ide_queue_pc_tail(ide_drive_t *drive, struct gendisk *disk, ...@@ -93,8 +94,8 @@ int ide_queue_pc_tail(ide_drive_t *drive, struct gendisk *disk,
rq->cmd_type = REQ_TYPE_SPECIAL; rq->cmd_type = REQ_TYPE_SPECIAL;
rq->special = (char *)pc; rq->special = (char *)pc;
if (pc->req_xfer) { if (buf && bufflen) {
error = blk_rq_map_kern(drive->queue, rq, pc->buf, pc->req_xfer, error = blk_rq_map_kern(drive->queue, rq, buf, bufflen,
GFP_NOIO); GFP_NOIO);
if (error) if (error)
goto put_req; goto put_req;
...@@ -117,7 +118,7 @@ int ide_do_test_unit_ready(ide_drive_t *drive, struct gendisk *disk) ...@@ -117,7 +118,7 @@ int ide_do_test_unit_ready(ide_drive_t *drive, struct gendisk *disk)
ide_init_pc(&pc); ide_init_pc(&pc);
pc.c[0] = TEST_UNIT_READY; pc.c[0] = TEST_UNIT_READY;
return ide_queue_pc_tail(drive, disk, &pc); return ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
} }
EXPORT_SYMBOL_GPL(ide_do_test_unit_ready); EXPORT_SYMBOL_GPL(ide_do_test_unit_ready);
...@@ -132,7 +133,7 @@ int ide_do_start_stop(ide_drive_t *drive, struct gendisk *disk, int start) ...@@ -132,7 +133,7 @@ int ide_do_start_stop(ide_drive_t *drive, struct gendisk *disk, int start)
if (drive->media == ide_tape) if (drive->media == ide_tape)
pc.flags |= PC_FLAG_WAIT_FOR_DSC; pc.flags |= PC_FLAG_WAIT_FOR_DSC;
return ide_queue_pc_tail(drive, disk, &pc); return ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
} }
EXPORT_SYMBOL_GPL(ide_do_start_stop); EXPORT_SYMBOL_GPL(ide_do_start_stop);
...@@ -147,7 +148,7 @@ int ide_set_media_lock(ide_drive_t *drive, struct gendisk *disk, int on) ...@@ -147,7 +148,7 @@ int ide_set_media_lock(ide_drive_t *drive, struct gendisk *disk, int on)
pc.c[0] = ALLOW_MEDIUM_REMOVAL; pc.c[0] = ALLOW_MEDIUM_REMOVAL;
pc.c[4] = on; pc.c[4] = on;
return ide_queue_pc_tail(drive, disk, &pc); return ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
} }
EXPORT_SYMBOL_GPL(ide_set_media_lock); EXPORT_SYMBOL_GPL(ide_set_media_lock);
...@@ -172,8 +173,6 @@ void ide_prep_sense(ide_drive_t *drive, struct request *rq) ...@@ -172,8 +173,6 @@ void ide_prep_sense(ide_drive_t *drive, struct request *rq)
unsigned int cmd_len, sense_len; unsigned int cmd_len, sense_len;
int err; int err;
debug_log("%s: enter\n", __func__);
switch (drive->media) { switch (drive->media) {
case ide_floppy: case ide_floppy:
cmd_len = 255; cmd_len = 255;
...@@ -201,8 +200,8 @@ void ide_prep_sense(ide_drive_t *drive, struct request *rq) ...@@ -201,8 +200,8 @@ void ide_prep_sense(ide_drive_t *drive, struct request *rq)
GFP_NOIO); GFP_NOIO);
if (unlikely(err)) { if (unlikely(err)) {
if (printk_ratelimit()) if (printk_ratelimit())
printk(KERN_WARNING "%s: failed to map sense buffer\n", printk(KERN_WARNING PFX "%s: failed to map sense "
drive->name); "buffer\n", drive->name);
return; return;
} }
...@@ -223,7 +222,7 @@ int ide_queue_sense_rq(ide_drive_t *drive, void *special) ...@@ -223,7 +222,7 @@ int ide_queue_sense_rq(ide_drive_t *drive, void *special)
{ {
/* deferred failure from ide_prep_sense() */ /* deferred failure from ide_prep_sense() */
if (!drive->sense_rq_armed) { if (!drive->sense_rq_armed) {
printk(KERN_WARNING "%s: failed queue sense request\n", printk(KERN_WARNING PFX "%s: error queuing a sense request\n",
drive->name); drive->name);
return -ENOMEM; return -ENOMEM;
} }
...@@ -255,8 +254,6 @@ void ide_retry_pc(ide_drive_t *drive) ...@@ -255,8 +254,6 @@ void ide_retry_pc(ide_drive_t *drive)
/* init pc from sense_rq */ /* init pc from sense_rq */
ide_init_pc(pc); ide_init_pc(pc);
memcpy(pc->c, sense_rq->cmd, 12); memcpy(pc->c, sense_rq->cmd, 12);
pc->buf = bio_data(sense_rq->bio); /* pointer to mapped address */
pc->req_xfer = blk_rq_bytes(sense_rq);
if (drive->media == ide_tape) if (drive->media == ide_tape)
drive->atapi_flags |= IDE_AFLAG_IGNORE_DSC; drive->atapi_flags |= IDE_AFLAG_IGNORE_DSC;
...@@ -298,7 +295,7 @@ int ide_cd_expiry(ide_drive_t *drive) ...@@ -298,7 +295,7 @@ int ide_cd_expiry(ide_drive_t *drive)
break; break;
default: default:
if (!(rq->cmd_flags & REQ_QUIET)) if (!(rq->cmd_flags & REQ_QUIET))
printk(KERN_INFO "cmd 0x%x timed out\n", printk(KERN_INFO PFX "cmd 0x%x timed out\n",
rq->cmd[0]); rq->cmd[0]);
wait = 0; wait = 0;
break; break;
...@@ -331,6 +328,55 @@ void ide_read_bcount_and_ireason(ide_drive_t *drive, u16 *bcount, u8 *ireason) ...@@ -331,6 +328,55 @@ void ide_read_bcount_and_ireason(ide_drive_t *drive, u16 *bcount, u8 *ireason)
} }
EXPORT_SYMBOL_GPL(ide_read_bcount_and_ireason); EXPORT_SYMBOL_GPL(ide_read_bcount_and_ireason);
/*
* Check the contents of the interrupt reason register and attempt to recover if
* there are problems.
*
* Returns:
* - 0 if everything's ok
* - 1 if the request has to be terminated.
*/
int ide_check_ireason(ide_drive_t *drive, struct request *rq, int len,
int ireason, int rw)
{
ide_hwif_t *hwif = drive->hwif;
debug_log("ireason: 0x%x, rw: 0x%x\n", ireason, rw);
if (ireason == (!rw << 1))
return 0;
else if (ireason == (rw << 1)) {
printk(KERN_ERR PFX "%s: %s: wrong transfer direction!\n",
drive->name, __func__);
if (dev_is_idecd(drive))
ide_pad_transfer(drive, rw, len);
} else if (!rw && ireason == ATAPI_COD) {
if (dev_is_idecd(drive)) {
/*
* Some drives (ASUS) seem to tell us that status info
* is available. Just get it and ignore.
*/
(void)hwif->tp_ops->read_status(hwif);
return 0;
}
} else {
if (ireason & ATAPI_COD)
printk(KERN_ERR PFX "%s: CoD != 0 in %s\n", drive->name,
__func__);
/* drive wants a command packet, or invalid ireason... */
printk(KERN_ERR PFX "%s: %s: bad interrupt reason 0x%02x\n",
drive->name, __func__, ireason);
}
if (dev_is_idecd(drive) && rq->cmd_type == REQ_TYPE_ATA_PC)
rq->cmd_flags |= REQ_FAILED;
return 1;
}
EXPORT_SYMBOL_GPL(ide_check_ireason);
/* /*
* This is the usual interrupt handler which will be called during a packet * This is the usual interrupt handler which will be called during a packet
* command. We will transfer some of the data (as requested by the drive) * command. We will transfer some of the data (as requested by the drive)
...@@ -365,12 +411,12 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive) ...@@ -365,12 +411,12 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive)
if (rc || (drive->media == ide_tape && (stat & ATA_ERR))) { if (rc || (drive->media == ide_tape && (stat & ATA_ERR))) {
if (drive->media == ide_floppy) if (drive->media == ide_floppy)
printk(KERN_ERR "%s: DMA %s error\n", printk(KERN_ERR PFX "%s: DMA %s error\n",
drive->name, rq_data_dir(pc->rq) drive->name, rq_data_dir(pc->rq)
? "write" : "read"); ? "write" : "read");
pc->flags |= PC_FLAG_DMA_ERROR; pc->flags |= PC_FLAG_DMA_ERROR;
} else } else
pc->xferred = pc->req_xfer; rq->resid_len = 0;
debug_log("%s: DMA finished\n", drive->name); debug_log("%s: DMA finished\n", drive->name);
} }
...@@ -379,7 +425,7 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive) ...@@ -379,7 +425,7 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive)
int uptodate, error; int uptodate, error;
debug_log("Packet command completed, %d bytes transferred\n", debug_log("Packet command completed, %d bytes transferred\n",
pc->xferred); blk_rq_bytes(rq));
pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS; pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
...@@ -397,8 +443,8 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive) ...@@ -397,8 +443,8 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive)
pc->rq->errors++; pc->rq->errors++;
if (rq->cmd[0] == REQUEST_SENSE) { if (rq->cmd[0] == REQUEST_SENSE) {
printk(KERN_ERR "%s: I/O error in request sense" printk(KERN_ERR PFX "%s: I/O error in request "
" command\n", drive->name); "sense command\n", drive->name);
return ide_do_reset(drive); return ide_do_reset(drive);
} }
...@@ -446,8 +492,8 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive) ...@@ -446,8 +492,8 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive)
if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) { if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS; pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
printk(KERN_ERR "%s: The device wants to issue more interrupts " printk(KERN_ERR PFX "%s: The device wants to issue more "
"in DMA mode\n", drive->name); "interrupts in DMA mode\n", drive->name);
ide_dma_off(drive); ide_dma_off(drive);
return ide_do_reset(drive); return ide_do_reset(drive);
} }
...@@ -455,33 +501,22 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive) ...@@ -455,33 +501,22 @@ static ide_startstop_t ide_pc_intr(ide_drive_t *drive)
/* Get the number of bytes to transfer on this interrupt. */ /* Get the number of bytes to transfer on this interrupt. */
ide_read_bcount_and_ireason(drive, &bcount, &ireason); ide_read_bcount_and_ireason(drive, &bcount, &ireason);
if (ireason & ATAPI_COD) { if (ide_check_ireason(drive, rq, bcount, ireason, write))
printk(KERN_ERR "%s: CoD != 0 in %s\n", drive->name, __func__);
return ide_do_reset(drive);
}
if (((ireason & ATAPI_IO) == ATAPI_IO) == write) {
/* Hopefully, we will never get here */
printk(KERN_ERR "%s: We wanted to %s, but the device wants us "
"to %s!\n", drive->name,
(ireason & ATAPI_IO) ? "Write" : "Read",
(ireason & ATAPI_IO) ? "Read" : "Write");
return ide_do_reset(drive); return ide_do_reset(drive);
}
done = min_t(unsigned int, bcount, cmd->nleft); done = min_t(unsigned int, bcount, cmd->nleft);
ide_pio_bytes(drive, cmd, write, done); ide_pio_bytes(drive, cmd, write, done);
/* Update transferred byte count */ /* Update transferred byte count */
pc->xferred += done; rq->resid_len -= done;
bcount -= done; bcount -= done;
if (bcount) if (bcount)
ide_pad_transfer(drive, write, bcount); ide_pad_transfer(drive, write, bcount);
debug_log("[cmd %x] transferred %d bytes, padded %d bytes\n", debug_log("[cmd %x] transferred %d bytes, padded %d bytes, resid: %u\n",
rq->cmd[0], done, bcount); rq->cmd[0], done, bcount, rq->resid_len);
/* And set the interrupt handler again */ /* And set the interrupt handler again */
ide_set_handler(drive, ide_pc_intr, timeout); ide_set_handler(drive, ide_pc_intr, timeout);
...@@ -515,13 +550,13 @@ static u8 ide_wait_ireason(ide_drive_t *drive, u8 ireason) ...@@ -515,13 +550,13 @@ static u8 ide_wait_ireason(ide_drive_t *drive, u8 ireason)
while (retries-- && ((ireason & ATAPI_COD) == 0 || while (retries-- && ((ireason & ATAPI_COD) == 0 ||
(ireason & ATAPI_IO))) { (ireason & ATAPI_IO))) {
printk(KERN_ERR "%s: (IO,CoD != (0,1) while issuing " printk(KERN_ERR PFX "%s: (IO,CoD != (0,1) while issuing "
"a packet command, retrying\n", drive->name); "a packet command, retrying\n", drive->name);
udelay(100); udelay(100);
ireason = ide_read_ireason(drive); ireason = ide_read_ireason(drive);
if (retries == 0) { if (retries == 0) {
printk(KERN_ERR "%s: (IO,CoD != (0,1) while issuing " printk(KERN_ERR PFX "%s: (IO,CoD != (0,1) while issuing"
"a packet command, ignoring\n", " a packet command, ignoring\n",
drive->name); drive->name);
ireason |= ATAPI_COD; ireason |= ATAPI_COD;
ireason &= ~ATAPI_IO; ireason &= ~ATAPI_IO;
...@@ -552,7 +587,7 @@ static ide_startstop_t ide_transfer_pc(ide_drive_t *drive) ...@@ -552,7 +587,7 @@ static ide_startstop_t ide_transfer_pc(ide_drive_t *drive)
u8 ireason; u8 ireason;
if (ide_wait_stat(&startstop, drive, ATA_DRQ, ATA_BUSY, WAIT_READY)) { if (ide_wait_stat(&startstop, drive, ATA_DRQ, ATA_BUSY, WAIT_READY)) {
printk(KERN_ERR "%s: Strange, packet command initiated yet " printk(KERN_ERR PFX "%s: Strange, packet command initiated yet "
"DRQ isn't asserted\n", drive->name); "DRQ isn't asserted\n", drive->name);
return startstop; return startstop;
} }
...@@ -594,8 +629,8 @@ static ide_startstop_t ide_transfer_pc(ide_drive_t *drive) ...@@ -594,8 +629,8 @@ static ide_startstop_t ide_transfer_pc(ide_drive_t *drive)
ireason = ide_wait_ireason(drive, ireason); ireason = ide_wait_ireason(drive, ireason);
if ((ireason & ATAPI_COD) == 0 || (ireason & ATAPI_IO)) { if ((ireason & ATAPI_COD) == 0 || (ireason & ATAPI_IO)) {
printk(KERN_ERR "%s: (IO,CoD) != (0,1) while issuing " printk(KERN_ERR PFX "%s: (IO,CoD) != (0,1) while "
"a packet command\n", drive->name); "issuing a packet command\n", drive->name);
return ide_do_reset(drive); return ide_do_reset(drive);
} }
...@@ -633,7 +668,7 @@ ide_startstop_t ide_issue_pc(ide_drive_t *drive, struct ide_cmd *cmd) ...@@ -633,7 +668,7 @@ ide_startstop_t ide_issue_pc(ide_drive_t *drive, struct ide_cmd *cmd)
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
ide_expiry_t *expiry = NULL; ide_expiry_t *expiry = NULL;
struct request *rq = hwif->rq; struct request *rq = hwif->rq;
unsigned int timeout; unsigned int timeout, bytes;
u16 bcount; u16 bcount;
u8 valid_tf; u8 valid_tf;
u8 drq_int = !!(drive->atapi_flags & IDE_AFLAG_DRQ_INTERRUPT); u8 drq_int = !!(drive->atapi_flags & IDE_AFLAG_DRQ_INTERRUPT);
...@@ -649,13 +684,14 @@ ide_startstop_t ide_issue_pc(ide_drive_t *drive, struct ide_cmd *cmd) ...@@ -649,13 +684,14 @@ ide_startstop_t ide_issue_pc(ide_drive_t *drive, struct ide_cmd *cmd)
} else { } else {
pc = drive->pc; pc = drive->pc;
/* We haven't transferred any data yet */
pc->xferred = 0;
valid_tf = IDE_VALID_DEVICE; valid_tf = IDE_VALID_DEVICE;
bcount = ((drive->media == ide_tape) ? bytes = blk_rq_bytes(rq);
pc->req_xfer : bcount = ((drive->media == ide_tape) ? bytes
min(pc->req_xfer, 63 * 1024)); : min_t(unsigned int,
bytes, 63 * 1024));
/* We haven't transferred any data yet */
rq->resid_len = bcount;
if (pc->flags & PC_FLAG_DMA_ERROR) { if (pc->flags & PC_FLAG_DMA_ERROR) {
pc->flags &= ~PC_FLAG_DMA_ERROR; pc->flags &= ~PC_FLAG_DMA_ERROR;
......
...@@ -92,16 +92,16 @@ static void cdrom_saw_media_change(ide_drive_t *drive) ...@@ -92,16 +92,16 @@ static void cdrom_saw_media_change(ide_drive_t *drive)
drive->atapi_flags &= ~IDE_AFLAG_TOC_VALID; drive->atapi_flags &= ~IDE_AFLAG_TOC_VALID;
} }
static int cdrom_log_sense(ide_drive_t *drive, struct request *rq, static int cdrom_log_sense(ide_drive_t *drive, struct request *rq)
struct request_sense *sense)
{ {
struct request_sense *sense = &drive->sense_data;
int log = 0; int log = 0;
ide_debug_log(IDE_DBG_SENSE, "sense_key: 0x%x", sense->sense_key);
if (!sense || !rq || (rq->cmd_flags & REQ_QUIET)) if (!sense || !rq || (rq->cmd_flags & REQ_QUIET))
return 0; return 0;
ide_debug_log(IDE_DBG_SENSE, "sense_key: 0x%x", sense->sense_key);
switch (sense->sense_key) { switch (sense->sense_key) {
case NO_SENSE: case NO_SENSE:
case RECOVERED_ERROR: case RECOVERED_ERROR:
...@@ -140,12 +140,12 @@ static int cdrom_log_sense(ide_drive_t *drive, struct request *rq, ...@@ -140,12 +140,12 @@ static int cdrom_log_sense(ide_drive_t *drive, struct request *rq,
} }
static void cdrom_analyze_sense_data(ide_drive_t *drive, static void cdrom_analyze_sense_data(ide_drive_t *drive,
struct request *failed_command, struct request *failed_command)
struct request_sense *sense)
{ {
struct request_sense *sense = &drive->sense_data;
struct cdrom_info *info = drive->driver_data;
unsigned long sector; unsigned long sector;
unsigned long bio_sectors; unsigned long bio_sectors;
struct cdrom_info *info = drive->driver_data;
ide_debug_log(IDE_DBG_SENSE, "error_code: 0x%x, sense_key: 0x%x", ide_debug_log(IDE_DBG_SENSE, "error_code: 0x%x, sense_key: 0x%x",
sense->error_code, sense->sense_key); sense->error_code, sense->sense_key);
...@@ -154,7 +154,7 @@ static void cdrom_analyze_sense_data(ide_drive_t *drive, ...@@ -154,7 +154,7 @@ static void cdrom_analyze_sense_data(ide_drive_t *drive,
ide_debug_log(IDE_DBG_SENSE, "failed cmd: 0x%x", ide_debug_log(IDE_DBG_SENSE, "failed cmd: 0x%x",
failed_command->cmd[0]); failed_command->cmd[0]);
if (!cdrom_log_sense(drive, failed_command, sense)) if (!cdrom_log_sense(drive, failed_command))
return; return;
/* /*
...@@ -225,15 +225,14 @@ static void ide_cd_complete_failed_rq(ide_drive_t *drive, struct request *rq) ...@@ -225,15 +225,14 @@ static void ide_cd_complete_failed_rq(ide_drive_t *drive, struct request *rq)
* sense pointer set. * sense pointer set.
*/ */
memcpy(failed->sense, sense, 18); memcpy(failed->sense, sense, 18);
sense = failed->sense;
failed->sense_len = rq->sense_len; failed->sense_len = rq->sense_len;
} }
cdrom_analyze_sense_data(drive, failed, sense); cdrom_analyze_sense_data(drive, failed);
if (ide_end_rq(drive, failed, -EIO, blk_rq_bytes(failed))) if (ide_end_rq(drive, failed, -EIO, blk_rq_bytes(failed)))
BUG(); BUG();
} else } else
cdrom_analyze_sense_data(drive, NULL, sense); cdrom_analyze_sense_data(drive, NULL);
} }
...@@ -410,50 +409,6 @@ static int cdrom_decode_status(ide_drive_t *drive, u8 stat) ...@@ -410,50 +409,6 @@ static int cdrom_decode_status(ide_drive_t *drive, u8 stat)
return 2; return 2;
} }
/*
* Check the contents of the interrupt reason register from the cdrom
* and attempt to recover if there are problems. Returns 0 if everything's
* ok; nonzero if the request has been terminated.
*/
static int ide_cd_check_ireason(ide_drive_t *drive, struct request *rq,
int len, int ireason, int rw)
{
ide_hwif_t *hwif = drive->hwif;
ide_debug_log(IDE_DBG_FUNC, "ireason: 0x%x, rw: 0x%x", ireason, rw);
/*
* ireason == 0: the drive wants to receive data from us
* ireason == 2: the drive is expecting to transfer data to us
*/
if (ireason == (!rw << 1))
return 0;
else if (ireason == (rw << 1)) {
/* whoops... */
printk(KERN_ERR PFX "%s: %s: wrong transfer direction!\n",
drive->name, __func__);
ide_pad_transfer(drive, rw, len);
} else if (rw == 0 && ireason == 1) {
/*
* Some drives (ASUS) seem to tell us that status info is
* available. Just get it and ignore.
*/
(void)hwif->tp_ops->read_status(hwif);
return 0;
} else {
/* drive wants a command packet, or invalid ireason... */
printk(KERN_ERR PFX "%s: %s: bad interrupt reason 0x%02x\n",
drive->name, __func__, ireason);
}
if (rq->cmd_type == REQ_TYPE_ATA_PC)
rq->cmd_flags |= REQ_FAILED;
return -1;
}
static void ide_cd_request_sense_fixup(ide_drive_t *drive, struct ide_cmd *cmd) static void ide_cd_request_sense_fixup(ide_drive_t *drive, struct ide_cmd *cmd)
{ {
struct request *rq = cmd->rq; struct request *rq = cmd->rq;
...@@ -645,8 +600,7 @@ static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive) ...@@ -645,8 +600,7 @@ static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
goto out_end; goto out_end;
} }
/* check which way to transfer data */ rc = ide_check_ireason(drive, rq, len, ireason, write);
rc = ide_cd_check_ireason(drive, rq, len, ireason, write);
if (rc) if (rc)
goto out_end; goto out_end;
...@@ -713,7 +667,7 @@ static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive) ...@@ -713,7 +667,7 @@ static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
rq->errors = -EIO; rq->errors = -EIO;
} }
if (uptodate == 0) if (uptodate == 0 && rq->bio)
ide_cd_error_cmd(drive, cmd); ide_cd_error_cmd(drive, cmd);
/* make sure it's fully ended */ /* make sure it's fully ended */
...@@ -831,12 +785,8 @@ static ide_startstop_t ide_cd_do_request(ide_drive_t *drive, struct request *rq, ...@@ -831,12 +785,8 @@ static ide_startstop_t ide_cd_do_request(ide_drive_t *drive, struct request *rq,
/* right now this can only be a reset... */ /* right now this can only be a reset... */
uptodate = 1; uptodate = 1;
goto out_end; goto out_end;
} else { } else
blk_dump_rq_flags(rq, DRV_NAME " bad flags"); BUG();
if (rq->errors == 0)
rq->errors = -EIO;
goto out_end;
}
/* prepare sense request for this command */ /* prepare sense request for this command */
ide_prep_sense(drive, rq); ide_prep_sense(drive, rq);
......
...@@ -184,14 +184,7 @@ static ide_startstop_t ide_do_rw_disk(ide_drive_t *drive, struct request *rq, ...@@ -184,14 +184,7 @@ static ide_startstop_t ide_do_rw_disk(ide_drive_t *drive, struct request *rq,
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
BUG_ON(drive->dev_flags & IDE_DFLAG_BLOCKED); BUG_ON(drive->dev_flags & IDE_DFLAG_BLOCKED);
BUG_ON(!blk_fs_request(rq));
if (!blk_fs_request(rq)) {
blk_dump_rq_flags(rq, "ide_do_rw_disk - bad command");
if (rq->errors == 0)
rq->errors = -EIO;
ide_complete_rq(drive, -EIO, ide_rq_bytes(rq));
return ide_stopped;
}
ledtrig_ide_activity(); ledtrig_ide_activity();
......
...@@ -77,7 +77,8 @@ static int ide_floppy_callback(ide_drive_t *drive, int dsc) ...@@ -77,7 +77,8 @@ static int ide_floppy_callback(ide_drive_t *drive, int dsc)
(rq && blk_pc_request(rq))) (rq && blk_pc_request(rq)))
uptodate = 1; /* FIXME */ uptodate = 1; /* FIXME */
else if (pc->c[0] == GPCMD_REQUEST_SENSE) { else if (pc->c[0] == GPCMD_REQUEST_SENSE) {
u8 *buf = pc->buf;
u8 *buf = bio_data(rq->bio);
if (!pc->error) { if (!pc->error) {
floppy->sense_key = buf[2] & 0x0F; floppy->sense_key = buf[2] & 0x0F;
...@@ -209,8 +210,7 @@ static void idefloppy_create_rw_cmd(ide_drive_t *drive, ...@@ -209,8 +210,7 @@ static void idefloppy_create_rw_cmd(ide_drive_t *drive,
pc->rq = rq; pc->rq = rq;
if (rq->cmd_flags & REQ_RW) if (rq->cmd_flags & REQ_RW)
pc->flags |= PC_FLAG_WRITING; pc->flags |= PC_FLAG_WRITING;
pc->buf = NULL;
pc->req_xfer = pc->buf_size = blocks * floppy->block_size;
pc->flags |= PC_FLAG_DMA_OK; pc->flags |= PC_FLAG_DMA_OK;
} }
...@@ -225,9 +225,6 @@ static void idefloppy_blockpc_cmd(struct ide_disk_obj *floppy, ...@@ -225,9 +225,6 @@ static void idefloppy_blockpc_cmd(struct ide_disk_obj *floppy,
if (rq_data_dir(rq) == WRITE) if (rq_data_dir(rq) == WRITE)
pc->flags |= PC_FLAG_WRITING; pc->flags |= PC_FLAG_WRITING;
} }
/* pio will be performed by ide_pio_bytes() which handles sg fine */
pc->buf = NULL;
pc->req_xfer = pc->buf_size = blk_rq_bytes(rq);
} }
static ide_startstop_t ide_floppy_do_request(ide_drive_t *drive, static ide_startstop_t ide_floppy_do_request(ide_drive_t *drive,
...@@ -272,10 +269,8 @@ static ide_startstop_t ide_floppy_do_request(ide_drive_t *drive, ...@@ -272,10 +269,8 @@ static ide_startstop_t ide_floppy_do_request(ide_drive_t *drive,
} else if (blk_pc_request(rq)) { } else if (blk_pc_request(rq)) {
pc = &floppy->queued_pc; pc = &floppy->queued_pc;
idefloppy_blockpc_cmd(floppy, pc, rq); idefloppy_blockpc_cmd(floppy, pc, rq);
} else { } else
blk_dump_rq_flags(rq, PFX "unsupported command in queue"); BUG();
goto out_end;
}
ide_prep_sense(drive, rq); ide_prep_sense(drive, rq);
...@@ -286,8 +281,8 @@ static ide_startstop_t ide_floppy_do_request(ide_drive_t *drive, ...@@ -286,8 +281,8 @@ static ide_startstop_t ide_floppy_do_request(ide_drive_t *drive,
cmd.rq = rq; cmd.rq = rq;
if (blk_fs_request(rq) || pc->req_xfer) { if (blk_fs_request(rq) || blk_rq_bytes(rq)) {
ide_init_sg_cmd(&cmd, pc->req_xfer); ide_init_sg_cmd(&cmd, blk_rq_bytes(rq));
ide_map_sg(drive, &cmd); ide_map_sg(drive, &cmd);
} }
...@@ -311,33 +306,33 @@ static int ide_floppy_get_flexible_disk_page(ide_drive_t *drive, ...@@ -311,33 +306,33 @@ static int ide_floppy_get_flexible_disk_page(ide_drive_t *drive,
{ {
struct ide_disk_obj *floppy = drive->driver_data; struct ide_disk_obj *floppy = drive->driver_data;
struct gendisk *disk = floppy->disk; struct gendisk *disk = floppy->disk;
u8 *page; u8 *page, buf[40];
int capacity, lba_capacity; int capacity, lba_capacity;
u16 transfer_rate, sector_size, cyls, rpm; u16 transfer_rate, sector_size, cyls, rpm;
u8 heads, sectors; u8 heads, sectors;
ide_floppy_create_mode_sense_cmd(pc, IDEFLOPPY_FLEXIBLE_DISK_PAGE); ide_floppy_create_mode_sense_cmd(pc, IDEFLOPPY_FLEXIBLE_DISK_PAGE);
if (ide_queue_pc_tail(drive, disk, pc)) { if (ide_queue_pc_tail(drive, disk, pc, buf, pc->req_xfer)) {
printk(KERN_ERR PFX "Can't get flexible disk page params\n"); printk(KERN_ERR PFX "Can't get flexible disk page params\n");
return 1; return 1;
} }
if (pc->buf[3] & 0x80) if (buf[3] & 0x80)
drive->dev_flags |= IDE_DFLAG_WP; drive->dev_flags |= IDE_DFLAG_WP;
else else
drive->dev_flags &= ~IDE_DFLAG_WP; drive->dev_flags &= ~IDE_DFLAG_WP;
set_disk_ro(disk, !!(drive->dev_flags & IDE_DFLAG_WP)); set_disk_ro(disk, !!(drive->dev_flags & IDE_DFLAG_WP));
page = &pc->buf[8]; page = &buf[8];
transfer_rate = be16_to_cpup((__be16 *)&pc->buf[8 + 2]); transfer_rate = be16_to_cpup((__be16 *)&buf[8 + 2]);
sector_size = be16_to_cpup((__be16 *)&pc->buf[8 + 6]); sector_size = be16_to_cpup((__be16 *)&buf[8 + 6]);
cyls = be16_to_cpup((__be16 *)&pc->buf[8 + 8]); cyls = be16_to_cpup((__be16 *)&buf[8 + 8]);
rpm = be16_to_cpup((__be16 *)&pc->buf[8 + 28]); rpm = be16_to_cpup((__be16 *)&buf[8 + 28]);
heads = pc->buf[8 + 4]; heads = buf[8 + 4];
sectors = pc->buf[8 + 5]; sectors = buf[8 + 5];
capacity = cyls * heads * sectors * sector_size; capacity = cyls * heads * sectors * sector_size;
...@@ -387,22 +382,19 @@ static int ide_floppy_get_capacity(ide_drive_t *drive) ...@@ -387,22 +382,19 @@ static int ide_floppy_get_capacity(ide_drive_t *drive)
drive->capacity64 = 0; drive->capacity64 = 0;
ide_floppy_create_read_capacity_cmd(&pc); ide_floppy_create_read_capacity_cmd(&pc);
pc.buf = &pc_buf[0]; if (ide_queue_pc_tail(drive, disk, &pc, pc_buf, pc.req_xfer)) {
pc.buf_size = sizeof(pc_buf);
if (ide_queue_pc_tail(drive, disk, &pc)) {
printk(KERN_ERR PFX "Can't get floppy parameters\n"); printk(KERN_ERR PFX "Can't get floppy parameters\n");
return 1; return 1;
} }
header_len = pc.buf[3]; header_len = pc_buf[3];
cap_desc = &pc.buf[4]; cap_desc = &pc_buf[4];
desc_cnt = header_len / 8; /* capacity descriptor of 8 bytes */ desc_cnt = header_len / 8; /* capacity descriptor of 8 bytes */
for (i = 0; i < desc_cnt; i++) { for (i = 0; i < desc_cnt; i++) {
unsigned int desc_start = 4 + i*8; unsigned int desc_start = 4 + i*8;
blocks = be32_to_cpup((__be32 *)&pc.buf[desc_start]); blocks = be32_to_cpup((__be32 *)&pc_buf[desc_start]);
length = be16_to_cpup((__be16 *)&pc.buf[desc_start + 6]); length = be16_to_cpup((__be16 *)&pc_buf[desc_start + 6]);
ide_debug_log(IDE_DBG_PROBE, "Descriptor %d: %dkB, %d blocks, " ide_debug_log(IDE_DBG_PROBE, "Descriptor %d: %dkB, %d blocks, "
"%d sector size", "%d sector size",
...@@ -415,7 +407,7 @@ static int ide_floppy_get_capacity(ide_drive_t *drive) ...@@ -415,7 +407,7 @@ static int ide_floppy_get_capacity(ide_drive_t *drive)
* the code below is valid only for the 1st descriptor, ie i=0 * the code below is valid only for the 1st descriptor, ie i=0
*/ */
switch (pc.buf[desc_start + 4] & 0x03) { switch (pc_buf[desc_start + 4] & 0x03) {
/* Clik! drive returns this instead of CAPACITY_CURRENT */ /* Clik! drive returns this instead of CAPACITY_CURRENT */
case CAPACITY_UNFORMATTED: case CAPACITY_UNFORMATTED:
if (!(drive->atapi_flags & IDE_AFLAG_CLIK_DRIVE)) if (!(drive->atapi_flags & IDE_AFLAG_CLIK_DRIVE))
...@@ -464,7 +456,7 @@ static int ide_floppy_get_capacity(ide_drive_t *drive) ...@@ -464,7 +456,7 @@ static int ide_floppy_get_capacity(ide_drive_t *drive)
break; break;
} }
ide_debug_log(IDE_DBG_PROBE, "Descriptor 0 Code: %d", ide_debug_log(IDE_DBG_PROBE, "Descriptor 0 Code: %d",
pc.buf[desc_start + 4] & 0x03); pc_buf[desc_start + 4] & 0x03);
} }
/* Clik! disk does not support get_flexible_disk_page */ /* Clik! disk does not support get_flexible_disk_page */
......
...@@ -47,15 +47,13 @@ static int ide_floppy_get_format_capacities(ide_drive_t *drive, ...@@ -47,15 +47,13 @@ static int ide_floppy_get_format_capacities(ide_drive_t *drive,
return -EINVAL; return -EINVAL;
ide_floppy_create_read_capacity_cmd(pc); ide_floppy_create_read_capacity_cmd(pc);
pc->buf = &pc_buf[0];
pc->buf_size = sizeof(pc_buf);
if (ide_queue_pc_tail(drive, floppy->disk, pc)) { if (ide_queue_pc_tail(drive, floppy->disk, pc, pc_buf, pc->req_xfer)) {
printk(KERN_ERR "ide-floppy: Can't get floppy parameters\n"); printk(KERN_ERR "ide-floppy: Can't get floppy parameters\n");
return -EIO; return -EIO;
} }
header_len = pc->buf[3]; header_len = pc_buf[3];
desc_cnt = header_len / 8; /* capacity descriptor of 8 bytes */ desc_cnt = header_len / 8; /* capacity descriptor of 8 bytes */
u_index = 0; u_index = 0;
...@@ -72,8 +70,8 @@ static int ide_floppy_get_format_capacities(ide_drive_t *drive, ...@@ -72,8 +70,8 @@ static int ide_floppy_get_format_capacities(ide_drive_t *drive,
if (u_index >= u_array_size) if (u_index >= u_array_size)
break; /* User-supplied buffer too small */ break; /* User-supplied buffer too small */
blocks = be32_to_cpup((__be32 *)&pc->buf[desc_start]); blocks = be32_to_cpup((__be32 *)&pc_buf[desc_start]);
length = be16_to_cpup((__be16 *)&pc->buf[desc_start + 6]); length = be16_to_cpup((__be16 *)&pc_buf[desc_start + 6]);
if (put_user(blocks, argp)) if (put_user(blocks, argp))
return -EFAULT; return -EFAULT;
...@@ -94,40 +92,42 @@ static int ide_floppy_get_format_capacities(ide_drive_t *drive, ...@@ -94,40 +92,42 @@ static int ide_floppy_get_format_capacities(ide_drive_t *drive,
return 0; return 0;
} }
static void ide_floppy_create_format_unit_cmd(struct ide_atapi_pc *pc, int b, static void ide_floppy_create_format_unit_cmd(struct ide_atapi_pc *pc,
int l, int flags) u8 *buf, int b, int l,
int flags)
{ {
ide_init_pc(pc); ide_init_pc(pc);
pc->c[0] = GPCMD_FORMAT_UNIT; pc->c[0] = GPCMD_FORMAT_UNIT;
pc->c[1] = 0x17; pc->c[1] = 0x17;
memset(pc->buf, 0, 12); memset(buf, 0, 12);
pc->buf[1] = 0xA2; buf[1] = 0xA2;
/* Default format list header, u8 1: FOV/DCRT/IMM bits set */ /* Default format list header, u8 1: FOV/DCRT/IMM bits set */
if (flags & 1) /* Verify bit on... */ if (flags & 1) /* Verify bit on... */
pc->buf[1] ^= 0x20; /* ... turn off DCRT bit */ buf[1] ^= 0x20; /* ... turn off DCRT bit */
pc->buf[3] = 8; buf[3] = 8;
put_unaligned(cpu_to_be32(b), (unsigned int *)(&pc->buf[4])); put_unaligned(cpu_to_be32(b), (unsigned int *)(&buf[4]));
put_unaligned(cpu_to_be32(l), (unsigned int *)(&pc->buf[8])); put_unaligned(cpu_to_be32(l), (unsigned int *)(&buf[8]));
pc->buf_size = 12; pc->req_xfer = 12;
pc->flags |= PC_FLAG_WRITING; pc->flags |= PC_FLAG_WRITING;
} }
static int ide_floppy_get_sfrp_bit(ide_drive_t *drive, struct ide_atapi_pc *pc) static int ide_floppy_get_sfrp_bit(ide_drive_t *drive, struct ide_atapi_pc *pc)
{ {
struct ide_disk_obj *floppy = drive->driver_data; struct ide_disk_obj *floppy = drive->driver_data;
u8 buf[20];
drive->atapi_flags &= ~IDE_AFLAG_SRFP; drive->atapi_flags &= ~IDE_AFLAG_SRFP;
ide_floppy_create_mode_sense_cmd(pc, IDEFLOPPY_CAPABILITIES_PAGE); ide_floppy_create_mode_sense_cmd(pc, IDEFLOPPY_CAPABILITIES_PAGE);
pc->flags |= PC_FLAG_SUPPRESS_ERROR; pc->flags |= PC_FLAG_SUPPRESS_ERROR;
if (ide_queue_pc_tail(drive, floppy->disk, pc)) if (ide_queue_pc_tail(drive, floppy->disk, pc, buf, pc->req_xfer))
return 1; return 1;
if (pc->buf[8 + 2] & 0x40) if (buf[8 + 2] & 0x40)
drive->atapi_flags |= IDE_AFLAG_SRFP; drive->atapi_flags |= IDE_AFLAG_SRFP;
return 0; return 0;
...@@ -137,6 +137,7 @@ static int ide_floppy_format_unit(ide_drive_t *drive, struct ide_atapi_pc *pc, ...@@ -137,6 +137,7 @@ static int ide_floppy_format_unit(ide_drive_t *drive, struct ide_atapi_pc *pc,
int __user *arg) int __user *arg)
{ {
struct ide_disk_obj *floppy = drive->driver_data; struct ide_disk_obj *floppy = drive->driver_data;
u8 buf[12];
int blocks, length, flags, err = 0; int blocks, length, flags, err = 0;
if (floppy->openers > 1) { if (floppy->openers > 1) {
...@@ -170,9 +171,9 @@ static int ide_floppy_format_unit(ide_drive_t *drive, struct ide_atapi_pc *pc, ...@@ -170,9 +171,9 @@ static int ide_floppy_format_unit(ide_drive_t *drive, struct ide_atapi_pc *pc,
} }
ide_floppy_get_sfrp_bit(drive, pc); ide_floppy_get_sfrp_bit(drive, pc);
ide_floppy_create_format_unit_cmd(pc, blocks, length, flags); ide_floppy_create_format_unit_cmd(pc, buf, blocks, length, flags);
if (ide_queue_pc_tail(drive, floppy->disk, pc)) if (ide_queue_pc_tail(drive, floppy->disk, pc, buf, pc->req_xfer))
err = -EIO; err = -EIO;
out: out:
...@@ -196,11 +197,13 @@ static int ide_floppy_get_format_progress(ide_drive_t *drive, ...@@ -196,11 +197,13 @@ static int ide_floppy_get_format_progress(ide_drive_t *drive,
int __user *arg) int __user *arg)
{ {
struct ide_disk_obj *floppy = drive->driver_data; struct ide_disk_obj *floppy = drive->driver_data;
u8 sense_buf[18];
int progress_indication = 0x10000; int progress_indication = 0x10000;
if (drive->atapi_flags & IDE_AFLAG_SRFP) { if (drive->atapi_flags & IDE_AFLAG_SRFP) {
ide_create_request_sense_cmd(drive, pc); ide_create_request_sense_cmd(drive, pc);
if (ide_queue_pc_tail(drive, floppy->disk, pc)) if (ide_queue_pc_tail(drive, floppy->disk, pc, sense_buf,
pc->req_xfer))
return -EIO; return -EIO;
if (floppy->sense_key == 2 && if (floppy->sense_key == 2 &&
......
...@@ -683,8 +683,9 @@ void ide_timer_expiry (unsigned long data) ...@@ -683,8 +683,9 @@ void ide_timer_expiry (unsigned long data)
} else if (drive_is_ready(drive)) { } else if (drive_is_ready(drive)) {
if (drive->waiting_for_dma) if (drive->waiting_for_dma)
hwif->dma_ops->dma_lost_irq(drive); hwif->dma_ops->dma_lost_irq(drive);
if (hwif->ack_intr) if (hwif->port_ops && hwif->port_ops->clear_irq)
hwif->ack_intr(hwif); hwif->port_ops->clear_irq(drive);
printk(KERN_WARNING "%s: lost interrupt\n", printk(KERN_WARNING "%s: lost interrupt\n",
drive->name); drive->name);
startstop = handler(drive); startstop = handler(drive);
...@@ -803,7 +804,8 @@ irqreturn_t ide_intr (int irq, void *dev_id) ...@@ -803,7 +804,8 @@ irqreturn_t ide_intr (int irq, void *dev_id)
spin_lock_irqsave(&hwif->lock, flags); spin_lock_irqsave(&hwif->lock, flags);
if (hwif->ack_intr && hwif->ack_intr(hwif) == 0) if (hwif->port_ops && hwif->port_ops->test_irq &&
hwif->port_ops->test_irq(hwif) == 0)
goto out; goto out;
handler = hwif->handler; handler = hwif->handler;
......
...@@ -118,7 +118,6 @@ static int ide_cmd_ioctl(ide_drive_t *drive, unsigned long arg) ...@@ -118,7 +118,6 @@ static int ide_cmd_ioctl(ide_drive_t *drive, unsigned long arg)
u8 args[4], xfer_rate = 0; u8 args[4], xfer_rate = 0;
struct ide_cmd cmd; struct ide_cmd cmd;
struct ide_taskfile *tf = &cmd.tf; struct ide_taskfile *tf = &cmd.tf;
u16 *id = drive->id;
if (NULL == (void *) arg) { if (NULL == (void *) arg) {
struct request *rq; struct request *rq;
...@@ -161,14 +160,10 @@ static int ide_cmd_ioctl(ide_drive_t *drive, unsigned long arg) ...@@ -161,14 +160,10 @@ static int ide_cmd_ioctl(ide_drive_t *drive, unsigned long arg)
if (tf->command == ATA_CMD_SET_FEATURES && if (tf->command == ATA_CMD_SET_FEATURES &&
tf->feature == SETFEATURES_XFER && tf->feature == SETFEATURES_XFER &&
tf->nsect >= XFER_SW_DMA_0 && tf->nsect >= XFER_SW_DMA_0) {
(id[ATA_ID_UDMA_MODES] || xfer_rate = ide_find_dma_mode(drive, XFER_UDMA_6);
id[ATA_ID_MWDMA_MODES] || if (xfer_rate != tf->nsect) {
id[ATA_ID_SWDMA_MODES])) { err = -EINVAL;
xfer_rate = args[1];
if (tf->nsect > XFER_UDMA_2 && !eighty_ninty_three(drive)) {
printk(KERN_WARNING "%s: UDMA speeds >UDMA33 cannot "
"be set\n", drive->name);
goto abort; goto abort;
} }
} }
......
...@@ -1170,7 +1170,6 @@ static void ide_init_port_hw(ide_hwif_t *hwif, struct ide_hw *hw) ...@@ -1170,7 +1170,6 @@ static void ide_init_port_hw(ide_hwif_t *hwif, struct ide_hw *hw)
hwif->irq = hw->irq; hwif->irq = hw->irq;
hwif->dev = hw->dev; hwif->dev = hw->dev;
hwif->gendev.parent = hw->parent ? hw->parent : hw->dev; hwif->gendev.parent = hw->parent ? hw->parent : hw->dev;
hwif->ack_intr = hw->ack_intr;
hwif->config_data = hw->config; hwif->config_data = hw->config;
} }
...@@ -1378,6 +1377,9 @@ int ide_host_register(struct ide_host *host, const struct ide_port_info *d, ...@@ -1378,6 +1377,9 @@ int ide_host_register(struct ide_host *host, const struct ide_port_info *d,
ide_init_port(hwif, i & 1, d); ide_init_port(hwif, i & 1, d);
ide_port_cable_detect(hwif); ide_port_cable_detect(hwif);
hwif->port_flags |= IDE_PFLAG_PROBING;
ide_port_init_devices(hwif); ide_port_init_devices(hwif);
} }
...@@ -1388,6 +1390,8 @@ int ide_host_register(struct ide_host *host, const struct ide_port_info *d, ...@@ -1388,6 +1390,8 @@ int ide_host_register(struct ide_host *host, const struct ide_port_info *d,
if (ide_probe_port(hwif) == 0) if (ide_probe_port(hwif) == 0)
hwif->present = 1; hwif->present = 1;
hwif->port_flags &= ~IDE_PFLAG_PROBING;
if ((hwif->host_flags & IDE_HFLAG_4DRIVES) == 0 || if ((hwif->host_flags & IDE_HFLAG_4DRIVES) == 0 ||
hwif->mate == NULL || hwif->mate->present == 0) { hwif->mate == NULL || hwif->mate->present == 0) {
if (ide_register_port(hwif)) { if (ide_register_port(hwif)) {
...@@ -1569,11 +1573,20 @@ EXPORT_SYMBOL_GPL(ide_host_remove); ...@@ -1569,11 +1573,20 @@ EXPORT_SYMBOL_GPL(ide_host_remove);
void ide_port_scan(ide_hwif_t *hwif) void ide_port_scan(ide_hwif_t *hwif)
{ {
int rc;
ide_port_apply_params(hwif); ide_port_apply_params(hwif);
ide_port_cable_detect(hwif); ide_port_cable_detect(hwif);
hwif->port_flags |= IDE_PFLAG_PROBING;
ide_port_init_devices(hwif); ide_port_init_devices(hwif);
if (ide_probe_port(hwif) < 0) rc = ide_probe_port(hwif);
hwif->port_flags &= ~IDE_PFLAG_PROBING;
if (rc < 0)
return; return;
hwif->present = 1; hwif->present = 1;
......
...@@ -279,10 +279,12 @@ static void ide_tape_put(struct ide_tape_obj *tape) ...@@ -279,10 +279,12 @@ static void ide_tape_put(struct ide_tape_obj *tape)
* called on each failed packet command retry to analyze the request sense. We * called on each failed packet command retry to analyze the request sense. We
* currently do not utilize this information. * currently do not utilize this information.
*/ */
static void idetape_analyze_error(ide_drive_t *drive, u8 *sense) static void idetape_analyze_error(ide_drive_t *drive)
{ {
idetape_tape_t *tape = drive->driver_data; idetape_tape_t *tape = drive->driver_data;
struct ide_atapi_pc *pc = drive->failed_pc; struct ide_atapi_pc *pc = drive->failed_pc;
struct request *rq = drive->hwif->rq;
u8 *sense = bio_data(rq->bio);
tape->sense_key = sense[2] & 0xF; tape->sense_key = sense[2] & 0xF;
tape->asc = sense[12]; tape->asc = sense[12];
...@@ -291,11 +293,9 @@ static void idetape_analyze_error(ide_drive_t *drive, u8 *sense) ...@@ -291,11 +293,9 @@ static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
debug_log(DBG_ERR, "pc = %x, sense key = %x, asc = %x, ascq = %x\n", debug_log(DBG_ERR, "pc = %x, sense key = %x, asc = %x, ascq = %x\n",
pc->c[0], tape->sense_key, tape->asc, tape->ascq); pc->c[0], tape->sense_key, tape->asc, tape->ascq);
/* Correct pc->xferred by asking the tape. */ /* correct remaining bytes to transfer */
if (pc->flags & PC_FLAG_DMA_ERROR) if (pc->flags & PC_FLAG_DMA_ERROR)
pc->xferred = pc->req_xfer - rq->resid_len = tape->blk_size * get_unaligned_be32(&sense[3]);
tape->blk_size *
get_unaligned_be32(&sense[3]);
/* /*
* If error was the result of a zero-length read or write command, * If error was the result of a zero-length read or write command,
...@@ -329,7 +329,7 @@ static void idetape_analyze_error(ide_drive_t *drive, u8 *sense) ...@@ -329,7 +329,7 @@ static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
pc->flags |= PC_FLAG_ABORT; pc->flags |= PC_FLAG_ABORT;
} }
if (!(pc->flags & PC_FLAG_ABORT) && if (!(pc->flags & PC_FLAG_ABORT) &&
pc->xferred) (blk_rq_bytes(rq) - rq->resid_len))
pc->retries = IDETAPE_MAX_PC_RETRIES + 1; pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
} }
} }
...@@ -354,12 +354,13 @@ static int ide_tape_callback(ide_drive_t *drive, int dsc) ...@@ -354,12 +354,13 @@ static int ide_tape_callback(ide_drive_t *drive, int dsc)
if (pc->c[0] == REQUEST_SENSE) { if (pc->c[0] == REQUEST_SENSE) {
if (uptodate) if (uptodate)
idetape_analyze_error(drive, pc->buf); idetape_analyze_error(drive);
else else
printk(KERN_ERR "ide-tape: Error in REQUEST SENSE " printk(KERN_ERR "ide-tape: Error in REQUEST SENSE "
"itself - Aborting request!\n"); "itself - Aborting request!\n");
} else if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) { } else if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
int blocks = pc->xferred / tape->blk_size; unsigned int blocks =
(blk_rq_bytes(rq) - rq->resid_len) / tape->blk_size;
tape->avg_size += blocks * tape->blk_size; tape->avg_size += blocks * tape->blk_size;
...@@ -371,38 +372,12 @@ static int ide_tape_callback(ide_drive_t *drive, int dsc) ...@@ -371,38 +372,12 @@ static int ide_tape_callback(ide_drive_t *drive, int dsc)
} }
tape->first_frame += blocks; tape->first_frame += blocks;
rq->resid_len -= blocks * tape->blk_size;
if (pc->error) { if (pc->error) {
uptodate = 0; uptodate = 0;
err = pc->error; err = pc->error;
} }
} else if (pc->c[0] == READ_POSITION && uptodate) {
u8 *readpos = pc->buf;
debug_log(DBG_SENSE, "BOP - %s\n",
(readpos[0] & 0x80) ? "Yes" : "No");
debug_log(DBG_SENSE, "EOP - %s\n",
(readpos[0] & 0x40) ? "Yes" : "No");
if (readpos[0] & 0x4) {
printk(KERN_INFO "ide-tape: Block location is unknown"
"to the tape\n");
clear_bit(ilog2(IDE_AFLAG_ADDRESS_VALID),
&drive->atapi_flags);
uptodate = 0;
err = IDE_DRV_ERROR_GENERAL;
} else {
debug_log(DBG_SENSE, "Block Location - %u\n",
be32_to_cpup((__be32 *)&readpos[4]));
tape->partition = readpos[1];
tape->first_frame = be32_to_cpup((__be32 *)&readpos[4]);
set_bit(ilog2(IDE_AFLAG_ADDRESS_VALID),
&drive->atapi_flags);
}
} }
rq->errors = err; rq->errors = err;
return uptodate; return uptodate;
...@@ -477,6 +452,7 @@ static ide_startstop_t ide_tape_issue_pc(ide_drive_t *drive, ...@@ -477,6 +452,7 @@ static ide_startstop_t ide_tape_issue_pc(ide_drive_t *drive,
struct ide_atapi_pc *pc) struct ide_atapi_pc *pc)
{ {
idetape_tape_t *tape = drive->driver_data; idetape_tape_t *tape = drive->driver_data;
struct request *rq = drive->hwif->rq;
if (drive->failed_pc == NULL && pc->c[0] != REQUEST_SENSE) if (drive->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
drive->failed_pc = pc; drive->failed_pc = pc;
...@@ -486,7 +462,6 @@ static ide_startstop_t ide_tape_issue_pc(ide_drive_t *drive, ...@@ -486,7 +462,6 @@ static ide_startstop_t ide_tape_issue_pc(ide_drive_t *drive,
if (pc->retries > IDETAPE_MAX_PC_RETRIES || if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
(pc->flags & PC_FLAG_ABORT)) { (pc->flags & PC_FLAG_ABORT)) {
unsigned int done = blk_rq_bytes(drive->hwif->rq);
/* /*
* We will "abort" retrying a packet command in case legitimate * We will "abort" retrying a packet command in case legitimate
...@@ -510,7 +485,7 @@ static ide_startstop_t ide_tape_issue_pc(ide_drive_t *drive, ...@@ -510,7 +485,7 @@ static ide_startstop_t ide_tape_issue_pc(ide_drive_t *drive,
drive->failed_pc = NULL; drive->failed_pc = NULL;
drive->pc_callback(drive, 0); drive->pc_callback(drive, 0);
ide_complete_rq(drive, -EIO, done); ide_complete_rq(drive, -EIO, blk_rq_bytes(rq));
return ide_stopped; return ide_stopped;
} }
debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]); debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
...@@ -579,15 +554,13 @@ static void ide_tape_create_rw_cmd(idetape_tape_t *tape, ...@@ -579,15 +554,13 @@ static void ide_tape_create_rw_cmd(idetape_tape_t *tape,
struct ide_atapi_pc *pc, struct request *rq, struct ide_atapi_pc *pc, struct request *rq,
u8 opcode) u8 opcode)
{ {
unsigned int length = blk_rq_sectors(rq); unsigned int length = blk_rq_sectors(rq) / (tape->blk_size >> 9);
ide_init_pc(pc); ide_init_pc(pc);
put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]); put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
pc->c[1] = 1; pc->c[1] = 1;
pc->buf = NULL;
pc->buf_size = length * tape->blk_size; if (blk_rq_bytes(rq) == tape->buffer_size)
pc->req_xfer = pc->buf_size;
if (pc->req_xfer == tape->buffer_size)
pc->flags |= PC_FLAG_DMA_OK; pc->flags |= PC_FLAG_DMA_OK;
if (opcode == READ_6) if (opcode == READ_6)
...@@ -613,15 +586,7 @@ static ide_startstop_t idetape_do_request(ide_drive_t *drive, ...@@ -613,15 +586,7 @@ static ide_startstop_t idetape_do_request(ide_drive_t *drive,
debug_log(DBG_SENSE, "sector: %llu, nr_sectors: %u\n" debug_log(DBG_SENSE, "sector: %llu, nr_sectors: %u\n"
(unsigned long long)blk_rq_pos(rq), blk_rq_sectors(rq)); (unsigned long long)blk_rq_pos(rq), blk_rq_sectors(rq));
if (!(blk_special_request(rq) || blk_sense_request(rq))) { BUG_ON(!(blk_special_request(rq) || blk_sense_request(rq)));
/* We do not support buffer cache originated requests. */
printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
"request queue (%d)\n", drive->name, rq->cmd_type);
if (blk_fs_request(rq) == 0 && rq->errors == 0)
rq->errors = -EIO;
ide_complete_rq(drive, -EIO, ide_rq_bytes(rq));
return ide_stopped;
}
/* Retry a failed packet command */ /* Retry a failed packet command */
if (drive->failed_pc && drive->pc->c[0] == REQUEST_SENSE) { if (drive->failed_pc && drive->pc->c[0] == REQUEST_SENSE) {
...@@ -713,7 +678,7 @@ static ide_startstop_t idetape_do_request(ide_drive_t *drive, ...@@ -713,7 +678,7 @@ static ide_startstop_t idetape_do_request(ide_drive_t *drive,
cmd.rq = rq; cmd.rq = rq;
ide_init_sg_cmd(&cmd, pc->req_xfer); ide_init_sg_cmd(&cmd, blk_rq_bytes(rq));
ide_map_sg(drive, &cmd); ide_map_sg(drive, &cmd);
return ide_tape_issue_pc(drive, &cmd, pc); return ide_tape_issue_pc(drive, &cmd, pc);
...@@ -767,33 +732,53 @@ static int idetape_flush_tape_buffers(ide_drive_t *drive) ...@@ -767,33 +732,53 @@ static int idetape_flush_tape_buffers(ide_drive_t *drive)
int rc; int rc;
idetape_create_write_filemark_cmd(drive, &pc, 0); idetape_create_write_filemark_cmd(drive, &pc, 0);
rc = ide_queue_pc_tail(drive, tape->disk, &pc); rc = ide_queue_pc_tail(drive, tape->disk, &pc, NULL, 0);
if (rc) if (rc)
return rc; return rc;
idetape_wait_ready(drive, 60 * 5 * HZ); idetape_wait_ready(drive, 60 * 5 * HZ);
return 0; return 0;
} }
static void idetape_create_read_position_cmd(struct ide_atapi_pc *pc) static int ide_tape_read_position(ide_drive_t *drive)
{
ide_init_pc(pc);
pc->c[0] = READ_POSITION;
pc->req_xfer = 20;
}
static int idetape_read_position(ide_drive_t *drive)
{ {
idetape_tape_t *tape = drive->driver_data; idetape_tape_t *tape = drive->driver_data;
struct ide_atapi_pc pc; struct ide_atapi_pc pc;
int position; u8 buf[20];
debug_log(DBG_PROCS, "Enter %s\n", __func__); debug_log(DBG_PROCS, "Enter %s\n", __func__);
idetape_create_read_position_cmd(&pc); /* prep cmd */
if (ide_queue_pc_tail(drive, tape->disk, &pc)) ide_init_pc(&pc);
pc.c[0] = READ_POSITION;
pc.req_xfer = 20;
if (ide_queue_pc_tail(drive, tape->disk, &pc, buf, pc.req_xfer))
return -1;
if (!pc.error) {
debug_log(DBG_SENSE, "BOP - %s\n",
(buf[0] & 0x80) ? "Yes" : "No");
debug_log(DBG_SENSE, "EOP - %s\n",
(buf[0] & 0x40) ? "Yes" : "No");
if (buf[0] & 0x4) {
printk(KERN_INFO "ide-tape: Block location is unknown"
"to the tape\n");
clear_bit(ilog2(IDE_AFLAG_ADDRESS_VALID),
&drive->atapi_flags);
return -1; return -1;
position = tape->first_frame; } else {
return position; debug_log(DBG_SENSE, "Block Location - %u\n",
be32_to_cpup((__be32 *)&buf[4]));
tape->partition = buf[1];
tape->first_frame = be32_to_cpup((__be32 *)&buf[4]);
set_bit(ilog2(IDE_AFLAG_ADDRESS_VALID),
&drive->atapi_flags);
}
}
return tape->first_frame;
} }
static void idetape_create_locate_cmd(ide_drive_t *drive, static void idetape_create_locate_cmd(ide_drive_t *drive,
...@@ -836,19 +821,21 @@ static int idetape_position_tape(ide_drive_t *drive, unsigned int block, ...@@ -836,19 +821,21 @@ static int idetape_position_tape(ide_drive_t *drive, unsigned int block,
{ {
idetape_tape_t *tape = drive->driver_data; idetape_tape_t *tape = drive->driver_data;
struct gendisk *disk = tape->disk; struct gendisk *disk = tape->disk;
int retval; int ret;
struct ide_atapi_pc pc; struct ide_atapi_pc pc;
if (tape->chrdev_dir == IDETAPE_DIR_READ) if (tape->chrdev_dir == IDETAPE_DIR_READ)
__ide_tape_discard_merge_buffer(drive); __ide_tape_discard_merge_buffer(drive);
idetape_wait_ready(drive, 60 * 5 * HZ); idetape_wait_ready(drive, 60 * 5 * HZ);
idetape_create_locate_cmd(drive, &pc, block, partition, skip); idetape_create_locate_cmd(drive, &pc, block, partition, skip);
retval = ide_queue_pc_tail(drive, disk, &pc); ret = ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
if (retval) if (ret)
return (retval); return ret;
idetape_create_read_position_cmd(&pc); ret = ide_tape_read_position(drive);
return ide_queue_pc_tail(drive, disk, &pc); if (ret < 0)
return ret;
return 0;
} }
static void ide_tape_discard_merge_buffer(ide_drive_t *drive, static void ide_tape_discard_merge_buffer(ide_drive_t *drive,
...@@ -859,7 +846,7 @@ static void ide_tape_discard_merge_buffer(ide_drive_t *drive, ...@@ -859,7 +846,7 @@ static void ide_tape_discard_merge_buffer(ide_drive_t *drive,
__ide_tape_discard_merge_buffer(drive); __ide_tape_discard_merge_buffer(drive);
if (restore_position) { if (restore_position) {
position = idetape_read_position(drive); position = ide_tape_read_position(drive);
seek = position > 0 ? position : 0; seek = position > 0 ? position : 0;
if (idetape_position_tape(drive, seek, 0, 0)) { if (idetape_position_tape(drive, seek, 0, 0)) {
printk(KERN_INFO "ide-tape: %s: position_tape failed in" printk(KERN_INFO "ide-tape: %s: position_tape failed in"
...@@ -1039,20 +1026,19 @@ static int idetape_rewind_tape(ide_drive_t *drive) ...@@ -1039,20 +1026,19 @@ static int idetape_rewind_tape(ide_drive_t *drive)
{ {
struct ide_tape_obj *tape = drive->driver_data; struct ide_tape_obj *tape = drive->driver_data;
struct gendisk *disk = tape->disk; struct gendisk *disk = tape->disk;
int retval;
struct ide_atapi_pc pc; struct ide_atapi_pc pc;
int ret;
debug_log(DBG_SENSE, "Enter %s\n", __func__); debug_log(DBG_SENSE, "Enter %s\n", __func__);
idetape_create_rewind_cmd(drive, &pc); idetape_create_rewind_cmd(drive, &pc);
retval = ide_queue_pc_tail(drive, disk, &pc); ret = ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
if (retval) if (ret)
return retval; return ret;
idetape_create_read_position_cmd(&pc); ret = ide_tape_read_position(drive);
retval = ide_queue_pc_tail(drive, disk, &pc); if (ret < 0)
if (retval) return ret;
return retval;
return 0; return 0;
} }
...@@ -1119,7 +1105,7 @@ static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op, ...@@ -1119,7 +1105,7 @@ static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op,
case MTBSF: case MTBSF:
idetape_create_space_cmd(&pc, mt_count - count, idetape_create_space_cmd(&pc, mt_count - count,
IDETAPE_SPACE_OVER_FILEMARK); IDETAPE_SPACE_OVER_FILEMARK);
return ide_queue_pc_tail(drive, disk, &pc); return ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
case MTFSFM: case MTFSFM:
case MTBSFM: case MTBSFM:
if (!sprev) if (!sprev)
...@@ -1259,7 +1245,7 @@ static int idetape_write_filemark(ide_drive_t *drive) ...@@ -1259,7 +1245,7 @@ static int idetape_write_filemark(ide_drive_t *drive)
/* Write a filemark */ /* Write a filemark */
idetape_create_write_filemark_cmd(drive, &pc, 1); idetape_create_write_filemark_cmd(drive, &pc, 1);
if (ide_queue_pc_tail(drive, tape->disk, &pc)) { if (ide_queue_pc_tail(drive, tape->disk, &pc, NULL, 0)) {
printk(KERN_ERR "ide-tape: Couldn't write a filemark\n"); printk(KERN_ERR "ide-tape: Couldn't write a filemark\n");
return -EIO; return -EIO;
} }
...@@ -1345,11 +1331,11 @@ static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count) ...@@ -1345,11 +1331,11 @@ static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK); IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK);
case MTEOM: case MTEOM:
idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD); idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD);
return ide_queue_pc_tail(drive, disk, &pc); return ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
case MTERASE: case MTERASE:
(void)idetape_rewind_tape(drive); (void)idetape_rewind_tape(drive);
idetape_create_erase_cmd(&pc); idetape_create_erase_cmd(&pc);
return ide_queue_pc_tail(drive, disk, &pc); return ide_queue_pc_tail(drive, disk, &pc, NULL, 0);
case MTSETBLK: case MTSETBLK:
if (mt_count) { if (mt_count) {
if (mt_count < tape->blk_size || if (mt_count < tape->blk_size ||
...@@ -1415,7 +1401,7 @@ static int idetape_chrdev_ioctl(struct inode *inode, struct file *file, ...@@ -1415,7 +1401,7 @@ static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
if (cmd == MTIOCGET || cmd == MTIOCPOS) { if (cmd == MTIOCGET || cmd == MTIOCPOS) {
block_offset = tape->valid / block_offset = tape->valid /
(tape->blk_size * tape->user_bs_factor); (tape->blk_size * tape->user_bs_factor);
position = idetape_read_position(drive); position = ide_tape_read_position(drive);
if (position < 0) if (position < 0)
return -EIO; return -EIO;
} }
...@@ -1458,9 +1444,10 @@ static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive) ...@@ -1458,9 +1444,10 @@ static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive)
{ {
idetape_tape_t *tape = drive->driver_data; idetape_tape_t *tape = drive->driver_data;
struct ide_atapi_pc pc; struct ide_atapi_pc pc;
u8 buf[12];
idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR); idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR);
if (ide_queue_pc_tail(drive, tape->disk, &pc)) { if (ide_queue_pc_tail(drive, tape->disk, &pc, buf, pc.req_xfer)) {
printk(KERN_ERR "ide-tape: Can't get block descriptor\n"); printk(KERN_ERR "ide-tape: Can't get block descriptor\n");
if (tape->blk_size == 0) { if (tape->blk_size == 0) {
printk(KERN_WARNING "ide-tape: Cannot deal with zero " printk(KERN_WARNING "ide-tape: Cannot deal with zero "
...@@ -1469,10 +1456,10 @@ static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive) ...@@ -1469,10 +1456,10 @@ static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive)
} }
return; return;
} }
tape->blk_size = (pc.buf[4 + 5] << 16) + tape->blk_size = (buf[4 + 5] << 16) +
(pc.buf[4 + 6] << 8) + (buf[4 + 6] << 8) +
pc.buf[4 + 7]; buf[4 + 7];
tape->drv_write_prot = (pc.buf[2] & 0x80) >> 7; tape->drv_write_prot = (buf[2] & 0x80) >> 7;
} }
static int idetape_chrdev_open(struct inode *inode, struct file *filp) static int idetape_chrdev_open(struct inode *inode, struct file *filp)
...@@ -1517,7 +1504,7 @@ static int idetape_chrdev_open(struct inode *inode, struct file *filp) ...@@ -1517,7 +1504,7 @@ static int idetape_chrdev_open(struct inode *inode, struct file *filp)
goto out_put_tape; goto out_put_tape;
} }
idetape_read_position(drive); ide_tape_read_position(drive);
if (!test_bit(ilog2(IDE_AFLAG_ADDRESS_VALID), &drive->atapi_flags)) if (!test_bit(ilog2(IDE_AFLAG_ADDRESS_VALID), &drive->atapi_flags))
(void)idetape_rewind_tape(drive); (void)idetape_rewind_tape(drive);
...@@ -1615,17 +1602,14 @@ static void idetape_get_inquiry_results(ide_drive_t *drive) ...@@ -1615,17 +1602,14 @@ static void idetape_get_inquiry_results(ide_drive_t *drive)
char fw_rev[4], vendor_id[8], product_id[16]; char fw_rev[4], vendor_id[8], product_id[16];
idetape_create_inquiry_cmd(&pc); idetape_create_inquiry_cmd(&pc);
pc.buf = &pc_buf[0]; if (ide_queue_pc_tail(drive, tape->disk, &pc, pc_buf, pc.req_xfer)) {
pc.buf_size = sizeof(pc_buf);
if (ide_queue_pc_tail(drive, tape->disk, &pc)) {
printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n", printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
tape->name); tape->name);
return; return;
} }
memcpy(vendor_id, &pc.buf[8], 8); memcpy(vendor_id, &pc_buf[8], 8);
memcpy(product_id, &pc.buf[16], 16); memcpy(product_id, &pc_buf[16], 16);
memcpy(fw_rev, &pc.buf[32], 4); memcpy(fw_rev, &pc_buf[32], 4);
ide_fixstring(vendor_id, 8, 0); ide_fixstring(vendor_id, 8, 0);
ide_fixstring(product_id, 16, 0); ide_fixstring(product_id, 16, 0);
...@@ -1643,11 +1627,11 @@ static void idetape_get_mode_sense_results(ide_drive_t *drive) ...@@ -1643,11 +1627,11 @@ static void idetape_get_mode_sense_results(ide_drive_t *drive)
{ {
idetape_tape_t *tape = drive->driver_data; idetape_tape_t *tape = drive->driver_data;
struct ide_atapi_pc pc; struct ide_atapi_pc pc;
u8 *caps; u8 buf[24], *caps;
u8 speed, max_speed; u8 speed, max_speed;
idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE); idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
if (ide_queue_pc_tail(drive, tape->disk, &pc)) { if (ide_queue_pc_tail(drive, tape->disk, &pc, buf, pc.req_xfer)) {
printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming" printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
" some default values\n"); " some default values\n");
tape->blk_size = 512; tape->blk_size = 512;
...@@ -1656,7 +1640,7 @@ static void idetape_get_mode_sense_results(ide_drive_t *drive) ...@@ -1656,7 +1640,7 @@ static void idetape_get_mode_sense_results(ide_drive_t *drive)
put_unaligned(6*52, (u16 *)&tape->caps[16]); put_unaligned(6*52, (u16 *)&tape->caps[16]);
return; return;
} }
caps = pc.buf + 4 + pc.buf[3]; caps = buf + 4 + buf[3];
/* convert to host order and save for later use */ /* convert to host order and save for later use */
speed = be16_to_cpup((__be16 *)&caps[14]); speed = be16_to_cpup((__be16 *)&caps[14]);
......
...@@ -107,6 +107,18 @@ u8 ide_get_best_pio_mode(ide_drive_t *drive, u8 mode_wanted, u8 max_mode) ...@@ -107,6 +107,18 @@ u8 ide_get_best_pio_mode(ide_drive_t *drive, u8 mode_wanted, u8 max_mode)
} }
EXPORT_SYMBOL_GPL(ide_get_best_pio_mode); EXPORT_SYMBOL_GPL(ide_get_best_pio_mode);
int ide_pio_need_iordy(ide_drive_t *drive, const u8 pio)
{
/*
* IORDY may lead to controller lock up on certain controllers
* if the port is not occupied.
*/
if (pio == 0 && (drive->hwif->port_flags & IDE_PFLAG_PROBING))
return 0;
return ata_id_pio_need_iordy(drive->id, pio);
}
EXPORT_SYMBOL_GPL(ide_pio_need_iordy);
int ide_set_pio_mode(ide_drive_t *drive, const u8 mode) int ide_set_pio_mode(ide_drive_t *drive, const u8 mode)
{ {
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
......
...@@ -66,7 +66,7 @@ static void it8172_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -66,7 +66,7 @@ static void it8172_set_pio_mode(ide_drive_t *drive, const u8 pio)
if (drive->media == ide_disk) if (drive->media == ide_disk)
/* enable prefetch */ /* enable prefetch */
drive_enables |= 0x0004 << (drive->dn * 4); drive_enables |= 0x0004 << (drive->dn * 4);
if (ata_id_has_iordy(drive->id)) if (ide_pio_need_iordy(drive, pio))
/* enable IORDY sample-point */ /* enable IORDY sample-point */
drive_enables |= 0x0002 << (drive->dn * 4); drive_enables |= 0x0002 << (drive->dn * 4);
......
...@@ -50,7 +50,7 @@ static void it8213_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -50,7 +50,7 @@ static void it8213_set_pio_mode(ide_drive_t *drive, const u8 pio)
control |= 1; /* Programmable timing on */ control |= 1; /* Programmable timing on */
if (drive->media != ide_disk) if (drive->media != ide_disk)
control |= 4; /* ATAPI */ control |= 4; /* ATAPI */
if (pio > 2) if (ide_pio_need_iordy(drive, pio))
control |= 2; /* IORDY */ control |= 2; /* IORDY */
if (is_slave) { if (is_slave) {
master_data |= 0x4000; master_data |= 0x4000;
......
...@@ -53,17 +53,20 @@ ...@@ -53,17 +53,20 @@
volatile unsigned char *ide_ifr = (unsigned char *) (IDE_BASE + IDE_IFR); volatile unsigned char *ide_ifr = (unsigned char *) (IDE_BASE + IDE_IFR);
int macide_ack_intr(ide_hwif_t* hwif) int macide_test_irq(ide_hwif_t *hwif)
{ {
if (*ide_ifr & 0x20) { if (*ide_ifr & 0x20)
*ide_ifr &= ~0x20;
return 1; return 1;
}
return 0; return 0;
} }
static void macide_clear_irq(ide_drive_t *drive)
{
*ide_ifr &= ~0x20;
}
static void __init macide_setup_ports(struct ide_hw *hw, unsigned long base, static void __init macide_setup_ports(struct ide_hw *hw, unsigned long base,
int irq, ide_ack_intr_t *ack_intr) int irq)
{ {
int i; int i;
...@@ -75,10 +78,15 @@ static void __init macide_setup_ports(struct ide_hw *hw, unsigned long base, ...@@ -75,10 +78,15 @@ static void __init macide_setup_ports(struct ide_hw *hw, unsigned long base,
hw->io_ports.ctl_addr = base + IDE_CONTROL; hw->io_ports.ctl_addr = base + IDE_CONTROL;
hw->irq = irq; hw->irq = irq;
hw->ack_intr = ack_intr;
} }
static const struct ide_port_ops macide_port_ops = {
.clear_irq = macide_clear_irq,
.test_irq = macide_test_irq,
};
static const struct ide_port_info macide_port_info = { static const struct ide_port_info macide_port_info = {
.port_ops = &macide_port_ops,
.host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_NO_DMA, .host_flags = IDE_HFLAG_MMIO | IDE_HFLAG_NO_DMA,
.irq_flags = IRQF_SHARED, .irq_flags = IRQF_SHARED,
.chipset = ide_generic, .chipset = ide_generic,
...@@ -93,10 +101,10 @@ static const char *mac_ide_name[] = ...@@ -93,10 +101,10 @@ static const char *mac_ide_name[] =
static int __init macide_init(void) static int __init macide_init(void)
{ {
ide_ack_intr_t *ack_intr;
unsigned long base; unsigned long base;
int irq; int irq;
struct ide_hw hw, *hws[] = { &hw }; struct ide_hw hw, *hws[] = { &hw };
struct ide_port_info d = macide_port_info;
if (!MACH_IS_MAC) if (!MACH_IS_MAC)
return -ENODEV; return -ENODEV;
...@@ -104,17 +112,15 @@ static int __init macide_init(void) ...@@ -104,17 +112,15 @@ static int __init macide_init(void)
switch (macintosh_config->ide_type) { switch (macintosh_config->ide_type) {
case MAC_IDE_QUADRA: case MAC_IDE_QUADRA:
base = IDE_BASE; base = IDE_BASE;
ack_intr = macide_ack_intr;
irq = IRQ_NUBUS_F; irq = IRQ_NUBUS_F;
break; break;
case MAC_IDE_PB: case MAC_IDE_PB:
base = IDE_BASE; base = IDE_BASE;
ack_intr = macide_ack_intr;
irq = IRQ_NUBUS_C; irq = IRQ_NUBUS_C;
break; break;
case MAC_IDE_BABOON: case MAC_IDE_BABOON:
base = BABOON_BASE; base = BABOON_BASE;
ack_intr = NULL; d.port_ops = NULL;
irq = IRQ_BABOON_1; irq = IRQ_BABOON_1;
break; break;
default: default:
...@@ -124,9 +130,9 @@ static int __init macide_init(void) ...@@ -124,9 +130,9 @@ static int __init macide_init(void)
printk(KERN_INFO "ide: Macintosh %s IDE controller\n", printk(KERN_INFO "ide: Macintosh %s IDE controller\n",
mac_ide_name[macintosh_config->ide_type - 1]); mac_ide_name[macintosh_config->ide_type - 1]);
macide_setup_ports(&hw, base, irq, ack_intr); macide_setup_ports(&hw, base, irq);
return ide_host_add(&macide_port_info, hws, 1, NULL); return ide_host_add(&d, hws, 1, NULL);
} }
module_init(macide_init); module_init(macide_init);
......
...@@ -138,6 +138,7 @@ static void opti621_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -138,6 +138,7 @@ static void opti621_set_pio_mode(ide_drive_t *drive, const u8 pio)
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
ide_drive_t *pair = ide_get_pair_dev(drive); ide_drive_t *pair = ide_get_pair_dev(drive);
unsigned long flags; unsigned long flags;
unsigned long mode = XFER_PIO_0 + pio, pair_mode;
u8 tim, misc, addr_pio = pio, clk; u8 tim, misc, addr_pio = pio, clk;
/* DRDY is default 2 (by OPTi Databook) */ /* DRDY is default 2 (by OPTi Databook) */
...@@ -150,11 +151,12 @@ static void opti621_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -150,11 +151,12 @@ static void opti621_set_pio_mode(ide_drive_t *drive, const u8 pio)
{ 0x48, 0x34, 0x21, 0x10, 0x10 } /* 25 MHz */ { 0x48, 0x34, 0x21, 0x10, 0x10 } /* 25 MHz */
}; };
drive->drive_data = XFER_PIO_0 + pio; ide_set_drivedata(drive, (void *)mode);
if (pair) { if (pair) {
if (pair->drive_data && pair->drive_data < drive->drive_data) pair_mode = (unsigned long)ide_get_drivedata(pair);
addr_pio = pair->drive_data - XFER_PIO_0; if (pair_mode && pair_mode < mode)
addr_pio = pair_mode - XFER_PIO_0;
} }
spin_lock_irqsave(&opti621_lock, flags); spin_lock_irqsave(&opti621_lock, flags);
......
...@@ -73,7 +73,7 @@ static void pdc202xx_set_mode(ide_drive_t *drive, const u8 speed) ...@@ -73,7 +73,7 @@ static void pdc202xx_set_mode(ide_drive_t *drive, const u8 speed)
* Prefetch_EN / IORDY_EN / PA[3:0] bits of register A * Prefetch_EN / IORDY_EN / PA[3:0] bits of register A
*/ */
AP &= ~0x3f; AP &= ~0x3f;
if (ata_id_iordy_disable(drive->id)) if (ide_pio_need_iordy(drive, speed - XFER_PIO_0))
AP |= 0x20; /* set IORDY_EN bit */ AP |= 0x20; /* set IORDY_EN bit */
if (drive->media == ide_disk) if (drive->media == ide_disk)
AP |= 0x10; /* set Prefetch_EN bit */ AP |= 0x10; /* set Prefetch_EN bit */
...@@ -104,6 +104,27 @@ static void pdc202xx_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -104,6 +104,27 @@ static void pdc202xx_set_pio_mode(ide_drive_t *drive, const u8 pio)
pdc202xx_set_mode(drive, XFER_PIO_0 + pio); pdc202xx_set_mode(drive, XFER_PIO_0 + pio);
} }
static int pdc202xx_test_irq(ide_hwif_t *hwif)
{
struct pci_dev *dev = to_pci_dev(hwif->dev);
unsigned long high_16 = pci_resource_start(dev, 4);
u8 sc1d = inb(high_16 + 0x1d);
if (hwif->channel) {
/*
* bit 7: error, bit 6: interrupting,
* bit 5: FIFO full, bit 4: FIFO empty
*/
return ((sc1d & 0x50) == 0x40) ? 1 : 0;
} else {
/*
* bit 3: error, bit 2: interrupting,
* bit 1: FIFO full, bit 0: FIFO empty
*/
return ((sc1d & 0x05) == 0x04) ? 1 : 0;
}
}
static u8 pdc2026x_cable_detect(ide_hwif_t *hwif) static u8 pdc2026x_cable_detect(ide_hwif_t *hwif)
{ {
struct pci_dev *dev = to_pci_dev(hwif->dev); struct pci_dev *dev = to_pci_dev(hwif->dev);
...@@ -231,6 +252,7 @@ static void __devinit pdc202ata4_fixup_irq(struct pci_dev *dev, ...@@ -231,6 +252,7 @@ static void __devinit pdc202ata4_fixup_irq(struct pci_dev *dev,
static const struct ide_port_ops pdc20246_port_ops = { static const struct ide_port_ops pdc20246_port_ops = {
.set_pio_mode = pdc202xx_set_pio_mode, .set_pio_mode = pdc202xx_set_pio_mode,
.set_dma_mode = pdc202xx_set_mode, .set_dma_mode = pdc202xx_set_mode,
.test_irq = pdc202xx_test_irq,
}; };
static const struct ide_port_ops pdc2026x_port_ops = { static const struct ide_port_ops pdc2026x_port_ops = {
......
...@@ -98,7 +98,7 @@ static void piix_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -98,7 +98,7 @@ static void piix_set_pio_mode(ide_drive_t *drive, const u8 pio)
control |= 1; /* Programmable timing on */ control |= 1; /* Programmable timing on */
if (drive->media == ide_disk) if (drive->media == ide_disk)
control |= 4; /* Prefetch, post write */ control |= 4; /* Prefetch, post write */
if (pio > 2) if (ide_pio_need_iordy(drive, pio))
control |= 2; /* IORDY */ control |= 2; /* IORDY */
if (is_slave) { if (is_slave) {
master_data |= 0x4000; master_data |= 0x4000;
......
...@@ -51,9 +51,7 @@ static int q40ide_default_irq(unsigned long base) ...@@ -51,9 +51,7 @@ static int q40ide_default_irq(unsigned long base)
/* /*
* Addresses are pretranslated for Q40 ISA access. * Addresses are pretranslated for Q40 ISA access.
*/ */
static void q40_ide_setup_ports(struct ide_hw *hw, unsigned long base, static void q40_ide_setup_ports(struct ide_hw *hw, unsigned long base, int irq)
ide_ack_intr_t *ack_intr,
int irq)
{ {
memset(hw, 0, sizeof(*hw)); memset(hw, 0, sizeof(*hw));
/* BIG FAT WARNING: /* BIG FAT WARNING:
...@@ -69,7 +67,6 @@ static void q40_ide_setup_ports(struct ide_hw *hw, unsigned long base, ...@@ -69,7 +67,6 @@ static void q40_ide_setup_ports(struct ide_hw *hw, unsigned long base,
hw->io_ports.ctl_addr = Q40_ISA_IO_B(base + 0x206); hw->io_ports.ctl_addr = Q40_ISA_IO_B(base + 0x206);
hw->irq = irq; hw->irq = irq;
hw->ack_intr = ack_intr;
} }
static void q40ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, static void q40ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd,
...@@ -156,7 +153,7 @@ static int __init q40ide_init(void) ...@@ -156,7 +153,7 @@ static int __init q40ide_init(void)
release_region(pcide_bases[i], 8); release_region(pcide_bases[i], 8);
continue; continue;
} }
q40_ide_setup_ports(&hw[i], pcide_bases[i], NULL, q40_ide_setup_ports(&hw[i], pcide_bases[i],
q40ide_default_irq(pcide_bases[i])); q40ide_default_irq(pcide_bases[i]));
hws[i] = &hw[i]; hws[i] = &hw[i];
......
...@@ -180,8 +180,11 @@ static int qd_find_disk_type (ide_drive_t *drive, ...@@ -180,8 +180,11 @@ static int qd_find_disk_type (ide_drive_t *drive,
static void qd_set_timing (ide_drive_t *drive, u8 timing) static void qd_set_timing (ide_drive_t *drive, u8 timing)
{ {
drive->drive_data &= 0xff00; unsigned long data = (unsigned long)ide_get_drivedata(drive);
drive->drive_data |= timing;
data &= 0xff00;
data |= timing;
ide_set_drivedata(drive, (void *)data);
printk(KERN_DEBUG "%s: %#x\n", drive->name, timing); printk(KERN_DEBUG "%s: %#x\n", drive->name, timing);
} }
...@@ -292,7 +295,7 @@ static void __init qd6500_init_dev(ide_drive_t *drive) ...@@ -292,7 +295,7 @@ static void __init qd6500_init_dev(ide_drive_t *drive)
u8 base = (hwif->config_data & 0xff00) >> 8; u8 base = (hwif->config_data & 0xff00) >> 8;
u8 config = QD_CONFIG(hwif); u8 config = QD_CONFIG(hwif);
drive->drive_data = QD6500_DEF_DATA; ide_set_drivedata(drive, (void *)QD6500_DEF_DATA);
} }
static void __init qd6580_init_dev(ide_drive_t *drive) static void __init qd6580_init_dev(ide_drive_t *drive)
...@@ -308,7 +311,7 @@ static void __init qd6580_init_dev(ide_drive_t *drive) ...@@ -308,7 +311,7 @@ static void __init qd6580_init_dev(ide_drive_t *drive)
} else } else
t2 = t1 = hwif->channel ? QD6580_DEF_DATA2 : QD6580_DEF_DATA; t2 = t1 = hwif->channel ? QD6580_DEF_DATA2 : QD6580_DEF_DATA;
drive->drive_data = (drive->dn & 1) ? t2 : t1; ide_set_drivedata(drive, (void *)((drive->dn & 1) ? t2 : t1));
} }
static const struct ide_tp_ops qd65xx_tp_ops = { static const struct ide_tp_ops qd65xx_tp_ops = {
......
...@@ -31,8 +31,15 @@ ...@@ -31,8 +31,15 @@
#define QD_CONFIG(hwif) ((hwif)->config_data & 0x00ff) #define QD_CONFIG(hwif) ((hwif)->config_data & 0x00ff)
#define QD_TIMING(drive) (u8)(((drive)->drive_data) & 0x00ff) static inline u8 QD_TIMING(ide_drive_t *drive)
#define QD_TIMREG(drive) (u8)((((drive)->drive_data) & 0xff00) >> 8) {
return (unsigned long)ide_get_drivedata(drive) & 0x00ff;
}
static inline u8 QD_TIMREG(ide_drive_t *drive)
{
return ((unsigned long)ide_get_drivedata(drive) & 0xff00) >> 8;
}
#define QD6500_DEF_DATA ((QD_TIM1_PORT<<8) | (QD_ID3 ? 0x0c : 0x08)) #define QD6500_DEF_DATA ((QD_TIM1_PORT<<8) | (QD_ID3 ? 0x0c : 0x08))
#define QD6580_DEF_DATA ((QD_TIM1_PORT<<8) | (QD_ID3 ? 0x0a : 0x00)) #define QD6580_DEF_DATA ((QD_TIM1_PORT<<8) | (QD_ID3 ? 0x0a : 0x00))
......
/* /*
* Copyright (c) 2003-2006 Silicon Graphics, Inc. All Rights Reserved. * Copyright (c) 2003-2006 Silicon Graphics, Inc. All Rights Reserved.
* Copyright (C) 2008 MontaVista Software, Inc. * Copyright (C) 2008-2009 MontaVista Software, Inc.
* *
* This program is free software; you can redistribute it and/or modify it * This program is free software; you can redistribute it and/or modify it
* under the terms of version 2 of the GNU General Public License * under the terms of version 2 of the GNU General Public License
...@@ -29,8 +29,7 @@ ...@@ -29,8 +29,7 @@
#include <linux/blkdev.h> #include <linux/blkdev.h>
#include <linux/scatterlist.h> #include <linux/scatterlist.h>
#include <linux/ioc4.h> #include <linux/ioc4.h>
#include <asm/io.h> #include <linux/io.h>
#include <linux/ide.h> #include <linux/ide.h>
#define DRV_NAME "SGIIOC4" #define DRV_NAME "SGIIOC4"
...@@ -72,7 +71,7 @@ ...@@ -72,7 +71,7 @@
#define IOC4_CMD_CTL_BLK_SIZE 0x20 #define IOC4_CMD_CTL_BLK_SIZE 0x20
#define IOC4_SUPPORTED_FIRMWARE_REV 46 #define IOC4_SUPPORTED_FIRMWARE_REV 46
typedef struct { struct ioc4_dma_regs {
u32 timing_reg0; u32 timing_reg0;
u32 timing_reg1; u32 timing_reg1;
u32 low_mem_ptr; u32 low_mem_ptr;
...@@ -82,17 +81,18 @@ typedef struct { ...@@ -82,17 +81,18 @@ typedef struct {
u32 dev_byte_count; u32 dev_byte_count;
u32 mem_byte_count; u32 mem_byte_count;
u32 status; u32 status;
} ioc4_dma_regs_t; };
/* Each Physical Region Descriptor Entry size is 16 bytes (2 * 64 bits) */ /* Each Physical Region Descriptor Entry size is 16 bytes (2 * 64 bits) */
/* IOC4 has only 1 IDE channel */ /* IOC4 has only 1 IDE channel */
#define IOC4_PRD_BYTES 16 #define IOC4_PRD_BYTES 16
#define IOC4_PRD_ENTRIES (PAGE_SIZE /(4*IOC4_PRD_BYTES)) #define IOC4_PRD_ENTRIES (PAGE_SIZE / (4 * IOC4_PRD_BYTES))
static void static void sgiioc4_init_hwif_ports(struct ide_hw *hw,
sgiioc4_init_hwif_ports(struct ide_hw *hw, unsigned long data_port, unsigned long data_port,
unsigned long ctrl_port, unsigned long irq_port) unsigned long ctrl_port,
unsigned long irq_port)
{ {
unsigned long reg = data_port; unsigned long reg = data_port;
int i; int i;
...@@ -105,13 +105,11 @@ sgiioc4_init_hwif_ports(struct ide_hw *hw, unsigned long data_port, ...@@ -105,13 +105,11 @@ sgiioc4_init_hwif_ports(struct ide_hw *hw, unsigned long data_port,
hw->io_ports.irq_addr = irq_port; hw->io_ports.irq_addr = irq_port;
} }
static int static int sgiioc4_checkirq(ide_hwif_t *hwif)
sgiioc4_checkirq(ide_hwif_t * hwif)
{ {
unsigned long intr_addr = unsigned long intr_addr = hwif->io_ports.irq_addr + IOC4_INTR_REG * 4;
hwif->io_ports.irq_addr + IOC4_INTR_REG * 4;
if ((u8)readl((void __iomem *)intr_addr) & 0x03) if (readl((void __iomem *)intr_addr) & 0x03)
return 1; return 1;
return 0; return 0;
...@@ -119,8 +117,7 @@ sgiioc4_checkirq(ide_hwif_t * hwif) ...@@ -119,8 +117,7 @@ sgiioc4_checkirq(ide_hwif_t * hwif)
static u8 sgiioc4_read_status(ide_hwif_t *); static u8 sgiioc4_read_status(ide_hwif_t *);
static int static int sgiioc4_clearirq(ide_drive_t *drive)
sgiioc4_clearirq(ide_drive_t * drive)
{ {
u32 intr_reg; u32 intr_reg;
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
...@@ -158,12 +155,10 @@ sgiioc4_clearirq(ide_drive_t * drive) ...@@ -158,12 +155,10 @@ sgiioc4_clearirq(ide_drive_t * drive)
readl((void __iomem *)(io_ports->irq_addr + 4)); readl((void __iomem *)(io_ports->irq_addr + 4));
pci_read_config_dword(dev, PCI_COMMAND, pci_read_config_dword(dev, PCI_COMMAND,
&pci_stat_cmd_reg); &pci_stat_cmd_reg);
printk(KERN_ERR printk(KERN_ERR "%s(%s): PCI Bus Error when doing DMA: "
"%s(%s) : PCI Bus Error when doing DMA:" "status-cmd reg is 0x%x\n",
" status-cmd reg is 0x%x\n",
__func__, drive->name, pci_stat_cmd_reg); __func__, drive->name, pci_stat_cmd_reg);
printk(KERN_ERR printk(KERN_ERR "%s(%s): PCI Error Address is 0x%x%x\n",
"%s(%s) : PCI Error Address is 0x%x%x\n",
__func__, drive->name, __func__, drive->name,
pci_err_addr_high, pci_err_addr_low); pci_err_addr_high, pci_err_addr_low);
/* Clear the PCI Error indicator */ /* Clear the PCI Error indicator */
...@@ -189,8 +184,7 @@ static void sgiioc4_dma_start(ide_drive_t *drive) ...@@ -189,8 +184,7 @@ static void sgiioc4_dma_start(ide_drive_t *drive)
writel(temp_reg, (void __iomem *)ioc4_dma_addr); writel(temp_reg, (void __iomem *)ioc4_dma_addr);
} }
static u32 static u32 sgiioc4_ide_dma_stop(ide_hwif_t *hwif, u64 dma_base)
sgiioc4_ide_dma_stop(ide_hwif_t *hwif, u64 dma_base)
{ {
unsigned long ioc4_dma_addr = dma_base + IOC4_DMA_CTRL * 4; unsigned long ioc4_dma_addr = dma_base + IOC4_DMA_CTRL * 4;
u32 ioc4_dma; u32 ioc4_dma;
...@@ -227,7 +221,7 @@ static int sgiioc4_dma_end(ide_drive_t *drive) ...@@ -227,7 +221,7 @@ static int sgiioc4_dma_end(ide_drive_t *drive)
} }
/* /*
* The IOC4 will DMA 1's to the ending dma area to indicate that * The IOC4 will DMA 1's to the ending DMA area to indicate that
* previous data DMA is complete. This is necessary because of relaxed * previous data DMA is complete. This is necessary because of relaxed
* ordering between register reads and DMA writes on the Altix. * ordering between register reads and DMA writes on the Altix.
*/ */
...@@ -265,7 +259,7 @@ static void sgiioc4_set_dma_mode(ide_drive_t *drive, const u8 speed) ...@@ -265,7 +259,7 @@ static void sgiioc4_set_dma_mode(ide_drive_t *drive, const u8 speed)
{ {
} }
/* returns 1 if dma irq issued, 0 otherwise */ /* Returns 1 if DMA IRQ issued, 0 otherwise */
static int sgiioc4_dma_test_irq(ide_drive_t *drive) static int sgiioc4_dma_test_irq(ide_drive_t *drive)
{ {
return sgiioc4_checkirq(drive->hwif); return sgiioc4_checkirq(drive->hwif);
...@@ -286,8 +280,7 @@ static void sgiioc4_resetproc(ide_drive_t *drive) ...@@ -286,8 +280,7 @@ static void sgiioc4_resetproc(ide_drive_t *drive)
sgiioc4_clearirq(drive); sgiioc4_clearirq(drive);
} }
static void static void sgiioc4_dma_lost_irq(ide_drive_t *drive)
sgiioc4_dma_lost_irq(ide_drive_t * drive)
{ {
sgiioc4_resetproc(drive); sgiioc4_resetproc(drive);
...@@ -313,13 +306,13 @@ static u8 sgiioc4_read_status(ide_hwif_t *hwif) ...@@ -313,13 +306,13 @@ static u8 sgiioc4_read_status(ide_hwif_t *hwif)
return reg; return reg;
} }
/* Creates a dma map for the scatter-gather list entries */ /* Creates a DMA map for the scatter-gather list entries */
static int __devinit static int __devinit ide_dma_sgiioc4(ide_hwif_t *hwif,
ide_dma_sgiioc4(ide_hwif_t *hwif, const struct ide_port_info *d) const struct ide_port_info *d)
{ {
struct pci_dev *dev = to_pci_dev(hwif->dev); struct pci_dev *dev = to_pci_dev(hwif->dev);
unsigned long dma_base = pci_resource_start(dev, 0) + IOC4_DMA_OFFSET; unsigned long dma_base = pci_resource_start(dev, 0) + IOC4_DMA_OFFSET;
int num_ports = sizeof (ioc4_dma_regs_t); int num_ports = sizeof(struct ioc4_dma_regs);
void *pad; void *pad;
printk(KERN_INFO " %s: MMIO-DMA\n", hwif->name); printk(KERN_INFO " %s: MMIO-DMA\n", hwif->name);
...@@ -362,8 +355,7 @@ ide_dma_sgiioc4(ide_hwif_t *hwif, const struct ide_port_info *d) ...@@ -362,8 +355,7 @@ ide_dma_sgiioc4(ide_hwif_t *hwif, const struct ide_port_info *d)
} }
/* Initializes the IOC4 DMA Engine */ /* Initializes the IOC4 DMA Engine */
static void static void sgiioc4_configure_for_dma(int dma_direction, ide_drive_t *drive)
sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive)
{ {
u32 ioc4_dma; u32 ioc4_dma;
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
...@@ -374,31 +366,27 @@ sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive) ...@@ -374,31 +366,27 @@ sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive)
ioc4_dma = readl((void __iomem *)ioc4_dma_addr); ioc4_dma = readl((void __iomem *)ioc4_dma_addr);
if (ioc4_dma & IOC4_S_DMA_ACTIVE) { if (ioc4_dma & IOC4_S_DMA_ACTIVE) {
printk(KERN_WARNING printk(KERN_WARNING "%s(%s): Warning!! DMA from previous "
"%s(%s):Warning!! DMA from previous transfer was still active\n", "transfer was still active\n", __func__, drive->name);
__func__, drive->name);
writel(IOC4_S_DMA_STOP, (void __iomem *)ioc4_dma_addr); writel(IOC4_S_DMA_STOP, (void __iomem *)ioc4_dma_addr);
ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base); ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base);
if (ioc4_dma & IOC4_S_DMA_STOP) if (ioc4_dma & IOC4_S_DMA_STOP)
printk(KERN_ERR printk(KERN_ERR "%s(%s): IOC4 DMA STOP bit is "
"%s(%s) : IOC4 Dma STOP bit is still 1\n", "still 1\n", __func__, drive->name);
__func__, drive->name);
} }
ioc4_dma = readl((void __iomem *)ioc4_dma_addr); ioc4_dma = readl((void __iomem *)ioc4_dma_addr);
if (ioc4_dma & IOC4_S_DMA_ERROR) { if (ioc4_dma & IOC4_S_DMA_ERROR) {
printk(KERN_WARNING printk(KERN_WARNING "%s(%s): Warning!! DMA Error during "
"%s(%s) : Warning!! - DMA Error during Previous" "previous transfer, status 0x%x\n",
" transfer | status 0x%x\n",
__func__, drive->name, ioc4_dma); __func__, drive->name, ioc4_dma);
writel(IOC4_S_DMA_STOP, (void __iomem *)ioc4_dma_addr); writel(IOC4_S_DMA_STOP, (void __iomem *)ioc4_dma_addr);
ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base); ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base);
if (ioc4_dma & IOC4_S_DMA_STOP) if (ioc4_dma & IOC4_S_DMA_STOP)
printk(KERN_ERR printk(KERN_ERR "%s(%s): IOC4 DMA STOP bit is "
"%s(%s) : IOC4 DMA STOP bit is still 1\n", "still 1\n", __func__, drive->name);
__func__, drive->name);
} }
/* Address of the Scatter Gather List */ /* Address of the Scatter Gather List */
...@@ -408,7 +396,8 @@ sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive) ...@@ -408,7 +396,8 @@ sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive)
/* Address of the Ending DMA */ /* Address of the Ending DMA */
memset(ide_get_hwifdata(hwif), 0, IOC4_IDE_CACHELINE_SIZE); memset(ide_get_hwifdata(hwif), 0, IOC4_IDE_CACHELINE_SIZE);
ending_dma_addr = cpu_to_le32(hwif->extra_base); ending_dma_addr = cpu_to_le32(hwif->extra_base);
writel(ending_dma_addr, (void __iomem *)(dma_base + IOC4_DMA_END_ADDR * 4)); writel(ending_dma_addr, (void __iomem *)(dma_base +
IOC4_DMA_END_ADDR * 4));
writel(dma_direction, (void __iomem *)ioc4_dma_addr); writel(dma_direction, (void __iomem *)ioc4_dma_addr);
} }
...@@ -422,6 +411,7 @@ sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive) ...@@ -422,6 +411,7 @@ sgiioc4_configure_for_dma(int dma_direction, ide_drive_t * drive)
/* | Upper 32 bits - Zero |EOL| 15 unused | 16 Bit Length| */ /* | Upper 32 bits - Zero |EOL| 15 unused | 16 Bit Length| */
/* --------------------------------------------------------------------- */ /* --------------------------------------------------------------------- */
/* Creates the scatter gather list, DMA Table */ /* Creates the scatter gather list, DMA Table */
static int sgiioc4_build_dmatable(ide_drive_t *drive, struct ide_cmd *cmd) static int sgiioc4_build_dmatable(ide_drive_t *drive, struct ide_cmd *cmd)
{ {
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
...@@ -448,8 +438,10 @@ static int sgiioc4_build_dmatable(ide_drive_t *drive, struct ide_cmd *cmd) ...@@ -448,8 +438,10 @@ static int sgiioc4_build_dmatable(ide_drive_t *drive, struct ide_cmd *cmd)
if (bcount > cur_len) if (bcount > cur_len)
bcount = cur_len; bcount = cur_len;
/* put the addr, length in /*
* the IOC4 dma-table format */ * Put the address, length in
* the IOC4 dma-table format
*/
*table = 0x0; *table = 0x0;
table++; table++;
*table = cpu_to_be32(cur_addr); *table = cpu_to_be32(cur_addr);
...@@ -540,8 +532,7 @@ static const struct ide_port_info sgiioc4_port_info __devinitconst = { ...@@ -540,8 +532,7 @@ static const struct ide_port_info sgiioc4_port_info __devinitconst = {
.mwdma_mask = ATA_MWDMA2_ONLY, .mwdma_mask = ATA_MWDMA2_ONLY,
}; };
static int __devinit static int __devinit sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
{ {
unsigned long cmd_base, irqport; unsigned long cmd_base, irqport;
unsigned long bar0, cmd_phys_base, ctl; unsigned long bar0, cmd_phys_base, ctl;
...@@ -549,7 +540,7 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev) ...@@ -549,7 +540,7 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
struct ide_hw hw, *hws[] = { &hw }; struct ide_hw hw, *hws[] = { &hw };
int rc; int rc;
/* Get the CmdBlk and CtrlBlk Base Registers */ /* Get the CmdBlk and CtrlBlk base registers */
bar0 = pci_resource_start(dev, 0); bar0 = pci_resource_start(dev, 0);
virt_base = pci_ioremap_bar(dev, 0); virt_base = pci_ioremap_bar(dev, 0);
if (virt_base == NULL) { if (virt_base == NULL) {
...@@ -557,9 +548,9 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev) ...@@ -557,9 +548,9 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
DRV_NAME, bar0); DRV_NAME, bar0);
return -ENOMEM; return -ENOMEM;
} }
cmd_base = (unsigned long) virt_base + IOC4_CMD_OFFSET; cmd_base = (unsigned long)virt_base + IOC4_CMD_OFFSET;
ctl = (unsigned long) virt_base + IOC4_CTRL_OFFSET; ctl = (unsigned long)virt_base + IOC4_CTRL_OFFSET;
irqport = (unsigned long) virt_base + IOC4_INTR_OFFSET; irqport = (unsigned long)virt_base + IOC4_INTR_OFFSET;
cmd_phys_base = bar0 + IOC4_CMD_OFFSET; cmd_phys_base = bar0 + IOC4_CMD_OFFSET;
if (request_mem_region(cmd_phys_base, IOC4_CMD_CTL_BLK_SIZE, if (request_mem_region(cmd_phys_base, IOC4_CMD_CTL_BLK_SIZE,
...@@ -577,7 +568,7 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev) ...@@ -577,7 +568,7 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
hw.irq = dev->irq; hw.irq = dev->irq;
hw.dev = &dev->dev; hw.dev = &dev->dev;
/* Initializing chipset IRQ Registers */ /* Initialize chipset IRQ registers */
writel(0x03, (void __iomem *)(irqport + IOC4_INTR_SET * 4)); writel(0x03, (void __iomem *)(irqport + IOC4_INTR_SET * 4));
rc = ide_host_add(&sgiioc4_port_info, hws, 1, NULL); rc = ide_host_add(&sgiioc4_port_info, hws, 1, NULL);
...@@ -590,8 +581,7 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev) ...@@ -590,8 +581,7 @@ sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
return rc; return rc;
} }
static unsigned int __devinit static unsigned int __devinit pci_init_sgiioc4(struct pci_dev *dev)
pci_init_sgiioc4(struct pci_dev *dev)
{ {
int ret; int ret;
...@@ -611,10 +601,10 @@ pci_init_sgiioc4(struct pci_dev *dev) ...@@ -611,10 +601,10 @@ pci_init_sgiioc4(struct pci_dev *dev)
return ret; return ret;
} }
int __devinit int __devinit ioc4_ide_attach_one(struct ioc4_driver_data *idd)
ioc4_ide_attach_one(struct ioc4_driver_data *idd)
{ {
/* PCI-RT does not bring out IDE connection. /*
* PCI-RT does not bring out IDE connection.
* Do not attach to this particular IOC4. * Do not attach to this particular IOC4.
*/ */
if (idd->idd_variant == IOC4_VARIANT_PCI_RT) if (idd->idd_variant == IOC4_VARIANT_PCI_RT)
...@@ -627,7 +617,6 @@ static struct ioc4_submodule __devinitdata ioc4_ide_submodule = { ...@@ -627,7 +617,6 @@ static struct ioc4_submodule __devinitdata ioc4_ide_submodule = {
.is_name = "IOC4_ide", .is_name = "IOC4_ide",
.is_owner = THIS_MODULE, .is_owner = THIS_MODULE,
.is_probe = ioc4_ide_attach_one, .is_probe = ioc4_ide_attach_one,
/* .is_remove = ioc4_ide_remove_one, */
}; };
static int __init ioc4_ide_init(void) static int __init ioc4_ide_init(void)
......
...@@ -32,7 +32,6 @@ ...@@ -32,7 +32,6 @@
* smarter code in libata. * smarter code in libata.
* *
* TODO: * TODO:
* - IORDY fixes
* - VDMA support * - VDMA support
*/ */
...@@ -234,8 +233,7 @@ static u8 sil_sata_udma_filter(ide_drive_t *drive) ...@@ -234,8 +233,7 @@ static u8 sil_sata_udma_filter(ide_drive_t *drive)
* @pio: PIO mode number * @pio: PIO mode number
* *
* Load the timing settings for this device mode into the * Load the timing settings for this device mode into the
* controller. If we are in PIO mode 3 or 4 turn on IORDY * controller.
* monitoring (bit 9). The TF timing is bits 31:16
*/ */
static void sil_set_pio_mode(ide_drive_t *drive, u8 pio) static void sil_set_pio_mode(ide_drive_t *drive, u8 pio)
...@@ -276,13 +274,16 @@ static void sil_set_pio_mode(ide_drive_t *drive, u8 pio) ...@@ -276,13 +274,16 @@ static void sil_set_pio_mode(ide_drive_t *drive, u8 pio)
/* now set up IORDY */ /* now set up IORDY */
speedp = sil_ioread16(dev, tfaddr - 2); speedp = sil_ioread16(dev, tfaddr - 2);
speedp &= ~0x200; speedp &= ~0x200;
if (pio > 2)
speedp |= 0x200;
sil_iowrite16(dev, speedp, tfaddr - 2);
mode = sil_ioread8(dev, base + addr_mask); mode = sil_ioread8(dev, base + addr_mask);
mode &= ~(unit ? 0x30 : 0x03); mode &= ~(unit ? 0x30 : 0x03);
if (ide_pio_need_iordy(drive, pio)) {
speedp |= 0x200;
mode |= unit ? 0x10 : 0x01; mode |= unit ? 0x10 : 0x01;
}
sil_iowrite16(dev, speedp, tfaddr - 2);
sil_iowrite8(dev, mode, base + addr_mask); sil_iowrite8(dev, mode, base + addr_mask);
} }
...@@ -337,24 +338,14 @@ static void sil_set_dma_mode(ide_drive_t *drive, const u8 speed) ...@@ -337,24 +338,14 @@ static void sil_set_dma_mode(ide_drive_t *drive, const u8 speed)
sil_iowrite16(dev, ultra, ua); sil_iowrite16(dev, ultra, ua);
} }
/* returns 1 if dma irq issued, 0 otherwise */ static int sil_test_irq(ide_hwif_t *hwif)
static int siimage_io_dma_test_irq(ide_drive_t *drive)
{ {
ide_hwif_t *hwif = drive->hwif;
struct pci_dev *dev = to_pci_dev(hwif->dev); struct pci_dev *dev = to_pci_dev(hwif->dev);
u8 dma_altstat = 0;
unsigned long addr = siimage_selreg(hwif, 1); unsigned long addr = siimage_selreg(hwif, 1);
u8 val = sil_ioread8(dev, addr);
/* return 1 if INTR asserted */ /* Return 1 if INTRQ asserted */
if (inb(hwif->dma_base + ATA_DMA_STATUS) & 4) return (val & 8) ? 1 : 0;
return 1;
/* return 1 if Device INTR asserted */
pci_read_config_byte(dev, addr, &dma_altstat);
if (dma_altstat & 8)
return 0; /* return 1; */
return 0;
} }
/** /**
...@@ -368,7 +359,6 @@ static int siimage_io_dma_test_irq(ide_drive_t *drive) ...@@ -368,7 +359,6 @@ static int siimage_io_dma_test_irq(ide_drive_t *drive)
static int siimage_mmio_dma_test_irq(ide_drive_t *drive) static int siimage_mmio_dma_test_irq(ide_drive_t *drive)
{ {
ide_hwif_t *hwif = drive->hwif; ide_hwif_t *hwif = drive->hwif;
unsigned long addr = siimage_selreg(hwif, 0x1);
void __iomem *sata_error_addr void __iomem *sata_error_addr
= (void __iomem *)hwif->sata_scr[SATA_ERROR_OFFSET]; = (void __iomem *)hwif->sata_scr[SATA_ERROR_OFFSET];
...@@ -397,10 +387,6 @@ static int siimage_mmio_dma_test_irq(ide_drive_t *drive) ...@@ -397,10 +387,6 @@ static int siimage_mmio_dma_test_irq(ide_drive_t *drive)
if (readb((void __iomem *)(hwif->dma_base + ATA_DMA_STATUS)) & 4) if (readb((void __iomem *)(hwif->dma_base + ATA_DMA_STATUS)) & 4)
return 1; return 1;
/* return 1 if Device INTR asserted */
if (readb((void __iomem *)addr) & 8)
return 0; /* return 1; */
return 0; return 0;
} }
...@@ -409,7 +395,7 @@ static int siimage_dma_test_irq(ide_drive_t *drive) ...@@ -409,7 +395,7 @@ static int siimage_dma_test_irq(ide_drive_t *drive)
if (drive->hwif->host_flags & IDE_HFLAG_MMIO) if (drive->hwif->host_flags & IDE_HFLAG_MMIO)
return siimage_mmio_dma_test_irq(drive); return siimage_mmio_dma_test_irq(drive);
else else
return siimage_io_dma_test_irq(drive); return ide_dma_test_irq(drive);
} }
/** /**
...@@ -694,6 +680,7 @@ static const struct ide_port_ops sil_pata_port_ops = { ...@@ -694,6 +680,7 @@ static const struct ide_port_ops sil_pata_port_ops = {
.set_pio_mode = sil_set_pio_mode, .set_pio_mode = sil_set_pio_mode,
.set_dma_mode = sil_set_dma_mode, .set_dma_mode = sil_set_dma_mode,
.quirkproc = sil_quirkproc, .quirkproc = sil_quirkproc,
.test_irq = sil_test_irq,
.udma_filter = sil_pata_udma_filter, .udma_filter = sil_pata_udma_filter,
.cable_detect = sil_cable_detect, .cable_detect = sil_cable_detect,
}; };
...@@ -704,6 +691,7 @@ static const struct ide_port_ops sil_sata_port_ops = { ...@@ -704,6 +691,7 @@ static const struct ide_port_ops sil_sata_port_ops = {
.reset_poll = sil_sata_reset_poll, .reset_poll = sil_sata_reset_poll,
.pre_reset = sil_sata_pre_reset, .pre_reset = sil_sata_pre_reset,
.quirkproc = sil_quirkproc, .quirkproc = sil_quirkproc,
.test_irq = sil_test_irq,
.udma_filter = sil_sata_udma_filter, .udma_filter = sil_sata_udma_filter,
.cable_detect = sil_cable_detect, .cable_detect = sil_cable_detect,
}; };
......
...@@ -61,8 +61,7 @@ static unsigned int get_pio_timings(ide_drive_t *drive, u8 pio) ...@@ -61,8 +61,7 @@ static unsigned int get_pio_timings(ide_drive_t *drive, u8 pio)
if (cmd_off == 0) if (cmd_off == 0)
cmd_off = 1; cmd_off = 1;
if ((pio > 2 || ata_id_has_iordy(drive->id)) && if (ide_pio_need_iordy(drive, pio))
!(pio > 4 && ata_id_is_cfa(drive->id)))
iordy = 0x40; iordy = 0x40;
return (cmd_on - 1) << 8 | (cmd_off - 1) | iordy; return (cmd_on - 1) << 8 | (cmd_off - 1) | iordy;
...@@ -74,6 +73,7 @@ static unsigned int get_pio_timings(ide_drive_t *drive, u8 pio) ...@@ -74,6 +73,7 @@ static unsigned int get_pio_timings(ide_drive_t *drive, u8 pio)
static void sl82c105_set_pio_mode(ide_drive_t *drive, const u8 pio) static void sl82c105_set_pio_mode(ide_drive_t *drive, const u8 pio)
{ {
struct pci_dev *dev = to_pci_dev(drive->hwif->dev); struct pci_dev *dev = to_pci_dev(drive->hwif->dev);
unsigned long timings = (unsigned long)ide_get_drivedata(drive);
int reg = 0x44 + drive->dn * 4; int reg = 0x44 + drive->dn * 4;
u16 drv_ctrl; u16 drv_ctrl;
...@@ -83,8 +83,9 @@ static void sl82c105_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -83,8 +83,9 @@ static void sl82c105_set_pio_mode(ide_drive_t *drive, const u8 pio)
* Store the PIO timings so that we can restore them * Store the PIO timings so that we can restore them
* in case DMA will be turned off... * in case DMA will be turned off...
*/ */
drive->drive_data &= 0xffff0000; timings &= 0xffff0000;
drive->drive_data |= drv_ctrl; timings |= drv_ctrl;
ide_set_drivedata(drive, (void *)timings);
pci_write_config_word(dev, reg, drv_ctrl); pci_write_config_word(dev, reg, drv_ctrl);
pci_read_config_word (dev, reg, &drv_ctrl); pci_read_config_word (dev, reg, &drv_ctrl);
...@@ -100,6 +101,7 @@ static void sl82c105_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -100,6 +101,7 @@ static void sl82c105_set_pio_mode(ide_drive_t *drive, const u8 pio)
static void sl82c105_set_dma_mode(ide_drive_t *drive, const u8 speed) static void sl82c105_set_dma_mode(ide_drive_t *drive, const u8 speed)
{ {
static u16 mwdma_timings[] = {0x0707, 0x0201, 0x0200}; static u16 mwdma_timings[] = {0x0707, 0x0201, 0x0200};
unsigned long timings = (unsigned long)ide_get_drivedata(drive);
u16 drv_ctrl; u16 drv_ctrl;
DBG(("sl82c105_tune_chipset(drive:%s, speed:%s)\n", DBG(("sl82c105_tune_chipset(drive:%s, speed:%s)\n",
...@@ -111,8 +113,19 @@ static void sl82c105_set_dma_mode(ide_drive_t *drive, const u8 speed) ...@@ -111,8 +113,19 @@ static void sl82c105_set_dma_mode(ide_drive_t *drive, const u8 speed)
* Store the DMA timings so that we can actually program * Store the DMA timings so that we can actually program
* them when DMA will be turned on... * them when DMA will be turned on...
*/ */
drive->drive_data &= 0x0000ffff; timings &= 0x0000ffff;
drive->drive_data |= (unsigned long)drv_ctrl << 16; timings |= (unsigned long)drv_ctrl << 16;
ide_set_drivedata(drive, (void *)timings);
}
static int sl82c105_test_irq(ide_hwif_t *hwif)
{
struct pci_dev *dev = to_pci_dev(hwif->dev);
u32 val, mask = hwif->channel ? CTRL_IDE_IRQB : CTRL_IDE_IRQA;
pci_read_config_dword(dev, 0x40, &val);
return (val & mask) ? 1 : 0;
} }
/* /*
...@@ -185,7 +198,8 @@ static void sl82c105_dma_start(ide_drive_t *drive) ...@@ -185,7 +198,8 @@ static void sl82c105_dma_start(ide_drive_t *drive)
DBG(("%s(drive:%s)\n", __func__, drive->name)); DBG(("%s(drive:%s)\n", __func__, drive->name));
pci_write_config_word(dev, reg, drive->drive_data >> 16); pci_write_config_word(dev, reg,
(unsigned long)ide_get_drivedata(drive) >> 16);
sl82c105_reset_host(dev); sl82c105_reset_host(dev);
ide_dma_start(drive); ide_dma_start(drive);
...@@ -210,7 +224,8 @@ static int sl82c105_dma_end(ide_drive_t *drive) ...@@ -210,7 +224,8 @@ static int sl82c105_dma_end(ide_drive_t *drive)
ret = ide_dma_end(drive); ret = ide_dma_end(drive);
pci_write_config_word(dev, reg, drive->drive_data); pci_write_config_word(dev, reg,
(unsigned long)ide_get_drivedata(drive));
return ret; return ret;
} }
...@@ -289,6 +304,7 @@ static const struct ide_port_ops sl82c105_port_ops = { ...@@ -289,6 +304,7 @@ static const struct ide_port_ops sl82c105_port_ops = {
.set_pio_mode = sl82c105_set_pio_mode, .set_pio_mode = sl82c105_set_pio_mode,
.set_dma_mode = sl82c105_set_dma_mode, .set_dma_mode = sl82c105_set_dma_mode,
.resetproc = sl82c105_resetproc, .resetproc = sl82c105_resetproc,
.test_irq = sl82c105_test_irq,
}; };
static const struct ide_dma_ops sl82c105_dma_ops = { static const struct ide_dma_ops sl82c105_dma_ops = {
......
...@@ -44,7 +44,7 @@ static void slc90e66_set_pio_mode(ide_drive_t *drive, const u8 pio) ...@@ -44,7 +44,7 @@ static void slc90e66_set_pio_mode(ide_drive_t *drive, const u8 pio)
control |= 1; /* Programmable timing on */ control |= 1; /* Programmable timing on */
if (drive->media == ide_disk) if (drive->media == ide_disk)
control |= 4; /* Prefetch, post write */ control |= 4; /* Prefetch, post write */
if (pio > 2) if (ide_pio_need_iordy(drive, pio))
control |= 2; /* IORDY */ control |= 2; /* IORDY */
if (is_slave) { if (is_slave) {
master_data |= 0x4000; master_data |= 0x4000;
......
...@@ -800,6 +800,20 @@ static inline int ata_id_is_ssd(const u16 *id) ...@@ -800,6 +800,20 @@ static inline int ata_id_is_ssd(const u16 *id)
return id[ATA_ID_ROT_SPEED] == 0x01; return id[ATA_ID_ROT_SPEED] == 0x01;
} }
static inline int ata_id_pio_need_iordy(const u16 *id, const u8 pio)
{
/* CF spec. r4.1 Table 22 says no IORDY on PIO5 and PIO6. */
if (pio > 4 && ata_id_is_cfa(id))
return 0;
/* For PIO3 and higher it is mandatory. */
if (pio > 2)
return 1;
/* Turn it on when possible. */
if (ata_id_has_iordy(id))
return 1;
return 0;
}
static inline int ata_drive_40wire(const u16 *dev_id) static inline int ata_drive_40wire(const u16 *dev_id)
{ {
if (ata_id_is_sata(dev_id)) if (ata_id_is_sata(dev_id))
......
...@@ -156,12 +156,6 @@ enum { ...@@ -156,12 +156,6 @@ enum {
#define REQ_PARK_HEADS 0x22 #define REQ_PARK_HEADS 0x22
#define REQ_UNPARK_HEADS 0x23 #define REQ_UNPARK_HEADS 0x23
/*
* Check for an interrupt and acknowledge the interrupt status
*/
struct hwif_s;
typedef int (ide_ack_intr_t)(struct hwif_s *);
/* /*
* hwif_chipset_t is used to keep track of the specific hardware * hwif_chipset_t is used to keep track of the specific hardware
* chipset used by each IDE interface, if known. * chipset used by each IDE interface, if known.
...@@ -185,7 +179,6 @@ struct ide_hw { ...@@ -185,7 +179,6 @@ struct ide_hw {
}; };
int irq; /* our irq number */ int irq; /* our irq number */
ide_ack_intr_t *ack_intr; /* acknowledge interrupt */
struct device *dev, *parent; struct device *dev, *parent;
unsigned long config; unsigned long config;
}; };
...@@ -331,11 +324,6 @@ enum { ...@@ -331,11 +324,6 @@ enum {
PC_FLAG_WRITING = (1 << 6), PC_FLAG_WRITING = (1 << 6),
}; };
/*
* With each packet command, we allocate a buffer of IDE_PC_BUFFER_SIZE bytes.
* This is used for several packet commands (not for READ/WRITE commands).
*/
#define IDE_PC_BUFFER_SIZE 64
#define ATAPI_WAIT_PC (60 * HZ) #define ATAPI_WAIT_PC (60 * HZ)
struct ide_atapi_pc { struct ide_atapi_pc {
...@@ -347,12 +335,6 @@ struct ide_atapi_pc { ...@@ -347,12 +335,6 @@ struct ide_atapi_pc {
/* bytes to transfer */ /* bytes to transfer */
int req_xfer; int req_xfer;
/* bytes actually transferred */
int xferred;
/* data buffer */
u8 *buf;
int buf_size;
/* the corresponding request */ /* the corresponding request */
struct request *rq; struct request *rq;
...@@ -363,8 +345,6 @@ struct ide_atapi_pc { ...@@ -363,8 +345,6 @@ struct ide_atapi_pc {
* those are more or less driver-specific and some of them are subject * those are more or less driver-specific and some of them are subject
* to change/removal later. * to change/removal later.
*/ */
u8 pc_buf[IDE_PC_BUFFER_SIZE];
unsigned long timeout; unsigned long timeout;
}; };
...@@ -552,7 +532,7 @@ struct ide_drive_s { ...@@ -552,7 +532,7 @@ struct ide_drive_s {
unsigned int bios_cyl; /* BIOS/fdisk/LILO number of cyls */ unsigned int bios_cyl; /* BIOS/fdisk/LILO number of cyls */
unsigned int cyl; /* "real" number of cyls */ unsigned int cyl; /* "real" number of cyls */
unsigned int drive_data; /* used by set_pio_mode/dev_select() */ void *drive_data; /* used by set_pio_mode/dev_select() */
unsigned int failures; /* current failure count */ unsigned int failures; /* current failure count */
unsigned int max_failures; /* maximum allowed failure count */ unsigned int max_failures; /* maximum allowed failure count */
u64 probed_capacity;/* initial/native media capacity */ u64 probed_capacity;/* initial/native media capacity */
...@@ -649,6 +629,7 @@ struct ide_port_ops { ...@@ -649,6 +629,7 @@ struct ide_port_ops {
void (*maskproc)(ide_drive_t *, int); void (*maskproc)(ide_drive_t *, int);
void (*quirkproc)(ide_drive_t *); void (*quirkproc)(ide_drive_t *);
void (*clear_irq)(ide_drive_t *); void (*clear_irq)(ide_drive_t *);
int (*test_irq)(struct hwif_s *);
u8 (*mdma_filter)(ide_drive_t *); u8 (*mdma_filter)(ide_drive_t *);
u8 (*udma_filter)(ide_drive_t *); u8 (*udma_filter)(ide_drive_t *);
...@@ -674,6 +655,10 @@ struct ide_dma_ops { ...@@ -674,6 +655,10 @@ struct ide_dma_ops {
u8 (*dma_sff_read_status)(struct hwif_s *); u8 (*dma_sff_read_status)(struct hwif_s *);
}; };
enum {
IDE_PFLAG_PROBING = (1 << 0),
};
struct ide_host; struct ide_host;
typedef struct hwif_s { typedef struct hwif_s {
...@@ -690,6 +675,8 @@ typedef struct hwif_s { ...@@ -690,6 +675,8 @@ typedef struct hwif_s {
ide_drive_t *devices[MAX_DRIVES + 1]; ide_drive_t *devices[MAX_DRIVES + 1];
unsigned long port_flags;
u8 major; /* our major number */ u8 major; /* our major number */
u8 index; /* 0 for ide0; 1 for ide1; ... */ u8 index; /* 0 for ide0; 1 for ide1; ... */
u8 channel; /* for dual-port chips: 0=primary, 1=secondary */ u8 channel; /* for dual-port chips: 0=primary, 1=secondary */
...@@ -708,8 +695,6 @@ typedef struct hwif_s { ...@@ -708,8 +695,6 @@ typedef struct hwif_s {
struct device *dev; struct device *dev;
ide_ack_intr_t *ack_intr;
void (*rw_disk)(ide_drive_t *, struct request *); void (*rw_disk)(ide_drive_t *, struct request *);
const struct ide_tp_ops *tp_ops; const struct ide_tp_ops *tp_ops;
...@@ -1130,6 +1115,8 @@ void SELECT_MASK(ide_drive_t *, int); ...@@ -1130,6 +1115,8 @@ void SELECT_MASK(ide_drive_t *, int);
u8 ide_read_error(ide_drive_t *); u8 ide_read_error(ide_drive_t *);
void ide_read_bcount_and_ireason(ide_drive_t *, u16 *, u8 *); void ide_read_bcount_and_ireason(ide_drive_t *, u16 *, u8 *);
int ide_check_ireason(ide_drive_t *, struct request *, int, int, int);
int ide_check_atapi_device(ide_drive_t *, const char *); int ide_check_atapi_device(ide_drive_t *, const char *);
void ide_init_pc(struct ide_atapi_pc *); void ide_init_pc(struct ide_atapi_pc *);
...@@ -1154,7 +1141,8 @@ enum { ...@@ -1154,7 +1141,8 @@ enum {
REQ_IDETAPE_WRITE = (1 << 3), REQ_IDETAPE_WRITE = (1 << 3),
}; };
int ide_queue_pc_tail(ide_drive_t *, struct gendisk *, struct ide_atapi_pc *); int ide_queue_pc_tail(ide_drive_t *, struct gendisk *, struct ide_atapi_pc *,
void *, unsigned int);
int ide_do_test_unit_ready(ide_drive_t *, struct gendisk *); int ide_do_test_unit_ready(ide_drive_t *, struct gendisk *);
int ide_do_start_stop(ide_drive_t *, struct gendisk *, int); int ide_do_start_stop(ide_drive_t *, struct gendisk *, int);
...@@ -1524,6 +1512,7 @@ int ide_timing_compute(ide_drive_t *, u8, struct ide_timing *, int, int); ...@@ -1524,6 +1512,7 @@ int ide_timing_compute(ide_drive_t *, u8, struct ide_timing *, int, int);
int ide_scan_pio_blacklist(char *); int ide_scan_pio_blacklist(char *);
const char *ide_xfer_verbose(u8); const char *ide_xfer_verbose(u8);
u8 ide_get_best_pio_mode(ide_drive_t *, u8, u8); u8 ide_get_best_pio_mode(ide_drive_t *, u8, u8);
int ide_pio_need_iordy(ide_drive_t *, const u8);
int ide_set_pio_mode(ide_drive_t *, u8); int ide_set_pio_mode(ide_drive_t *, u8);
int ide_set_dma_mode(ide_drive_t *, u8); int ide_set_dma_mode(ide_drive_t *, u8);
void ide_set_pio(ide_drive_t *, u8); void ide_set_pio(ide_drive_t *, u8);
...@@ -1561,6 +1550,16 @@ static inline ide_drive_t *ide_get_pair_dev(ide_drive_t *drive) ...@@ -1561,6 +1550,16 @@ static inline ide_drive_t *ide_get_pair_dev(ide_drive_t *drive)
return (peer->dev_flags & IDE_DFLAG_PRESENT) ? peer : NULL; return (peer->dev_flags & IDE_DFLAG_PRESENT) ? peer : NULL;
} }
static inline void *ide_get_drivedata(ide_drive_t *drive)
{
return drive->drive_data;
}
static inline void ide_set_drivedata(ide_drive_t *drive, void *data)
{
drive->drive_data = data;
}
#define ide_port_for_each_dev(i, dev, port) \ #define ide_port_for_each_dev(i, dev, port) \
for ((i) = 0; ((dev) = (port)->devices[i]) || (i) < MAX_DRIVES; (i)++) for ((i) = 0; ((dev) = (port)->devices[i]) || (i) < MAX_DRIVES; (i)++)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment