[linux.git] / drivers / ide / tx4939ide.c

/*
 * TX4939 internal IDE driver
 * Based on RBTX49xx patch from CELF patch archive.
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * (C) Copyright TOSHIBA CORPORATION 2005-2007
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/ide.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/io.h>
#include <linux/scatterlist.h>

#include <asm/ide.h>

#define MODNAME	"tx4939ide"

/* ATA Shadow Registers (8-bit except for Data which is 16-bit) */
#define TX4939IDE_Data			0x000
#define TX4939IDE_Error_Feature		0x001
#define TX4939IDE_Sec			0x002
#define TX4939IDE_LBA0			0x003
#define TX4939IDE_LBA1			0x004
#define TX4939IDE_LBA2			0x005
#define TX4939IDE_DevHead		0x006
#define TX4939IDE_Stat_Cmd		0x007
#define TX4939IDE_AltStat_DevCtl	0x402
/* H/W DMA Registers  */
#define TX4939IDE_DMA_Cmd	0x800	/* 8-bit */
#define TX4939IDE_DMA_Stat	0x802	/* 8-bit */
#define TX4939IDE_PRD_Ptr	0x804	/* 32-bit */
/* ATA100 CORE Registers (16-bit) */
#define TX4939IDE_Sys_Ctl	0xc00
#define TX4939IDE_Xfer_Cnt_1	0xc08
#define TX4939IDE_Xfer_Cnt_2	0xc0a
#define TX4939IDE_Sec_Cnt	0xc10
#define TX4939IDE_Start_Lo_Addr	0xc18
#define TX4939IDE_Start_Up_Addr	0xc20
#define TX4939IDE_Add_Ctl	0xc28
#define TX4939IDE_Lo_Burst_Cnt	0xc30
#define TX4939IDE_Up_Burst_Cnt	0xc38
#define TX4939IDE_PIO_Addr	0xc88
#define TX4939IDE_H_Rst_Tim	0xc90
#define TX4939IDE_Int_Ctl	0xc98
#define TX4939IDE_Pkt_Cmd	0xcb8
#define TX4939IDE_Bxfer_Cnt_Hi	0xcc0
#define TX4939IDE_Bxfer_Cnt_Lo	0xcc8
#define TX4939IDE_Dev_TErr	0xcd0
#define TX4939IDE_Pkt_Xfer_Ctl	0xcd8
#define TX4939IDE_Start_TAddr	0xce0

/* bits for Int_Ctl */
#define TX4939IDE_INT_ADDRERR	0x80
#define TX4939IDE_INT_REACHMUL	0x40
#define TX4939IDE_INT_DEVTIMING	0x20
#define TX4939IDE_INT_UDMATERM	0x10
#define TX4939IDE_INT_TIMER	0x08
#define TX4939IDE_INT_BUSERR	0x04
#define TX4939IDE_INT_XFEREND	0x02
#define TX4939IDE_INT_HOST	0x01

#define TX4939IDE_IGNORE_INTS	\
	(TX4939IDE_INT_ADDRERR | TX4939IDE_INT_REACHMUL | \
	 TX4939IDE_INT_DEVTIMING | TX4939IDE_INT_UDMATERM | \
	 TX4939IDE_INT_TIMER | TX4939IDE_INT_XFEREND)

#ifdef __BIG_ENDIAN
#define tx4939ide_swizzlel(a)	((a) ^ 4)
#define tx4939ide_swizzlew(a)	((a) ^ 6)
#define tx4939ide_swizzleb(a)	((a) ^ 7)
#else
#define tx4939ide_swizzlel(a)	(a)
#define tx4939ide_swizzlew(a)	(a)
#define tx4939ide_swizzleb(a)	(a)
#endif

static u16 tx4939ide_readw(void __iomem *base, u32 reg)
{
	return __raw_readw(base + tx4939ide_swizzlew(reg));
}
static u8 tx4939ide_readb(void __iomem *base, u32 reg)
{
	return __raw_readb(base + tx4939ide_swizzleb(reg));
}
static void tx4939ide_writel(u32 val, void __iomem *base, u32 reg)
{
	__raw_writel(val, base + tx4939ide_swizzlel(reg));
}
static void tx4939ide_writew(u16 val, void __iomem *base, u32 reg)
{
	__raw_writew(val, base + tx4939ide_swizzlew(reg));
}
static void tx4939ide_writeb(u8 val, void __iomem *base, u32 reg)
{
	__raw_writeb(val, base + tx4939ide_swizzleb(reg));
}

#define TX4939IDE_BASE(hwif)	((void __iomem *)(hwif)->extra_base)

static void tx4939ide_set_pio_mode(ide_hwif_t *hwif, ide_drive_t *drive)
{
	int is_slave = drive->dn;
	u32 mask, val;
	const u8 pio = drive->pio_mode - XFER_PIO_0;
	u8 safe = pio;
	ide_drive_t *pair;

	pair = ide_get_pair_dev(drive);
	if (pair)
		safe = min_t(u8, safe, pair->pio_mode - XFER_PIO_0);
	/*
	 * Update Command Transfer Mode for master/slave and Data
	 * Transfer Mode for this drive.
	 */
	mask = is_slave ? 0x07f00000 : 0x000007f0;
	val = ((safe << 8) | (pio << 4)) << (is_slave ? 16 : 0);
	hwif->select_data = (hwif->select_data & ~mask) | val;
	/* tx4939ide_tf_load_fixup() will set the Sys_Ctl register */
}

static void tx4939ide_set_dma_mode(ide_hwif_t *hwif, ide_drive_t *drive)
{
	u32 mask, val;
	const u8 mode = drive->dma_mode;

	/* Update Data Transfer Mode for this drive. */
	if (mode >= XFER_UDMA_0)
		val = mode - XFER_UDMA_0 + 8;
	else
		val = mode - XFER_MW_DMA_0 + 5;
	if (drive->dn) {
		mask = 0x00f00000;
		val <<= 20;
	} else {
		mask = 0x000000f0;
		val <<= 4;
	}
	hwif->select_data = (hwif->select_data & ~mask) | val;
	/* tx4939ide_tf_load_fixup() will set the Sys_Ctl register */
}

static u16 tx4939ide_check_error_ints(ide_hwif_t *hwif)
{
	void __iomem *base = TX4939IDE_BASE(hwif);
	u16 ctl = tx4939ide_readw(base, TX4939IDE_Int_Ctl);

	if (ctl & TX4939IDE_INT_BUSERR) {
		/* reset FIFO */
		u16 sysctl = tx4939ide_readw(base, TX4939IDE_Sys_Ctl);

		tx4939ide_writew(sysctl | 0x4000, base, TX4939IDE_Sys_Ctl);
		mmiowb();
		/* wait 12GBUSCLK (typ. 60ns @ GBUS200MHz, max 270ns) */
		ndelay(270);
		tx4939ide_writew(sysctl, base, TX4939IDE_Sys_Ctl);
	}
	if (ctl & (TX4939IDE_INT_ADDRERR |
		   TX4939IDE_INT_DEVTIMING | TX4939IDE_INT_BUSERR))
		pr_err("%s: Error interrupt %#x (%s%s%s )\n",
		       hwif->name, ctl,
		       ctl & TX4939IDE_INT_ADDRERR ? " Address-Error" : "",
		       ctl & TX4939IDE_INT_DEVTIMING ? " DEV-Timing" : "",
		       ctl & TX4939IDE_INT_BUSERR ? " Bus-Error" : "");
	return ctl;
}

