|  | /* | 
|  | * (C) Copyright 2000 | 
|  | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | 
|  | * | 
|  | * See file CREDITS for list of people who contributed to this | 
|  | * project. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or | 
|  | * modify it 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. | 
|  | * | 
|  | * This program is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | * GNU General Public License for more details. | 
|  | * | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * along with this program; if not, write to the Free Software | 
|  | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | 
|  | * MA 02111-1307 USA | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * FLASH support | 
|  | */ | 
|  | #include <common.h> | 
|  | #include <command.h> | 
|  |  | 
|  |  | 
|  | #ifdef CONFIG_HAS_DATAFLASH | 
|  | #include <dataflash.h> | 
|  | #endif | 
|  |  | 
|  | #if (CONFIG_COMMANDS & CFG_CMD_FLASH) | 
|  |  | 
|  | extern flash_info_t flash_info[];	/* info for FLASH chips */ | 
|  |  | 
|  | /* | 
|  | * The user interface starts numbering for Flash banks with 1 | 
|  | * for historical reasons. | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * this routine looks for an abbreviated flash range specification. | 
|  | * the syntax is B:SF[-SL], where B is the bank number, SF is the first | 
|  | * sector to erase, and SL is the last sector to erase (defaults to SF). | 
|  | * bank numbers start at 1 to be consistent with other specs, sector numbers | 
|  | * start at zero. | 
|  | * | 
|  | * returns:	1	- correct spec; *pinfo, *psf and *psl are | 
|  | *			  set appropriately | 
|  | *		0	- doesn't look like an abbreviated spec | 
|  | *		-1	- looks like an abbreviated spec, but got | 
|  | *			  a parsing error, a number out of range, | 
|  | *			  or an invalid flash bank. | 
|  | */ | 
|  | static int | 
|  | abbrev_spec (char *str, flash_info_t ** pinfo, int *psf, int *psl) | 
|  | { | 
|  | flash_info_t *fp; | 
|  | int bank, first, last; | 
|  | char *p, *ep; | 
|  |  | 
|  | if ((p = strchr (str, ':')) == NULL) | 
|  | return 0; | 
|  | *p++ = '\0'; | 
|  |  | 
|  | bank = simple_strtoul (str, &ep, 10); | 
|  | if (ep == str || *ep != '\0' || | 
|  | bank < 1 || bank > CFG_MAX_FLASH_BANKS || | 
|  | (fp = &flash_info[bank - 1])->flash_id == FLASH_UNKNOWN) | 
|  | return -1; | 
|  |  | 
|  | str = p; | 
|  | if ((p = strchr (str, '-')) != NULL) | 
|  | *p++ = '\0'; | 
|  |  | 
|  | first = simple_strtoul (str, &ep, 10); | 
|  | if (ep == str || *ep != '\0' || first >= fp->sector_count) | 
|  | return -1; | 
|  |  | 
|  | if (p != NULL) { | 
|  | last = simple_strtoul (p, &ep, 10); | 
|  | if (ep == p || *ep != '\0' || | 
|  | last < first || last >= fp->sector_count) | 
|  | return -1; | 
|  | } else { | 
|  | last = first; | 
|  | } | 
|  |  | 
|  | *pinfo = fp; | 
|  | *psf = first; | 
|  | *psl = last; | 
|  |  | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static int | 
|  | flash_fill_sect_ranges (ulong addr_first, ulong addr_last, | 
|  | int *s_first, int *s_last, | 
|  | int *s_count ) | 
|  | { | 
|  | flash_info_t *info; | 
|  | ulong bank; | 
|  | int rcode = 0; | 
|  |  | 
|  | *s_count = 0; | 
|  |  | 
|  | for (bank=0; bank < CFG_MAX_FLASH_BANKS; ++bank) { | 
|  | s_first[bank] = -1;	/* first sector to erase	*/ | 
|  | s_last [bank] = -1;	/* last  sector to erase	*/ | 
|  | } | 
|  |  | 
|  | for (bank=0,info=&flash_info[0]; | 
|  | (bank < CFG_MAX_FLASH_BANKS) && (addr_first <= addr_last); | 
|  | ++bank, ++info) { | 
|  | ulong b_end; | 
|  | int sect; | 
|  | short s_end; | 
|  |  | 
|  | if (info->flash_id == FLASH_UNKNOWN) { | 
|  | continue; | 
|  | } | 
|  |  | 
|  | b_end = info->start[0] + info->size - 1;	/* bank end addr */ | 
|  | s_end = info->sector_count - 1;			/* last sector   */ | 
|  |  | 
|  |  | 
|  | for (sect=0; sect < info->sector_count; ++sect) { | 
|  | ulong end;	/* last address in current sect	*/ | 
|  |  | 
|  | end = (sect == s_end) ? b_end : info->start[sect + 1] - 1; | 
|  |  | 
|  | if (addr_first > end) | 
|  | continue; | 
|  | if (addr_last < info->start[sect]) | 
|  | continue; | 
|  |  | 
|  | if (addr_first == info->start[sect]) { | 
|  | s_first[bank] = sect; | 
|  | } | 
|  | if (addr_last  == end) { | 
|  | s_last[bank]  = sect; | 
|  | } | 
|  | } | 
|  | if (s_first[bank] >= 0) { | 
|  | if (s_last[bank] < 0) { | 
|  | if (addr_last > b_end) { | 
|  | s_last[bank] = s_end; | 
|  | } else { | 
|  | puts ("Error: end address" | 
|  | " not on sector boundary\n"); | 
|  | rcode = 1; | 
|  | break; | 
|  | } | 
|  | } | 
|  | if (s_last[bank] < s_first[bank]) { | 
|  | puts ("Error: end sector" | 
|  | " precedes start sector\n"); | 
|  | rcode = 1; | 
|  | break; | 
|  | } | 
|  | sect = s_last[bank]; | 
|  | addr_first = (sect == s_end) ? b_end + 1: info->start[sect + 1]; | 
|  | (*s_count) += s_last[bank] - s_first[bank] + 1; | 
|  | } else if (s_last[bank] >= 0) { | 
|  | puts ("Error: cannot span across banks when they are" | 
|  | " mapped in reverse order\n"); | 
|  | rcode = 1; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | int do_flinfo ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | ulong bank; | 
|  |  | 
|  | #ifdef CONFIG_HAS_DATAFLASH | 
|  | dataflash_print_info(); | 
|  | #endif | 
|  |  | 
|  | if (argc == 1) {	/* print info for all FLASH banks */ | 
|  | for (bank=0; bank <CFG_MAX_FLASH_BANKS; ++bank) { | 
|  | printf ("\nBank # %ld: ", bank+1); | 
|  |  | 
|  | flash_print_info (&flash_info[bank]); | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | bank = simple_strtoul(argv[1], NULL, 16); | 
|  | if ((bank < 1) || (bank > CFG_MAX_FLASH_BANKS)) { | 
|  | printf ("Only FLASH Banks # 1 ... # %d supported\n", | 
|  | CFG_MAX_FLASH_BANKS); | 
|  | return 1; | 
|  | } | 
|  | printf ("\nBank # %ld: ", bank); | 
|  | flash_print_info (&flash_info[bank-1]); | 
|  | return 0; | 
|  | } | 
|  | int do_flerase (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | flash_info_t *info; | 
|  | ulong bank, addr_first, addr_last; | 
|  | int n, sect_first, sect_last; | 
|  | int rcode = 0; | 
|  |  | 
|  | if (argc < 2) { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | if (strcmp(argv[1], "all") == 0) { | 
|  | for (bank=1; bank<=CFG_MAX_FLASH_BANKS; ++bank) { | 
|  | printf ("Erase Flash Bank # %ld ", bank); | 
|  | info = &flash_info[bank-1]; | 
|  | rcode = flash_erase (info, 0, info->sector_count-1); | 
|  | } | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | if ((n = abbrev_spec(argv[1], &info, §_first, §_last)) != 0) { | 
|  | if (n < 0) { | 
|  | puts ("Bad sector specification\n"); | 
|  | return 1; | 
|  | } | 
|  | printf ("Erase Flash Sectors %d-%d in Bank # %d ", | 
|  | sect_first, sect_last, (info-flash_info)+1); | 
|  | rcode = flash_erase(info, sect_first, sect_last); | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | if (argc != 3) { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | if (strcmp(argv[1], "bank") == 0) { | 
|  | bank = simple_strtoul(argv[2], NULL, 16); | 
|  | if ((bank < 1) || (bank > CFG_MAX_FLASH_BANKS)) { | 
|  | printf ("Only FLASH Banks # 1 ... # %d supported\n", | 
|  | CFG_MAX_FLASH_BANKS); | 
|  | return 1; | 
|  | } | 
|  | printf ("Erase Flash Bank # %ld ", bank); | 
|  | info = &flash_info[bank-1]; | 
|  | rcode = flash_erase (info, 0, info->sector_count-1); | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | addr_first = simple_strtoul(argv[1], NULL, 16); | 
|  | addr_last  = simple_strtoul(argv[2], NULL, 16); | 
|  |  | 
|  | if (addr_first >= addr_last) { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | rcode = flash_sect_erase(addr_first, addr_last); | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | int flash_sect_erase (ulong addr_first, ulong addr_last) | 
|  | { | 
|  | flash_info_t *info; | 
|  | ulong bank; | 
|  | int s_first[CFG_MAX_FLASH_BANKS], s_last[CFG_MAX_FLASH_BANKS]; | 
|  | int erased = 0; | 
|  | int planned; | 
|  | int rcode = 0; | 
|  |  | 
|  | rcode = flash_fill_sect_ranges (addr_first, addr_last, | 
|  | s_first, s_last, &planned ); | 
|  |  | 
|  | if (planned && (rcode == 0)) { | 
|  | for (bank=0,info=&flash_info[0]; | 
|  | (bank < CFG_MAX_FLASH_BANKS) && (rcode == 0); | 
|  | ++bank, ++info) { | 
|  | if (s_first[bank]>=0) { | 
|  | erased += s_last[bank] - s_first[bank] + 1; | 
|  | debug ("Erase Flash from 0x%08lx to 0x%08lx " | 
|  | "in Bank # %ld ", | 
|  | info->start[s_first[bank]], | 
|  | (s_last[bank] == info->sector_count) ? | 
|  | info->start[0] + info->size - 1: | 
|  | info->start[s_last[bank]+1] - 1, | 
|  | bank+1); | 
|  | rcode = flash_erase (info, s_first[bank], s_last[bank]); | 
|  | } | 
|  | } | 
|  | printf ("Erased %d sectors\n", erased); | 
|  | } else if (rcode == 0) { | 
|  | puts ("Error: start and/or end address" | 
|  | " not on sector boundary\n"); | 
|  | rcode = 1; | 
|  | } | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | int do_protect (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) | 
|  | { | 
|  | flash_info_t *info; | 
|  | ulong bank, addr_first, addr_last; | 
|  | int i, p, n, sect_first, sect_last; | 
|  | int rcode = 0; | 
|  | #ifdef CONFIG_HAS_DATAFLASH | 
|  | int status; | 
|  | #endif | 
|  | if (argc < 3) { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | if (strcmp(argv[1], "off") == 0) { | 
|  | p = 0; | 
|  | } else if (strcmp(argv[1], "on") == 0) { | 
|  | p = 1; | 
|  | } else { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_HAS_DATAFLASH | 
|  | if ((strcmp(argv[2], "all") != 0) && (strcmp(argv[2], "bank") != 0)) { | 
|  | addr_first = simple_strtoul(argv[2], NULL, 16); | 
|  | addr_last  = simple_strtoul(argv[3], NULL, 16); | 
|  |  | 
|  | if (addr_dataflash(addr_first) && addr_dataflash(addr_last)) { | 
|  | status = dataflash_real_protect(p,addr_first,addr_last); | 
|  | if (status < 0){ | 
|  | puts ("Bad DataFlash sector specification\n"); | 
|  | return 1; | 
|  | } | 
|  | printf("%sProtect %d DataFlash Sectors\n", | 
|  | p ? "" : "Un-", status); | 
|  | return 0; | 
|  | } | 
|  | } | 
|  | #endif | 
|  |  | 
|  | if (strcmp(argv[2], "all") == 0) { | 
|  | for (bank=1; bank<=CFG_MAX_FLASH_BANKS; ++bank) { | 
|  | info = &flash_info[bank-1]; | 
|  | if (info->flash_id == FLASH_UNKNOWN) { | 
|  | continue; | 
|  | } | 
|  | printf ("%sProtect Flash Bank # %ld\n", | 
|  | p ? "" : "Un-", bank); | 
|  |  | 
|  | for (i=0; i<info->sector_count; ++i) { | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (flash_real_protect(info, i, p)) | 
|  | rcode = 1; | 
|  | putc ('.'); | 
|  | #else | 
|  | info->protect[i] = p; | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  | } | 
|  | } | 
|  |  | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (!rcode) puts (" done\n"); | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  |  | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | if ((n = abbrev_spec(argv[2], &info, §_first, §_last)) != 0) { | 
|  | if (n < 0) { | 
|  | puts ("Bad sector specification\n"); | 
|  | return 1; | 
|  | } | 
|  | printf("%sProtect Flash Sectors %d-%d in Bank # %d\n", | 
|  | p ? "" : "Un-", sect_first, sect_last, | 
|  | (info-flash_info)+1); | 
|  | for (i = sect_first; i <= sect_last; i++) { | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (flash_real_protect(info, i, p)) | 
|  | rcode =  1; | 
|  | putc ('.'); | 
|  | #else | 
|  | info->protect[i] = p; | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  | } | 
|  |  | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (!rcode) puts (" done\n"); | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  |  | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | if (argc != 4) { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | if (strcmp(argv[2], "bank") == 0) { | 
|  | bank = simple_strtoul(argv[3], NULL, 16); | 
|  | if ((bank < 1) || (bank > CFG_MAX_FLASH_BANKS)) { | 
|  | printf ("Only FLASH Banks # 1 ... # %d supported\n", | 
|  | CFG_MAX_FLASH_BANKS); | 
|  | return 1; | 
|  | } | 
|  | printf ("%sProtect Flash Bank # %ld\n", | 
|  | p ? "" : "Un-", bank); | 
|  | info = &flash_info[bank-1]; | 
|  |  | 
|  | if (info->flash_id == FLASH_UNKNOWN) { | 
|  | puts ("missing or unknown FLASH type\n"); | 
|  | return 1; | 
|  | } | 
|  | for (i=0; i<info->sector_count; ++i) { | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (flash_real_protect(info, i, p)) | 
|  | rcode =  1; | 
|  | putc ('.'); | 
|  | #else | 
|  | info->protect[i] = p; | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  | } | 
|  |  | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (!rcode) puts (" done\n"); | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  |  | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  | addr_first = simple_strtoul(argv[2], NULL, 16); | 
|  | addr_last  = simple_strtoul(argv[3], NULL, 16); | 
|  |  | 
|  | if (addr_first >= addr_last) { | 
|  | printf ("Usage:\n%s\n", cmdtp->usage); | 
|  | return 1; | 
|  | } | 
|  | rcode = flash_sect_protect (p, addr_first, addr_last); | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  |  | 
|  | int flash_sect_protect (int p, ulong addr_first, ulong addr_last) | 
|  | { | 
|  | flash_info_t *info; | 
|  | ulong bank; | 
|  | int s_first[CFG_MAX_FLASH_BANKS], s_last[CFG_MAX_FLASH_BANKS]; | 
|  | int protected, i; | 
|  | int planned; | 
|  | int rcode; | 
|  |  | 
|  | rcode = flash_fill_sect_ranges( addr_first, addr_last, s_first, s_last, &planned ); | 
|  |  | 
|  | protected = 0; | 
|  |  | 
|  | if (planned && (rcode == 0)) { | 
|  | for (bank=0,info=&flash_info[0]; bank < CFG_MAX_FLASH_BANKS; ++bank, ++info) { | 
|  | if (info->flash_id == FLASH_UNKNOWN) { | 
|  | continue; | 
|  | } | 
|  |  | 
|  | if (s_first[bank]>=0 && s_first[bank]<=s_last[bank]) { | 
|  | debug ("%sProtecting sectors %d..%d in bank %ld\n", | 
|  | p ? "" : "Un-", | 
|  | s_first[bank], s_last[bank], bank+1); | 
|  | protected += s_last[bank] - s_first[bank] + 1; | 
|  | for (i=s_first[bank]; i<=s_last[bank]; ++i) { | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (flash_real_protect(info, i, p)) | 
|  | rcode = 1; | 
|  | putc ('.'); | 
|  | #else | 
|  | info->protect[i] = p; | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  | } | 
|  | } | 
|  | #if defined(CFG_FLASH_PROTECTION) | 
|  | if (!rcode) putc ('\n'); | 
|  | #endif	/* CFG_FLASH_PROTECTION */ | 
|  | } | 
|  |  | 
|  | printf ("%sProtected %d sectors\n", | 
|  | p ? "" : "Un-", protected); | 
|  | } else if (rcode == 0) { | 
|  | puts ("Error: start and/or end address" | 
|  | " not on sector boundary\n"); | 
|  | rcode = 1; | 
|  | } | 
|  | return rcode; | 
|  | } | 
|  |  | 
|  |  | 
|  | /**************************************************/ | 
|  |  | 
|  | U_BOOT_CMD( | 
|  | flinfo,    2,    1,    do_flinfo, | 
|  | "flinfo  - print FLASH memory information\n", | 
|  | "\n    - print information for all FLASH memory banks\n" | 
|  | "flinfo N\n    - print information for FLASH memory bank # N\n" | 
|  | ); | 
|  |  | 
|  | U_BOOT_CMD( | 
|  | erase,   3,   1,  do_flerase, | 
|  | "erase   - erase FLASH memory\n", | 
|  | "start end\n" | 
|  | "    - erase FLASH from addr 'start' to addr 'end'\n" | 
|  | "erase N:SF[-SL]\n    - erase sectors SF-SL in FLASH bank # N\n" | 
|  | "erase bank N\n    - erase FLASH bank # N\n" | 
|  | "erase all\n    - erase all FLASH banks\n" | 
|  | ); | 
|  |  | 
|  | U_BOOT_CMD( | 
|  | protect,  4,  1,   do_protect, | 
|  | "protect - enable or disable FLASH write protection\n", | 
|  | "on  start end\n" | 
|  | "    - protect FLASH from addr 'start' to addr 'end'\n" | 
|  | "protect on  N:SF[-SL]\n" | 
|  | "    - protect sectors SF-SL in FLASH bank # N\n" | 
|  | "protect on  bank N\n    - protect FLASH bank # N\n" | 
|  | "protect on  all\n    - protect all FLASH banks\n" | 
|  | "protect off start end\n" | 
|  | "    - make FLASH from addr 'start' to addr 'end' writable\n" | 
|  | "protect off N:SF[-SL]\n" | 
|  | "    - make sectors SF-SL writable in FLASH bank # N\n" | 
|  | "protect off bank N\n    - make FLASH bank # N writable\n" | 
|  | "protect off all\n    - make all FLASH banks writable\n" | 
|  | ); | 
|  |  | 
|  | #endif	/* CFG_CMD_FLASH */ |