5 files changed, 60 insertions, 115 deletions

diff --git a/arch/mips/txx9/rbtx4938/Makefile b/arch/mips/txx9/rbtx4938/Makefile
index 9dcc52ae5b9d..f3e1f597b4f1 100644
--- a/arch/mips/txx9/rbtx4938/Makefile
+++ b/arch/mips/txx9/rbtx4938/Makefile
@@ -1,3 +1,3 @@
-obj-y   += prom.o setup.o irq.o spi_eeprom.o
+obj-y   += prom.o setup.o irq.o
 
 EXTRA_CFLAGS += -Werror
diff --git a/arch/mips/txx9/rbtx4938/irq.c b/arch/mips/txx9/rbtx4938/irq.c
index ca2f8306ce93..7d21befb8932 100644
--- a/arch/mips/txx9/rbtx4938/irq.c
+++ b/arch/mips/txx9/rbtx4938/irq.c
@@ -85,10 +85,10 @@ static int toshiba_rbtx4938_irq_nested(int sw_irq)
         u8 level3;
 
         level3 = readb(rbtx4938_imstat_addr);
-        if (level3)
-                /* must use fls so onboard ATA has priority */
-                sw_irq = RBTX4938_IRQ_IOC + fls(level3) - 1;
-        return sw_irq;
+        if (unlikely(!level3))
+                return -1;
+        /* must use fls so onboard ATA has priority */
+        return RBTX4938_IRQ_IOC + __fls8(level3);
 }
 
 static void __init
diff --git a/arch/mips/txx9/rbtx4938/prom.c b/arch/mips/txx9/rbtx4938/prom.c
index d73123cd2ab9..bcb469247e8c 100644
--- a/arch/mips/txx9/rbtx4938/prom.c
+++ b/arch/mips/txx9/rbtx4938/prom.c
@@ -18,9 +18,6 @@
 
 void __init rbtx4938_prom_init(void)
 {
-#ifndef CONFIG_TX4938_NAND_BOOT
-        prom_init_cmdline();
-#endif
         add_memory_region(0, tx4938_get_mem_size(), BOOT_MEM_RAM);
         txx9_sio_putchar_init(TX4938_SIO_REG(0) & 0xfffffffffULL);
 }
diff --git a/arch/mips/txx9/rbtx4938/setup.c b/arch/mips/txx9/rbtx4938/setup.c
index 9ab48dec0fe8..e077cc4d3a59 100644
--- a/arch/mips/txx9/rbtx4938/setup.c
+++ b/arch/mips/txx9/rbtx4938/setup.c
@@ -15,6 +15,7 @@
 #include <linux/delay.h>
 #include <linux/platform_device.h>
 #include <linux/gpio.h>
+#include <linux/mtd/physmap.h>
 
 #include <asm/reboot.h>
 #include <asm/io.h>
@@ -110,6 +111,7 @@ static void __init rbtx4938_pci_setup(void)
 #define SEEPROM2_CS     0       /* IOC */
 #define SEEPROM3_CS     1       /* IOC */
 #define SRTC_CS 2       /* IOC */
