linux 2.6.16.38 w/ vs2.0.3-rc1
[linux-2.6.git] / drivers / mtd / nand / toto.c
index f9e2d4a..7609c43 100644 (file)
@@ -32,8 +32,6 @@
 #include <asm/arch-omap1510/hardware.h>
 #include <asm/arch/gpio.h>
 
-#define CONFIG_NAND_WORKAROUND 1
-
 /*
  * MTD structure for TOTO board
  */
@@ -41,6 +39,25 @@ static struct mtd_info *toto_mtd = NULL;
 
 static unsigned long toto_io_base = OMAP_FLASH_1_BASE;
 
+#define CONFIG_NAND_WORKAROUND 1
+
+#define NAND_NCE 0x4000
+#define NAND_CLE 0x1000
+#define NAND_ALE 0x0002
+#define NAND_MASK (NAND_CLE | NAND_ALE | NAND_NCE)
+
+#define T_NAND_CTL_CLRALE(iob)  gpiosetout(NAND_ALE, 0)
+#define T_NAND_CTL_SETALE(iob)  gpiosetout(NAND_ALE, NAND_ALE)
+#ifdef CONFIG_NAND_WORKAROUND     /* "some" dev boards busted, blue wired to rts2 :( */
+#define T_NAND_CTL_CLRCLE(iob)  gpiosetout(NAND_CLE, 0); rts2setout(2, 2)
+#define T_NAND_CTL_SETCLE(iob)  gpiosetout(NAND_CLE, NAND_CLE); rts2setout(2, 0)
+#else
+#define T_NAND_CTL_CLRCLE(iob)  gpiosetout(NAND_CLE, 0)
+#define T_NAND_CTL_SETCLE(iob)  gpiosetout(NAND_CLE, NAND_CLE)
+#endif
+#define T_NAND_CTL_SETNCE(iob)  gpiosetout(NAND_NCE, 0)
+#define T_NAND_CTL_CLRNCE(iob)  gpiosetout(NAND_NCE, NAND_NCE)
+
 /*
  * Define partitions for flash devices
  */
