| /* | |
| * (C) Copyright 2000-2004 | |
| * 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 | |
| */ | |
| #include <common.h> | |
| #if defined(CONFIG_NIOS) | |
| #include <nios.h> | |
| #else | |
| #include <asm/io.h> | |
| #endif | |
| #define SECTSZ (64 * 1024) | |
| flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS]; | |
| /*----------------------------------------------------------------------*/ | |
| unsigned long flash_init (void) | |
| { | |
| int i; | |
| unsigned long addr; | |
| flash_info_t *fli = &flash_info[0]; | |
| fli->size = CONFIG_SYS_FLASH_SIZE; | |
| fli->sector_count = CONFIG_SYS_MAX_FLASH_SECT; | |
| fli->flash_id = FLASH_MAN_AMD + FLASH_AMDLV065D; | |
| addr = CONFIG_SYS_FLASH_BASE; | |
| for (i = 0; i < fli->sector_count; ++i) { | |
| fli->start[i] = addr; | |
| addr += SECTSZ; | |
| fli->protect[i] = 1; | |
| } | |
| return (CONFIG_SYS_FLASH_SIZE); | |
| } | |
| /*--------------------------------------------------------------------*/ | |
| void flash_print_info (flash_info_t * info) | |
| { | |
| int i, k; | |
| int erased; | |
| unsigned long *addr; | |
| printf (" Size: %ld KB in %d Sectors\n", | |
| info->size >> 10, info->sector_count); | |
| printf (" Sector Start Addresses:"); | |
| for (i = 0; i < info->sector_count; ++i) { | |
| /* Check if whole sector is erased */ | |
| erased = 1; | |
| addr = (unsigned long *) info->start[i]; | |
| for (k = 0; k < SECTSZ/sizeof(unsigned long); k++) { | |
| if ( readl(addr++) != (unsigned long)-1) { | |
| erased = 0; | |
| break; | |
| } | |
| } | |
| /* Print the info */ | |
| if ((i % 5) == 0) | |
| printf ("\n "); | |
| printf (" %08lX%s%s", | |
| info->start[i], | |
| erased ? " E" : " ", | |
| info->protect[i] ? "RO " : " "); | |
| } | |
| printf ("\n"); | |
| } | |
| /*-------------------------------------------------------------------*/ | |
| int flash_erase (flash_info_t * info, int s_first, int s_last) | |
| { | |
| unsigned char *addr = (unsigned char *) info->start[0]; | |
| unsigned char *addr2; | |
| int prot, sect; | |
| ulong start; | |
| /* Some sanity checking */ | |
| if ((s_first < 0) || (s_first > s_last)) { | |
| printf ("- no sectors to erase\n"); | |
| return 1; | |
| } | |
| prot = 0; | |
| for (sect = s_first; sect <= s_last; ++sect) { | |
| if (info->protect[sect]) { | |
| prot++; | |
| } | |
| } | |
| if (prot) { | |
| printf ("- Warning: %d protected sectors will not be erased!\n", | |
| prot); | |
| } else { | |
| printf ("\n"); | |
| } | |
| /* It's ok to erase multiple sectors provided we don't delay more | |
| * than 50 usec between cmds ... at which point the erase time-out | |
| * occurs. So don't go and put printf() calls in the loop ... it | |
| * won't be very helpful ;-) | |
| */ | |
| for (sect = s_first; sect <= s_last; sect++) { | |
| if (info->protect[sect] == 0) { /* not protected */ | |
| addr2 = (unsigned char *) info->start[sect]; | |
| writeb (0xaa, addr); | |
| writeb (0x55, addr); | |
| writeb (0x80, addr); | |
| writeb (0xaa, addr); | |
| writeb (0x55, addr); | |
| writeb (0x30, addr2); | |
| /* Now just wait for 0xff & provide some user | |
| * feedback while we wait. | |
| */ | |
| start = get_timer (0); | |
| while ( readb (addr2) != 0xff) { | |
| udelay (1000 * 1000); | |
| putc ('.'); | |
| if (get_timer (start) > CONFIG_SYS_FLASH_ERASE_TOUT) { | |
| printf ("timeout\n"); | |
| return 1; | |
| } | |
| } | |
| } | |
| } | |
| printf ("\n"); | |
| return 0; | |
| } | |
| /*----------------------------------------------------------------------- | |
| * Copy memory to flash, returns: | |
| * 0 - OK | |
| * 1 - write timeout | |
| * 2 - Flash not erased | |
| */ | |
| int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt) | |
| { | |
| vu_char *cmd = (vu_char *) info->start[0]; | |
| vu_char *dst = (vu_char *) addr; | |
| unsigned char b; | |
| ulong start; | |
| while (cnt) { | |
| /* Check for sufficient erase */ | |
| b = *src; | |
| if ((readb (dst) & b) != b) { | |
| printf ("%02x : %02x\n", readb (dst), b); | |
| return (2); | |
| } | |
| writeb (0xaa, cmd); | |
| writeb (0x55, cmd); | |
| writeb (0xa0, cmd); | |
| writeb (b, dst); | |
| /* Verify write */ | |
| start = get_timer (0); | |
| while (readb (dst) != b) { | |
| if (get_timer (start) > CONFIG_SYS_FLASH_WRITE_TOUT) { | |
| return 1; | |
| } | |
| } | |
| dst++; | |
| src++; | |
| cnt--; | |
| } | |
| return (0); | |
| } |