static void tx4939ide_clear_irq(ide_drive_t *drive)
{
	ide_hwif_t *hwif;
	void __iomem *base;
	u16 ctl;

	/*
	 * tx4939ide_dma_test_irq() and tx4939ide_dma_end() do all job
	 * for DMA case.
	 */
	if (drive->waiting_for_dma)
		return;
	hwif = drive->hwif;
	base = TX4939IDE_BASE(hwif);
	ctl = tx4939ide_check_error_ints(hwif);
	tx4939ide_writew(ctl, base, TX4939IDE_Int_Ctl);
}

static u8 tx4939ide_cable_detect(ide_hwif_t *hwif)
{
	void __iomem *base = TX4939IDE_BASE(hwif);

	return tx4939ide_readw(base, TX4939IDE_Sys_Ctl) & 0x2000 ?
		ATA_CBL_PATA40 : ATA_CBL_PATA80;
}

#ifdef __BIG_ENDIAN
static void tx4939ide_dma_host_set(ide_drive_t *drive, int on)
{
	ide_hwif_t *hwif = drive->hwif;
	u8 unit = drive->dn;
	void __iomem *base = TX4939IDE_BASE(hwif);
	u8 dma_stat = tx4939ide_readb(base, TX4939IDE_DMA_Stat);

	if (on)
		dma_stat |= (1 << (5 + unit));
	else
		dma_stat &= ~(1 << (5 + unit));

	tx4939ide_writeb(dma_stat, base, TX4939IDE_DMA_Stat);
}
#else
#define tx4939ide_dma_host_set	ide_dma_host_set
#endif

static u8 tx4939ide_clear_dma_status(void __iomem *base)
{
	u8 dma_stat;

	/* read DMA status for INTR & ERROR flags */
	dma_stat = tx4939ide_readb(base, TX4939IDE_DMA_Stat);
	/* clear INTR & ERROR flags */
	tx4939ide_writeb(dma_stat | ATA_DMA_INTR | ATA_DMA_ERR, base,
			 TX4939IDE_DMA_Stat);
	/* recover intmask cleared by writing to bit2 of DMA_Stat */
	tx4939ide_writew(TX4939IDE_IGNORE_INTS << 8, base, TX4939IDE_Int_Ctl);
	return dma_stat;
}

#ifdef __BIG_ENDIAN
/* custom ide_build_dmatable to handle swapped layout */
static int tx4939ide_build_dmatable(ide_drive_t *drive, struct ide_cmd *cmd)
{
	ide_hwif_t *hwif = drive->hwif;
	u32 *table = (u32 *)hwif->dmatable_cpu;
	unsigned int count = 0;
	int i;
	struct scatterlist *sg;

	for_each_sg(hwif->sg_table, sg, cmd->sg_nents, i) {
		u32 cur_addr, cur_len, bcount;

		cur_addr = sg_dma_address(sg);
		cur_len = sg_dma_len(sg);

		/*
		 * Fill in the DMA table, without crossing any 64kB boundaries.
		 */

		while (cur_len) {
			if (count++ >= PRD_ENTRIES)
				goto use_pio_instead;

			bcount = 0x10000 - (cur_addr & 0xffff);
			if (bcount > cur_len)
				bcount = cur_len;
			/*
			 * This workaround for zero count seems required.
			 * (standard ide_build_dmatable does it too)
			 */
			if (bcount == 0x10000)
				bcount = 0x8000;
			*table++ = bcount & 0xffff;
			*table++ = cur_addr;
			cur_addr += bcount;
			cur_len -= bcount;
		}
	}

	if (count) {
		*(table - 2) |= 0x80000000;
		return count;
	}

use_pio_instead:
	printk(KERN_ERR "%s: %s\n", drive->name,
		count ? "DMA table too small" : "empty DMA table?");

	return 0; /* revert to PIO for this request */
}
#else
#define tx4939ide_build_dmatable	ide_build_dmatable
#endif

static int tx4939ide_dma_setup(ide_drive_t *drive, struct ide_cmd *cmd)
{
	ide_hwif_t *hwif = drive->hwif;
	void __iomem *base = TX4939IDE_BASE(hwif);
	u8 rw = (cmd->tf_flags & IDE_TFLAG_WRITE) ? 0 : ATA_DMA_WR;

	/* fall back to PIO! */
	if (tx4939ide_build_dmatable(drive, cmd) == 0)
		return 1;

	/* PRD table */
	tx4939ide_writel(hwif->dmatable_dma, base, TX4939IDE_PRD_Ptr);

	/* specify r/w */
	tx4939ide_writeb(rw, base, TX4939IDE_DMA_Cmd);

	/* clear INTR & ERROR flags */
	tx4939ide_clear_dma_status(base);

	tx4939ide_writew(SECTOR_SIZE / 2, base, drive->dn ?
			 TX4939IDE_Xfer_Cnt_2 : TX4939IDE_Xfer_Cnt_1);

	tx4939ide_writew(blk_rq_sectors(cmd->rq), base, TX4939IDE_Sec_Cnt);

	return 0;
}

static int tx4939ide_dma_end(ide_drive_t *drive)
{
	ide_hwif_t *hwif = drive->hwif;
	u8 dma_stat, dma_cmd;
	void __iomem *base = TX4939IDE_BASE(hwif);
	u16 ctl = tx4939ide_readw(base, TX4939IDE_Int_Ctl);

	/* get DMA command mode */
	dma_cmd = tx4939ide_readb(base, TX4939IDE_DMA_Cmd);
	/* stop DMA */
	tx4939ide_writeb(dma_cmd & ~ATA_DMA_START, base, TX4939IDE_DMA_Cmd);

	/* read and clear the INTR & ERROR bits */
	dma_stat = tx4939ide_clear_dma_status(base);

#define CHECK_DMA_MASK (ATA_DMA_ACTIVE | ATA_DMA_ERR | ATA_DMA_INTR)

	/* verify good DMA status */
	if ((dma_stat & CHECK_DMA_MASK) == 0 &&
	    (ctl & (TX4939IDE_INT_XFEREND | TX4939IDE_INT_HOST)) ==
	    (TX4939IDE_INT_XFEREND | TX4939IDE_INT_HOST))
		/* INT_IDE lost... bug? */
		return 0;
	return ((dma_stat & CHECK_DMA_MASK) !=
		ATA_DMA_INTR) ? 0x10 | dma_stat : 0;
}