+#define SPI_BUSNO       0
 
 static int __init rbtx4938_ethaddr_init(void)
 {
@@ -119,7 +121,7 @@ static int __init rbtx4938_ethaddr_init(void)
         int i;
 
         /* 0-3: "MAC\0", 4-9:eth0, 10-15:eth1, 16:sum */
-        if (spi_eeprom_read(SEEPROM1_CS, 0, dat, sizeof(dat))) {
+        if (spi_eeprom_read(SPI_BUSNO, SEEPROM1_CS, 0, dat, sizeof(dat))) {
                 printk(KERN_ERR "seeprom: read error.\n");
                 return -ENODEV;
         } else {
@@ -173,23 +175,30 @@ static void __init rbtx4938_mem_setup(void)
 #endif
 
 #ifdef CONFIG_TOSHIBA_RBTX4938_MPLEX_PIO58_61
-        printk(KERN_INFO "PIOSEL: disabling both ata and nand selection\n");
+        pr_info("PIOSEL: disabling both ATA and NAND selection\n");
         txx9_clear64(&tx4938_ccfgptr->pcfg,
                      TX4938_PCFG_NDF_SEL | TX4938_PCFG_ATA_SEL);
 #endif
 
 #ifdef CONFIG_TOSHIBA_RBTX4938_MPLEX_NAND
-        printk(KERN_INFO "PIOSEL: enabling nand selection\n");
+        pr_info("PIOSEL: enabling NAND selection\n");
         txx9_set64(&tx4938_ccfgptr->pcfg, TX4938_PCFG_NDF_SEL);
         txx9_clear64(&tx4938_ccfgptr->pcfg, TX4938_PCFG_ATA_SEL);
 #endif
 
 #ifdef CONFIG_TOSHIBA_RBTX4938_MPLEX_ATA
-        printk(KERN_INFO "PIOSEL: enabling ata selection\n");
+        pr_info("PIOSEL: enabling ATA selection\n");
         txx9_set64(&tx4938_ccfgptr->pcfg, TX4938_PCFG_ATA_SEL);
         txx9_clear64(&tx4938_ccfgptr->pcfg, TX4938_PCFG_NDF_SEL);
 #endif
 
+#ifdef CONFIG_TOSHIBA_RBTX4938_MPLEX_KEEP
+        pcfg = ____raw_readq(&tx4938_ccfgptr->pcfg);
+        pr_info("PIOSEL: NAND %s, ATA %s\n",
+                (pcfg & TX4938_PCFG_NDF_SEL) ? "enabled" : "disabled",
+                (pcfg & TX4938_PCFG_ATA_SEL) ? "enabled" : "disabled");
+#endif
+
         rbtx4938_spi_setup();
         pcfg = ____raw_readq(&tx4938_ccfgptr->pcfg);    /* updated */
         /* fixup piosel */
@@ -279,9 +288,9 @@ static int __init rbtx4938_spi_init(void)
                 .mode = SPI_MODE_1 | SPI_CS_HIGH,
         };
         spi_register_board_info(&srtc_info, 1);
-        spi_eeprom_register(SEEPROM1_CS);
-        spi_eeprom_register(16 + SEEPROM2_CS);
-        spi_eeprom_register(16 + SEEPROM3_CS);
+        spi_eeprom_register(SPI_BUSNO, SEEPROM1_CS, 128);
+        spi_eeprom_register(SPI_BUSNO, 16 + SEEPROM2_CS, 128);
+        spi_eeprom_register(SPI_BUSNO, 16 + SEEPROM3_CS, 128);
         gpio_request(16 + SRTC_CS, "rtc-rs5c348");
         gpio_direction_output(16 + SRTC_CS, 0);
         gpio_request(SEEPROM1_CS, "seeprom1");
@@ -290,10 +299,46 @@ static int __init rbtx4938_spi_init(void)
         gpio_direction_output(16 + SEEPROM2_CS, 1);
         gpio_request(16 + SEEPROM3_CS, "seeprom3");
         gpio_direction_output(16 + SEEPROM3_CS, 1);
-        tx4938_spi_init(0);
+        tx4938_spi_init(SPI_BUSNO);
         return 0;
 }
 
+static void __init rbtx4938_mtd_init(void)
+{
+        struct physmap_flash_data pdata = {
+                .width = 4,
+        };
+
+        switch (readb(rbtx4938_bdipsw_addr) & 7) {
+        case 0:
+                /* Boot */
+                txx9_physmap_flash_init(0, 0x1fc00000, 0x400000, &pdata);
+                /* System */
+                txx9_physmap_flash_init(1, 0x1e000000, 0x1000000, &pdata);
+                break;
+        case 1:
+                /* System */
+                txx9_physmap_flash_init(0, 0x1f000000, 0x1000000, &pdata);
+                /* Boot */
+                txx9_physmap_flash_init(1, 0x1ec00000, 0x400000, &pdata);
+                break;
+        case 2:
+                /* Ext */
+                txx9_physmap_flash_init(0, 0x1f000000, 0x1000000, &pdata);
+                /* System */
+                txx9_physmap_flash_init(1, 0x1e000000, 0x1000000, &pdata);
+                /* Boot */
+                txx9_physmap_flash_init(2, 0x1dc00000, 0x400000, &pdata);
+                break;
+        case 3:
+                /* Boot */
+                txx9_physmap_flash_init(1, 0x1bc00000, 0x400000, &pdata);
+                /* System */
+                txx9_physmap_flash_init(2, 0x1a000000, 0x1000000, &pdata);
+                break;
+        }
+}
+
 static void __init rbtx4938_arch_init(void)
 {
         gpiochip_add(&rbtx4938_spi_gpio_chip);
@@ -306,6 +351,8 @@ static void __init rbtx4938_device_init(void)
         rbtx4938_ethaddr_init();
         rbtx4938_ne_init();
         tx4938_wdt_init();
+        rbtx4938_mtd_init();
+        txx9_iocled_init(RBTX4938_LED_ADDR - IO_BASE, -1, 8, 1, "green", NULL);
 }
 
 struct txx9_board_vec rbtx4938_vec __initdata = {
diff --git a/arch/mips/txx9/rbtx4938/spi_eeprom.c b/arch/mips/txx9/rbtx4938/spi_eeprom.c
deleted file mode 100644
index a7ea8b041c1d..000000000000
--- a/arch/mips/txx9/rbtx4938/spi_eeprom.c
+++ /dev/null
@@ -1,99 +0,0 @@
-/*
- * spi_eeprom.c
- * Copyright (C) 2000-2001 Toshiba Corporation
- *
- * 2003-2005 (c) MontaVista Software, Inc. This file is licensed under the
- * terms of the GNU General Public License version 2. This program is
- * licensed "as is" without any warranty of any kind, whether express
- * or implied.
- *
- * Support for TX4938 in 2.6 - Manish Lachwani (mlachwani@mvista.com)
- */
-#include <linux/init.h>
-#include <linux/device.h>
-#include <linux/spi/spi.h>
-#include <linux/spi/eeprom.h>
-#include <asm/txx9/spi.h>
-
-#define AT250X0_PAGE_SIZE       8
-
-/* register board information for at25 driver */
-int __init spi_eeprom_register(int chipid)
-{
-        static struct spi_eeprom eeprom = {
-                .name = "at250x0",
-                .byte_len = 128,
-                .page_size = AT250X0_PAGE_SIZE,
-                .flags = EE_ADDR1,
-        };
-        struct spi_board_info info = {
-                .modalias = "at25",
-                .max_speed_hz = 1500000,        /* 1.5Mbps */
-                .bus_num = 0,
-                .chip_select = chipid,
-                .platform_data = &eeprom,
-                /* Mode 0: High-Active, Sample-Then-Shift */
-        };
-
-        return spi_register_board_info(&info, 1);
-}
-
-/* simple temporary spi driver to provide early access to seeprom. */
-
-static struct read_param {
-        int chipid;
-        int address;
-        unsigned char *buf;
-        int len;
-} *read_param;
-
-static int __init early_seeprom_probe(struct spi_device *spi)
-{
-        int stat = 0;
-        u8 cmd[2];
-        int len = read_param->len;
-        char *buf = read_param->buf;
-        int address = read_param->address;
-
-        dev_info(&spi->dev, "spiclk %u KHz.\n",
-                 (spi->max_speed_hz + 500) / 1000);
-        if (read_param->chipid != spi->chip_select)
-                return -ENODEV;
-        while (len > 0) {
-                /* spi_write_then_read can only work with small chunk */
-                int c = len < AT250X0_PAGE_SIZE ? len : AT250X0_PAGE_SIZE;
-                cmd[0] = 0x03;  /* AT25_READ */
-                cmd[1] = address;
-                stat = spi_write_then_read(spi, cmd, sizeof(cmd), buf, c);
-                buf += c;
-                len -= c;
-                address += c;
-        }
-        return stat;
-}
-
-static struct spi_driver early_seeprom_driver __initdata = {
-        .driver = {
-                .name   = "at25",
-                .owner  = THIS_MODULE,
-        },
-        .probe  = early_seeprom_probe,
-};
-
-int __init spi_eeprom_read(int chipid, int address,
-                           unsigned char *buf, int len)
-{
-        int ret;
-        struct read_param param = {
-                .chipid = chipid,
-                .address = address,
-                .buf = buf,
-                .len = len
-        };
-
-        read_param = &param;
-        ret = spi_register_driver(&early_seeprom_driver);
-        if (!ret)
-                spi_unregister_driver(&early_seeprom_driver);
-        return ret;
-}