TXx9: Add TX4938 ATA support (v3)

[linux-2.6-omap-h63xx.git] / arch / mips / txx9 / generic / setup_tx4938.c

diff --git a/arch/mips/txx9/generic/setup_tx4938.c b/arch/mips/txx9/generic/setup_tx4938.c
index 0d8517ad3ad0da6baf0725e9b476c3fd8bfe99e7..25819ff1c3507310b0edad65559afbe14afddf63 100644 (file)
--- a/arch/mips/txx9/generic/setup_tx4938.c
+++ b/arch/mips/txx9/generic/setup_tx4938.c
@@ -16,6 +16,7 @@
 #include <linux/param.h>
 #include <linux/ptrace.h>
 #include <linux/mtd/physmap.h>
+#include <linux/platform_device.h>
 #include <asm/reboot.h>
 #include <asm/traps.h>
 #include <asm/txx9irq.h>
@@ -334,3 +335,105 @@ void __init tx4938_mtd_init(int ch)
                return; /* disabled */
        txx9_physmap_flash_init(ch, start, size, &pdata);
 }
+
+void __init tx4938_ata_init(unsigned int irq, unsigned int shift, int tune)
+{
+       struct platform_device *pdev;
+       struct resource res[] = {
+               {
+                       /* .start and .end are filled in later */
+                       .flags = IORESOURCE_MEM,
+               }, {
+                       .start = irq,
+                       .flags = IORESOURCE_IRQ,
+               },
+       };
+       struct tx4938ide_platform_info pdata = {
+               .ioport_shift = shift,
+               /*
+                * The IDE driver should not change bus timings if other ISA
+                * devices existed.
+                */
+               .gbus_clock = tune ? txx9_gbus_clock : 0,
+       };
+       u64 ebccr;
+       int i;
+
+       if ((__raw_readq(&tx4938_ccfgptr->pcfg) &
+            (TX4938_PCFG_ATA_SEL | TX4938_PCFG_NDF_SEL))
+           != TX4938_PCFG_ATA_SEL)
+               return;
+       for (i = 0; i < 8; i++) {
+               /* check EBCCRn.ISA, EBCCRn.BSZ, EBCCRn.ME */
+               ebccr = __raw_readq(&tx4938_ebuscptr->cr[i]);
+               if ((ebccr & 0x00f00008) == 0x00e00008)
+                       break;
+       }
+       if (i == 8)
+               return;
+       pdata.ebus_ch = i;
+       res[0].start = ((ebccr >> 48) << 20) + 0x10000;
+       res[0].end = res[0].start + 0x20000 - 1;
+       pdev = platform_device_alloc("tx4938ide", -1);
+       if (!pdev ||
+           platform_device_add_resources(pdev, res, ARRAY_SIZE(res)) ||
+           platform_device_add_data(pdev, &pdata, sizeof(pdata)) ||
+           platform_device_add(pdev))
+               platform_device_put(pdev);
+}
+
+static void __init tx4938_stop_unused_modules(void)
+{
+       __u64 pcfg, rst = 0, ckd = 0;
+       char buf[128];
+
+       buf[0] = '\0';
+       local_irq_disable();
+       pcfg = ____raw_readq(&tx4938_ccfgptr->pcfg);
+       switch (txx9_pcode) {
+       case 0x4937:
+               if (!(pcfg & TX4938_PCFG_SEL2)) {
+                       rst |= TX4938_CLKCTR_ACLRST;
+                       ckd |= TX4938_CLKCTR_ACLCKD;
+                       strcat(buf, " ACLC");
+               }
+               break;
+       case 0x4938:
+               if (!(pcfg & TX4938_PCFG_SEL2) ||
+                   (pcfg & TX4938_PCFG_ETH0_SEL)) {
+                       rst |= TX4938_CLKCTR_ACLRST;
+                       ckd |= TX4938_CLKCTR_ACLCKD;
+                       strcat(buf, " ACLC");
+               }
+               if ((pcfg &
+                    (TX4938_PCFG_ATA_SEL | TX4938_PCFG_ISA_SEL |
+                     TX4938_PCFG_NDF_SEL))
+                   != TX4938_PCFG_NDF_SEL) {
+                       rst |= TX4938_CLKCTR_NDFRST;
+                       ckd |= TX4938_CLKCTR_NDFCKD;
+                       strcat(buf, " NDFMC");
+               }
+               if (!(pcfg & TX4938_PCFG_SPI_SEL)) {
+                       rst |= TX4938_CLKCTR_SPIRST;
+                       ckd |= TX4938_CLKCTR_SPICKD;
+                       strcat(buf, " SPI");
+               }
+               break;
+       }
+       if (rst | ckd) {
+               txx9_set64(&tx4938_ccfgptr->clkctr, rst);
+               txx9_set64(&tx4938_ccfgptr->clkctr, ckd);
+       }
+       local_irq_enable();
+       if (buf[0])
+               pr_info("%s: stop%s\n", txx9_pcode_str, buf);
+}
+
+static int __init tx4938_late_init(void)
+{
+       if (txx9_pcode != 0x4937 && txx9_pcode != 0x4938)
+               return -ENODEV;
+       tx4938_stop_unused_modules();
+       return 0;
+}
+late_initcall(tx4938_late_init);