@@ -74,110 +91,91 @@ static struct mtd_partition partition_info32M[] = {
 
 #define NUM_PARTITIONS32M 3
 #define NUM_PARTITIONS64M 4
-
 /*
  *     hardware specific access to control-lines
- *
- *     ctrl:
- *     NAND_NCE: bit 0 -> bit 14 (0x4000)
- *     NAND_CLE: bit 1 -> bit 12 (0x1000)
- *     NAND_ALE: bit 2 -> bit 1  (0x0002)
- */
-static void toto_hwcontrol(struct mtd_info *mtd, int cmd,
-                          unsigned int ctrl)
-{
-       struct nand_chip *chip = mtd->priv;
+*/
 
-       if (ctrl & NAND_CTRL_CHANGE) {
-               unsigned long bits;
+static void toto_hwcontrol(struct mtd_info *mtd, int cmd)
+{
 
-               /* hopefully enough time for tc make proceding write to clear */
-               udelay(1);
+       udelay(1); /* hopefully enough time for tc make proceding write to clear */
+       switch(cmd){
 
-               bits = (~ctrl & NAND_NCE) << 14;
-               bits |= (ctrl & NAND_CLE) << 12;
-               bits |= (ctrl & NAND_ALE) >> 1;
+               case NAND_CTL_SETCLE: T_NAND_CTL_SETCLE(cmd); break;
+               case NAND_CTL_CLRCLE: T_NAND_CTL_CLRCLE(cmd); break;
 
-#warning Wild guess as gpiosetout() is nowhere defined in the kernel source - tglx
-               gpiosetout(0x5002, bits);
+               case NAND_CTL_SETALE: T_NAND_CTL_SETALE(cmd); break;
+               case NAND_CTL_CLRALE: T_NAND_CTL_CLRALE(cmd); break;
 
-#ifdef CONFIG_NAND_WORKAROUND
-               /* "some" dev boards busted, blue wired to rts2 :( */
-               rts2setout(2, (ctrl & NAND_CLE) << 1);
-#endif
-               /* allow time to ensure gpio state to over take memory write */
-               udelay(1);
+               case NAND_CTL_SETNCE: T_NAND_CTL_SETNCE(cmd); break;
+               case NAND_CTL_CLRNCE: T_NAND_CTL_CLRNCE(cmd); break;
        }
-
-       if (cmd != NAND_CMD_NONE)
-               writeb(cmd, chip->IO_ADDR_W);
+       udelay(1); /* allow time to ensure gpio state to over take memory write */
 }
 
 /*
  * Main initialization routine
  */
-static int __init toto_init(void)
+int __init toto_init (void)
 {
        struct nand_chip *this;
        int err = 0;
 
        /* Allocate memory for MTD device structure and private data */
-       toto_mtd = kmalloc(sizeof(struct mtd_info) + sizeof(struct nand_chip), GFP_KERNEL);
+       toto_mtd = kmalloc (sizeof(struct mtd_info) + sizeof (struct nand_chip),
+                               GFP_KERNEL);
        if (!toto_mtd) {
-               printk(KERN_WARNING "Unable to allocate toto NAND MTD device structure.\n");
+               printk (KERN_WARNING "Unable to allocate toto NAND MTD device structure.\n");
                err = -ENOMEM;
                goto out;
        }
 
        /* Get pointer to private data */
-       this = (struct nand_chip *)(&toto_mtd[1]);
+       this = (struct nand_chip *) (&toto_mtd[1]);
 
        /* Initialize structures */
-       memset(toto_mtd, 0, sizeof(struct mtd_info));
-       memset(this, 0, sizeof(struct nand_chip));
+       memset((char *) toto_mtd, 0, sizeof(struct mtd_info));
+       memset((char *) this, 0, sizeof(struct nand_chip));
 
        /* Link the private data with the MTD structure */
        toto_mtd->priv = this;
-       toto_mtd->owner = THIS_MODULE;
 
        /* Set address of NAND IO lines */
        this->IO_ADDR_R = toto_io_base;
        this->IO_ADDR_W = toto_io_base;
-       this->cmd_ctrl = toto_hwcontrol;
+       this->hwcontrol = toto_hwcontrol;
        this->dev_ready = NULL;
        /* 25 us command delay time */
        this->chip_delay = 30;
-       this->ecc.mode = NAND_ECC_SOFT;
+       this->eccmode = NAND_ECC_SOFT;
 
-       /* Scan to find existance of the device */
-       if (nand_scan(toto_mtd, 1)) {
+        /* Scan to find existance of the device */
+       if (nand_scan (toto_mtd, 1)) {
                err = -ENXIO;
                goto out_mtd;
        }
 
        /* Register the partitions */
-       switch (toto_mtd->size) {
-       case SZ_64M:
-               add_mtd_partitions(toto_mtd, partition_info64M, NUM_PARTITIONS64M);
-               break;
-       case SZ_32M:
-               add_mtd_partitions(toto_mtd, partition_info32M, NUM_PARTITIONS32M);
-               break;
-       default:{
-                       printk(KERN_WARNING "Unsupported Nand device\n");
+       switch(toto_mtd->size){
+               case SZ_64M: add_mtd_partitions(toto_mtd, partition_info64M, NUM_PARTITIONS64M); break;
+               case SZ_32M: add_mtd_partitions(toto_mtd, partition_info32M, NUM_PARTITIONS32M); break;
+               default: {
+                       printk (KERN_WARNING "Unsupported Nand device\n");
                        err = -ENXIO;
                        goto out_buf;
                }
        }
 
-       gpioreserve(NAND_MASK); /* claim our gpios */
-       archflashwp(0, 0);      /* open up flash for writing */
+       gpioreserve(NAND_MASK);  /* claim our gpios */
+       archflashwp(0,0);        /* open up flash for writing */
 
        goto out;
 
- out_mtd:
-       kfree(toto_mtd);
- out:
+out_buf:
+       kfree (this->data_buf);
+out_mtd:
+       kfree (toto_mtd);
+out:
        return err;
 }
 
@@ -186,21 +184,20 @@ module_init(toto_init);
 /*
  * Clean up routine
  */
-static void __exit toto_cleanup(void)
+static void __exit toto_cleanup (void)
 {
        /* Release resources, unregister device */
-       nand_release(toto_mtd);
+       nand_release (toto_mtd);
 
        /* Free the MTD device structure */
-       kfree(toto_mtd);
+       kfree (toto_mtd);
 
        /* stop flash writes */
-       archflashwp(0, 1);
+        archflashwp(0,1);
 
        /* release gpios to system */
-       gpiorelease(NAND_MASK);
+        gpiorelease(NAND_MASK);
 }
-
 module_exit(toto_cleanup);
 
 MODULE_LICENSE("GPL");