/* returns 1 if DMA IRQ issued, 0 otherwise */
static int tx4939ide_dma_test_irq(ide_drive_t *drive)
{
	ide_hwif_t *hwif = drive->hwif;
	void __iomem *base = TX4939IDE_BASE(hwif);
	u16 ctl, ide_int;
	u8 dma_stat, stat;
	int found = 0;

	ctl = tx4939ide_check_error_ints(hwif);
	ide_int = ctl & (TX4939IDE_INT_XFEREND | TX4939IDE_INT_HOST);
	switch (ide_int) {
	case TX4939IDE_INT_HOST:
		/* On error, XFEREND might not be asserted. */
		stat = tx4939ide_readb(base, TX4939IDE_AltStat_DevCtl);
		if ((stat & (ATA_BUSY | ATA_DRQ | ATA_ERR)) == ATA_ERR)
			found = 1;
		else
			/* Wait for XFEREND (Mask HOST and unmask XFEREND) */
			ctl &= ~TX4939IDE_INT_XFEREND << 8;
		ctl |= ide_int << 8;
		break;
	case TX4939IDE_INT_HOST | TX4939IDE_INT_XFEREND:
		dma_stat = tx4939ide_readb(base, TX4939IDE_DMA_Stat);
		if (!(dma_stat & ATA_DMA_INTR))
			pr_warning("%s: weird interrupt status. "
				   "DMA_Stat %#02x int_ctl %#04x\n",
				   hwif->name, dma_stat, ctl);
		found = 1;
		break;
	}
	/*
	 * Do not clear XFEREND, HOST now.  They will be cleared by
	 * clearing bit2 of DMA_Stat.
	 */
	ctl &= ~ide_int;
	tx4939ide_writew(ctl, base, TX4939IDE_Int_Ctl);
	return found;
}

#ifdef __BIG_ENDIAN
static u8 tx4939ide_dma_sff_read_status(ide_hwif_t *hwif)
{
	void __iomem *base = TX4939IDE_BASE(hwif);

	return tx4939ide_readb(base, TX4939IDE_DMA_Stat);
}
#else
#define tx4939ide_dma_sff_read_status ide_dma_sff_read_status
#endif

static void tx4939ide_init_hwif(ide_hwif_t *hwif)
{
	void __iomem *base = TX4939IDE_BASE(hwif);

	/* Soft Reset */
	tx4939ide_writew(0x8000, base, TX4939IDE_Sys_Ctl);
	mmiowb();
	/* at least 20 GBUSCLK (typ. 100ns @ GBUS200MHz, max 450ns) */
	ndelay(450);
	tx4939ide_writew(0x0000, base, TX4939IDE_Sys_Ctl);
	/* mask some interrupts and clear all interrupts */
	tx4939ide_writew((TX4939IDE_IGNORE_INTS << 8) | 0xff, base,
			 TX4939IDE_Int_Ctl);

	tx4939ide_writew(0x0008, base, TX4939IDE_Lo_Burst_Cnt);
	tx4939ide_writew(0, base, TX4939IDE_Up_Burst_Cnt);
}

static int tx4939ide_init_dma(ide_hwif_t *hwif, const struct ide_port_info *d)
{
	hwif->dma_base =
		hwif->extra_base + tx4939ide_swizzleb(TX4939IDE_DMA_Cmd);
	/*
	 * Note that we cannot use ATA_DMA_TABLE_OFS, ATA_DMA_STATUS
	 * for big endian.
	 */
	return ide_allocate_dma_engine(hwif);
}

static void tx4939ide_tf_load_fixup(ide_drive_t *drive)
{
	ide_hwif_t *hwif = drive->hwif;
	void __iomem *base = TX4939IDE_BASE(hwif);
	u16 sysctl = hwif->select_data >> (drive->dn ? 16 : 0);

	/*
	 * Fix ATA100 CORE System Control Register. (The write to the
	 * Device/Head register may write wrong data to the System
	 * Control Register)
	 * While Sys_Ctl is written here, dev_select() is not needed.
	 */
	tx4939ide_writew(sysctl, base, TX4939IDE_Sys_Ctl);
}

static void tx4939ide_tf_load(ide_drive_t *drive, struct ide_taskfile *tf,
			      u8 valid)
{
	ide_tf_load(drive, tf, valid);

	if (valid & IDE_VALID_DEVICE)
		tx4939ide_tf_load_fixup(drive);
}

#ifdef __BIG_ENDIAN

/* custom iops (independent from SWAP_IO_SPACE) */
static void tx4939ide_input_data_swap(ide_drive_t *drive, struct ide_cmd *cmd,
				void *buf, unsigned int len)
{
	unsigned long port = drive->hwif->io_ports.data_addr;
	unsigned short *ptr = buf;
	unsigned int count = (len + 1) / 2;

	while (count--)
		*ptr++ = cpu_to_le16(__raw_readw((void __iomem *)port));
	__ide_flush_dcache_range((unsigned long)buf, roundup(len, 2));
}

static void tx4939ide_output_data_swap(ide_drive_t *drive, struct ide_cmd *cmd,
				void *buf, unsigned int len)
{
	unsigned long port = drive->hwif->io_ports.data_addr;
	unsigned short *ptr = buf;
	unsigned int count = (len + 1) / 2;

	while (count--) {
		__raw_writew(le16_to_cpu(*ptr), (void __iomem *)port);
		ptr++;
	}
	__ide_flush_dcache_range((unsigned long)buf, roundup(len, 2));
}

static const struct ide_tp_ops tx4939ide_tp_ops = {
	.exec_command		= ide_exec_command,
	.read_status		= ide_read_status,
	.read_altstatus		= ide_read_altstatus,
	.write_devctl		= ide_write_devctl,

	.dev_select		= ide_dev_select,
	.tf_load		= tx4939ide_tf_load,
	.tf_read		= ide_tf_read,

	.input_data		= tx4939ide_input_data_swap,
	.output_data		= tx4939ide_output_data_swap,
};

#else	/* __LITTLE_ENDIAN */

static const struct ide_tp_ops tx4939ide_tp_ops = {
	.exec_command		= ide_exec_command,
	.read_status		= ide_read_status,
	.read_altstatus		= ide_read_altstatus,
	.write_devctl		= ide_write_devctl,

	.dev_select		= ide_dev_select,
	.tf_load		= tx4939ide_tf_load,
	.tf_read		= ide_tf_read,

	.input_data		= ide_input_data,
	.output_data		= ide_output_data,
};

#endif	/* __LITTLE_ENDIAN */

static const struct ide_port_ops tx4939ide_port_ops = {
	.set_pio_mode		= tx4939ide_set_pio_mode,
	.set_dma_mode		= tx4939ide_set_dma_mode,
	.clear_irq		= tx4939ide_clear_irq,
	.cable_detect		= tx4939ide_cable_detect,
};

static const struct ide_dma_ops tx4939ide_dma_ops = {
	.dma_host_set		= tx4939ide_dma_host_set,
	.dma_setup		= tx4939ide_dma_setup,
	.dma_start		= ide_dma_start,
	.dma_end		= tx4939ide_dma_end,
	.dma_test_irq		= tx4939ide_dma_test_irq,
	.dma_lost_irq		= ide_dma_lost_irq,
	.dma_timer_expiry	= ide_dma_sff_timer_expiry,
	.dma_sff_read_status	= tx4939ide_dma_sff_read_status,
};

static const struct ide_port_info tx4939ide_port_info __initdata = {
	.init_hwif		= tx4939ide_init_hwif,
	.init_dma		= tx4939ide_init_dma,
	.port_ops		= &tx4939ide_port_ops,
	.dma_ops		= &tx4939ide_dma_ops,
	.tp_ops			= &tx4939ide_tp_ops,
	.host_flags		= IDE_HFLAG_MMIO,
	.pio_mask		= ATA_PIO4,
	.mwdma_mask		= ATA_MWDMA2,
	.udma_mask		= ATA_UDMA5,
	.chipset		= ide_generic,
};

static int __init tx4939ide_probe(struct platform_device *pdev)
{
	struct ide_hw hw, *hws[] = { &hw };
	struct ide_host *host;
	struct resource *res;
	int irq, ret;
	unsigned long mapbase;

	irq = platform_get_irq(pdev, 0);
	if (irq < 0)
		return -ENODEV;
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res)
		return -ENODEV;

	if (!devm_request_mem_region(&pdev->dev, res->start,
				     resource_size(res), "tx4938ide"))
		return -EBUSY;
	mapbase = (unsigned long)devm_ioremap(&pdev->dev, res->start,
					      resource_size(res));
	if (!mapbase)
		return -EBUSY;
	memset(&hw, 0, sizeof(hw));
	hw.io_ports.data_addr =
		mapbase + tx4939ide_swizzlew(TX4939IDE_Data);
	hw.io_ports.error_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_Error_Feature);
	hw.io_ports.nsect_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_Sec);
	hw.io_ports.lbal_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_LBA0);
	hw.io_ports.lbam_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_LBA1);
	hw.io_ports.lbah_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_LBA2);
	hw.io_ports.device_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_DevHead);
	hw.io_ports.command_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_Stat_Cmd);
	hw.io_ports.ctl_addr =
		mapbase + tx4939ide_swizzleb(TX4939IDE_AltStat_DevCtl);
	hw.irq = irq;
	hw.dev = &pdev->dev;

	pr_info("TX4939 IDE interface (base %#lx, irq %d)\n", mapbase, irq);
	host = ide_host_alloc(&tx4939ide_port_info, hws, 1);
	if (!host)
		return -ENOMEM;
	/* use extra_base for base address of the all registers */
	host->ports[0]->extra_base = mapbase;
	ret = ide_host_register(host, &tx4939ide_port_info, hws);
	if (ret) {
		ide_host_free(host);
		return ret;
	}
	platform_set_drvdata(pdev, host);
	return 0;
}

static int __exit tx4939ide_remove(struct platform_device *pdev)
{
	struct ide_host *host = platform_get_drvdata(pdev);

	ide_host_remove(host);
	return 0;
}

#ifdef CONFIG_PM
static int tx4939ide_resume(struct platform_device *dev)
{
	struct ide_host *host = platform_get_drvdata(dev);
	ide_hwif_t *hwif = host->ports[0];

	tx4939ide_init_hwif(hwif);
	return 0;
}
#else
#define tx4939ide_resume	NULL
#endif

static struct platform_driver tx4939ide_driver = {
	.driver = {
		.name = MODNAME,
		.owner = THIS_MODULE,
	},
	.remove = __exit_p(tx4939ide_remove),
	.resume = tx4939ide_resume,
};

static int __init tx4939ide_init(void)
{
	return platform_driver_probe(&tx4939ide_driver, tx4939ide_probe);
}

static void __exit tx4939ide_exit(void)
{
	platform_driver_unregister(&tx4939ide_driver);
}

module_init(tx4939ide_init);
module_exit(tx4939ide_exit);

MODULE_DESCRIPTION("TX4939 internal IDE driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:tx4939ide");
Commit	Line	Data
37897989 AN	1	/*
	2	* TX4939 internal IDE driver
	3	* Based on RBTX49xx patch from CELF patch archive.
	4	*
	5	* This file is subject to the terms and conditions of the GNU General Public
	6	* License. See the file "COPYING" in the main directory of this archive
	7	* for more details.
	8	*
	9	* (C) Copyright TOSHIBA CORPORATION 2005-2007
	10	*/
	11
	12	#include <linux/module.h>
	13	#include <linux/types.h>
	14	#include <linux/ide.h>
	15	#include <linux/init.h>
	16	#include <linux/delay.h>
	17	#include <linux/platform_device.h>
	18	#include <linux/io.h>
	19	#include <linux/scatterlist.h>
	20
