[RFC][PATCH] NAND flash-unlock support in MTD

[RFC][PATCH] NAND flash-unlock support in MTD

[subbu31mani]

+#define NAND_CMD_UNLOCK1        0x23
+#define NAND_CMD_UNLOCK2        0x24
+/**
+ * @brief platform specific unlock function
+ *
+ * @param mtd - mtd info
+ * @param ofs - offset to start unlock from
+ * @param len - length to unlock
+ *
+ * @return - unlock status
+ */
+static int nand_unlock(struct mtd_info *mtd, loff_t ofs, size_t len)
+{
+        int ret = 0;
+        int chipnr;
+        int status;
+        unsigned long page;
+        struct nand_chip *this = mtd->priv;
+        printk(KERN_INFO "nand_unlock: start: %08x, length: %d!\n",
+                        (int)ofs, (int)len);
+
+        /* select the NAND device */
+        chipnr = (int)(ofs >> this->chip_shift);
+        this->select_chip(mtd, chipnr);
+        /* check the WP bit */
+        this->cmdfunc(mtd, NAND_CMD_STATUS, -1, -1);
+        if ((this->read_byte(mtd) & 0x80) == 0) {
+                printk(KERN_ERR "nand_unlock: Device is write protected!\n");
+                ret = -EINVAL;
+                goto out;
+        }
+
+        if ((ofs & (mtd->writesize - 1)) != 0) {
+                printk(KERN_ERR "nand_unlock: Start address must be"
+                                "beginning of nand page!\n");
+                ret = -EINVAL;
+                goto out;
+        }
+
+        if (len == 0 || (len & (mtd->writesize - 1)) != 0) {
+                printk(KERN_ERR "nand_unlock: Length must be a multiple of "
+                                "nand page size!\n");
+                ret = -EINVAL;
+                goto out;
+        }
+
+        /* submit address of first page to unlock */
+        page = (unsigned long)(ofs >> this->page_shift);
+        this->cmdfunc(mtd, NAND_CMD_UNLOCK1, -1, page & this->pagemask);
+
+        /* submit ADDRESS of LAST page to unlock */
+        page += (unsigned long)((ofs + len) >> this->page_shift) ;
+        this->cmdfunc(mtd, NAND_CMD_UNLOCK2, -1, page & this->pagemask);
+
+        /* call wait ready function */
+        status = this->waitfunc(mtd, this);
+        udelay(1000);
+        /* see if device thinks it succeeded */
+        if (status & 0x01) {
+                /* there was an error */
+                printk(KERN_ERR "nand_unlock: error status =0x%08x ", status);
+                ret = -EIO;
+                goto out;
+        }
+
+ out:
+        /* de-select the NAND device */
+        this->select_chip(mtd, -1);
+        return ret;
+}
+
+
 /**
  * single_erease_cmd - [GENERIC] NAND standard block erase command function
  * @mtd:	MTD device structure
@@ -2794,7 +2866,7 @@ int nand_scan_tail(struct mtd_info *mtd)
 	mtd->write_oob = nand_write_oob;
 	mtd->sync = nand_sync;
 	mtd->lock = NULL;
-	mtd->unlock = NULL;
+	mtd->unlock = nand_unlock;
 	mtd->suspend = nand_suspend;
 	mtd->resume = nand_resume;
 	mtd->block_isbad = nand_block_isbad;