mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-04 18:09:57 +00:00
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 ...
This commit is contained in:
commit
e6423407d0
34 changed files with 598 additions and 574 deletions
|
@ -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" };
|
||||||
* 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)
|
||||||
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,
|
||||||
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)
|
||||||
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)
|
||||||
} 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)
|
||||||
|
|
||||||
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;
|
||||||
#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)
|
||||||
#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 @@
|
||||||
* 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)
|
||||||
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)
|
||||||
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)
|
||||||
(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)
|
||||||
/* 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)
|
||||||
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 */
|
return (irq_stat & irq_mask) ? 1 : 0;
|
||||||
if (dma_stat & 4)
|
|
||||||
return 1;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -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 = {
|
||||||
.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 = {
|
||||||
.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 = {
|
||||||
.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 = {
|
||||||
.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
|
||||||
*/
|
*/
|
||||||
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)
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
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");
|
||||||
* 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)
|
||||||
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,
|
||||||
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)
|
||||||
{
|
{
|
||||||
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)
|
||||||
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)
|
||||||
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 @@
|
||||||
* 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 @@
|
||||||
* 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);
|
||||||
*/
|
*/
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
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 = {
|
||||||
*/
|
*/
|
||||||
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)
|
||||||
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)
|
||||||
/*
|
/*
|
||||||
* 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 @@
|
||||||
|
|
||||||
#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);
|
||||||
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);
|
||||||
* 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,
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
{
|
{
|
||||||
/* 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)
|
||||||
/* 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)
|
||||||
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)
|
||||||
}
|
}
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
/* 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);
|
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);
|
|
||||||
}
|
|
||||||
|
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
} 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)
|
||||||
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,
|
||||||
}
|
}
|
||||||
|
|
||||||
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,
|
||||||
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)
|
||||||
* 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)
|
||||||
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)
|
||||||
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)
|
||||||
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,
|
||||||
/* 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,
|
||||||
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)
|
||||||
(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,
|
||||||
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,
|
||||||
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,
|
||||||
} 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,
|
||||||
|
|
||||||
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,
|
||||||
{
|
{
|
||||||
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)
|
||||||
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)
|
||||||
* 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)
|
||||||
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,
|
||||||
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,
|
||||||
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,
|
||||||
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,
|
||||||
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,
|
||||||
}
|
}
|
||||||
|
|
||||||
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,
|
||||||
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)
|
||||||
} 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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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,
|
||||||
|
|
||||||
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,
|
||||||
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);
|
||||||
|
|
||||||
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)
|
||||||
* 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)
|
||||||
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)
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
}
|
}
|
||||||
|
|
||||||
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,
|
||||||
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,
|
||||||
|
|
||||||
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,
|
||||||
|
|
||||||
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,
|
||||||
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,
|
||||||
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,
|
||||||
|
|
||||||
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)
|
||||||
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;
|
return -1;
|
||||||
position = tape->first_frame;
|
|
||||||
return position;
|
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;
|
||||||
|
} else {
|
||||||
|
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,
|
||||||
{
|
{
|
||||||
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,
|
||||||
|
|
||||||
__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)
|
||||||
{
|
{
|
||||||
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,
|
||||||
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)
|
||||||
|
|
||||||
/* 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)
|
||||||
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,
|
||||||
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)
|
||||||
{
|
{
|
||||||
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)
|
||||||
}
|
}
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
{
|
{
|
||||||
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)
|
||||||
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)
|
||||||
}
|
}
|
||||||
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)
|
||||||
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)
|
||||||
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 @@
|
||||||
|
|
||||||
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,
|
||||||
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[] =
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
{ 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)
|
||||||
* 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)
|
||||||
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,
|
||||||
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)
|
||||||
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)
|
||||||
/*
|
/*
|
||||||
* 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,
|
||||||
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)
|
||||||
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,
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
} 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 @@
|
||||||
|
|
||||||
#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))
|
||||||
|
|
|
@ -1,6 +1,6 @@
|
||||||
/*
|
/*
|
||||||
* 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 @@
|
||||||
#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 @@
|
||||||
#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 {
|
||||||
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,
|
||||||
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)
|
||||||
|
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* 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)
|
||||||
{
|
{
|
||||||
}
|
}
|
||||||
|
|
||||||
/* 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)
|
||||||
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)
|
||||||
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)
|
||||||
}
|
}
|
||||||
|
|
||||||
/* 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)
|
||||||
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,20 +396,22 @@ 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);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* IOC4 Scatter Gather list Format */
|
/* IOC4 Scatter Gather list Format */
|
||||||
/* 128 Bit entries to support 64 bit addresses in the future */
|
/* 128 Bit entries to support 64 bit addresses in the future */
|
||||||
/* The Scatter Gather list Entry should be in the BIG-ENDIAN Format */
|
/* The Scatter Gather list Entry should be in the BIG-ENDIAN Format */
|
||||||
/* --------------------------------------------------------------------- */
|
/* --------------------------------------------------------------------- */
|
||||||
/* | Upper 32 bits - Zero | Lower 32 bits- address | */
|
/* | Upper 32 bits - Zero | Lower 32 bits- address | */
|
||||||
/* --------------------------------------------------------------------- */
|
/* --------------------------------------------------------------------- */
|
||||||
/* | 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)
|
||||||
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 = {
|
||||||
.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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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 = {
|
||||||
.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 @@
|
||||||
* 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)
|
||||||
* @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)
|
||||||
/* 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);
|
||||||
mode |= unit ? 0x10 : 0x01;
|
|
||||||
|
if (ide_pio_need_iordy(drive, pio)) {
|
||||||
|
speedp |= 0x200;
|
||||||
|
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)
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
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 = {
|
||||||
.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 = {
|
||||||
.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)
|
||||||
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)
|
||||||
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)
|
||||||
* 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)
|
||||||
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)
|
||||||
* 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)
|
||||||
|
|
||||||
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)
|
||||||
|
|
||||||
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 = {
|
||||||
.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)
|
||||||
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)
|
||||||
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 {
|
||||||
#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 {
|
||||||
};
|
};
|
||||||
|
|
||||||
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 {
|
||||||
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 {
|
||||||
|
|
||||||
/* 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 {
|
||||||
* 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 {
|
||||||
|
|
||||||
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 {
|
||||||
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 {
|
||||||
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 {
|
||||||
|
|
||||||
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 {
|
||||||
|
|
||||||
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);
|
||||||
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 {
|
||||||
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);
|
||||||
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)
|
||||||
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)++)
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue