Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / u-boot / board / psyent / common / AMDLV065D.c
diff --git a/qemu/roms/u-boot/board/psyent/common/AMDLV065D.c b/qemu/roms/u-boot/board/psyent/common/AMDLV065D.c
new file mode 100644 (file)
index 0000000..409a7a8
--- /dev/null
@@ -0,0 +1,174 @@
+/*
+ * (C) Copyright 2000-2004
+ * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+
+#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 (dst, b);
+
+               /* 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);
+}