Atsushi Nemoto wrote:
This is the driver for the Toshiba TX4939 SoC ATA controller.
This controller has standard ATA taskfile registers and DMA command/status registers, but the register layout is swapped on big endian. There are some other endian issue and some special registers which requires many custom dma_ops/port_ops routines.
Signed-off-by: Atsushi Nemoto <anemo@xxxxxxxxxxxxx> --- This patch is against linux-next 20080905.
drivers/ide/Kconfig | 6 + drivers/ide/mips/Makefile | 1 + drivers/ide/mips/tx4939ide.c | 762 ++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 769 insertions(+), 0 deletions(-) create mode 100644 drivers/ide/mips/tx4939ide.c
diff --git a/drivers/ide/mips/tx4939ide.c b/drivers/ide/mips/tx4939ide.c new file mode 100644 index 0000000..ba9776d --- /dev/null +++ b/drivers/ide/mips/tx4939ide.c @@ -0,0 +1,762 @@
[...]
+static void tx4939ide_set_mode(ide_drive_t *drive, const u8 speed) +{ + ide_hwif_t *hwif = HWIF(drive); + unsigned long base = TX4939IDE_BASE(hwif); + int is_slave = drive->dn & 1; + u16 value; + int safe_speed = speed; + int i; + + for (i = 0; i < MAX_DRIVES; i++) {
Use ide_get_paired_drive() ISO this loop.
+ if (drive != &hwif->drives[i] && + (hwif->drives[i].dev_flags & IDE_DFLAG_PRESENT)) + safe_speed = min(safe_speed, + (int)hwif->drives[i].current_speed);
You shouldn't clamp the command PIO mode timings like this, and shouldn't do it at all when DMA mode is set. Call ide_get_best_pio_mode(255, 4) to get the mate drive's fastest PIO mode which should be a clamping value.
+ /* Command Transfer Mode Select */ + switch (safe_speed) { + case XFER_UDMA_5: + case XFER_UDMA_4: + case XFER_UDMA_3: + case XFER_UDMA_2: + case XFER_UDMA_1: + case XFER_UDMA_0: + case XFER_MW_DMA_2:
You shouldn't change the command PIO mode when DMA mode is selected.
+ case XFER_MW_DMA_1: + case XFER_MW_DMA_0: + case XFER_PIO_4:
MWDMA0/1 timings don't match PIO4, they are [much] slower.
+ value |= 0x0400; + break; + case XFER_PIO_3: + value |= 0x0300; + break; + case XFER_PIO_2: + value |= 0x0200; + break; + case XFER_PIO_1: + value |= 0x0100; + break; + default: + case XFER_PIO_0: + value |= 0x0000; + break; + }
> +
+ if (is_slave) + hwif->select_data = + (hwif->select_data & ~0xffff0000) | (value << 16);
Why not just 0x0000ffff?
+ else + hwif->select_data = (hwif->select_data & ~0x0000ffff) | value;
Why not just 0xffff0000?
+ TX4939IDE_writew(value, base, Sys_Ctl); +} + +static void tx4939ide_set_pio_mode(ide_drive_t *drive, const u8 pio) +{ + tx4939ide_set_mode(drive, XFER_PIO_0 + pio); +}
I suggest that you implement tx4939ide_set_{dma|pio}_mode() as seperate functions, possibly using a common function to do a final part. These 2 methods are quite different functionally.
+ +static void tx4939ide_check_error_ints(ide_hwif_t *hwif, u16 stat) +{ + if (stat & TX4939IDE_INT_BUSERR) { + unsigned long base = TX4939IDE_BASE(hwif); + /* reset FIFO */ + TX4939IDE_writew(TX4939IDE_readw(base, Sys_Ctl) | + 0x4000, + base, Sys_Ctl); + } + if (stat & (TX4939IDE_INT_ADDRERR | TX4939IDE_INT_REACHMUL | + TX4939IDE_INT_DEVTIMING | TX4939IDE_INT_BUSERR)) + pr_err("%s: Error interrupt %#x (%s%s%s%s )\n", + hwif->name, stat, + (stat & TX4939IDE_INT_ADDRERR) ? + " Address-Error" : "", + (stat & TX4939IDE_INT_REACHMUL) ? + " Reach-Multiple" : "", + (stat & TX4939IDE_INT_DEVTIMING) ? + " DEV-Timing" : "", + (stat & TX4939IDE_INT_BUSERR) ? + " Bus-Error" : ""); +} + +static void tx4939ide_clear_irq(ide_drive_t *drive) +{ + ide_hwif_t *hwif; + unsigned long base; + u16 ctl; + + /* + * tx4939ide_dma_test_irq() and tx4939ide_dma_end() do all + * jobs for DMA case. + */ + if (drive->waiting_for_dma) + return; + hwif = HWIF(drive); + base = TX4939IDE_BASE(hwif); + ctl = TX4939IDE_readw(base, int_ctl); + + tx4939ide_check_error_ints(hwif, ctl); + TX4939IDE_writew(ctl, base, int_ctl); +} + +static int tx4939ide_dma_setup(ide_drive_t *drive) +{ + ide_hwif_t *hwif = HWIF(drive); + unsigned long base = TX4939IDE_BASE(hwif); + int is_slave = drive->dn & 1; + unsigned int nframes; + int rc, i; + unsigned int sect_size = queue_hardsect_size(drive->queue); + u16 select_data; + + select_data = (hwif->select_data >> (is_slave ? 16 : 0)) & 0xffff; + TX4939IDE_writew(select_data, base, Sys_Ctl);
Unfortunately, programming the timings from the dma_setup() method isn't enough since it won't be called for PIO transfers. You'll have to use the selectproc() method.
MBR, Sergei -- To unsubscribe from this list: send the line "unsubscribe linux-ide" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html