static int do_store_rom_protect(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { #if defined(CONFIG_AML_NAND) char *cmd = NULL; char str[128]; char *area = argv[2]; #endif if (argc < 3)return CMD_RET_USAGE; if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf rom_protect %s", area); store_dbg("command: %s", str); int ret = run_command(str, 0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } #else return -1; #endif } return CMD_RET_SUCCESS; }
static int get_off_size(int argc, char *argv[], loff_t *off, loff_t *size) { if (argc >= 1) { if (!(str2longlong(argv[0], (unsigned long long*)off))) { store_msg("'%s' is not a number\n", argv[0]); return -1; } } else { *off = 0; *size = 0; } if (argc >= 2) { if (!(str2longlong(argv[1], (unsigned long long *)size))) { store_msg("'%s' is not a number\n", argv[1]); return -1; } }else{ *size = 0; } store_dbg("offset 0x%llx, size 0x%llx", *off, *size); return 0; }
int do_store(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) { int i, init_flag=0,dev, ret = 0; uint64_t addr; loff_t off=0, size=0; char *cmd, *s, *area; char str[128]; unsigned char *tmp_buf= NULL; if (argc < 2) goto usage; cmd = argv[1]; if (strcmp(cmd, "erase") == 0){ area = argv[2]; if(strcmp(area, "boot") == 0){ if(POR_NAND_BOOT()){ off = simple_strtoul(argv[3], NULL, 16); size = simple_strtoul(argv[4], NULL, 16); store_dbg("NAND BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); ret = run_command("amlnf deverase boot 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } return ret; }else if(POR_SPI_BOOT()){ off = simple_strtoul(argv[3], NULL, 16); size = simple_strtoul(argv[4], NULL, 16); store_dbg("SPI BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__,off,size); ret = run_command("sf probe 2",0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf erase 0 0x%x", CONFIG_ENV_IN_SPI_OFFSET);//store erase boot shoould NOT erase ENV in flash! ret = run_command(str,0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; }else if(POR_EMMC_BOOT()){ off = simple_strtoul(argv[3], NULL, 16); size = simple_strtoul(argv[4], NULL, 16); store_dbg("MMC BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__,off,size); sprintf(str, "mmc erase bootloader"); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed",cmd); return -1; } #ifdef MMC_BOOT_PARTITION_SUPPORT for(i=0; i<2; i++){ //switch to boot partition here sprintf(str, "mmc switch 1 boot%d", i); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret == -1){ //store_msg("mmc cmd %s failed \n",cmd); return 0; } else if(ret != 0){ store_msg("mmc cmd %s failed",cmd); //return -1; goto E_SWITCH_BACK; } //erase boot partition sprintf(str, "mmc erase bootloader"); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed",cmd); //return -1; goto E_SWITCH_BACK; } } E_SWITCH_BACK: //switch back to urs partition sprintf(str, "mmc switch 1 user"); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } #endif return ret; }else{ store_dbg("CARD BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__,off,size); return 0; } } else if(strcmp(area, "data") == 0){ if(POR_NAND_BOOT()){ store_dbg("NAND BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); ret = run_command("amlnf deverase data 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase code 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase cache 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } return ret; } else if(POR_SPI_BOOT()){ store_dbg("SPI BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); ret = run_command("amlnf deverase data 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase code 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase cache 0",0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } } if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); off = size =0; ret = run_command("mmc erase 1",0); // whole if(ret != 0){ store_msg("mmc cmd %s failed ",cmd); return -1; } } return ret; } else if(POR_EMMC_BOOT()){ store_dbg("MMC BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); off = size =0; ret = run_command("mmc erase 1",0); //whole if(ret != 0){ store_msg("mmc cmd %s failed ",cmd); return -1; } return ret; }else{ store_dbg("CARD BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); return 0; } } else { goto usage; } } else if(strcmp(cmd, "read") == 0){ if (argc < 6) goto usage; s = argv[2]; addr = (ulong)simple_strtoul(argv[3], NULL, 16); if (get_off_size(argc - 4, argv + 4, &off, &size) != 0) goto usage; store_dbg("addr = %llx off= 0x%llx size=0x%llx",addr,off,size); if((POR_NAND_BOOT())){ sprintf(str, "amlnf read_byte %s 0x%llx 0x%llx 0x%llx",s, addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } return ret; }else if((POR_SPI_BOOT())){ if(device_boot_flag == SPI_NAND_FLAG){ sprintf(str, "amlnf read_byte %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed \n",cmd); return -1; } } if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); sprintf(str, "mmc read %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } } return ret; } else if(POR_EMMC_BOOT()) { store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); sprintf(str, "mmc read %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } return ret; }else{ store_dbg("CARD BOOT, %s %d ",__func__,__LINE__); return 0; } } else if(strcmp(cmd, "write") == 0){ if (argc < 6) goto usage; s = argv[2]; addr = (ulong)simple_strtoul(argv[3], NULL, 16); if (get_off_size(argc - 4, argv + 4, &off, &size) != 0) goto usage; if((POR_NAND_BOOT())){ sprintf(str, "amlnf write_byte %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed ",cmd); return -1; } }else if((POR_SPI_BOOT())){ if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); sprintf(str, "amlnf write_byte %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed \n",cmd); return -1; } } if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); sprintf(str, "mmc write %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } } } else if(POR_EMMC_BOOT()) { store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); sprintf(str, "mmc write %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } return ret; }else{ store_dbg("CARD BOOT, %s %d ",__func__,__LINE__); return 0; } return ret; } else if(strcmp(cmd, "rom_write") == 0){ if (argc < 5) goto usage; addr = (ulong)simple_strtoul(argv[2], NULL, 16); if (get_off_size(argc - 3, argv + 3, &off, &size) != 0) goto usage; if(POR_NAND_BOOT()){ sprintf(str, "amlnf rom_write 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; }else if (POR_SPI_BOOT()){ ret = run_command("sf probe 2",0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf erase 0x%llx 0x%llx ", off, size); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf write 0x%llx 0x%llx 0x%llx ",addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; } else if(POR_EMMC_BOOT()){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); tmp_buf= (unsigned char *)addr; #ifndef CONFIG_AML_SECU_BOOT_V2 #ifdef MMC_UBOOT_CLEAR_MBR //modify the 55 AA info for emmc uboot _mbrFlag[0] = tmp_buf[510]; _mbrFlag[1] = tmp_buf[511]; tmp_buf[510]=0; tmp_buf[511]=0; #endif #endif// #if defined(CONFIG_AML_SECU_BOOT_V2) sprintf(str, "mmc write bootloader 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } #ifdef MMC_BOOT_PARTITION_SUPPORT for(i=0; i<2; i++){ //switch to boot partition here sprintf(str, "mmc switch 1 boot%d", i); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret == -1){ //store_msg("mmc cmd %s failed \n",cmd); ret = 0; return ret; } else if(ret != 0){ store_msg("mmc cmd %s failed",cmd); //return -1; goto W_SWITCH_BACK; } //write uboot to boot partition sprintf(str, "mmc write bootloader 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); //return -1; goto W_SWITCH_BACK; } } W_SWITCH_BACK: //switch back to urs partition sprintf(str, "mmc switch 1 user"); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } #endif return ret; }else{ store_dbg("CARD BOOT, %s %d",__func__,__LINE__); return 0; } } else if(strcmp(cmd, "rom_read") == 0){ if (argc < 5) goto usage; addr = (ulong)simple_strtoul(argv[2], NULL, 16); if (get_off_size(argc - 3, argv + 3, &off, &size) != 0) goto usage; if(POR_NAND_BOOT()){ sprintf(str, "amlnf rom_read 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; }else if (POR_SPI_BOOT()){ ret = run_command("sf probe 2",0); if(ret != 0){ return -1; } sprintf(str, "sf read 0x%llx 0x%llx 0x%llx ",addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; }else if (POR_EMMC_BOOT()){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); sprintf(str, "mmc read bootloader 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s\n", str); tmp_buf= (unsigned char *)addr; ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } #ifdef MMC_BOOT_PARTITION_SUPPORT for(i=0; i<2; i++){ //switch to boot partition here sprintf(str, "mmc switch 1 boot%d", i); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret == -1){ //store_msg("mmc cmd %s failed \n",cmd); return 0; } else if(ret != 0){ store_msg("mmc cmd %s failed",cmd); goto R_SWITCH_BACK; //return -1; } //write uboot to boot partition sprintf(str, "mmc read bootloader 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); //return -1; goto R_SWITCH_BACK; } } R_SWITCH_BACK: //switch back to urs partition sprintf(str, "mmc switch 1 user"); store_dbg("command: %s\n", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } #endif #ifndef CONFIG_AML_SECU_BOOT_V2 #ifdef MMC_UBOOT_CLEAR_MBR tmp_buf[510]= _mbrFlag[0]; tmp_buf[511]= _mbrFlag[1]; #endif #endif// #ifndef CONFIG_AML_SECU_BOOT_V2 return ret; }else{ store_dbg("CARD BOOT, %s %d ",__func__,__LINE__); return 0; } } else if (strcmp(cmd, "rom_protect") == 0){ if (argc < 3) goto usage; area = argv[2]; if(POR_NAND_BOOT()){ sprintf(str, "amlnf rom_protect %s", area); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; } } else if (strcmp(cmd, "scrub") == 0){ off = (ulong)simple_strtoul(argv[2], NULL, 16); sprintf(str, "amlnf scrub %d", off); if((POR_NAND_BOOT()) ){ ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } }else if(POR_SPI_BOOT()){ if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } ret = run_command("sf probe 2", 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } } if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); ret = run_command("mmc erase whole",0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } } }else if(POR_EMMC_BOOT()){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); device_boot_flag = EMMC_BOOT_FLAG; ret = run_command("mmcinfo 1", 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } if(_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY){ MsgP("mmc key\n"); run_command("mmc key", 0); } MsgP("mmc erase 1"); ret = run_command("mmc erase 1", 0); } return ret; } else if(strcmp(cmd, "init") == 0){ init_flag = (argc > 2) ? (int)simple_strtoul(argv[2], NULL, 16) : 0; store_dbg("init_flag %d",init_flag); if(POR_NAND_BOOT()){ if((init_flag >=STORE_BOOT_ERASE_PROTECT_CACHE)&&(init_flag <=STORE_BOOT_SCRUB_ALL)){ sprintf(str, "amlnf init %d ",init_flag); run_command(str, 0); } sprintf(str, "amlnf init %d ",0); printf("command: %s -> %d\n", str, init_flag); device_boot_flag = NAND_BOOT_FLAG; ret = run_command(str, 0); if(ret != 0){ #if 0 if((ret == NAND_INIT_FAILED)&&(init_flag == STORE_BOOT_ERASE_ALL)){ sprintf(str, "amlnf init %d ",4); ret = run_command(str, 0); } if(ret){ store_msg("nand cmd %s failed,ret=%d ",cmd,ret); return -1; } return 0; #else return -1; #endif } return ret; } else if(POR_SPI_BOOT()) { if(device_boot_flag == -1) { ret = run_command("sf probe 2", 0); if(ret){ store_msg(" cmd %s failed \n",cmd); return -1; } if((init_flag > STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <= STORE_BOOT_SCRUB_ALL)){ sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); /*nand erase!*/ sprintf(str, "amlnf init %d ",init_flag); run_command(str, 0); } sprintf(str, "amlnf init %d ",0); printf("command: %s -> %d\n", str, init_flag); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret < 0)//fail to init NAND flash { store_msg("nand cmd %s failed \n",cmd); device_boot_flag = SPI_EMMC_FLAG; store_dbg("spi+mmc , %s %d ",__func__,__LINE__); ret = run_command("mmcinfo 1", 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -2; } if(init_flag == STORE_BOOT_ERASE_PROTECT_CACHE){ // OTA upgrade protect cache store_msg("mmc erase non_cache \n"); ret = run_command("mmc erase non_cache", 0); }else if(init_flag >= STORE_BOOT_ERASE_ALL){ // erase all except reserved area if(_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY){ MsgP("mmc key;\n"); run_command("mmc key", 0); } MsgP("mmc erase 1 \n"); ret = run_command("mmc erase 1", 0); } return 0; } else if((ret == NAND_INIT_FAILED)&&(init_flag == STORE_BOOT_ERASE_ALL)){ #if 0 sprintf(str, "amlnf init %d ",4); ret = run_command(str, 0); #else return -1; #endif } device_boot_flag = SPI_NAND_FLAG; return 0; } if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); if((init_flag >=STORE_BOOT_ERASE_PROTECT_CACHE)&&(init_flag <=STORE_BOOT_SCRUB_ALL)){ sprintf(str, "amlnf init %d ",init_flag); run_command(str, 0); } sprintf(str, "amlnf init %d ",0); store_dbg("command: %s", str); ret = run_command(str, 0); #if 0 if((ret == NAND_INIT_FAILED)&&(init_flag == STORE_BOOT_ERASE_ALL)){ sprintf(str, "amlnf init %d ",4); ret = run_command(str, 0); } #else if(ret == NAND_INIT_FAILED){ return -1; } #endif if((init_flag > STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <= STORE_BOOT_SCRUB_ALL)){ ret = run_command("sf probe 2", 0); sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); } } if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); ret = run_command("mmcinfo 1", 0); if(init_flag == STORE_BOOT_ERASE_PROTECT_CACHE){ // OTA upgrade protect cache store_msg("mmc erase non_cache \n"); ret = run_command("mmc erase non_cache", 0); }else if(init_flag == STORE_BOOT_ERASE_ALL){ // erase all except reserved area if(_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY){ run_command("mmc key", 0); } MsgP("mmc erase 1 \n"); ret = run_command("mmc erase 1", 0); } if((init_flag > STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <= STORE_BOOT_SCRUB_ALL)){ ret = run_command("sf probe 2", 0); sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); } } if(ret != 0){ store_msg("cmd %s failed \n",cmd); return -1; } return ret; } else if(POR_EMMC_BOOT()){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); device_boot_flag = EMMC_BOOT_FLAG; ret = run_command("mmcinfo 1", 0); if(ret != 0){ store_msg("mmc cmd %s failed \n",cmd); return -1; } if(init_flag == STORE_BOOT_ERASE_PROTECT_CACHE){ // OTA upgrade protect cache ret = run_command("mmc erase non_cache", 0); }else if(init_flag >= STORE_BOOT_ERASE_ALL){ // erase all except reserved area if(_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY){ MsgP("mmc key\n"); run_command("mmc key", 0); } MsgP("mmc erase 1"); ret = run_command("mmc erase 1", 0); } return ret; }else{ store_dbg("CARD BOOT, %s %d",__func__,__LINE__); return 0; } } else if(strcmp(cmd, "size") == 0){ if (argc < 4) goto usage; s = argv[2]; addr = (ulong)simple_strtoul(argv[3], NULL, 16); if(POR_NAND_BOOT()){ sprintf(str, "amlnf size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } return ret; }else if(POR_SPI_BOOT()){ if(device_boot_flag == SPI_NAND_FLAG){ sprintf(str, "amlnf size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } } if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("MMC , %s %d ",__func__,__LINE__); sprintf(str, "mmc size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed",cmd); return -1; } } return ret; } else if(POR_EMMC_BOOT()){ store_dbg("MMC , %s %d ",__func__,__LINE__); sprintf(str, "mmc size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); if(ret != 0){ store_msg("mmc cmd %s failed",cmd); return -1; } return ret; } else if(POR_CARD_BOOT()){ store_dbg("CARD BOOT , %s %d ",__func__,__LINE__); return 0; } } else if(strcmp(cmd, "disprotect") == 0){ area = argv[2]; if(strcmp(area, "key") == 0){ MsgP("disprotect key\n"); info_disprotect |= DISPROTECT_KEY; _info_disprotect_back_before_mmcinfo1 |= DISPROTECT_KEY; } if(strcmp(area, "secure") == 0){ store_msg("disprotect secure"); info_disprotect |= DISPROTECT_SECURE; } if(strcmp(area, "fbbt") == 0){ store_msg("disprotect fbbt"); info_disprotect |= DISPROTECT_FBBT; } if(strcmp(area, "hynix") == 0){ store_msg("disprotect hynix"); info_disprotect |= DISPROTECT_HYNIX; } return 0; } else if(strcmp(cmd, "exit") == 0){ if(POR_NAND_BOOT()){ ret = run_command("amlnf exit", 0); if(ret != 0){ store_msg("nand cmd %s failed",cmd); return -1; } } return 0; } else{ goto usage; } return ret; usage: cmd_usage(cmdtp); return 1; }
static int do_store_rom_write(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { uint64_t addr; loff_t off=0, size=0; char *cmd = NULL; char str[128]; int ret = 0; int i = 0; cpu_id_t cpu_id = get_cpu_id(); if (argc < 5) return CMD_RET_USAGE; addr = (ulong)simple_strtoul(argv[2], NULL, 16); if (get_off_size(argc - 3, (char **)(argv + 3), &off, &size) != 0) return CMD_RET_FAILURE; if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf rom_write 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } return ret; } else if ((device_boot_flag==SPI_EMMC_FLAG)||(device_boot_flag==SPI_NAND_FLAG)){ ret = run_command("sf probe 2",0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf erase 0x%llx 0x%llx ", off, size); ret = run_command(str, 0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf write 0x%llx 0x%llx 0x%llx ",addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } return ret; } else if(device_boot_flag==EMMC_BOOT_FLAG){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); #ifndef CONFIG_AML_SECU_BOOT_V2 #ifdef MMC_UBOOT_CLEAR_MBR //modify the 55 AA info for emmc uboot unsigned char *tmp_buf= (unsigned char *)addr; _mbrFlag[0] = tmp_buf[510]; _mbrFlag[1] = tmp_buf[511]; tmp_buf[510]=0; tmp_buf[511]=0; #endif #endif// #if defined(CONFIG_AML_SECU_BOOT_V2) if (cpu_id.family_id >= MESON_CPU_MAJOR_ID_GXL) off += 512; sprintf(str, "amlmmc write bootloader 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } #ifdef MMC_BOOT_PARTITION_SUPPORT for (i=0; i<2; i++) { //switch to boot partition here sprintf(str, "amlmmc switch 1 boot%d", i); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret == -1) { //store_msg("mmc cmd %s failed \n",cmd); ret = 0; return ret; } else if(ret != 0){ store_msg("amlmmc cmd %s failed",cmd); //return -1; goto W_SWITCH_BACK; } //write uboot to boot partition sprintf(str, "amlmmc write bootloader 0x%llx 0x%llx 0x%llx", addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); //return -1; goto W_SWITCH_BACK; } } W_SWITCH_BACK: //switch back to urs partition sprintf(str, "amlmmc switch 1 user"); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } #endif return ret; }else{ store_dbg("CARD BOOT, %s %d",__func__,__LINE__); return 0; } }
static int do_store_erase(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { int i, ret = 0; loff_t size=0; char *cmd = NULL, *area; char str[128]; loff_t off; if (argc < 3) return CMD_RET_USAGE; off = off; area = argv[2]; if (strcmp(area, "boot") == 0) { off = argc > 3 ? simple_strtoul(argv[3], NULL, 16) : 0; size = argc > 4 ? simple_strtoul(argv[4], NULL, 16) : 0x60000; if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) store_dbg("NAND BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); ret = run_command("amlnf deverase boot 0",0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } return ret; }else if((device_boot_flag==SPI_EMMC_FLAG)||(device_boot_flag==SPI_NAND_FLAG)){ store_dbg("SPI BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__,off,size); ret = run_command("sf probe 2",0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf erase 0 0x%x", CONFIG_ENV_IN_SPI_OFFSET);//store erase boot shoould NOT erase ENV in flash! ret = run_command(str,0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } return ret; }else if(device_boot_flag == EMMC_BOOT_FLAG){ store_dbg("MMC BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__,off,size); sprintf(str, "amlmmc erase bootloader"); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed",cmd); return -1; } #ifdef MMC_BOOT_PARTITION_SUPPORT for (i=0; i<2; i++) { //switch to boot partition here sprintf(str, "amlmmc switch 1 boot%d", i); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret == -1) { //store_msg("mmc cmd %s failed \n",cmd); return 0; } else if(ret != 0){ store_msg("amlmmc cmd %s failed",cmd); //return -1; goto E_SWITCH_BACK; } //erase boot partition sprintf(str, "amlmmc erase bootloader"); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed",cmd); //return -1; goto E_SWITCH_BACK; } } E_SWITCH_BACK: //switch back to urs partition sprintf(str, "amlmmc switch 1 user"); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } #endif return ret; }else{ store_dbg("CARD BOOT,erase uboot : %s %d off =%llx ,size=%llx",__func__,__LINE__,off,size); return 0; } } else if (strcmp(area, "data") == 0){ if (device_boot_flag == NAND_BOOT_FLAG) { store_dbg("NAND BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); #if defined(CONFIG_AML_NAND) ret = run_command("amlnf deverase data 0",0); if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase code 0",0); if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase cache 0",0); if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } #endif return ret; } else if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); #if defined(CONFIG_AML_NAND) ret = run_command("amlnf deverase data 0",0); if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase code 0",0); if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } ret = run_command("amlnf deverase cache 0",0); if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } #endif return ret; } else if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); off = size =0; ret = run_command("mmc erase 1",0); // whole if (ret != 0) { store_msg("mmc cmd %s failed ",cmd); return -1; } return ret; } else if(device_boot_flag==EMMC_BOOT_FLAG){ store_dbg("MMC BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); off = size =0; ret = run_command("amlmmc erase 1",0); //whole if (ret != 0) { store_msg("amlmmc cmd %s failed ",cmd); return -1; } return ret; }else{ store_dbg("CARD BOOT,erase data : %s %d off =%llx ,size=%llx",__func__,__LINE__, off, size); return 0; } } else if (strcmp(area, "key") == 0){ if (device_boot_flag == EMMC_BOOT_FLAG) { sprintf(str, "emmc erase key"); ret = run_command(str, 0); if (ret != 0) { store_msg("emmc cmd %s failed",cmd); return CMD_RET_USAGE; } } else if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf key_erase"); ret = run_command(str, 0); if (ret != 0) { store_msg("emmc cmd %s failed",cmd); return CMD_RET_USAGE; } #endif } } else if (strcmp(area, "dtb") == 0) { if (device_boot_flag == EMMC_BOOT_FLAG) { sprintf(str, "emmc erase dtb"); ret = run_command(str, 0); if (ret != 0) { store_msg("emmc cmd %s failed",cmd); return CMD_RET_USAGE; } } else if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf dtb_erase"); ret = run_command(str, 0); if (ret != 0) { store_msg("emmc cmd %s failed",cmd); return CMD_RET_USAGE; } #endif } } return 0; }
static int do_store_scrub(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { int ret = 0; loff_t off=0; char *cmd = NULL; char str[128]; off = (ulong)simple_strtoul(argv[2], NULL, 16); sprintf(str, "amlnf scrub %d", (int)off); if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) ret = run_command(str, 0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } } else if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); #if defined(CONFIG_AML_NAND) ret = run_command(str, 0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } #endif ret = run_command("sf probe 2", 0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } return ret; } else if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); ret = run_command("amlmmc erase whole",0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } return ret; } else if(device_boot_flag==EMMC_BOOT_FLAG){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); device_boot_flag = EMMC_BOOT_FLAG; run_command("mmc dev 1", 0); ret = run_command("mmcinfo", 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } if (_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY) { MsgP("mmc key\n"); run_command("mmc key", 0); } MsgP("amlmmc erase 1"); ret = run_command("amlmmc erase 1", 0); } return ret; }
static int do_store_size(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { int ret = 0; uint64_t addr; char *cmd = NULL, *s = NULL; char str[128]; if (argc < 4) return CMD_RET_USAGE; s = argv[2]; addr = (ulong)simple_strtoul(argv[3], NULL, 16); if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } return ret; } else if(device_boot_flag == SPI_NAND_FLAG){ #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed",cmd); return -1; } return ret; } else if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("MMC , %s %d ",__func__,__LINE__); sprintf(str, "amlmmc size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed",cmd); return -1; } return ret; } else if(device_boot_flag==EMMC_BOOT_FLAG){ store_dbg("MMC , %s %d ",__func__,__LINE__); sprintf(str, "amlmmc size %s %llx",s,addr); store_dbg("command: %s", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed",cmd); return -1; } return ret; } else if(device_boot_flag==CARD_BOOT_FLAG){ store_dbg("CARD BOOT , %s %d ",__func__,__LINE__); return CMD_RET_FAILURE; } return CMD_RET_FAILURE; }
static int do_store_init(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { int i, init_flag=0, ret = 0; char *cmd = ""; char str[128]; init_flag = (argc > 2) ? (int)simple_strtoul(argv[2], NULL, 16) : 0; store_dbg("init_flag %d",init_flag); if (device_boot_flag == _AML_DEVICE_BOOT_FLAG_DEFAULT ) { i = get_device_boot_flag(); if (i) { MsgP("ERR:FAILED in get_device_boot_flag\n"); return __LINE__; } } switch (device_boot_flag) { #if defined(CONFIG_AML_NAND) case NAND_BOOT_FLAG: { if ((init_flag >=STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <=STORE_BOOT_SCRUB_ALL)) { sprintf(str, "amlnf init %d ",init_flag); run_command(str, 0); } sprintf(str, "amlnf init %d ",1); printf("command: %s <- %d\n", str, init_flag); device_boot_flag = NAND_BOOT_FLAG; ret = run_command(str, 0); if (ret != 0) { #if 0 if ((ret == NAND_INIT_FAILED) && (init_flag == STORE_BOOT_ERASE_ALL)) { sprintf(str, "amlnf init %d ",4); ret = run_command(str, 0); } if (ret) { store_msg("nand cmd %s failed,ret=%d ",cmd,ret); return -1; } return 0; #else return -1; #endif } return ret; } break; #endif case EMMC_BOOT_FLAG: { store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); device_boot_flag = EMMC_BOOT_FLAG; sprintf(str, "mmc dev %d", CONFIG_SYS_MMC_ENV_DEV); run_command(str,0); ret = run_command("mmcinfo", 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } if (init_flag == STORE_BOOT_ERASE_PROTECT_CACHE) { // OTA upgrade protect cache ret = run_command("amlmmc erase non_cache", 0); }else if(init_flag >= STORE_BOOT_ERASE_ALL){ // erase all except reserved area if (_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY) { MsgP("amlmmc key\n"); run_command("amlmmc key", 0); } sprintf(str, "amlmmc erase %d", CONFIG_SYS_MMC_ENV_DEV); MsgP("amlmmc erase %d", CONFIG_SYS_MMC_ENV_DEV); ret = run_command(str, 0); } return ret; } break; case SPI_EMMC_FLAG: case SPI_NAND_FLAG: { /* if (device_boot_flag == -1) { ret = run_command("sf probe 2", 0); if (ret) { store_msg(" cmd %s failed \n",cmd); return -1; } if ((init_flag > STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <= STORE_BOOT_SCRUB_ALL)) { sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); } sprintf(str, "amlnf init %d ",init_flag); store_dbg("command: %s", str); ret = run_command(str, 0); if (ret < 0) //fail to init NAND flash { store_msg("nand cmd %s failed \n",cmd); device_boot_flag = SPI_EMMC_FLAG; store_dbg("spi+mmc , %s %d ",__func__,__LINE__); ret = run_command("mmcinfo 1", 0); if (ret != 0) { store_msg("mmc cmd %s failed \n",cmd); return -2; } if (init_flag == STORE_BOOT_ERASE_PROTECT_CACHE) { // OTA upgrade protect cache store_msg("mmc erase non_cache \n"); ret = run_command("mmc erase non_cache", 0); }else if(init_flag >= STORE_BOOT_ERASE_ALL){ // erase all except reserved area if (_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY) { MsgP("mmc key;\n"); run_command("mmc key", 0); } MsgP("mmc erase 1 \n"); ret = run_command("mmc erase 1", 0); } return 0; } else if((ret == NAND_INIT_FAILED)&&(init_flag == STORE_BOOT_ERASE_ALL)){ sprintf(str, "amlnf init %d ",4); ret = run_command(str, 0); } device_boot_flag = SPI_NAND_FLAG; return 0; } */ if (device_boot_flag == SPI_NAND_FLAG) { store_dbg("spi+nand , %s %d ",__func__,__LINE__); #if defined(CONFIG_AML_NAND) if ((init_flag >=STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <=STORE_BOOT_SCRUB_ALL)) { sprintf(str, "amlnf init %d ",init_flag); run_command(str, 0); } sprintf(str, "amlnf init %d ",1); store_dbg("command: %s", str); ret = run_command(str, 0); #else ret = NAND_INIT_FAILED; #endif #if 0 if ((ret == NAND_INIT_FAILED) && (init_flag == STORE_BOOT_ERASE_ALL)) { sprintf(str, "amlnf init %d ",4); ret = run_command(str, 0); } #else if (ret == NAND_INIT_FAILED) { return -1; } #endif if ((init_flag > STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <= STORE_BOOT_SCRUB_ALL)) { ret = run_command("sf probe 2", 0); sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); } } if (device_boot_flag == SPI_EMMC_FLAG) { store_dbg("spi+mmc , %s %d ",__func__,__LINE__); ret = run_command("mmcinfo 1", 0); if (init_flag == STORE_BOOT_ERASE_PROTECT_CACHE) { // OTA upgrade protect cache store_msg("amlmmc erase non_cache \n"); ret = run_command("amlmmc erase non_cache", 0); }else if(init_flag == STORE_BOOT_ERASE_ALL){ // erase all except reserved area if (_info_disprotect_back_before_mmcinfo1 & DISPROTECT_KEY) { run_command("mmc key", 0); } MsgP("amlmmc erase 1 \n"); ret = run_command("amlmmc erase 1", 0); } if ((init_flag > STORE_BOOT_ERASE_PROTECT_CACHE) && (init_flag <= STORE_BOOT_SCRUB_ALL)) { ret = run_command("sf probe 2", 0); sprintf(str, "sf erase 0 0x%x", _SPI_FLASH_ERASE_SZ); ret = run_command(str,0); } } if (ret != 0) { store_msg("cmd %s failed \n",cmd); return -1; } return ret; } default: store_dbg("CARD BOOT, %s %d",__func__,__LINE__); return CMD_RET_FAILURE; } return 0; }
static int do_store_write(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) { uint64_t addr; loff_t off=0, size=0; char *cmd = NULL; char str[128]; int ret = 0; char * s = argv[2]; if (argc < 6) return CMD_RET_USAGE; addr = (ulong)simple_strtoul(argv[3], NULL, 16); if (get_off_size(argc - 4, (char **)(argv + 4), &off, &size) != 0) return CMD_RET_FAILURE; if (device_boot_flag == NAND_BOOT_FLAG) { #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf write_byte %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed ",cmd); return -1; } return ret; } else if(device_boot_flag == SPI_NAND_FLAG){ store_dbg("spi+nand , %s %d ",__func__,__LINE__); #if defined(CONFIG_AML_NAND) sprintf(str, "amlnf write_byte %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s", str); ret = run_command(str, 0); #else ret = -1; #endif if (ret != 0) { store_msg("nand cmd %s failed \n",cmd); return -1; } return ret; } else if(device_boot_flag == SPI_EMMC_FLAG){ store_dbg("spi+mmc , %s %d ",__func__,__LINE__); sprintf(str, "amlmmc write %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } return ret; } else if(device_boot_flag==EMMC_BOOT_FLAG){ store_dbg("MMC BOOT, %s %d \n",__func__,__LINE__); sprintf(str, "amlmmc write %s 0x%llx 0x%llx 0x%llx", s, addr, off, size); store_dbg("command: %s\n", str); ret = run_command(str, 0); if (ret != 0) { store_msg("amlmmc cmd %s failed \n",cmd); return -1; } return ret; }else{ store_dbg("CARD BOOT, %s %d ",__func__,__LINE__); return CMD_RET_FAILURE; } return ret; }
void emmc_env_relocate_spec(void) { #if !defined(ENV_IS_EMBEDDED) int dev_num; int ret; env_t * env_buf = NULL; u64 cnt = CONFIG_ENV_SIZE; u64 blk = 0; uint32_t crc; struct mmc *mmc = NULL; char *name = "env"; struct partitions *part_info = NULL; int blk_shift = 0; env_buf = (env_t *)malloc(CONFIG_ENV_SIZE); if(!env_buf) { printf("malloc failed \n"); return ; } memset(env_buf->data, 0, ENV_SIZE); #ifdef CONFIG_STORE_COMPATIBLE part_info = find_mmc_partition_by_name(name); if(part_info == NULL) { printf("get partition info failed !!\n"); return ; } dev_num = find_dev_num_by_partition_name (name); if(dev_num < 0) { printf("get mmc dev failed !!\n"); return ; } store_dbg(" read env: dev_num %d",dev_num); mmc = find_mmc_device(dev_num); if (!mmc) { set_default_env("!No MMC device"); return; } if ((cnt % 512) || (blk % 512)) { set_default_env("!addr or blk count notalign"); return ; } blk_shift = ffs(mmc->read_bl_len) - 1; blk = part_info->offset >> blk_shift; cnt = cnt >> blk_shift; #endif store_dbg(" read env: blk_shift %d blk %d cnt %llx",blk_shift,blk,cnt); ret =(cnt == mmc->block_dev.block_read(dev_num, blk, cnt, env_buf)); if(!ret) { set_default_env("!readenv() failed"); saveenv(); return; } crc = env_buf->crc; if (crc32(0, env_buf->data, ENV_SIZE) != crc) { set_default_env("!bad CRC"); saveenv(); } env_import(env_buf, 1); #endif }
int emmc_saveenv(void) { struct mmc *mmc; int dev_num; u64 cnt = CONFIG_ENV_SIZE; u64 blk = 0; env_t *env_new_p = NULL; ssize_t len; char *res; #ifdef CONFIG_STORE_COMPATIBLE char *name = "env"; struct partitions *part_info = NULL; int blk_shift = 0; store_dbg("emmc save env: cnt %llx",cnt); part_info = find_mmc_partition_by_name(name); if(part_info == NULL) { printf("get partition info failed !!\n"); return ; } dev_num = find_dev_num_by_partition_name (name); if(dev_num < 0) { printf("get mmc dev failed !!\n"); return ; } #else blk = CONFIG_ENV_IN_EMMC_OFFSET; dev_num = CONFIG_SYS_MMC_ENV_DEV; #endif mmc = find_mmc_device(dev_num); if (!mmc) { puts("No MMC device! Environment MMC not initialized!\n"); return -1; } if ((cnt % 512) || (blk % 512)) { printf("addr notalign 0x%llx or byte notalign 0x%llx",blk,cnt); return -1; } env_new_p = (env_t *)malloc (CONFIG_ENV_SIZE); // get env data from hash table memset(env_new_p->data, 0, ENV_SIZE); res = (char *)&(env_new_p->data); len = hexport_r(&env_htab, '\0', &res, ENV_SIZE); if (len < 0) { error("Cannot export environment: errno = %d\n", errno); free(env_new_p); return 1; } env_new_p->crc = crc32(0, env_new_p->data, ENV_SIZE); mmc_init(mmc); #ifdef CONFIG_STORE_COMPATIBLE blk_shift = ffs(mmc->read_bl_len) - 1; blk = part_info->offset >> blk_shift; store_dbg("cnt %llx",cnt); cnt = cnt >> blk_shift; #else blk >>= 9; cnt >>= 9; #endif if(cnt == mmc->block_dev.block_write(dev_num, blk, cnt, (const void *)env_new_p)) { printf("mmc save env ok\n"); } else { printf("mmc save env fail\n"); free(env_new_p); return -1; } free(env_new_p); return 0; }