in order to use env in the SPL (CONFIG_SPL_ENV_SUPPORT) nand_info,
mtd_block_isbad, and mtd_read must be available.

Signed-off-by: Tim Harvey <thar...@gateworks.com>
---
 drivers/mtd/nand/mxs_nand_spl.c | 112 ++++++++++++++++++++++------------------
 1 file changed, 61 insertions(+), 51 deletions(-)

diff --git a/drivers/mtd/nand/mxs_nand_spl.c b/drivers/mtd/nand/mxs_nand_spl.c
index 0e7c364..d9d1811 100644
--- a/drivers/mtd/nand/mxs_nand_spl.c
+++ b/drivers/mtd/nand/mxs_nand_spl.c
@@ -8,7 +8,7 @@
 #include <nand.h>
 #include <malloc.h>
 
-static nand_info_t mtd;
+nand_info_t nand_info[1];
 static struct nand_chip nand_chip;
 
 static void mxs_nand_command(struct mtd_info *mtd, unsigned int command,
@@ -123,14 +123,11 @@ static int mxs_read_page_ecc(struct mtd_info *mtd, void 
*buf, unsigned int page)
        return 0;
 }
 
-static int is_badblock(struct mtd_info *mtd, loff_t offs, int allowbbt)
+int mtd_block_isbad(struct mtd_info *mtd, loff_t offs)
 {
        register struct nand_chip *chip = mtd->priv;
-       unsigned int block = offs >> chip->phys_erase_shift;
        unsigned int page = offs >> chip->page_shift;
 
-       debug("%s offs=0x%08x block:%d page:%d\n", __func__, (int)offs, block,
-             page);
        chip->cmdfunc(mtd, NAND_CMD_READ0, mtd->writesize, page);
        memset(chip->oob_poi, 0, mtd->oobsize);
        chip->read_buf(mtd, chip->oob_poi, mtd->oobsize);
@@ -138,62 +135,34 @@ static int is_badblock(struct mtd_info *mtd, loff_t offs, 
int allowbbt)
        return chip->oob_poi[0] != 0xff;
 }
 
-/* setup mtd and nand structs and init mxs_nand driver */
-static int mxs_nand_init(void)
-{
-       /* return if already initalized */
-       if (nand_chip.numchips)
-               return 0;
-
-       /* init mxs nand driver */
-       board_nand_init(&nand_chip);
-       mtd.priv = &nand_chip;
-       /* set mtd functions */
-       nand_chip.cmdfunc = mxs_nand_command;
-       nand_chip.numchips = 1;
-
-       /* identify flash device */
-       puts("NAND : ");
-       if (mxs_flash_ident(&mtd)) {
-               printf("Failed to identify\n");
-               return -1;
-       }
-
-       /* allocate and initialize buffers */
-       nand_chip.buffers = memalign(ARCH_DMA_MINALIGN,
-                                    sizeof(*nand_chip.buffers));
-       nand_chip.oob_poi = nand_chip.buffers->databuf + mtd.writesize;
-       /* setup flash layout (does not scan as we override that) */
-       mtd.size = nand_chip.chipsize;
-       nand_chip.scan_bbt(&mtd);
-
-       printf("%llu MiB\n", (mtd.size / (1024 * 1024)));
-       return 0;
-}
-
-int nand_spl_load_image(uint32_t offs, unsigned int size, void *buf)
+int mtd_read(struct mtd_info *mtd, loff_t offs, size_t size, size_t *retlen,
+            uchar *buf)
 {
        struct nand_chip *chip;
        unsigned int page;
        unsigned int nand_page_per_block;
        unsigned int sz = 0;
+       nand_info_t *info = &nand_info[0];
 
-       if (mxs_nand_init())
-               return -ENODEV;
-       chip = mtd.priv;
+       chip = info->priv;
        page = offs >> chip->page_shift;
-       nand_page_per_block = mtd.erasesize / mtd.writesize;
+       nand_page_per_block = info->erasesize / info->writesize;
 
-       debug("%s offset:0x%08x len:%d page:%d\n", __func__, offs, size, page);
+       debug("%s offs:0x%08x len:0x%x page:%d\n", __func__, (int)offs, size,
+             page);
 
-       size = roundup(size, mtd.writesize);
+       size = roundup(size, info->writesize);
+       if (retlen)
+               *retlen = 0;
        while (sz < size) {
-               if (mxs_read_page_ecc(&mtd, buf, page) < 0)
+               if (mxs_read_page_ecc(info, buf, page) < 0)
                        return -1;
-               sz += mtd.writesize;
-               offs += mtd.writesize;
+               sz += info->writesize;
+               offs += info->writesize;
                page++;
-               buf += mtd.writesize;
+               buf += info->writesize;
+               if (retlen)
+                       *retlen += info->writesize;
 
                /*
                 * Check if we have crossed a block boundary, and if so
@@ -204,10 +173,10 @@ int nand_spl_load_image(uint32_t offs, unsigned int size, 
void *buf)
                         * Yes, new block. See if this block is good. If not,
                         * loop until we find a good block.
                         */
-                       while (is_badblock(&mtd, offs, 1)) {
+                       while (mtd_block_isbad(info, offs)) {
                                page = page + nand_page_per_block;
                                /* Check i we've reached the end of flash. */
-                               if (page >= mtd.size >> chip->page_shift)
+                               if (page >= info->size >> chip->page_shift)
                                        return -ENOMEM;
                        }
                }
@@ -216,6 +185,46 @@ int nand_spl_load_image(uint32_t offs, unsigned int size, 
void *buf)
        return 0;
 }
 
+/* setup mtd and nand structs and init mxs_nand driver */
+static int mxs_nand_init(void)
+{
+       nand_info_t *info = &nand_info[0];
+
+       /* return if already initalized */
+       if (nand_chip.numchips)
+               return 0;
+
+       /* init mxs nand driver */
+       board_nand_init(&nand_chip);
+       info->priv = &nand_chip;
+       /* set mtd functions */
+       nand_chip.cmdfunc = mxs_nand_command;
+       nand_chip.numchips = 1;
+
+       /* identify flash device */
+       puts("NAND : ");
+       if (mxs_flash_ident(info)) {
+               printf("Failed to identify\n");
+               return -1;
+       }
+
+       /* allocate and initialize buffers */
+       nand_chip.buffers = memalign(ARCH_DMA_MINALIGN,
+                                    sizeof(*nand_chip.buffers));
+       nand_chip.oob_poi = nand_chip.buffers->databuf + info->writesize;
+       /* setup flash layout (does not scan as we override that) */
+       info->size = nand_chip.chipsize;
+       nand_chip.scan_bbt(info);
+
+       printf("%llu MiB\n", (info->size / (1024 * 1024)));
+       return 0;
+}
+
+int nand_spl_load_image(uint32_t offs, unsigned int size, void *buf)
+{
+       return mtd_read(NULL, offs, size, NULL, buf);
+}
+
 int nand_default_bbt(struct mtd_info *mtd)
 {
        return 0;
@@ -223,6 +232,7 @@ int nand_default_bbt(struct mtd_info *mtd)
 
 void nand_init(void)
 {
+       mxs_nand_init();
 }
 
 void nand_deselect(void)
-- 
1.9.1

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to