15a453a9 BZ	21	#include <asm/ide.h>
15a453a9 BZ	22
37897989 AN	23	#define MODNAME "tx4939ide"
	24
	25	/* ATA Shadow Registers (8-bit except for Data which is 16-bit) */
	26	#define TX4939IDE_Data 0x000
	27	#define TX4939IDE_Error_Feature 0x001
	28	#define TX4939IDE_Sec 0x002
	29	#define TX4939IDE_LBA0 0x003
	30	#define TX4939IDE_LBA1 0x004
	31	#define TX4939IDE_LBA2 0x005
	32	#define TX4939IDE_DevHead 0x006
	33	#define TX4939IDE_Stat_Cmd 0x007
	34	#define TX4939IDE_AltStat_DevCtl 0x402
	35	/* H/W DMA Registers */
	36	#define TX4939IDE_DMA_Cmd 0x800 /* 8-bit */
	37	#define TX4939IDE_DMA_Stat 0x802 /* 8-bit */
	38	#define TX4939IDE_PRD_Ptr 0x804 /* 32-bit */
	39	/* ATA100 CORE Registers (16-bit) */
	40	#define TX4939IDE_Sys_Ctl 0xc00
	41	#define TX4939IDE_Xfer_Cnt_1 0xc08
	42	#define TX4939IDE_Xfer_Cnt_2 0xc0a
	43	#define TX4939IDE_Sec_Cnt 0xc10
	44	#define TX4939IDE_Start_Lo_Addr 0xc18
	45	#define TX4939IDE_Start_Up_Addr 0xc20
	46	#define TX4939IDE_Add_Ctl 0xc28
	47	#define TX4939IDE_Lo_Burst_Cnt 0xc30
	48	#define TX4939IDE_Up_Burst_Cnt 0xc38
	49	#define TX4939IDE_PIO_Addr 0xc88
	50	#define TX4939IDE_H_Rst_Tim 0xc90
	51	#define TX4939IDE_Int_Ctl 0xc98
	52	#define TX4939IDE_Pkt_Cmd 0xcb8
	53	#define TX4939IDE_Bxfer_Cnt_Hi 0xcc0
	54	#define TX4939IDE_Bxfer_Cnt_Lo 0xcc8
	55	#define TX4939IDE_Dev_TErr 0xcd0
	56	#define TX4939IDE_Pkt_Xfer_Ctl 0xcd8
	57	#define TX4939IDE_Start_TAddr 0xce0
	58
	59	/* bits for Int_Ctl */
	60	#define TX4939IDE_INT_ADDRERR 0x80
	61	#define TX4939IDE_INT_REACHMUL 0x40
	62	#define TX4939IDE_INT_DEVTIMING 0x20
	63	#define TX4939IDE_INT_UDMATERM 0x10
	64	#define TX4939IDE_INT_TIMER 0x08
	65	#define TX4939IDE_INT_BUSERR 0x04
	66	#define TX4939IDE_INT_XFEREND 0x02
	67	#define TX4939IDE_INT_HOST 0x01
	68
	69	#define TX4939IDE_IGNORE_INTS \
	70	(TX4939IDE_INT_ADDRERR \| TX4939IDE_INT_REACHMUL \| \
	71	TX4939IDE_INT_DEVTIMING \| TX4939IDE_INT_UDMATERM \| \
	72	TX4939IDE_INT_TIMER \| TX4939IDE_INT_XFEREND)
	73
	74	#ifdef __BIG_ENDIAN
	75	#define tx4939ide_swizzlel(a) ((a) ^ 4)
	76	#define tx4939ide_swizzlew(a) ((a) ^ 6)
	77	#define tx4939ide_swizzleb(a) ((a) ^ 7)
	78	#else
	79	#define tx4939ide_swizzlel(a) (a)
	80	#define tx4939ide_swizzlew(a) (a)
	81	#define tx4939ide_swizzleb(a) (a)
	82	#endif
	83
	84	static u16 tx4939ide_readw(void __iomem *base, u32 reg)
	85	{
	86	return __raw_readw(base + tx4939ide_swizzlew(reg));
87	}
88	static u8 tx4939ide_readb(void __iomem *base, u32 reg)
89	{
90	return __raw_readb(base + tx4939ide_swizzleb(reg));
91	}
92	static void tx4939ide_writel(u32 val, void __iomem *base, u32 reg)
93	{
94	__raw_writel(val, base + tx4939ide_swizzlel(reg));
95	}
96	static void tx4939ide_writew(u16 val, void __iomem *base, u32 reg)
97	{
98	__raw_writew(val, base + tx4939ide_swizzlew(reg));
99	}
100	static void tx4939ide_writeb(u8 val, void __iomem *base, u32 reg)
101	{
102	__raw_writeb(val, base + tx4939ide_swizzleb(reg));
103	}
104
105	#define TX4939IDE_BASE(hwif) ((void __iomem *)(hwif)->extra_base)
106
e085b3ca	107	static void tx4939ide_set_pio_mode(ide_hwif_t hwif, ide_drive_t drive)
37897989	108	{
37897989 AN	109	int is_slave = drive->dn;
37897989 AN	110	u32 mask, val;
e085b3ca	111	const u8 pio = drive->pio_mode - XFER_PIO_0;
37897989 AN	112	u8 safe = pio;
	113	ide_drive_t *pair;
	114
	115	pair = ide_get_pair_dev(drive);
	116	if (pair)
cd078af6	117	safe = min_t(u8, safe, pair->pio_mode - XFER_PIO_0);
37897989 AN	118	/*
	119	* Update Command Transfer Mode for master/slave and Data
	120	* Transfer Mode for this drive.
	121	*/
	122	mask = is_slave ? 0x07f00000 : 0x000007f0;
	123	val = ((safe << 8) \| (pio << 4)) << (is_slave ? 16 : 0);
	124	hwif->select_data = (hwif->select_data & ~mask) \| val;
	125	/* tx4939ide_tf_load_fixup() will set the Sys_Ctl register */
	126	}
	127
