static int writeNandFlash(char *pcSourceBuffer, int nStartAddr, int nLength, ImageType_E type) { int nRet = -1; nand_info_t *nand = &nand_info[nand_curr_device]; if (type==EM_IMAGE_TYPE_BOOTSTRAP) { int i = 0; char *pcImageBuffer = (char *)malloc(nLength+52*4); int *pnImageBuffer = NULL; if (pcImageBuffer == NULL) { return FALSE; } pnImageBuffer = (int *)pcImageBuffer; for (i=0; i<52; i++) { pnImageBuffer[i] = 0xc0c00405; } memcpy(pcImageBuffer+52*4, pcSourceBuffer, nLength); nLength += 52*4; nRet = nand_write_skip_bad(nand, nStartAddr, (unsigned int *)&nLength, (u_char *)pcImageBuffer, 0); } else { nRet = nand_write_skip_bad(nand, nStartAddr, (unsigned int *)&nLength, (u_char *)pcSourceBuffer, (int)(type==EM_IMAGE_TYPE_ROOTFS?WITH_DROP_FFS:0)); } return nRet?FALSE:TRUE; }
int nand_logic_write ( nand_logic_t *nand_logic, unsigned long long offset, /* should be alignment with nand page size */ unsigned int length, /* should be alignment with nand page size */ unsigned char *buf, int withoob ) { unsigned long long phylength; unsigned long long phyaddress; nand_info_t *nand = nand_logic->nand; /* Reject write, which are not page aligned */ if ((offset & (nand->writesize - 1)) || (length & (nand->writesize - 1))) { printf("Attempt to write non page aligned data, " "nand page size: 0x%08x, offset: 0x%08llx, length: 0x%08x\n", nand->writesize, offset, length); return -1; } phylength = logic_to_phylength(nand, nand_logic->address, (offset + length + nand->erasesize - 1) & (~(nand_logic->erasesize - 1))); if ((offset > nand_logic->length) || (length > nand_logic->length) || (phylength > nand_logic->length)) { printf("Attempt to write outside the flash handle area, " "flash handle size: 0x%08llx, offset: 0x%08llx, " "length: 0x%08x, phylength: 0x%08llx\n", nand_logic->length, offset, length, phylength); return -1; } phylength = logic_to_phylength(nand, nand_logic->address, (offset + nand->erasesize - 1) & (~(nand_logic->erasesize - 1))); if(offset & (nand_logic->erasesize - 1)) { phyaddress = phylength - nand->erasesize + (offset & (nand_logic->erasesize - 1)) + nand_logic->address; } else { phyaddress = phylength + nand_logic->address; } if (withoob) { length = length / nand->writesize * (nand->writesize + nand->oobsize); return nand_write_yaffs_skip_bad(nand_logic->nand, phyaddress, &length, buf); } else { return nand_write_skip_bad(nand_logic->nand, phyaddress, &length, buf); } }
static int nand_block_op(enum dfu_nand_op op, struct dfu_entity *dfu, u64 offset, void *buf, long *len) { loff_t start, lim; size_t count, actual; int ret; nand_info_t *nand; /* if buf == NULL return total size of the area */ if (buf == NULL) { *len = dfu->data.nand.size; return 0; } start = dfu->data.nand.start + offset + dfu->bad_skip; lim = dfu->data.nand.start + dfu->data.nand.size - start; count = *len; if (nand_curr_device < 0 || nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[nand_curr_device].name) { printf("%s: invalid nand device\n", __func__); return -1; } nand = &nand_info[nand_curr_device]; if (op == DFU_OP_READ) ret = nand_read_skip_bad(nand, start, &count, &actual, lim, buf); else ret = nand_write_skip_bad(nand, start, &count, &actual, lim, buf, 0); if (ret != 0) { printf("%s: nand_%s_skip_bad call failed at %llx!\n", __func__, op == DFU_OP_READ ? "read" : "write", start); return ret; } /* * Find out where we stopped writing data. This can be deeper into * the NAND than we expected due to having to skip bad blocks. So * we must take this into account for the next write, if any. */ if (actual > count) dfu->bad_skip += actual - count; return ret; }
static int _fb_nand_write(struct mtd_info *mtd, struct part_info *part, void *buffer, unsigned int offset, unsigned int length, size_t *written) { int flags = WITH_WR_VERIFY; #ifdef CONFIG_FASTBOOT_FLASH_NAND_TRIMFFS flags |= WITH_DROP_FFS; #endif return nand_write_skip_bad(mtd, offset, &length, written, part->size - (offset - part->offset), buffer, flags); }
int do_nand(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { int i, dev, ret = 0; ulong addr, off; size_t size; char *cmd, *s; nand_info_t *nand; #ifdef CONFIG_SYS_NAND_QUIET int quiet = CONFIG_SYS_NAND_QUIET; #else int quiet = 0; #endif const char *quiet_str = getenv("quiet"); /* at least two arguments please */ if (argc < 2) goto usage; if (quiet_str) quiet = simple_strtoul(quiet_str, NULL, 0) != 0; cmd = argv[1]; if (strcmp(cmd, "info") == 0) { putc('\n'); for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) { if (nand_info[i].name) nand_print_info(i); } return 0; } if (strcmp(cmd, "device") == 0) { if (argc < 3) { putc('\n'); if ((nand_curr_device < 0) || (nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE)) puts("no devices available\n"); else nand_print_info(nand_curr_device); return 0; } dev = (int)simple_strtoul(argv[2], NULL, 10); if (dev < 0 || dev >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[dev].name) { puts("No such device\n"); return 1; } printf("Device %d: %s", dev, nand_info[dev].name); puts("... is now current device\n"); nand_curr_device = dev; #ifdef CONFIG_SYS_NAND_SELECT_DEVICE /* * Select the chip in the board/cpu specific driver */ board_nand_select_device(nand_info[dev].priv, dev); #endif return 0; } if (strcmp(cmd, "bad") != 0 && strcmp(cmd, "erase") != 0 && strncmp(cmd, "dump", 4) != 0 && strncmp(cmd, "read", 4) != 0 && strncmp(cmd, "write", 5) != 0 && strcmp(cmd, "scrub") != 0 && strcmp(cmd, "markbad") != 0 && strcmp(cmd, "biterr") != 0 && strcmp(cmd, "lock") != 0 && strcmp(cmd, "unlock") != 0 #ifdef CONFIG_ENV_OFFSET_OOB && strcmp(cmd, "env.oob") != 0 #endif ) goto usage; #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, &nand_info[0], argc - 1, argv + 1); } #endif /* the following commands operate on the current device */ if (nand_curr_device < 0 || nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[nand_curr_device].name) { puts("\nno devices available\n"); return 1; } nand = &nand_info[nand_curr_device]; if (strcmp(cmd, "bad") == 0) { printf("\nDevice %d bad blocks:\n", nand_curr_device); for (off = 0; off < nand->size; off += nand->erasesize) if (nand_block_isbad(nand, off)) printf(" %08lx\n", off); return 0; } /* * Syntax is: * 0 1 2 3 4 * nand erase [clean] [off size] */ if (strcmp(cmd, "erase") == 0 || strcmp(cmd, "scrub") == 0) { nand_erase_options_t opts; /* "clean" at index 2 means request to write cleanmarker */ int clean = argc > 2 && !strcmp("clean", argv[2]); int o = clean ? 3 : 2; int scrub = !strcmp(cmd, "scrub"); printf("\nNAND %s: ", scrub ? "scrub" : "erase"); /* skip first two or three arguments, look for offset and size */ if (arg_off_size(argc - o, argv + o, nand, &off, &size) != 0) return 1; memset(&opts, 0, sizeof(opts)); opts.offset = off; opts.length = size; opts.jffs2 = clean; opts.quiet = quiet; if (scrub) { puts("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 (getc() == 'y') { puts("y"); if (getc() == '\r') opts.scrub = 1; else { puts("scrub aborted\n"); return -1; } } else { puts("scrub aborted\n"); return -1; } } ret = nand_erase_opts(nand, &opts); printf("%s\n", ret ? "ERROR" : "OK"); return ret == 0 ? 0 : 1; } if (strncmp(cmd, "dump", 4) == 0) { if (argc < 3) goto usage; s = strchr(cmd, '.'); off = (int)simple_strtoul(argv[2], NULL, 16); if (s != NULL && strcmp(s, ".oob") == 0) ret = nand_dump(nand, off, 1); else ret = nand_dump(nand, off, 0); return ret == 0 ? 1 : 0; } if (strncmp(cmd, "read", 4) == 0 || strncmp(cmd, "write", 5) == 0) { int read; 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"); if (arg_off_size(argc - 3, argv + 3, nand, &off, &size) != 0) return 1; s = strchr(cmd, '.'); if (!s || !strcmp(s, ".jffs2") || !strcmp(s, ".e") || !strcmp(s, ".i")) { if (read) ret = nand_read_skip_bad(nand, off, &size, (u_char *)addr); else ret = nand_write_skip_bad(nand, off, &size, (u_char *)addr); } else if (!strcmp(s, ".oob")) { /* out-of-band data */ mtd_oob_ops_t ops = { .oobbuf = (u8 *)addr, .ooblen = size, .mode = MTD_OOB_RAW }; if (read) ret = nand->read_oob(nand, off, &ops); else ret = nand->write_oob(nand, off, &ops); } else {
void set_env_funcptrs(void) { #ifdef CONFIG_SOC_HAYDN env_init = serialflash_env_init ; saveenv = serialflash_saveenv ; env_get_char_spec = serialflash_env_get_char_spec ; env_relocate_spec = serialflash_env_relocate_spec ; #elif (defined(CONFIG_SOC_MOZART) || defined(CONFIG_SOC_BEETHOVEN)) unsigned long val = inl(BOOTING_DEVICE_INFO); int sdbootSucess = 0 ; #ifdef CONFIG_CMD_MMC if(val == SYSCTRL_DATA_IN_SD && SD_Card_Detect(0)) { printf( " Boot Storage : SD Card\n" ) ; gd->env_valid = 0 ;//We always use default envs when booting from SD. env_init = sd_env_init ; saveenv = sd_saveenv ; env_get_char_spec = sd_env_get_char_spec ; env_relocate_spec = sd_env_relocate_spec ; //check if real sd boot if(SD_Read(MAGIC_SD_ADDR, MAGIC_DATA_SIZE, MAGIC_DRAM_ADDR) != 0) { printf("[ERR] SD-Read fails!\n") ; sdbootSucess = 0 ; goto SDBOOT_FAIL; } if((v_inl(MAGIC_DRAM_ADDR) != MAGIC_NUM0) || (v_inl(MAGIC_DRAM_ADDR+4) != MAGIC_NUM1)) { printf(" !! MAGIC# of SD Card is wrong\n") ; printf(" !! Find other Boot Storage..\n\n") ; sdbootSucess = 0 ; goto SDBOOT_FAIL ; } printf(" SD Card has correct Magic#.\n") ; printf(" SD Boot Sucessfully.\n\n") ; update_default_envs_ifsdboot() ; sdbootSucess = 1 ; #ifdef SDAUTOBURN_FLOW_FROMSD printf(" ****** Auto Burn Flow ******\n") ; printf(" Step 1. Copy data(size 0x%08x) from 0x%08x of SD to 0x%08x of DRAM\n", AUTOBURN_DATASIZE, AUTOBURN_SDADDR, AUTOBURN_DRAMADDR) ; SD_Read(AUTOBURN_SDADDR, AUTOBURN_DATASIZE, AUTOBURN_DRAMADDR) ; if(AUTOBURN_FLASHTYPE == AUTOBURN_SPIFLASH) { printf(" Step 2. Write data from 0x%08x of DRAM to 0x%08x of SPI FLASH\n", AUTOBURN_DRAMADDR, AUTOBURN_FLASHADDR) ; autoburn_sf = spi_flash_probe(0, 0, CONFIG_SF_DEFAULT_SPEED, CONFIG_DEFAULT_SPI_MODE); spi_flash_erase(autoburn_sf, AUTOBURN_FLASHADDR, AUTOBURN_DATASIZE, 0) ; spi_flash_write(autoburn_sf, AUTOBURN_FLASHADDR, AUTOBURN_DATASIZE, AUTOBURN_DRAMADDR, 0) ; printf(" Done\n") ; outl(0xFFF, 0x49000004); } else if(AUTOBURN_FLASHTYPE == AUTOBURN_NANDFLASH) { printf(" Step 3. Write data from 0x%08x of DRAM to 0x%08x of NAND FLASH\n", AUTOBURN_DRAMADDR, AUTOBURN_FLASHADDR) ; nand_info_t *mtd ; mtd = &nand_info[0] ; nand_erase_options_t opts; memset(&opts, 0, sizeof(opts)); opts.offset = AUTOBURN_FLASHADDR; opts.length = AUTOBURN_DATASIZE; //opts.jffs2 = clean; opts.jffs2 = 0;//[patch] we do not allow jffs2 in our u-boot opts.quiet = 0; opts.all = 1 ; unsigned long datasize = AUTOBURN_DATASIZE ; nand_erase_opts(mtd, &opts) ; //printf("chipsize=%d, blocksize=%d, block#=%d\n", mtd->totalsize, mtd->erasesize, (mtd->totalsize / mtd->erasesize)) ; nand_write_skip_bad(mtd, AUTOBURN_FLASHADDR, &datasize, AUTOBURN_DRAMADDR) ;//100 temporary } #endif //SDAUTOBURN_FLOW_FROMSD } if(sdbootSucess) return ; #endif //CONFIG_CMD_SD SDBOOT_FAIL: if ( val == SYSCTRL_DATA_IN_SERIALFLASH) { printf( " Boot Storage : Serial Flash\n" ) ; env_init = serialflash_env_init ; saveenv = serialflash_saveenv ; env_get_char_spec = serialflash_env_get_char_spec ; env_relocate_spec = serialflash_env_relocate_spec ; } #if defined(CONFIG_CMD_NAND) else if ( val == SYSCTRL_DATA_IN_NANDFLASH) { update_default_envs_ifnfboot() ; printf( " Boot Storage : Nand Flash\n" ) ; env_init = nand_env_init ; saveenv = nand_saveenv ; env_get_char_spec = nand_env_get_char_spec ; env_relocate_spec = nand_env_relocate_spec ; } #endif #endif //CONFIG_SOC_MOZART }
int do_nand(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) { int i, dev, ret = 0; uint32_t addr, cmp_addr; uint64_t off; uint64_t size; char *cmd, *s; nand_info_t *nand; #ifdef CONFIG_SYS_NAND_QUIET int quiet = CONFIG_SYS_NAND_QUIET; #else int quiet = 0; #endif const char *quiet_str = getenv("quiet"); /* at least two arguments please */ if (argc < 2) goto usage; if (quiet_str) quiet = simple_strtoul(quiet_str, NULL, 0) != 0; cmd = argv[1]; if (strcmp(cmd, "info") == 0) { for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) { if (nand_info[i].name) nand_print_info(i); } return 0; } if (strcmp(cmd, "device") == 0) { if (argc < 3) { putc('\n'); if ((nand_curr_device < 0) || (nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE)) puts("no devices available\n"); else nand_print_info(nand_curr_device); return 0; } dev = (int)simple_strtoul(argv[2], NULL, 10); if (dev < 0 || dev >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[dev].name) { puts("No such device\n"); return 1; } printf("Device %d: %s", dev, nand_info[dev].name); puts("... is now current device\n"); nand_curr_device = dev; #ifdef CONFIG_SYS_NAND_SELECT_DEVICE /* * Select the chip in the board/cpu specific driver */ board_nand_select_device(nand_info[dev].priv, dev); #endif return 0; } if (strcmp(cmd, "bad") != 0 && strcmp(cmd, "erase") != 0 && strncmp(cmd, "dump", 4) != 0 && strncmp(cmd, "read", 4) != 0 && strncmp(cmd, "write", 5) != 0 && strcmp(cmd, "scrub") != 0 && strcmp(cmd, "markbad") != 0 && strcmp(cmd, "biterr") != 0 && strcmp(cmd, "pattern") != 0 && strcmp(cmd, "lock") != 0 && strcmp(cmd, "unlock") != 0 ) goto usage; /* the following commands operate on the current device */ if (nand_curr_device < 0 || nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[nand_curr_device].name) { puts("\nno devices available\n"); return 1; } nand = &nand_info[nand_curr_device]; if (strcmp(cmd, "bad") == 0) { printf("\nDevice %d bad blocks:\n", nand_curr_device); for (off = 0; off < nand->size; off += nand->erasesize) if (nand_block_isbad(nand, off)) printf(" %12llx\n", off); return 0; } /* * Syntax is: * 0 1 2 3 4 * nand erase [clean] [off size] */ if (strcmp(cmd, "erase") == 0 || strcmp(cmd, "scrub") == 0) { nand_erase_options_t opts; /* "clean" at index 2 means request to write cleanmarker */ int clean = argc > 2 && !strcmp("clean", argv[2]); int o = clean ? 3 : 2; int scrub = !strcmp(cmd, "scrub"); printf("\nNAND %s: ", scrub ? "scrub" : "erase"); /* skip first two or three arguments, look for offset and size */ if (arg_off_size(argc - o, argv + o, nand, &off, &size) != 0) return 1; memset(&opts, 0, sizeof(opts)); opts.offset = off; opts.length = size; opts.jffs2 = clean; opts.quiet = quiet; if (scrub) { puts("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 (getc() == 'y' && getc() == '\r') { opts.scrub = 1; } else { puts("scrub aborted\n"); return -1; } } ret = nand_erase_opts(nand, &opts); printf("%s\n", ret ? "ERROR" : "OK"); return ret == 0 ? 0 : 1; } if (strncmp(cmd, "dump", 4) == 0) { if (argc < 3) goto usage; s = strchr(cmd, '.'); off = simple_strtoull(argv[2], NULL, 16); if (s != NULL && strcmp(s, ".oob") == 0) ret = nand_dump(nand, off, 1); else ret = nand_dump(nand, off, 0); return ret == 0 ? 1 : 0; } if (strncmp(cmd, "pattern", 4) == 0) { int chunk_num; uint64_t offset, chunk64, cmp64; nand_erase_options_t opts; memset(&opts, 0, sizeof(opts)); // nand pattern addr cmp_addr chunk_size // 0 1 2 3 4 if (argc < 5) goto usage; addr = simple_strtoul(argv[2], NULL, 16); cmp_addr = simple_strtoul(argv[3], NULL, 16); chunk64 = simple_strtoull(argv[4], NULL, 16); cmp64 = chunk64; chunk_num = (int) (nand->size / chunk64); printf("NAND size [0x%llx], chunk size [0x%llx], number of chunks [%d]\n", nand->size, chunk64, chunk_num); printf("Erasing all chip...\n"); opts.offset = 0; opts.length = nand->size; opts.jffs2 = 0; opts.quiet = 0; opts.scrub = 0; if (nand_erase_opts(nand, &opts) != 0) { printf("[FAILED]\n"); return 1; } else { printf("[OK]\n"); } offset = 0; while(offset < nand->size) { printf("0x%010llx:", offset); // printf("\tB:"); // if (nand_block_isbad(nand, i*chunk_size & ~(nand->erasesize - 1))) { // printf("[V]\n"); // continue; // } else { // printf("[X]"); // } // size_include_bad = get_len_incl_bad (nand, offset, chunk_size); // opts.offset = offset; // opts.length = size_include_bad; // opts.quiet = 1; // printf("\tE:"); // if (nand_erase_opts(nand, &opts) != 0) { // printf("[X]\n"); // return 1; // } else { // printf("[V]"); // } printf("\tW:"); chunk64 = cmp64; if (nand_write_skip_bad(nand, offset, &chunk64, (u_char *)addr) != 0) { printf("[X]\n"); return 1; } else { printf("[V]"); } printf("\tR:"); chunk64 = cmp64; if (nand_read_skip_bad(nand, offset, &chunk64, (u_char *)cmp_addr) != 0) { printf("[X]\n"); return 1; } else { printf("[V]"); } printf("\tC:"); if (memcmp((void *)addr, (void *)cmp_addr, cmp64) != 0) { printf("[X]\n"); return 1; } else { printf("[V]"); } printf("\n"); if (ctrlc()) { puts ("\nAbort\n"); return (-1); } offset += get_len_incl_bad (nand, offset, cmp64); } printf("NAND Pattern Test PASSED!\n"); return 0; } if (strncmp(cmd, "read", 4) == 0 || strncmp(cmd, "write", 5) == 0) { int read; if (argc < 4) goto usage; addr = simple_strtoul(argv[2], NULL, 16); read = strncmp(cmd, "read", 4) == 0; /* 1 = read, 0 = write */ printf("\nNAND %s: ", read ? "read" : "write"); if (arg_off_size(argc - 3, argv + 3, nand, &off, &size) != 0) return 1; s = strchr(cmd, '.'); if (!s || !strcmp(s, ".jffs2") || !strcmp(s, ".e") || !strcmp(s, ".i")) { if (read) ret = nand_read_skip_bad(nand, off, &size, (u_char *)addr); else ret = nand_write_skip_bad(nand, off, &size, (u_char *)addr); } else if (!strcmp(s, ".oob")) { /* out-of-band data */ mtd_oob_ops_t ops = { .oobbuf = (uint8_t *)addr, .ooblen = size, .mode = MTD_OOB_RAW }; if (read) ret = nand->read_oob(nand, off, &ops); else ret = nand->write_oob(nand, off, &ops); } else {
int do_nand(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) { int i, dev, ret = 0; ulong addr; loff_t off, size; char *cmd, *s; nand_info_t *nand; #ifdef CONFIG_SYS_NAND_QUIET int quiet = CONFIG_SYS_NAND_QUIET; #else int quiet = 0; #endif const char *quiet_str = getenv("quiet"); #if ((defined CONFIG_AML_NAND_KEY) || (defined MX_REVD) || (defined CONFIG_SECURE_NAND)) int chip_num , tmp_chip_num, error; nand = nand_info[nand_curr_device]; struct mtd_info *mtd =nand; struct aml_nand_chip *aml_chip = mtd_to_nand_chip(nand); #endif /* at least two arguments please */ if (argc < 2) goto usage; if (quiet_str) quiet = simple_strtoul(quiet_str, NULL, 0) != 0; cmd = argv[1]; #ifdef CONFIG_AML_NAND_KEY if (strcmp(cmd, "key") == 0){ aml_chip->key_protect = 1; //force nand key can be erased return 0; } #endif #ifdef CONFIG_SECURE_NAND if (strcmp(cmd, "secure") == 0){ aml_chip->secure_protect = 1; //force nand key can be erased return 0; } #endif #ifdef CONFIG_SECURE_NAND if (strcmp(cmd, "secure") == 0){ aml_chip->secure_protect = 1; //force nand key can be erased return 0; } #endif if(strcmp(cmd, "exist") == 0){ if(nand_info[1]){ printf("nand exist return 0\n"); return 0; } else{ printf("nand exist return 1\n"); return 1; } } #ifdef MX_REVD if (strcmp(cmd, "errstat") == 0){ printk("checking chiprev here\n"); if(aml_chip->err_sts == NAND_CHIP_REVB_HY_ERR){ printk("Must use RevD chip for Hynix 26nm/20nm nand boot without SPI!!!\n"); return NAND_CHIP_REVB_HY_ERR; } return 0; } #endif #ifdef CONFIG_SECURE_NAND if (strcmp(cmd, "secure") == 0){ aml_chip->secure_protect = 1; //force nand key can be erased return 0; } #endif if (strcmp(cmd, "info") == 0) { #ifdef CONFIG_AML_NAND_KEY aml_chip->key_protect = 0; //protect nand key can not be erased #endif #ifdef CONFIG_SECURE_NAND aml_chip->secure_protect = 0; //protect nand secure can not be erased #endif putc('\n'); for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) { nand = nand_info[i]; if (!nand) { nand_init(); if (!nand) return -1; } if (nand->name) nand_print_info(i); } return 0; } if (strcmp(cmd, "init") == 0) { nand_init(); return 0; } //cmd for nand test , if nand is ok , then trigger power off if (strcmp(cmd, "test") == 0) { int ret=-1; puts("\ntest the nand flash ***\n"); for (i = 0; i < CONFIG_SYS_MAX_NAND_DEVICE; i++) { nand = nand_info[i]; if (!nand) { ret=nand_test_init(); printf("\n***nand_test_init()in NAND DEVICE %d returned:%d***\n ", i,ret); if (ret) return -1; } } return 0; } if (strcmp(cmd, "scrub_detect") == 0) { if (nand_curr_device < 0 || nand_curr_device >= (CONFIG_SYS_MAX_NAND_DEVICE+2)) { puts("\nno devices available\n"); return 1; } nand = nand_info[nand_curr_device]; aml_nand_stupid_dectect_badblock(nand); return 0; } if (strcmp(cmd, "device") == 0) { if (argc < 3) { putc('\n'); if ((nand_curr_device < 0) || (nand_curr_device >= CONFIG_SYS_MAX_NAND_DEVICE)) puts("no devices available\n"); else nand_print_info(nand_curr_device); return 0; } dev = (int)simple_strtoul(argv[2], NULL, 10); if (dev < 0 || dev >= (CONFIG_SYS_MAX_NAND_DEVICE+1) || !nand_info[dev]->name) { puts("No such device\n"); return 1; } printf("Device %d: %s", dev, nand_info[dev]->name); puts("... is now current device\n"); nand_curr_device = dev; #ifdef CONFIG_SYS_NAND_SELECT_DEVICE /* * Select the chip in the board/cpu specific driver */ board_nand_select_device(nand_info[dev]->priv, dev); #endif return 0; } if (strcmp(cmd, "bad") != 0 && strcmp(cmd, "erase") != 0 && strncmp(cmd, "dump", 4) != 0 && strncmp(cmd, "read", 4) != 0 && strncmp(cmd, "write", 5) != 0 && strcmp(cmd, "scrub") != 0 && strcmp(cmd, "markbad") != 0 && strcmp(cmd, "biterr") != 0 && strncmp(cmd, "rom_protect", 11) != 0 && strncmp(cmd, "wr_rd_cmp", 9) != 0 && strncmp(cmd, "rom_write", 9) != 0 && (strncmp(cmd, "rom_read", 8) != 0) && strcmp(cmd, "lock") != 0 && strcmp(cmd, "unlock") != 0 && strcmp(cmd, "factory_info") != 0 && strcmp(cmd, "show_para_page")&& strncmp(cmd, "scrub_safe", 10) != 0) //my_ goto usage; /* the following commands operate on the current device */ if (nand_curr_device < 0 || nand_curr_device >= (CONFIG_SYS_MAX_NAND_DEVICE+2)) { puts("\nno devices available\n"); return 1; } nand = nand_info[nand_curr_device]; if (!nand) return -1; if (strcmp(cmd, "bad") == 0) { printf("\nDevice %d bad blocks:\n", nand_curr_device); for (off = 0; off < nand->size; off += nand->erasesize) if (nand_block_isbad(nand, off)) printf(" %09llx\n", off); return 0; } /* * Syntax is: * 0 1 2 3 4 * nand erase [clean] [off size] */ if (strcmp(cmd, "erase") == 0 || strcmp(cmd, "scrub") == 0 || strcmp(cmd, "scrub_safe") == 0) { nand_erase_options_t opts; int argc_cnt = 2; //printk("%s\n", argv[2]); /* if (isstring(argv[2])) { nand = get_mtd_device_nm(argv[2]); if (IS_ERR(nand)){ printf("get nand device err\n"); return 1; } argc_cnt++; } */ /* "clean" at index 2 means request to write cleanmarker */ int clean = argc > argc_cnt && !strcmp("clean", argv[argc_cnt]); if (clean) argc_cnt++; int o = argc_cnt; int scrub = !strncmp(cmd, "scrub",10); int scrub_safe = !strncmp(cmd, "scrub_safe",10); if(scrub_safe) printf("\nNAND %s: ", scrub_safe ? "scrub_safe" : "erase"); else printf("\nNAND %s: ", scrub ? "scrub" : "erase"); if (argv[argc_cnt]) { if(!strcmp(argv[argc_cnt], "whole")) { off = 0; size = nand->size; printf("whole chip.\n"); } } else { /* skip first two or three arguments, look for offset and size */ if ((strcmp(cmd, "erase") == 0) && (argc < 3)) { goto usage; } if ((arg_off_size(argc - o, argv + o, nand, &off, &size) != 0)) { return 1; } } memset(&opts, 0, sizeof(opts)); opts.offset = off; opts.length = size; opts.jffs2 = clean; opts.quiet = quiet; if (scrub) { puts("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(nand_protect) { if (getc() == 'y') { puts("y"); if (getc() == '\r') opts.scrub = 1; else { puts("scrub aborted\n"); return -1; } } else { puts("scrub aborted\n"); return -1; } } else { opts.scrub = 1; } } else if(scrub_safe){ puts("Warning: " "scrub_safe option will erase all " "bad blocks except factory bad blocks!\n"); opts.scrub = 2; // indicate scrub_safe } ret = nand_erase_opts(nand, &opts); printf("%s\n", ret ? "ERROR" : "OK"); #ifdef CONFIG_AML_NAND_KEY aml_chip->key_protect = 0; //protect nand key can not be erased #endif #ifdef CONFIG_SECURE_NAND aml_chip->secure_protect = 0; //protect nand secure can not be erased #endif return ret == 0 ? 0 : 1; } if (strncmp(cmd, "dump", 4) == 0) { if (argc < 3) goto usage; s = strchr(cmd, '.'); //off = (loff_t)simple_strtoul(argv[2], NULL, 16); if (!(str2longlong(argv[2], (unsigned long long*)(&off)))) return -1; if (s != NULL && strcmp(s, ".oob") == 0) ret = nand_dump(nand, off, 1); else ret = nand_dump(nand, off, 0); return ret == 0 ? 1 : 0; } if (strncmp(cmd, "read", 4) == 0 || strncmp(cmd, "write", 5) == 0) { int read; if (argc < 4) goto usage; if (isstring(argv[2])) { nand = get_mtd_device_nm(argv[2]); if (IS_ERR(nand)) goto usage; addr = (ulong)simple_strtoul(argv[3], NULL, 16); read = strncmp(cmd, "read", 4) == 0; /* 1 = read, 0 = write */ printf("\nNAND %s: %s ", read ? "read" : "write", argv[2]); if (argc == 4) { extern unsigned int get_mtd_size(char *name); off = 0; size = get_mtd_size(argv[2]); } else { if (arg_off_size(argc - 4, argv + 4, nand, &off, &size) != 0) return 1; } } else { addr = (ulong)simple_strtoul(argv[2], NULL, 16); read = strncmp(cmd, "read", 4) == 0; /* 1 = read, 0 = write */ printf("\nNAND %s: ", read ? "read" : "write"); if (arg_off_size(argc - 3, argv + 3, nand, &off, &size) != 0) return 1; } #ifdef CONFIG_AMLROM_NANDBOOT if((read==0) && ((off)<(1024* nand->writesize)) && (nand_curr_device == 0)){ printf("offset 0x%llx in aml-boot area ,abort\n", off); return -1; } #endif s = strchr(cmd, '.'); if (!s || !strcmp(s, ".jffs2") || !strcmp(s, ".e") || !strcmp(s, ".i")) { if (read) ret = nand_read_skip_bad(nand, off, &size, (u_char *)addr, 0); else ret = nand_write_skip_bad(nand, off, &size, (u_char *)addr, 0); } else if (!strcmp(s, ".oob")) { /* out-of-band data */ mtd_oob_ops_t ops = { .oobbuf = (u8 *)addr, .ooblen = size, .mode = MTD_OOB_RAW }; if (read) ret = nand->read_oob(nand, off, &ops); else ret = nand->write_oob(nand, off, &ops); } else if (!strcmp(s, ".raw")) {
static int raw_access(nand_info_t *nand, ulong addr, loff_t off, ulong count, int read) { int ret = 0; while (count--) { /* Raw access */ mtd_oob_ops_t ops = { .datbuf = (u8 *)addr, .oobbuf = ((u8 *)addr) + nand->writesize, .len = nand->writesize, .ooblen = nand->oobsize, .mode = MTD_OOB_RAW }; if (read) ret = nand->read_oob(nand, off, &ops); else ret = nand->write_oob(nand, off, &ops); if (ret) { printf("%s: error at offset %llx, ret %d\n", __func__, (long long)off, ret); break; } addr += nand->writesize + nand->oobsize; off += nand->writesize; } return ret; } int do_nand(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { int i, ret = 0; ulong addr; loff_t off, size, maxsize; char *cmd, *s; nand_info_t *nand; #ifdef CONFIG_SYS_NAND_QUIET int quiet = CONFIG_SYS_NAND_QUIET; #else int quiet = 0; #endif const char *quiet_str = getenv("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++) { if (nand_info[i].name) 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. */ if (dev < 0 || dev >= CONFIG_SYS_MAX_NAND_DEVICE || !nand_info[dev].name) { puts("\nno devices available\n"); return 1; } nand = &nand_info[dev]; if (strcmp(cmd, "bad") == 0) { printf("\nDevice %d bad blocks:\n", dev); for (off = 0; off < nand->size; off += nand->erasesize) if (nand_block_isbad(nand, 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 (arg_off_size(argc - o, argv + o, &dev, &off, &size, &maxsize) != 0) return 1; nand = &nand_info[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) puts(scrub_warn); if (scrub_yes) opts.scrub = 1; else if (getc() == 'y') { puts("y"); if (getc() == '\r') opts.scrub = 1; else { puts("scrub aborted\n"); return -1; } } else { puts("scrub aborted\n"); return -1; } } ret = nand_erase_opts(nand, &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(nand, 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; 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"); nand = &nand_info[dev]; s = strchr(cmd, '.'); if (s && !strcmp(s, ".raw")) { raw = 1; if (arg_off(argv[3], &dev, &off, &size, &maxsize)) return 1; if (argc > 4 && !str2long(argv[4], &pagecount)) { printf("'%s' is not a number\n", argv[4]); return 1; } if (pagecount * nand->writesize > size) { puts("Size exceeds partition or device limit\n"); return -1; } rwsize = pagecount * (nand->writesize + nand->oobsize); } else { if (arg_off_size(argc - 3, argv + 3, &dev, &off, &size, &maxsize) != 0) return 1; rwsize = size; } if (!s || !strcmp(s, ".jffs2") || !strcmp(s, ".e") || !strcmp(s, ".i")) { if (read) ret = nand_read_skip_bad(nand, off, &rwsize, NULL, maxsize, (u_char *)addr); else ret = nand_write_skip_bad(nand, off, &rwsize, NULL, maxsize, (u_char *)addr, 0); #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(nand, off, &rwsize, NULL, maxsize, (u_char *)addr, WITH_DROP_FFS); #endif #ifdef CONFIG_CMD_NAND_YAFFS } else if (!strcmp(s, ".yaffs")) { if (read) { printf("Unknown nand command suffix '%s'.\n", s); return 1; } ret = nand_write_skip_bad(nand, off, &rwsize, NULL, maxsize, (u_char *)addr, WITH_YAFFS_OOB); #endif } else if (!strcmp(s, ".oob")) { /* out-of-band data */ mtd_oob_ops_t ops = { .oobbuf = (u8 *)addr, .ooblen = rwsize, .mode = MTD_OOB_RAW }; if (read) ret = nand->read_oob(nand, off, &ops); else ret = nand->write_oob(nand, off, &ops); } else if (raw) {
/** * NAND specific update routine. Handles erasing the previous * image if it exists. Note that this uses the standard U-Boot NAND * facilities which make use of the hardware BCH engine. * * @param image_addr Address of image in DRAM. Always * has an image header. * * @return 0 on success * 1 on failure */ int do_bootloader_update_nand(uint32_t image_addr) { const int dev = CONFIG_OCTEON_NAND_BOOT_DEV; const loff_t end = CONFIG_OCTEON_NAND_BOOT_END; const bootloader_header_t *new_header = (void *)image_addr; nand_info_t *nand = &nand_info[CONFIG_OCTEON_NAND_BOOT_DEV]; int page_size = nand->writesize; int pages_per_block = nand->erasesize / nand->writesize; size_t bytes_written = 0; uint64_t block_size = page_size * pages_per_block; loff_t last_image_addr = 0; loff_t nand_addr = block_size; uint64_t buf_storage[(NAND_MAX_PAGESIZE + NAND_MAX_OOBSIZE) / 8] = { 0 }; unsigned char *buf = (unsigned char *)buf_storage; const bootloader_header_t *header = (void *)buf; uint64_t old_image_nand_addr = 0; int old_image_size = 0; int image_no = 0; size_t write_length; int rc; int required_len; int required_blocks; int conseq_blank_blocks; loff_t erase_base, erase_size; if (!cvmx_nand_get_active_chips()) { puts("ERROR: No NAND Flash detected on board, can't burn " "NAND bootloader image\n"); return 1; } /* Find matching type (failsafe/normal, stage2/stage3) of image that * is currently in NAND, if present. Save location for later erasing */ while ((nand_addr = octeon_nand_image_search(dev, image_no, -1, new_header->image_type, &bytes_written, nand_addr, end)) > 0) { rc = octeon_nand_validate_image(dev, nand_addr, end); if (rc) { printf("Found bad NAND image at offset 0x%llx\n", nand_addr); nand_addr += page_size; continue; } else { printf("Found good NAND image at offset 0x%llx\n", nand_addr); } last_image_addr = nand_addr; /* Read new header */ rc = octeon_nand_read_dev(CONFIG_OCTEON_NAND_BOOT_DEV, nand_addr, page_size, end - nand_addr, (void *)buf, &nand_addr); if (rc) { printf("Error reading NAND addr 0x%llx\n", nand_addr); return 1; } /* Check a few more fields from the headers */ if (gd->board_type != CVMX_BOARD_TYPE_GENERIC && header->board_type != CVMX_BOARD_TYPE_GENERIC) { /* If the board type of the running image is generic, * don't do any board matching. When looking for images * in NAND to overwrite, treat generic board type images * as matching all board types. */ if (new_header->board_type != header->board_type) { puts("WARNING: A bootloader for a different " "board type was found and skipped (not erased.)\n"); /* Different board type, so skip (this is * strange to find..... */ nand_addr += ((header->hlen + header->dlen + page_size - 1) & ~(page_size - 1)); continue; } } if ((new_header->flags & BL_HEADER_FLAG_FAILSAFE) != (new_header->flags & BL_HEADER_FLAG_FAILSAFE)) { /* Not a match, so skip */ nand_addr += ((header->hlen + header->dlen + page_size - 1) & ~(page_size - 1)); continue; } /* A match, so break out */ old_image_nand_addr = last_image_addr; old_image_size = header->hlen + header->dlen; printf("Found existing bootloader image of the same type at NAND address 0x%llx\n", old_image_nand_addr); break; } /* nand_addr is either 0 (no image found), or has the address of the * image we will delete after the write of the new image. */ if (!last_image_addr) puts("No existing matching bootloader found in flash\n"); /* Find a blank set of _blocks_ to put the new image in. We want * to make sure that we don't put any part of it in a block with * something else, as we want to be able to erase it later. */ required_len = new_header->hlen + new_header->dlen; required_blocks = (required_len + block_size - 1) / block_size; conseq_blank_blocks = 0; for (nand_addr = block_size; nand_addr < end; nand_addr += block_size) { if (octeon_nand_is_block_blank(dev, nand_addr)) { debug("NAND address 0x%llx is blank\n", nand_addr); conseq_blank_blocks++; if (conseq_blank_blocks == required_blocks) { /* We have a large enough blank spot */ debug("Found %d consecutive blank blocks\n", conseq_blank_blocks); nand_addr -= (conseq_blank_blocks - 1) * block_size; break; } } else { debug("NAND address 0x%llx is not blank\n", nand_addr); conseq_blank_blocks = 0; } } if (nand_addr >= end) { puts("ERROR: unable to find blank space for new bootloader\n"); return 1; } printf("New bootloader image will be written at blank address 0x%llx, length 0x%x\n", nand_addr, required_len); write_length = required_len; bytes_written = 0; /* Write the new bootloader to blank location. */ if (nand_write_skip_bad(nand, nand_addr, &write_length, &bytes_written, CONFIG_OCTEON_NAND_BOOT_END - nand_addr, (u_char *)image_addr, 0) != 0 || (bytes_written != required_len)) { puts("ERROR: error while writing new image to flash.\n"); return 1; } printf("Wrote %d bytes at NAND offset 0x%llx\n", bytes_written, nand_addr); /* Now erase the old bootloader of the same type. * We know these are not bad NAND blocks since they have valid data * in them. */ erase_base = old_image_nand_addr & ~(block_size - 1); erase_size = (old_image_size + block_size - 1) & ~(block_size - 1); debug("Erasing old image at 0x%llx\n", erase_base); if (nand_erase(nand, erase_base, erase_size)) { printf("nand_erase() failed, addr 0x%08llx, size 0x%llx\n", erase_base, erase_size); return 1; } puts("Bootloader update in NAND complete.\n"); return 0; }
/* testd_flash_test * start_addr: the memory mapped address of where to start writing * nand flash should be 512-byte aligned. * end_addr: the memory mapped address of where to stop writing pattern * should be 512-byte aligned. * pattern: the data pattern to write to flash. Only the last byte of the * pattern is used. * The test writes 512 byte blocks (writesize) and validates the written * flash contents by reading back and comparing the data to the original buffer. * The calculated length end_addr - start_addr should be multiple of writesize.*/ static int testd_flash_test (ulong start_addr, ulong end_addr, ulong pattern) { nand_info_t *nand; u_char *nandptr; size_t tot_length; size_t length; int i; u_char *datbuf, *oobbuf; struct mtd_oob_ops ops; ulong off; u_char flashtest[TEST_BUF_SIZE]; int ret; nand = &nand_info[nand_curr_device]; datbuf = malloc(nand->writesize + nand->oobsize); oobbuf = malloc(nand->oobsize); if (!datbuf || !oobbuf) { puts("No memory for page buffer\n"); return 1; } tot_length = end_addr - start_addr; memset(flashtest, pattern, TEST_BUF_SIZE); while(tot_length > 0) { length = (TEST_BUF_SIZE < tot_length)? TEST_BUF_SIZE: tot_length; ret = nand_write_skip_bad(nand, start_addr&FLASH_OFFSET_MASK, &length, flashtest); /* write to the nand */ if (ret != 0) /* if can't write to the flash */ { free(datbuf); free(oobbuf); return(ret); /* on the nand write */ } off = (ulong) start_addr&FLASH_OFFSET_MASK; off &= ~(nand->writesize - 1); // range check offset loff_t addr = (loff_t) off; memset(&ops, 0, sizeof(ops)); // raw read the data in nand ops.datbuf = datbuf; ops.oobbuf = oobbuf; /* must exist, but oob data will be appended to ops.datbuf */ ops.len = nand->writesize; ops.ooblen = nand->oobsize; ops.mode = MTD_OOB_RAW; i = nand->read_oob(nand, addr, &ops); if (i != 0) { printf("Error (%d) reading page %08lx\n", i, off); free(datbuf); free(oobbuf); return 1; } i = nand->writesize >> 4; nandptr = datbuf; if (memcmp ((const char *)nandptr, flashtest, length)) { free(datbuf); free(oobbuf); return(TESTD_FAIL); } /* Advance start addr */ start_addr += length; tot_length -= length; } free(datbuf); free(oobbuf); return(TESTD_PASS); }