c5819701a3
At present this function does not accept a size for the FIT. This means that it must be read from the FIT itself, introducing potential security risk. Update the function to include a size parameter, which can be invalid, in which case fit_check_format() calculates it. For now no callers pass the size, but this can be updated later. Also adjust the return value to an error code so that all the different types of problems can be distinguished by the user. Signed-off-by: Simon Glass <sjg@chromium.org> Reported-by: Bruce Monroe <bruce.monroe@intel.com> Reported-by: Arie Haenel <arie.haenel@intel.com> Reported-by: Julien Lenoir <julien.lenoir@intel.com>
1023 lines
24 KiB
C
1023 lines
24 KiB
C
/*
|
|
* Driver for NAND support, Rick Bronson
|
|
* borrowed heavily from:
|
|
* (c) 1999 Machine Vision Holdings, Inc.
|
|
* (c) 1999, 2000 David Woodhouse <dwmw2@infradead.org>
|
|
*
|
|
* Ported 'dynenv' to 'nand env.oob' command
|
|
* (C) 2010 Nanometrics, Inc.
|
|
* 'dynenv' -- Dynamic environment offset in NAND OOB
|
|
* (C) Copyright 2006-2007 OpenMoko, Inc.
|
|
* Added 16-bit nand support
|
|
* (C) 2004 Texas Instruments
|
|
*
|
|
* Copyright 2010, 2012 Freescale Semiconductor
|
|
* The portions of this file whose copyright is held by Freescale and which
|
|
* are not considered a derived work of GPL v2-only code may be distributed
|
|
* and/or modified under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of the
|
|
* License, or (at your option) any later version.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <bootstage.h>
|
|
#include <image.h>
|
|
#include <asm/cache.h>
|
|
#include <linux/mtd/mtd.h>
|
|
#include <command.h>
|
|
#include <console.h>
|
|
#include <env.h>
|
|
#include <watchdog.h>
|
|
#include <malloc.h>
|
|
#include <asm/byteorder.h>
|
|
#include <jffs2/jffs2.h>
|
|
#include <nand.h>
|
|
|
|
#include "legacy-mtd-utils.h"
|
|
|
|
#if defined(CONFIG_CMD_MTDPARTS)
|
|
|
|
/* partition handling routines */
|
|
int mtdparts_init(void);
|
|
int find_dev_and_part(const char *id, struct mtd_device **dev,
|
|
u8 *part_num, struct part_info **part);
|
|
#endif
|
|
|
|
static int nand_dump(struct mtd_info *mtd, ulong off, int only_oob,
|
|
int repeat)
|
|
{
|
|
int i;
|
|
u_char *datbuf, *oobbuf, *p;
|
|
static loff_t last;
|
|
int ret = 0;
|
|
|
|
if (repeat)
|
|
off = last + mtd->writesize;
|
|
|
|
last = off;
|
|
|
|
datbuf = memalign(ARCH_DMA_MINALIGN, mtd->writesize);
|
|
if (!datbuf) {
|
|
puts("No memory for page buffer\n");
|
|
return 1;
|
|
}
|
|
|
|
oobbuf = memalign(ARCH_DMA_MINALIGN, mtd->oobsize);
|
|
if (!oobbuf) {
|
|
puts("No memory for page buffer\n");
|
|
ret = 1;
|
|
goto free_dat;
|
|
}
|
|
off &= ~(mtd->writesize - 1);
|
|
loff_t addr = (loff_t) off;
|
|
struct mtd_oob_ops ops;
|
|
memset(&ops, 0, sizeof(ops));
|
|
ops.datbuf = datbuf;
|
|
ops.oobbuf = oobbuf;
|
|
ops.len = mtd->writesize;
|
|
ops.ooblen = mtd->oobsize;
|
|
ops.mode = MTD_OPS_RAW;
|
|
i = mtd_read_oob(mtd, addr, &ops);
|
|
if (i < 0) {
|
|
printf("Error (%d) reading page %08lx\n", i, off);
|
|
ret = 1;
|
|
goto free_all;
|
|
}
|
|
printf("Page %08lx dump:\n", off);
|
|
|
|
if (!only_oob) {
|
|
i = mtd->writesize >> 4;
|
|
p = datbuf;
|
|
|
|
while (i--) {
|
|
printf("\t%02x %02x %02x %02x %02x %02x %02x %02x"
|
|
" %02x %02x %02x %02x %02x %02x %02x %02x\n",
|
|
p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7],
|
|
p[8], p[9], p[10], p[11], p[12], p[13], p[14],
|
|
p[15]);
|
|
p += 16;
|
|
}
|
|
}
|
|
|
|
puts("OOB:\n");
|
|
i = mtd->oobsize >> 3;
|
|
p = oobbuf;
|
|
while (i--) {
|
|
printf("\t%02x %02x %02x %02x %02x %02x %02x %02x\n",
|
|
p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7]);
|
|
p += 8;
|
|
}
|
|
|
|
free_all:
|
|
free(oobbuf);
|
|
free_dat:
|
|
free(datbuf);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
static int set_dev(int dev)
|
|
{
|
|
struct mtd_info *mtd = get_nand_dev_by_index(dev);
|
|
|
|
if (!mtd)
|
|
return -ENODEV;
|
|
|
|
if (nand_curr_device == dev)
|
|
return 0;
|
|
|
|
printf("Device %d: %s", dev, mtd->name);
|
|
puts("... is now current device\n");
|
|
nand_curr_device = dev;
|
|
|
|
#ifdef CONFIG_SYS_NAND_SELECT_DEVICE
|
|
board_nand_select_device(mtd_to_nand(mtd), dev);
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_CMD_NAND_LOCK_UNLOCK
|
|
static void print_status(ulong start, ulong end, ulong erasesize, int status)
|
|
{
|
|
/*
|
|
* Micron NAND flash (e.g. MT29F4G08ABADAH4) BLOCK LOCK READ STATUS is
|
|
* not the same as others. Instead of bit 1 being lock, it is
|
|
* #lock_tight. To make the driver support either format, ignore bit 1
|
|
* and use only bit 0 and bit 2.
|
|
*/
|
|
printf("%08lx - %08lx: %08lx blocks %s%s%s\n",
|
|
start,
|
|
end - 1,
|
|
(end - start) / erasesize,
|
|
((status & NAND_LOCK_STATUS_TIGHT) ? "TIGHT " : ""),
|
|
(!(status & NAND_LOCK_STATUS_UNLOCK) ? "LOCK " : ""),
|
|
((status & NAND_LOCK_STATUS_UNLOCK) ? "UNLOCK " : ""));
|
|
}
|
|
|
|
static void do_nand_status(struct mtd_info *mtd)
|
|
{
|
|
ulong block_start = 0;
|
|
ulong off;
|
|
int last_status = -1;
|
|
|
|
struct nand_chip *nand_chip = mtd_to_nand(mtd);
|
|
/* check the WP bit */
|
|
nand_chip->cmdfunc(mtd, NAND_CMD_STATUS, -1, -1);
|
|
printf("device is %swrite protected\n",
|
|
(nand_chip->read_byte(mtd) & 0x80 ?
|
|
"NOT " : ""));
|
|
|
|
for (off = 0; off < mtd->size; off += mtd->erasesize) {
|
|
int s = nand_get_lock_status(mtd, off);
|
|
|
|
/* print message only if status has changed */
|
|
if (s != last_status && off != 0) {
|
|
print_status(block_start, off, mtd->erasesize,
|
|
last_status);
|
|
block_start = off;
|
|
}
|
|
last_status = s;
|
|
}
|
|
/* Print the last block info */
|
|
print_status(block_start, off, mtd->erasesize, last_status);
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_ENV_OFFSET_OOB
|
|
unsigned long nand_env_oob_offset;
|
|
|
|
int do_nand_env_oob(struct cmd_tbl *cmdtp, int argc, char *const argv[])
|
|
{
|
|
int ret;
|
|
uint32_t oob_buf[ENV_OFFSET_SIZE/sizeof(uint32_t)];
|
|
struct mtd_info *mtd = get_nand_dev_by_index(0);
|
|
char *cmd = argv[1];
|
|
|
|
if (CONFIG_SYS_MAX_NAND_DEVICE == 0 || !mtd) {
|
|
puts("no devices available\n");
|
|
return 1;
|
|
}
|
|
|
|
set_dev(0);
|
|
|
|
if (!strcmp(cmd, "get")) {
|
|
ret = get_nand_env_oob(mtd, &nand_env_oob_offset);
|
|
if (ret)
|
|
return 1;
|
|
|
|
printf("0x%08lx\n", nand_env_oob_offset);
|
|
} else if (!strcmp(cmd, "set")) {
|
|
loff_t addr;
|
|
loff_t maxsize;
|
|
struct mtd_oob_ops ops;
|
|
int idx = 0;
|
|
|
|
if (argc < 3)
|
|
goto usage;
|
|
|
|
mtd = get_nand_dev_by_index(idx);
|
|
/* We don't care about size, or maxsize. */
|
|
if (mtd_arg_off(argv[2], &idx, &addr, &maxsize, &maxsize,
|
|
MTD_DEV_TYPE_NAND, mtd->size)) {
|
|
puts("Offset or partition name expected\n");
|
|
return 1;
|
|
}
|
|
if (set_dev(idx)) {
|
|
puts("Offset or partition name expected\n");
|
|
return 1;
|
|
}
|
|
|
|
if (idx != 0) {
|
|
puts("Partition not on first NAND device\n");
|
|
return 1;
|
|
}
|
|
|
|
if (mtd->oobavail < ENV_OFFSET_SIZE) {
|
|
printf("Insufficient available OOB bytes:\n"
|
|
"%d OOB bytes available but %d required for "
|
|
"env.oob support\n",
|
|
mtd->oobavail, ENV_OFFSET_SIZE);
|
|
return 1;
|
|
}
|
|
|
|
if ((addr & (mtd->erasesize - 1)) != 0) {
|
|
printf("Environment offset must be block-aligned\n");
|
|
return 1;
|
|
}
|
|
|
|
ops.datbuf = NULL;
|
|
ops.mode = MTD_OOB_AUTO;
|
|
ops.ooboffs = 0;
|
|
ops.ooblen = ENV_OFFSET_SIZE;
|
|
ops.oobbuf = (void *) oob_buf;
|
|
|
|
oob_buf[0] = ENV_OOB_MARKER;
|
|
oob_buf[1] = addr / mtd->erasesize;
|
|
|
|
ret = mtd->write_oob(mtd, ENV_OFFSET_SIZE, &ops);
|
|
if (ret) {
|
|
printf("Error writing OOB block 0\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = get_nand_env_oob(mtd, &nand_env_oob_offset);
|
|
if (ret) {
|
|
printf("Error reading env offset in OOB\n");
|
|
return ret;
|
|
}
|
|
|
|
if (addr != nand_env_oob_offset) {
|
|
printf("Verification of env offset in OOB failed: "
|
|
"0x%08llx expected but got 0x%08lx\n",
|
|
(unsigned long long)addr, nand_env_oob_offset);
|
|
return 1;
|
|
}
|
|
} else {
|
|
goto usage;
|
|
}
|
|
|
|
return ret;
|
|
|
|
usage:
|
|
return CMD_RET_USAGE;
|
|
}
|
|
|
|
#endif
|
|
|
|
static void nand_print_and_set_info(int idx)
|
|
{
|
|
struct mtd_info *mtd;
|
|
struct nand_chip *chip;
|
|
|
|
mtd = get_nand_dev_by_index(idx);
|
|
if (!mtd)
|
|
return;
|
|
|
|
chip = mtd_to_nand(mtd);
|
|
printf("Device %d: ", idx);
|
|
if (chip->numchips > 1)
|
|
printf("%dx ", chip->numchips);
|
|
printf("%s, sector size %u KiB\n",
|
|
mtd->name, mtd->erasesize >> 10);
|
|
printf(" Page size %8d b\n", mtd->writesize);
|
|
printf(" OOB size %8d b\n", mtd->oobsize);
|
|
printf(" Erase size %8d b\n", mtd->erasesize);
|
|
printf(" subpagesize %8d b\n", chip->subpagesize);
|
|
printf(" options 0x%08x\n", chip->options);
|
|
printf(" bbt options 0x%08x\n", chip->bbt_options);
|
|
|
|
/* Set geometry info */
|
|
env_set_hex("nand_writesize", mtd->writesize);
|
|
env_set_hex("nand_oobsize", mtd->oobsize);
|
|
env_set_hex("nand_erasesize", mtd->erasesize);
|
|
}
|
|
|
|
static int raw_access(struct mtd_info *mtd, ulong addr, loff_t off,
|
|
ulong count, int read, int no_verify)
|
|
{
|
|
int ret = 0;
|
|
|
|
while (count--) {
|
|
/* Raw access */
|
|
mtd_oob_ops_t ops = {
|
|
.datbuf = (u8 *)addr,
|
|
.oobbuf = ((u8 *)addr) + mtd->writesize,
|
|
.len = mtd->writesize,
|
|
.ooblen = mtd->oobsize,
|
|
.mode = MTD_OPS_RAW
|
|
};
|
|
|
|
if (read) {
|
|
ret = mtd_read_oob(mtd, off, &ops);
|
|
} else {
|
|
ret = mtd_write_oob(mtd, off, &ops);
|
|
if (!ret && !no_verify)
|
|
ret = nand_verify_page_oob(mtd, &ops, off);
|
|
}
|
|
|
|
if (ret) {
|
|
printf("%s: error at offset %llx, ret %d\n",
|
|
__func__, (long long)off, ret);
|
|
break;
|
|
}
|
|
|
|
addr += mtd->writesize + mtd->oobsize;
|
|
off += mtd->writesize;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* Adjust a chip/partition size down for bad blocks so we don't
|
|
* read/write past the end of a chip/partition by accident.
|
|
*/
|
|
static void adjust_size_for_badblocks(loff_t *size, loff_t offset, int dev)
|
|
{
|
|
/* We grab the nand info object here fresh because this is usually
|
|
* called after arg_off_size() which can change the value of dev.
|
|
*/
|
|
struct mtd_info *mtd = get_nand_dev_by_index(dev);
|
|
loff_t maxoffset = offset + *size;
|
|
int badblocks = 0;
|
|
|
|
/* count badblocks in NAND from offset to offset + size */
|
|
for (; offset < maxoffset; offset += mtd->erasesize) {
|
|
if (nand_block_isbad(mtd, offset))
|
|
badblocks++;
|
|
}
|
|
/* adjust size if any bad blocks found */
|
|
if (badblocks) {
|
|
*size -= badblocks * mtd->erasesize;
|
|
printf("size adjusted to 0x%llx (%d bad blocks)\n",
|
|
(unsigned long long)*size, badblocks);
|
|
}
|
|
}
|
|
|
|
static int do_nand(struct cmd_tbl *cmdtp, int flag, int argc,
|
|
char *const argv[])
|
|
{
|
|
int i, ret = 0;
|
|
ulong addr;
|
|
loff_t off, size, maxsize;
|
|
char *cmd, *s;
|
|
struct mtd_info *mtd;
|
|
#ifdef CONFIG_SYS_NAND_QUIET
|
|
int quiet = CONFIG_SYS_NAND_QUIET;
|
|
#else
|
|
int quiet = 0;
|
|
#endif
|
|
const char *quiet_str = env_get("quiet");
|
|
int dev = nand_curr_device;
|
|
int repeat = flag & CMD_FLAG_REPEAT;
|
|
|
|
/* at least two arguments please */
|
|
if (argc < 2)
|
|
goto usage;
|
|
|
|
if (quiet_str)
|
|
quiet = simple_strtoul(quiet_str, NULL, 0) != 0;
|
|
|
|
cmd = argv[1];
|
|
|
|
/* Only "dump" is repeatable. */
|
|
if (repeat && strcmp(cmd, "dump"))
|
|
return 0;
|
|
|
|
if (strcmp(cmd, "info") == 0) {
|
|
|
|
putc('\n');
|
|
for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++)
|
|
nand_print_and_set_info(i);
|
|
return 0;
|
|
}
|
|
|
|
if (strcmp(cmd, "device") == 0) {
|
|
if (argc < 3) {
|
|
putc('\n');
|
|
if (dev < 0 || dev >= CONFIG_SYS_MAX_NAND_DEVICE)
|
|
puts("no devices available\n");
|
|
else
|
|
nand_print_and_set_info(dev);
|
|
return 0;
|
|
}
|
|
|
|
dev = (int)simple_strtoul(argv[2], NULL, 10);
|
|
set_dev(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_ENV_OFFSET_OOB
|
|
/* this command operates only on the first nand device */
|
|
if (strcmp(cmd, "env.oob") == 0)
|
|
return do_nand_env_oob(cmdtp, argc - 1, argv + 1);
|
|
#endif
|
|
|
|
/* The following commands operate on the current device, unless
|
|
* overridden by a partition specifier. Note that if somehow the
|
|
* current device is invalid, it will have to be changed to a valid
|
|
* one before these commands can run, even if a partition specifier
|
|
* for another device is to be used.
|
|
*/
|
|
mtd = get_nand_dev_by_index(dev);
|
|
if (!mtd) {
|
|
puts("\nno devices available\n");
|
|
return 1;
|
|
}
|
|
|
|
if (strcmp(cmd, "bad") == 0) {
|
|
printf("\nDevice %d bad blocks:\n", dev);
|
|
for (off = 0; off < mtd->size; off += mtd->erasesize)
|
|
if (nand_block_isbad(mtd, off))
|
|
printf(" %08llx\n", (unsigned long long)off);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Syntax is:
|
|
* 0 1 2 3 4
|
|
* nand erase [clean] [off size]
|
|
*/
|
|
if (strncmp(cmd, "erase", 5) == 0 || strncmp(cmd, "scrub", 5) == 0) {
|
|
nand_erase_options_t opts;
|
|
/* "clean" at index 2 means request to write cleanmarker */
|
|
int clean = argc > 2 && !strcmp("clean", argv[2]);
|
|
int scrub_yes = argc > 2 && !strcmp("-y", argv[2]);
|
|
int o = (clean || scrub_yes) ? 3 : 2;
|
|
int scrub = !strncmp(cmd, "scrub", 5);
|
|
int spread = 0;
|
|
int args = 2;
|
|
const char *scrub_warn =
|
|
"Warning: "
|
|
"scrub option will erase all factory set bad blocks!\n"
|
|
" "
|
|
"There is no reliable way to recover them.\n"
|
|
" "
|
|
"Use this command only for testing purposes if you\n"
|
|
" "
|
|
"are sure of what you are doing!\n"
|
|
"\nReally scrub this NAND flash? <y/N>\n";
|
|
|
|
if (cmd[5] != 0) {
|
|
if (!strcmp(&cmd[5], ".spread")) {
|
|
spread = 1;
|
|
} else if (!strcmp(&cmd[5], ".part")) {
|
|
args = 1;
|
|
} else if (!strcmp(&cmd[5], ".chip")) {
|
|
args = 0;
|
|
} else {
|
|
goto usage;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Don't allow missing arguments to cause full chip/partition
|
|
* erases -- easy to do accidentally, e.g. with a misspelled
|
|
* variable name.
|
|
*/
|
|
if (argc != o + args)
|
|
goto usage;
|
|
|
|
printf("\nNAND %s: ", cmd);
|
|
/* skip first two or three arguments, look for offset and size */
|
|
if (mtd_arg_off_size(argc - o, argv + o, &dev, &off, &size,
|
|
&maxsize, MTD_DEV_TYPE_NAND,
|
|
mtd->size) != 0)
|
|
return 1;
|
|
|
|
if (set_dev(dev))
|
|
return 1;
|
|
|
|
mtd = get_nand_dev_by_index(dev);
|
|
|
|
memset(&opts, 0, sizeof(opts));
|
|
opts.offset = off;
|
|
opts.length = size;
|
|
opts.jffs2 = clean;
|
|
opts.quiet = quiet;
|
|
opts.spread = spread;
|
|
|
|
if (scrub) {
|
|
if (scrub_yes) {
|
|
opts.scrub = 1;
|
|
} else {
|
|
puts(scrub_warn);
|
|
if (confirm_yesno()) {
|
|
opts.scrub = 1;
|
|
} else {
|
|
puts("scrub aborted\n");
|
|
return 1;
|
|
}
|
|
}
|
|
}
|
|
ret = nand_erase_opts(mtd, &opts);
|
|
printf("%s\n", ret ? "ERROR" : "OK");
|
|
|
|
return ret == 0 ? 0 : 1;
|
|
}
|
|
|
|
if (strncmp(cmd, "dump", 4) == 0) {
|
|
if (argc < 3)
|
|
goto usage;
|
|
|
|
off = (int)simple_strtoul(argv[2], NULL, 16);
|
|
ret = nand_dump(mtd, off, !strcmp(&cmd[4], ".oob"), repeat);
|
|
|
|
return ret == 0 ? 1 : 0;
|
|
}
|
|
|
|
if (strncmp(cmd, "read", 4) == 0 || strncmp(cmd, "write", 5) == 0) {
|
|
size_t rwsize;
|
|
ulong pagecount = 1;
|
|
int read;
|
|
int raw = 0;
|
|
int no_verify = 0;
|
|
|
|
if (argc < 4)
|
|
goto usage;
|
|
|
|
addr = (ulong)simple_strtoul(argv[2], NULL, 16);
|
|
|
|
read = strncmp(cmd, "read", 4) == 0; /* 1 = read, 0 = write */
|
|
printf("\nNAND %s: ", read ? "read" : "write");
|
|
|
|
s = strchr(cmd, '.');
|
|
|
|
if (s && !strncmp(s, ".raw", 4)) {
|
|
raw = 1;
|
|
|
|
if (!strcmp(s, ".raw.noverify"))
|
|
no_verify = 1;
|
|
|
|
if (mtd_arg_off(argv[3], &dev, &off, &size, &maxsize,
|
|
MTD_DEV_TYPE_NAND,
|
|
mtd->size))
|
|
return 1;
|
|
|
|
if (set_dev(dev))
|
|
return 1;
|
|
|
|
mtd = get_nand_dev_by_index(dev);
|
|
|
|
if (argc > 4 && !str2long(argv[4], &pagecount)) {
|
|
printf("'%s' is not a number\n", argv[4]);
|
|
return 1;
|
|
}
|
|
|
|
if (pagecount * mtd->writesize > size) {
|
|
puts("Size exceeds partition or device limit\n");
|
|
return -1;
|
|
}
|
|
|
|
rwsize = pagecount * (mtd->writesize + mtd->oobsize);
|
|
} else {
|
|
if (mtd_arg_off_size(argc - 3, argv + 3, &dev, &off,
|
|
&size, &maxsize,
|
|
MTD_DEV_TYPE_NAND,
|
|
mtd->size) != 0)
|
|
return 1;
|
|
|
|
if (set_dev(dev))
|
|
return 1;
|
|
|
|
/* size is unspecified */
|
|
if (argc < 5)
|
|
adjust_size_for_badblocks(&size, off, dev);
|
|
rwsize = size;
|
|
}
|
|
|
|
mtd = get_nand_dev_by_index(dev);
|
|
|
|
if (!s || !strcmp(s, ".jffs2") ||
|
|
!strcmp(s, ".e") || !strcmp(s, ".i")) {
|
|
if (read)
|
|
ret = nand_read_skip_bad(mtd, off, &rwsize,
|
|
NULL, maxsize,
|
|
(u_char *)addr);
|
|
else
|
|
ret = nand_write_skip_bad(mtd, off, &rwsize,
|
|
NULL, maxsize,
|
|
(u_char *)addr,
|
|
WITH_WR_VERIFY);
|
|
#ifdef CONFIG_CMD_NAND_TRIMFFS
|
|
} else if (!strcmp(s, ".trimffs")) {
|
|
if (read) {
|
|
printf("Unknown nand command suffix '%s'\n", s);
|
|
return 1;
|
|
}
|
|
ret = nand_write_skip_bad(mtd, off, &rwsize, NULL,
|
|
maxsize, (u_char *)addr,
|
|
WITH_DROP_FFS | WITH_WR_VERIFY);
|
|
#endif
|
|
} else if (!strcmp(s, ".oob")) {
|
|
/* out-of-band data */
|
|
mtd_oob_ops_t ops = {
|
|
.oobbuf = (u8 *)addr,
|
|
.ooblen = rwsize,
|
|
.mode = MTD_OPS_RAW
|
|
};
|
|
|
|
if (read)
|
|
ret = mtd_read_oob(mtd, off, &ops);
|
|
else
|
|
ret = mtd_write_oob(mtd, off, &ops);
|
|
} else if (raw) {
|
|
ret = raw_access(mtd, addr, off, pagecount, read,
|
|
no_verify);
|
|
} else {
|
|
printf("Unknown nand command suffix '%s'.\n", s);
|
|
return 1;
|
|
}
|
|
|
|
printf(" %zu bytes %s: %s\n", rwsize,
|
|
read ? "read" : "written", ret ? "ERROR" : "OK");
|
|
|
|
return ret == 0 ? 0 : 1;
|
|
}
|
|
|
|
#ifdef CONFIG_CMD_NAND_TORTURE
|
|
if (strcmp(cmd, "torture") == 0) {
|
|
loff_t endoff;
|
|
unsigned int failed = 0, passed = 0;
|
|
|
|
if (argc < 3)
|
|
goto usage;
|
|
|
|
if (!str2off(argv[2], &off)) {
|
|
puts("Offset is not a valid number\n");
|
|
return 1;
|
|
}
|
|
|
|
size = mtd->erasesize;
|
|
if (argc > 3) {
|
|
if (!str2off(argv[3], &size)) {
|
|
puts("Size is not a valid number\n");
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
endoff = off + size;
|
|
if (endoff > mtd->size) {
|
|
puts("Arguments beyond end of NAND\n");
|
|
return 1;
|
|
}
|
|
|
|
off = round_down(off, mtd->erasesize);
|
|
endoff = round_up(endoff, mtd->erasesize);
|
|
size = endoff - off;
|
|
printf("\nNAND torture: device %d offset 0x%llx size 0x%llx (block size 0x%x)\n",
|
|
dev, off, size, mtd->erasesize);
|
|
while (off < endoff) {
|
|
ret = nand_torture(mtd, off);
|
|
if (ret) {
|
|
failed++;
|
|
printf(" block at 0x%llx failed\n", off);
|
|
} else {
|
|
passed++;
|
|
}
|
|
off += mtd->erasesize;
|
|
}
|
|
printf(" Passed: %u, failed: %u\n", passed, failed);
|
|
return failed != 0;
|
|
}
|
|
#endif
|
|
|
|
if (strcmp(cmd, "markbad") == 0) {
|
|
argc -= 2;
|
|
argv += 2;
|
|
|
|
if (argc <= 0)
|
|
goto usage;
|
|
|
|
while (argc > 0) {
|
|
addr = simple_strtoul(*argv, NULL, 16);
|
|
|
|
if (mtd_block_markbad(mtd, addr)) {
|
|
printf("block 0x%08lx NOT marked "
|
|
"as bad! ERROR %d\n",
|
|
addr, ret);
|
|
ret = 1;
|
|
} else {
|
|
printf("block 0x%08lx successfully "
|
|
"marked as bad\n",
|
|
addr);
|
|
}
|
|
--argc;
|
|
++argv;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
if (strcmp(cmd, "biterr") == 0) {
|
|
/* todo */
|
|
return 1;
|
|
}
|
|
|
|
#ifdef CONFIG_CMD_NAND_LOCK_UNLOCK
|
|
if (strcmp(cmd, "lock") == 0) {
|
|
int tight = 0;
|
|
int status = 0;
|
|
if (argc == 3) {
|
|
if (!strcmp("tight", argv[2]))
|
|
tight = 1;
|
|
if (!strcmp("status", argv[2]))
|
|
status = 1;
|
|
}
|
|
if (status) {
|
|
do_nand_status(mtd);
|
|
} else {
|
|
if (!nand_lock(mtd, tight)) {
|
|
puts("NAND flash successfully locked\n");
|
|
} else {
|
|
puts("Error locking NAND flash\n");
|
|
return 1;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
if (strncmp(cmd, "unlock", 5) == 0) {
|
|
int allexcept = 0;
|
|
|
|
s = strchr(cmd, '.');
|
|
|
|
if (s && !strcmp(s, ".allexcept"))
|
|
allexcept = 1;
|
|
|
|
if (mtd_arg_off_size(argc - 2, argv + 2, &dev, &off, &size,
|
|
&maxsize, MTD_DEV_TYPE_NAND,
|
|
mtd->size) < 0)
|
|
return 1;
|
|
|
|
if (set_dev(dev))
|
|
return 1;
|
|
|
|
mtd = get_nand_dev_by_index(dev);
|
|
|
|
if (!nand_unlock(mtd, off, size, allexcept)) {
|
|
puts("NAND flash successfully unlocked\n");
|
|
} else {
|
|
puts("Error unlocking NAND flash, "
|
|
"write and erase will probably fail\n");
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
usage:
|
|
return CMD_RET_USAGE;
|
|
}
|
|
|
|
#ifdef CONFIG_SYS_LONGHELP
|
|
static char nand_help_text[] =
|
|
"info - show available NAND devices\n"
|
|
"nand device [dev] - show or set current device\n"
|
|
"nand read - addr off|partition size\n"
|
|
"nand write - addr off|partition size\n"
|
|
" read/write 'size' bytes starting at offset 'off'\n"
|
|
" to/from memory address 'addr', skipping bad blocks.\n"
|
|
"nand read.raw - addr off|partition [count]\n"
|
|
"nand write.raw[.noverify] - addr off|partition [count]\n"
|
|
" Use read.raw/write.raw to avoid ECC and access the flash as-is.\n"
|
|
#ifdef CONFIG_CMD_NAND_TRIMFFS
|
|
"nand write.trimffs - addr off|partition size\n"
|
|
" write 'size' bytes starting at offset 'off' from memory address\n"
|
|
" 'addr', skipping bad blocks and dropping any pages at the end\n"
|
|
" of eraseblocks that contain only 0xFF\n"
|
|
#endif
|
|
"nand erase[.spread] [clean] off size - erase 'size' bytes "
|
|
"from offset 'off'\n"
|
|
" With '.spread', erase enough for given file size, otherwise,\n"
|
|
" 'size' includes skipped bad blocks.\n"
|
|
"nand erase.part [clean] partition - erase entire mtd partition'\n"
|
|
"nand erase.chip [clean] - erase entire chip'\n"
|
|
"nand bad - show bad blocks\n"
|
|
"nand dump[.oob] off - dump page\n"
|
|
#ifdef CONFIG_CMD_NAND_TORTURE
|
|
"nand torture off - torture one block at offset\n"
|
|
"nand torture off [size] - torture blocks from off to off+size\n"
|
|
#endif
|
|
"nand scrub [-y] off size | scrub.part partition | scrub.chip\n"
|
|
" really clean NAND erasing bad blocks (UNSAFE)\n"
|
|
"nand markbad off [...] - mark bad block(s) at offset (UNSAFE)\n"
|
|
"nand biterr off - make a bit error at offset (UNSAFE)"
|
|
#ifdef CONFIG_CMD_NAND_LOCK_UNLOCK
|
|
"\n"
|
|
"nand lock [tight] [status]\n"
|
|
" bring nand to lock state or display locked pages\n"
|
|
"nand unlock[.allexcept] [offset] [size] - unlock section"
|
|
#endif
|
|
#ifdef CONFIG_ENV_OFFSET_OOB
|
|
"\n"
|
|
"nand env.oob - environment offset in OOB of block 0 of"
|
|
" first device.\n"
|
|
"nand env.oob set off|partition - set enviromnent offset\n"
|
|
"nand env.oob get - get environment offset"
|
|
#endif
|
|
"";
|
|
#endif
|
|
|
|
U_BOOT_CMD(
|
|
nand, CONFIG_SYS_MAXARGS, 1, do_nand,
|
|
"NAND sub-system", nand_help_text
|
|
);
|
|
|
|
static int nand_load_image(struct cmd_tbl *cmdtp, struct mtd_info *mtd,
|
|
ulong offset, ulong addr, char *cmd)
|
|
{
|
|
int r;
|
|
char *s;
|
|
size_t cnt;
|
|
#if defined(CONFIG_LEGACY_IMAGE_FORMAT)
|
|
image_header_t *hdr;
|
|
#endif
|
|
#if defined(CONFIG_FIT)
|
|
const void *fit_hdr = NULL;
|
|
#endif
|
|
|
|
s = strchr(cmd, '.');
|
|
if (s != NULL &&
|
|
(strcmp(s, ".jffs2") && strcmp(s, ".e") && strcmp(s, ".i"))) {
|
|
printf("Unknown nand load suffix '%s'\n", s);
|
|
bootstage_error(BOOTSTAGE_ID_NAND_SUFFIX);
|
|
return 1;
|
|
}
|
|
|
|
printf("\nLoading from %s, offset 0x%lx\n", mtd->name, offset);
|
|
|
|
cnt = mtd->writesize;
|
|
r = nand_read_skip_bad(mtd, offset, &cnt, NULL, mtd->size,
|
|
(u_char *)addr);
|
|
if (r) {
|
|
puts("** Read error\n");
|
|
bootstage_error(BOOTSTAGE_ID_NAND_HDR_READ);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_HDR_READ);
|
|
|
|
switch (genimg_get_format ((void *)addr)) {
|
|
#if defined(CONFIG_LEGACY_IMAGE_FORMAT)
|
|
case IMAGE_FORMAT_LEGACY:
|
|
hdr = (image_header_t *)addr;
|
|
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_TYPE);
|
|
image_print_contents (hdr);
|
|
|
|
cnt = image_get_image_size (hdr);
|
|
break;
|
|
#endif
|
|
#if defined(CONFIG_FIT)
|
|
case IMAGE_FORMAT_FIT:
|
|
fit_hdr = (const void *)addr;
|
|
puts ("Fit image detected...\n");
|
|
|
|
cnt = fit_get_size (fit_hdr);
|
|
break;
|
|
#endif
|
|
default:
|
|
bootstage_error(BOOTSTAGE_ID_NAND_TYPE);
|
|
puts ("** Unknown image type\n");
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_TYPE);
|
|
|
|
r = nand_read_skip_bad(mtd, offset, &cnt, NULL, mtd->size,
|
|
(u_char *)addr);
|
|
if (r) {
|
|
puts("** Read error\n");
|
|
bootstage_error(BOOTSTAGE_ID_NAND_READ);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_READ);
|
|
|
|
#if defined(CONFIG_FIT)
|
|
/* This cannot be done earlier, we need complete FIT image in RAM first */
|
|
if (genimg_get_format ((void *)addr) == IMAGE_FORMAT_FIT) {
|
|
if (fit_check_format(fit_hdr, IMAGE_SIZE_INVAL)) {
|
|
bootstage_error(BOOTSTAGE_ID_NAND_FIT_READ);
|
|
puts ("** Bad FIT image format\n");
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_FIT_READ_OK);
|
|
fit_print_contents (fit_hdr);
|
|
}
|
|
#endif
|
|
|
|
/* Loading ok, update default load address */
|
|
|
|
image_load_addr = addr;
|
|
|
|
return bootm_maybe_autostart(cmdtp, cmd);
|
|
}
|
|
|
|
static int do_nandboot(struct cmd_tbl *cmdtp, int flag, int argc,
|
|
char *const argv[])
|
|
{
|
|
char *boot_device = NULL;
|
|
int idx;
|
|
ulong addr, offset = 0;
|
|
struct mtd_info *mtd;
|
|
#if defined(CONFIG_CMD_MTDPARTS)
|
|
struct mtd_device *dev;
|
|
struct part_info *part;
|
|
u8 pnum;
|
|
|
|
if (argc >= 2) {
|
|
char *p = (argc == 2) ? argv[1] : argv[2];
|
|
if (!(str2long(p, &addr)) && (mtdparts_init() == 0) &&
|
|
(find_dev_and_part(p, &dev, &pnum, &part) == 0)) {
|
|
if (dev->id->type != MTD_DEV_TYPE_NAND) {
|
|
puts("Not a NAND device\n");
|
|
return 1;
|
|
}
|
|
if (argc > 3)
|
|
goto usage;
|
|
if (argc == 3)
|
|
addr = simple_strtoul(argv[1], NULL, 16);
|
|
else
|
|
addr = CONFIG_SYS_LOAD_ADDR;
|
|
|
|
mtd = get_nand_dev_by_index(dev->id->num);
|
|
return nand_load_image(cmdtp, mtd, part->offset,
|
|
addr, argv[0]);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_PART);
|
|
switch (argc) {
|
|
case 1:
|
|
addr = CONFIG_SYS_LOAD_ADDR;
|
|
boot_device = env_get("bootdevice");
|
|
break;
|
|
case 2:
|
|
addr = simple_strtoul(argv[1], NULL, 16);
|
|
boot_device = env_get("bootdevice");
|
|
break;
|
|
case 3:
|
|
addr = simple_strtoul(argv[1], NULL, 16);
|
|
boot_device = argv[2];
|
|
break;
|
|
case 4:
|
|
addr = simple_strtoul(argv[1], NULL, 16);
|
|
boot_device = argv[2];
|
|
offset = simple_strtoul(argv[3], NULL, 16);
|
|
break;
|
|
default:
|
|
#if defined(CONFIG_CMD_MTDPARTS)
|
|
usage:
|
|
#endif
|
|
bootstage_error(BOOTSTAGE_ID_NAND_SUFFIX);
|
|
return CMD_RET_USAGE;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_SUFFIX);
|
|
|
|
if (!boot_device) {
|
|
puts("\n** No boot device **\n");
|
|
bootstage_error(BOOTSTAGE_ID_NAND_BOOT_DEVICE);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_BOOT_DEVICE);
|
|
|
|
idx = simple_strtoul(boot_device, NULL, 16);
|
|
|
|
mtd = get_nand_dev_by_index(idx);
|
|
if (!mtd) {
|
|
printf("\n** Device %d not available\n", idx);
|
|
bootstage_error(BOOTSTAGE_ID_NAND_AVAILABLE);
|
|
return 1;
|
|
}
|
|
bootstage_mark(BOOTSTAGE_ID_NAND_AVAILABLE);
|
|
|
|
return nand_load_image(cmdtp, mtd, offset, addr, argv[0]);
|
|
}
|
|
|
|
U_BOOT_CMD(nboot, 4, 1, do_nandboot,
|
|
"boot from NAND device",
|
|
"[partition] | [[[loadAddr] dev] offset]"
|
|
);
|