8776168c	128	static void tx4939ide_set_dma_mode(ide_hwif_t hwif, ide_drive_t drive)
37897989	129	{
37897989	130	u32 mask, val;
8776168c	131	const u8 mode = drive->dma_mode;
37897989 AN	132
	133	/* Update Data Transfer Mode for this drive. */
	134	if (mode >= XFER_UDMA_0)
	135	val = mode - XFER_UDMA_0 + 8;
	136	else
	137	val = mode - XFER_MW_DMA_0 + 5;
	138	if (drive->dn) {
	139	mask = 0x00f00000;
	140	val <<= 20;
	141	} else {
	142	mask = 0x000000f0;
	143	val <<= 4;
	144	}
	145	hwif->select_data = (hwif->select_data & ~mask) \| val;
	146	/* tx4939ide_tf_load_fixup() will set the Sys_Ctl register */
	147	}
	148
	149	static u16 tx4939ide_check_error_ints(ide_hwif_t *hwif)
	150	{
	151	void __iomem *base = TX4939IDE_BASE(hwif);
	152	u16 ctl = tx4939ide_readw(base, TX4939IDE_Int_Ctl);
	153
	154	if (ctl & TX4939IDE_INT_BUSERR) {
	155	/* reset FIFO */
	156	u16 sysctl = tx4939ide_readw(base, TX4939IDE_Sys_Ctl);
	157
	158	tx4939ide_writew(sysctl \| 0x4000, base, TX4939IDE_Sys_Ctl);
	159	mmiowb();
	160	/* wait 12GBUSCLK (typ. 60ns @ GBUS200MHz, max 270ns) */
	161	ndelay(270);
	162	tx4939ide_writew(sysctl, base, TX4939IDE_Sys_Ctl);
	163	}
	164	if (ctl & (TX4939IDE_INT_ADDRERR \|
	165	TX4939IDE_INT_DEVTIMING \| TX4939IDE_INT_BUSERR))
	166	pr_err("%s: Error interrupt %#x (%s%s%s )\n",
	167	hwif->name, ctl,
	168	ctl & TX4939IDE_INT_ADDRERR ? " Address-Error" : "",
	169	ctl & TX4939IDE_INT_DEVTIMING ? " DEV-Timing" : "",
	170	ctl & TX4939IDE_INT_BUSERR ? " Bus-Error" : "");
	171	return ctl;
	172	}
	173
	174	static void tx4939ide_clear_irq(ide_drive_t *drive)
	175	{
	176	ide_hwif_t *hwif;
	177	void __iomem *base;
	178	u16 ctl;
	179
	180	/*
	181	* tx4939ide_dma_test_irq() and tx4939ide_dma_end() do all job
	182	* for DMA case.
	183	*/
	184	if (drive->waiting_for_dma)
	185	return;
	186	hwif = drive->hwif;
	187	base = TX4939IDE_BASE(hwif);
	188	ctl = tx4939ide_check_error_ints(hwif);
	189	tx4939ide_writew(ctl, base, TX4939IDE_Int_Ctl);
	190	}
	191
	192	static u8 tx4939ide_cable_detect(ide_hwif_t *hwif)
	193	{
	194	void __iomem *base = TX4939IDE_BASE(hwif);
	195
196	return tx4939ide_readw(base, TX4939IDE_Sys_Ctl) & 0x2000 ?
197	ATA_CBL_PATA40 : ATA_CBL_PATA80;
198	}
199
200	#ifdef __BIG_ENDIAN
201	static void tx4939ide_dma_host_set(ide_drive_t *drive, int on)
202	{
203	ide_hwif_t *hwif = drive->hwif;
204	u8 unit = drive->dn;
205	void __iomem *base = TX4939IDE_BASE(hwif);
206	u8 dma_stat = tx4939ide_readb(base, TX4939IDE_DMA_Stat);
207
208	if (on)
209	dma_stat \|= (1 << (5 + unit));
210	else
211	dma_stat &= ~(1 << (5 + unit));
212
213	tx4939ide_writeb(dma_stat, base, TX4939IDE_DMA_Stat);
214	}
215	#else
216	#define tx4939ide_dma_host_set ide_dma_host_set
217	#endif
218
219	static u8 tx4939ide_clear_dma_status(void __iomem *base)
220	{
221	u8 dma_stat;
222
223	/* read DMA status for INTR & ERROR flags */
224	dma_stat = tx4939ide_readb(base, TX4939IDE_DMA_Stat);
225	/* clear INTR & ERROR flags */
226	tx4939ide_writeb(dma_stat \| ATA_DMA_INTR \| ATA_DMA_ERR, base,
227	TX4939IDE_DMA_Stat);
228	/* recover intmask cleared by writing to bit2 of DMA_Stat */
229	tx4939ide_writew(TX4939IDE_IGNORE_INTS << 8, base, TX4939IDE_Int_Ctl);
230	return dma_stat;
231	}
232
233	#ifdef __BIG_ENDIAN
234	/* custom ide_build_dmatable to handle swapped layout */
22981694	235	static int tx4939ide_build_dmatable(ide_drive_t drive, struct ide_cmd cmd)
37897989 AN	236	{
	237	ide_hwif_t *hwif = drive->hwif;
	238	u32 table = (u32 )hwif->dmatable_cpu;
	239	unsigned int count = 0;
	240	int i;
	241	struct scatterlist *sg;
	242
22981694	243	for_each_sg(hwif->sg_table, sg, cmd->sg_nents, i) {
37897989 AN	244	u32 cur_addr, cur_len, bcount;
	245
	246	cur_addr = sg_dma_address(sg);
	247	cur_len = sg_dma_len(sg);
	248
	249	/*
	250	* Fill in the DMA table, without crossing any 64kB boundaries.
	251	*/
	252
	253	while (cur_len) {
	254	if (count++ >= PRD_ENTRIES)
	255	goto use_pio_instead;
	256
	257	bcount = 0x10000 - (cur_addr & 0xffff);
	258	if (bcount > cur_len)
	259	bcount = cur_len;
a0fce792 AN	260	/*
a0fce792 AN	261	* This workaround for zero count seems required.
9711a537	262	* (standard ide_build_dmatable does it too)
a0fce792	263	*/
9711a537	264	if (bcount == 0x10000)
a0fce792	265	bcount = 0x8000;
37897989 AN	266	*table++ = bcount & 0xffff;
	267	*table++ = cur_addr;
	268	cur_addr += bcount;
	269	cur_len -= bcount;
	270	}
	271	}
	272
	273	if (count) {
	274	*(table - 2) \|= 0x80000000;
	275	return count;
	276	}
	277
	278	use_pio_instead:
	279	printk(KERN_ERR "%s: %s\n", drive->name,
	280	count ? "DMA table too small" : "empty DMA table?");
	281
37897989 AN	282	return 0; /* revert to PIO for this request */
	283	}
	284	#else
	285	#define tx4939ide_build_dmatable ide_build_dmatable
	286	#endif
	287
22981694	288	static int tx4939ide_dma_setup(ide_drive_t drive, struct ide_cmd cmd)
37897989 AN	289	{
	290	ide_hwif_t *hwif = drive->hwif;
	291	void __iomem *base = TX4939IDE_BASE(hwif);
22981694	292	u8 rw = (cmd->tf_flags & IDE_TFLAG_WRITE) ? 0 : ATA_DMA_WR;
37897989 AN	293
37897989 AN	294	/* fall back to PIO! */
11998b31	295	if (tx4939ide_build_dmatable(drive, cmd) == 0)
37897989	296	return 1;
37897989 AN	297
	298	/* PRD table */
	299	tx4939ide_writel(hwif->dmatable_dma, base, TX4939IDE_PRD_Ptr);
	300
	301	/* specify r/w */
22981694	302	tx4939ide_writeb(rw, base, TX4939IDE_DMA_Cmd);
37897989 AN	303
	304	/* clear INTR & ERROR flags */
	305	tx4939ide_clear_dma_status(base);
	306
37897989 AN	307	tx4939ide_writew(SECTOR_SIZE / 2, base, drive->dn ?
37897989 AN	308	TX4939IDE_Xfer_Cnt_2 : TX4939IDE_Xfer_Cnt_1);
22981694	309
9780e2dd	310	tx4939ide_writew(blk_rq_sectors(cmd->rq), base, TX4939IDE_Sec_Cnt);
22981694	311
37897989 AN	312	return 0;
	313	}
	314
	315	static int tx4939ide_dma_end(ide_drive_t *drive)
	316	{
	317	ide_hwif_t *hwif = drive->hwif;
	318	u8 dma_stat, dma_cmd;
	319	void __iomem *base = TX4939IDE_BASE(hwif);
	320	u16 ctl = tx4939ide_readw(base, TX4939IDE_Int_Ctl);
	321
37897989 AN	322	/* get DMA command mode */
	323	dma_cmd = tx4939ide_readb(base, TX4939IDE_DMA_Cmd);
	324	/* stop DMA */
	325	tx4939ide_writeb(dma_cmd & ~ATA_DMA_START, base, TX4939IDE_DMA_Cmd);
	326
	327	/* read and clear the INTR & ERROR bits */
	328	dma_stat = tx4939ide_clear_dma_status(base);
	329
253275c5	330	#define CHECK_DMA_MASK (ATA_DMA_ACTIVE \| ATA_DMA_ERR \| ATA_DMA_INTR)
37897989	331
4453011f	332	/* verify good DMA status */
253275c5	333	if ((dma_stat & CHECK_DMA_MASK) == 0 &&
37897989 AN	334	(ctl & (TX4939IDE_INT_XFEREND \| TX4939IDE_INT_HOST)) ==
	335	(TX4939IDE_INT_XFEREND \| TX4939IDE_INT_HOST))
	336	/* INT_IDE lost... bug? */
	337	return 0;
253275c5	338	return ((dma_stat & CHECK_DMA_MASK) !=
37897989 AN	339	ATA_DMA_INTR) ? 0x10 \| dma_stat : 0;
	340	}
	341
	342	/* returns 1 if DMA IRQ issued, 0 otherwise */
	343	static int tx4939ide_dma_test_irq(ide_drive_t *drive)
	344	{
	345	ide_hwif_t *hwif = drive->hwif;
	346	void __iomem *base = TX4939IDE_BASE(hwif);
	347	u16 ctl, ide_int;
	348	u8 dma_stat, stat;
	349	int found = 0;
	350
	351	ctl = tx4939ide_check_error_ints(hwif);
	352	ide_int = ctl & (TX4939IDE_INT_XFEREND \| TX4939IDE_INT_HOST);
	353	switch (ide_int) {
	354	case TX4939IDE_INT_HOST:
	355	/* On error, XFEREND might not be asserted. */
	356	stat = tx4939ide_readb(base, TX4939IDE_AltStat_DevCtl);
	357	if ((stat & (ATA_BUSY \| ATA_DRQ \| ATA_ERR)) == ATA_ERR)
	358	found = 1;
	359	else
	360	/* Wait for XFEREND (Mask HOST and unmask XFEREND) */
	361	ctl &= ~TX4939IDE_INT_XFEREND << 8;
	362	ctl \|= ide_int << 8;
	363	break;
	364	case TX4939IDE_INT_HOST \| TX4939IDE_INT_XFEREND:
	365	dma_stat = tx4939ide_readb(base, TX4939IDE_DMA_Stat);
	366	if (!(dma_stat & ATA_DMA_INTR))
	367	pr_warning("%s: weird interrupt status. "
	368	"DMA_Stat %#02x int_ctl %#04x\n",
	369	hwif->name, dma_stat, ctl);
	370	found = 1;
	371	break;
	372	}
	373	/*
	374	* Do not clear XFEREND, HOST now. They will be cleared by
	375	* clearing bit2 of DMA_Stat.
	376	*/
	377	ctl &= ~ide_int;
	378	tx4939ide_writew(ctl, base, TX4939IDE_Int_Ctl);
	379	return found;
	380	}
	381
