Skip to contentSkip to conversation

NAND flash-unlock support in MTD

RFC PATCH New [email protected] 1 participant 1 message Mar 31, 2009 Memory technology devices (MTD)

lore
Share & tools
lore
#0 lore raw

RFC PATCH 1/1 NAND flash-unlock support in MTD

+#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;