592b5315 SS	382	#ifdef __BIG_ENDIAN
	383	static u8 tx4939ide_dma_sff_read_status(ide_hwif_t *hwif)
	384	{
	385	void __iomem *base = TX4939IDE_BASE(hwif);
	386
	387	return tx4939ide_readb(base, TX4939IDE_DMA_Stat);
	388	}
	389	#else
	390	#define tx4939ide_dma_sff_read_status ide_dma_sff_read_status
	391	#endif
	392
37897989 AN	393	static void tx4939ide_init_hwif(ide_hwif_t *hwif)
	394	{
	395	void __iomem *base = TX4939IDE_BASE(hwif);
	396
	397	/* Soft Reset */
	398	tx4939ide_writew(0x8000, base, TX4939IDE_Sys_Ctl);
	399	mmiowb();
	400	/* at least 20 GBUSCLK (typ. 100ns @ GBUS200MHz, max 450ns) */
	401	ndelay(450);
	402	tx4939ide_writew(0x0000, base, TX4939IDE_Sys_Ctl);
	403	/* mask some interrupts and clear all interrupts */
	404	tx4939ide_writew((TX4939IDE_IGNORE_INTS << 8) \| 0xff, base,
	405	TX4939IDE_Int_Ctl);
	406
	407	tx4939ide_writew(0x0008, base, TX4939IDE_Lo_Burst_Cnt);
	408	tx4939ide_writew(0, base, TX4939IDE_Up_Burst_Cnt);
	409	}
	410
	411	static int tx4939ide_init_dma(ide_hwif_t hwif, const struct ide_port_info d)
	412	{
	413	hwif->dma_base =
	414	hwif->extra_base + tx4939ide_swizzleb(TX4939IDE_DMA_Cmd);
	415	/*
	416	* Note that we cannot use ATA_DMA_TABLE_OFS, ATA_DMA_STATUS
	417	* for big endian.
	418	*/
	419	return ide_allocate_dma_engine(hwif);
	420	}
	421
22aa4b32	422	static void tx4939ide_tf_load_fixup(ide_drive_t *drive)
37897989 AN	423	{
	424	ide_hwif_t *hwif = drive->hwif;
	425	void __iomem *base = TX4939IDE_BASE(hwif);
	426	u16 sysctl = hwif->select_data >> (drive->dn ? 16 : 0);
	427
	428	/*
	429	* Fix ATA100 CORE System Control Register. (The write to the
	430	* Device/Head register may write wrong data to the System
	431	* Control Register)
abb596b2	432	* While Sys_Ctl is written here, dev_select() is not needed.
37897989 AN	433	*/
	434	tx4939ide_writew(sysctl, base, TX4939IDE_Sys_Ctl);
	435	}
	436
c9ff9e7b SS	437	static void tx4939ide_tf_load(ide_drive_t drive, struct ide_taskfile tf,
c9ff9e7b SS	438	u8 valid)
37897989	439	{
c9ff9e7b	440	ide_tf_load(drive, tf, valid);
d68bab50	441
c9ff9e7b	442	if (valid & IDE_VALID_DEVICE)
22aa4b32	443	tx4939ide_tf_load_fixup(drive);
37897989 AN	444	}
37897989 AN	445
d68bab50	446	#ifdef __BIG_ENDIAN
37897989	447
d68bab50	448	/* custom iops (independent from SWAP_IO_SPACE) */
aa24d978	449	static void tx4939ide_input_data_swap(ide_drive_t drive, struct ide_cmd cmd,
37897989 AN	450	void *buf, unsigned int len)
	451	{
	452	unsigned long port = drive->hwif->io_ports.data_addr;
	453	unsigned short *ptr = buf;
	454	unsigned int count = (len + 1) / 2;
	455
	456	while (count--)
	457	ptr++ = cpu_to_le16(__raw_readw((void __iomem )port));
f26f6cea	458	__ide_flush_dcache_range((unsigned long)buf, roundup(len, 2));
37897989 AN	459	}
37897989 AN	460
aa24d978	461	static void tx4939ide_output_data_swap(ide_drive_t drive, struct ide_cmd cmd,
37897989 AN	462	void *buf, unsigned int len)
	463	{
	464	unsigned long port = drive->hwif->io_ports.data_addr;
	465	unsigned short *ptr = buf;
	466	unsigned int count = (len + 1) / 2;
	467
	468	while (count--) {
	469	__raw_writew(le16_to_cpu(ptr), (void __iomem )port);
	470	ptr++;
	471	}
f26f6cea	472	__ide_flush_dcache_range((unsigned long)buf, roundup(len, 2));
37897989 AN	473	}
	474
	475	static const struct ide_tp_ops tx4939ide_tp_ops = {
	476	.exec_command = ide_exec_command,
	477	.read_status = ide_read_status,
	478	.read_altstatus = ide_read_altstatus,
ecf3a31d	479	.write_devctl = ide_write_devctl,
37897989	480
abb596b2	481	.dev_select = ide_dev_select,
37897989	482	.tf_load = tx4939ide_tf_load,
d68bab50	483	.tf_read = ide_tf_read,
37897989 AN	484
	485	.input_data = tx4939ide_input_data_swap,
	486	.output_data = tx4939ide_output_data_swap,
	487	};
	488
	489	#else /* __LITTLE_ENDIAN */
	490
37897989 AN	491	static const struct ide_tp_ops tx4939ide_tp_ops = {
	492	.exec_command = ide_exec_command,
	493	.read_status = ide_read_status,
	494	.read_altstatus = ide_read_altstatus,
ecf3a31d	495	.write_devctl = ide_write_devctl,
37897989	496
abb596b2	497	.dev_select = ide_dev_select,
37897989 AN	498	.tf_load = tx4939ide_tf_load,
	499	.tf_read = ide_tf_read,
	500
	501	.input_data = ide_input_data,
	502	.output_data = ide_output_data,
	503	};
	504
	505	#endif /* __LITTLE_ENDIAN */
	506
	507	static const struct ide_port_ops tx4939ide_port_ops = {
3ee86dcd BZ	508	.set_pio_mode = tx4939ide_set_pio_mode,
	509	.set_dma_mode = tx4939ide_set_dma_mode,
	510	.clear_irq = tx4939ide_clear_irq,
	511	.cable_detect = tx4939ide_cable_detect,
37897989 AN	512	};
	513
	514	static const struct ide_dma_ops tx4939ide_dma_ops = {
3ee86dcd BZ	515	.dma_host_set = tx4939ide_dma_host_set,
3ee86dcd BZ	516	.dma_setup = tx4939ide_dma_setup,
3ee86dcd BZ	517	.dma_start = ide_dma_start,
	518	.dma_end = tx4939ide_dma_end,
	519	.dma_test_irq = tx4939ide_dma_test_irq,
	520	.dma_lost_irq = ide_dma_lost_irq,
22117d6e	521	.dma_timer_expiry = ide_dma_sff_timer_expiry,
592b5315	522	.dma_sff_read_status = tx4939ide_dma_sff_read_status,
37897989 AN	523	};
	524
	525	static const struct ide_port_info tx4939ide_port_info __initdata = {
3ee86dcd BZ	526	.init_hwif = tx4939ide_init_hwif,
	527	.init_dma = tx4939ide_init_dma,
	528	.port_ops = &tx4939ide_port_ops,
	529	.dma_ops = &tx4939ide_dma_ops,
	530	.tp_ops = &tx4939ide_tp_ops,
	531	.host_flags = IDE_HFLAG_MMIO,
	532	.pio_mask = ATA_PIO4,
	533	.mwdma_mask = ATA_MWDMA2,
	534	.udma_mask = ATA_UDMA5,
b1d249e8	535	.chipset = ide_generic,
37897989 AN	536	};
	537
	538	static int __init tx4939ide_probe(struct platform_device *pdev)
	539	{
9f36d314	540	struct ide_hw hw, *hws[] = { &hw };
37897989 AN	541	struct ide_host *host;
	542	struct resource *res;
	543	int irq, ret;
	544	unsigned long mapbase;
	545
	546	irq = platform_get_irq(pdev, 0);
	547	if (irq < 0)
	548	return -ENODEV;
	549	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	550	if (!res)
	551	return -ENODEV;
	552
	553	if (!devm_request_mem_region(&pdev->dev, res->start,
28f65c11	554	resource_size(res), "tx4938ide"))
37897989 AN	555	return -EBUSY;
37897989 AN	556	mapbase = (unsigned long)devm_ioremap(&pdev->dev, res->start,
28f65c11	557	resource_size(res));
37897989 AN	558	if (!mapbase)
	559	return -EBUSY;
	560	memset(&hw, 0, sizeof(hw));
	561	hw.io_ports.data_addr =
	562	mapbase + tx4939ide_swizzlew(TX4939IDE_Data);
	563	hw.io_ports.error_addr =
	564	mapbase + tx4939ide_swizzleb(TX4939IDE_Error_Feature);
	565	hw.io_ports.nsect_addr =
	566	mapbase + tx4939ide_swizzleb(TX4939IDE_Sec);
	567	hw.io_ports.lbal_addr =
	568	mapbase + tx4939ide_swizzleb(TX4939IDE_LBA0);
	569	hw.io_ports.lbam_addr =
	570	mapbase + tx4939ide_swizzleb(TX4939IDE_LBA1);
	571	hw.io_ports.lbah_addr =
	572	mapbase + tx4939ide_swizzleb(TX4939IDE_LBA2);
	573	hw.io_ports.device_addr =
	574	mapbase + tx4939ide_swizzleb(TX4939IDE_DevHead);
	575	hw.io_ports.command_addr =
	576	mapbase + tx4939ide_swizzleb(TX4939IDE_Stat_Cmd);
	577	hw.io_ports.ctl_addr =
	578	mapbase + tx4939ide_swizzleb(TX4939IDE_AltStat_DevCtl);
	579	hw.irq = irq;
	580	hw.dev = &pdev->dev;
	581
	582	pr_info("TX4939 IDE interface (base %#lx, irq %d)\n", mapbase, irq);
dca39830	583	host = ide_host_alloc(&tx4939ide_port_info, hws, 1);
37897989 AN	584	if (!host)
	585	return -ENOMEM;
	586	/* use extra_base for base address of the all registers */
	587	host->ports[0]->extra_base = mapbase;
	588	ret = ide_host_register(host, &tx4939ide_port_info, hws);
	589	if (ret) {
	590	ide_host_free(host);
	591	return ret;
	592	}
	593	platform_set_drvdata(pdev, host);
	594	return 0;
	595	}
	596
	597	static int __exit tx4939ide_remove(struct platform_device *pdev)
	598	{
	599	struct ide_host *host = platform_get_drvdata(pdev);
	600
	601	ide_host_remove(host);
	602	return 0;
	603	}
	604
	605	#ifdef CONFIG_PM
	606	static int tx4939ide_resume(struct platform_device *dev)
	607	{
	608	struct ide_host *host = platform_get_drvdata(dev);
	609	ide_hwif_t *hwif = host->ports[0];
	610
	611	tx4939ide_init_hwif(hwif);
	612	return 0;
	613	}
	614	#else
	615	#define tx4939ide_resume NULL
	616	#endif
	617
	618	static struct platform_driver tx4939ide_driver = {
	619	.driver = {
	620	.name = MODNAME,
	621	.owner = THIS_MODULE,
	622	},
	623	.remove = __exit_p(tx4939ide_remove),
	624	.resume = tx4939ide_resume,
	625	};
	626
	627	static int __init tx4939ide_init(void)
	628	{
	629	return platform_driver_probe(&tx4939ide_driver, tx4939ide_probe);
	630	}
	631
	632	static void __exit tx4939ide_exit(void)
	633	{
	634	platform_driver_unregister(&tx4939ide_driver);
	635	}
	636
	637	module_init(tx4939ide_init);
	638	module_exit(tx4939ide_exit);
	639
	640	MODULE_DESCRIPTION("TX4939 internal IDE driver");
	641	MODULE_LICENSE("GPL");
	642	MODULE_ALIAS("platform:tx4939ide");