rename CFG_ENV macros to CONFIG_ENV
[platform/kernel/u-boot.git] / board / csb226 / flash.c
index 0b4e2f6..2a60909 100644 (file)
@@ -7,7 +7,10 @@
  * Marius Groeger <mgroeger@sysgo.de>
  *
  * (C) Copyright 2002
- * Robert Schwebel, Pengutronix, <r.schwebel@pengutronix.de> 
+ * Robert Schwebel, Pengutronix, <r.schwebel@pengutronix.de>
+ *
+ * (C) Copyright 2003 (2 x 16 bit Flash bank patches)
+ * Rolf Peukert, IMMS gGmbH, <rolf.peukert@imms.de>
  *
  * See file CREDITS for list of people who contributed to this
  * project.
@@ -19,7 +22,7 @@
  *
  * 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
+ * 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
@@ -32,9 +35,9 @@
 #include <asm/arch/pxa-regs.h>
 
 #define FLASH_BANK_SIZE 0x02000000
-#define MAIN_SECT_SIZE  0x40000         /* 2x16 = 256k per sector */
+#define MAIN_SECT_SIZE 0x40000         /* 2x16 = 256k per sector */
 
-flash_info_t    flash_info[CFG_MAX_FLASH_BANKS];
+flash_info_t   flash_info[CFG_MAX_FLASH_BANKS];
 
 
 /**
@@ -45,329 +48,319 @@ flash_info_t    flash_info[CFG_MAX_FLASH_BANKS];
 
 ulong flash_init(void)
 {
-    int i, j;
-    ulong size = 0;
+       int i, j;
+       ulong size = 0;
 
        for (i = 0; i < CFG_MAX_FLASH_BANKS; i++) {
-       ulong flashbase = 0;
-       flash_info[i].flash_id =
-         (INTEL_MANUFACT & FLASH_VENDMASK) |
-         (INTEL_ID_28F128J3 & FLASH_TYPEMASK);
-       flash_info[i].size = FLASH_BANK_SIZE;
-       flash_info[i].sector_count = CFG_MAX_FLASH_SECT;
-       memset(flash_info[i].protect, 0, CFG_MAX_FLASH_SECT);
+               ulong flashbase = 0;
+               flash_info[i].flash_id =
+                       (INTEL_MANUFACT & FLASH_VENDMASK) |
+                       (INTEL_ID_28F128J3 & FLASH_TYPEMASK);
+               flash_info[i].size = FLASH_BANK_SIZE;
+               flash_info[i].sector_count = CFG_MAX_FLASH_SECT;
+               memset(flash_info[i].protect, 0, CFG_MAX_FLASH_SECT);
 
                switch (i) {
-           case 0:
-               flashbase = PHYS_FLASH_1;
-                break;
-           default:
-               panic("configured to many flash banks!\n");
-                break;
-        }
+               case 0:
+                       flashbase = PHYS_FLASH_1;
+                       break;
+               default:
+                       panic("configured too many flash banks!\n");
+                       break;
+               }
                for (j = 0; j < flash_info[i].sector_count; j++) {
-           flash_info[i].start[j] = flashbase + j*MAIN_SECT_SIZE;
+                       flash_info[i].start[j] = flashbase + j*MAIN_SECT_SIZE;
+               }
+               size += flash_info[i].size;
        }
-       size += flash_info[i].size;
-    }
 
        /* Protect monitor and environment sectors */
-    flash_protect(FLAG_PROTECT_SET,
-                 CFG_FLASH_BASE,
-                 CFG_FLASH_BASE + _armboot_end_data - _armboot_start,
-                 &flash_info[0]);
+       flash_protect(FLAG_PROTECT_SET,
+                       CFG_FLASH_BASE,
+                       CFG_FLASH_BASE + monitor_flash_len - 1,
+                       &flash_info[0]);
 
-    flash_protect(FLAG_PROTECT_SET,
-                 CFG_ENV_ADDR,
-                 CFG_ENV_ADDR + CFG_ENV_SIZE - 1,
-                 &flash_info[0]);
+       flash_protect(FLAG_PROTECT_SET,
+                       CONFIG_ENV_ADDR,
+                       CONFIG_ENV_ADDR + CONFIG_ENV_SIZE - 1,
+                       &flash_info[0]);
 
-    return size;
+       return size;
 }
 
 
 /**
  * flash_print_info: - print information about the flash situation
- *
- * @param info: 
  */
 
 void flash_print_info  (flash_info_t *info)
 {
-    int i, j;
+       int i, j;
 
        for (j=0; j<CFG_MAX_FLASH_BANKS; j++) {
 
                switch (info->flash_id & FLASH_VENDMASK) {
-
-        case (INTEL_MANUFACT & FLASH_VENDMASK):
-               printf("Intel: ");
-               break;
-        default:
-               printf("Unknown Vendor ");
-               break;
-        }
+               case (INTEL_MANUFACT & FLASH_VENDMASK):
+                       printf ("Intel: ");
+                       break;
+               default:
+                       printf ("Unknown Vendor ");
+                       break;
+               }
 
                switch (info->flash_id & FLASH_TYPEMASK) {
+               case (INTEL_ID_28F128J3 & FLASH_TYPEMASK):
+                       printf("28F128J3 (128Mbit)\n");
+                       break;
+               default:
+                       printf("Unknown Chip Type\n");
+                       return;
+               }
 
-        case (INTEL_ID_28F128J3 & FLASH_TYPEMASK):
-               printf("28F128J3 (128Mbit)\n");
-               break;
-        default:
-               printf("Unknown Chip Type\n");
-                               return;
-        }
-
-        printf("  Size: %ld MB in %d Sectors\n",
-               info->size >> 20, info->sector_count);
+               printf("  Size: %ld MB in %d Sectors\n",
+                       info->size >> 20, info->sector_count);
 
-        printf("  Sector Start Addresses:");
+               printf("  Sector Start Addresses:");
                for (i = 0; i < info->sector_count; i++) {
-                       if ((i % 5) == 0) printf ("\n   ");
-               
-               printf (" %08lX%s", info->start[i],
-                       info->protect[i] ? " (RO)" : "     ");
-        }
-        printf ("\n");
-        info++;
-    }
+                       if ((i % 5) == 0) printf ("\n   ");
+
+                       printf (" %08lX%s", info->start[i],
+                               info->protect[i] ? " (RO)" : "     ");
+               }
+               printf ("\n");
+               info++;
+       }
 }
 
 
 /**
  * flash_erase: - erase flash sectors
- *
  */
 
-int    flash_erase (flash_info_t *info, int s_first, int s_last)
+int flash_erase(flash_info_t *info, int s_first, int s_last)
 {
-    int flag, prot, sect;
-    int rc = ERR_OK;
+       int flag, prot, sect;
+       int rc = ERR_OK;
 
-    if (info->flash_id == FLASH_UNKNOWN)
-       return ERR_UNKNOWN_FLASH_TYPE;
+       if (info->flash_id == FLASH_UNKNOWN)
+               return ERR_UNKNOWN_FLASH_TYPE;
 
-    if ((s_first < 0) || (s_first > s_last)) {
-       return ERR_INVAL;
-    }
+       if ((s_first < 0) || (s_first > s_last)) {
+               return ERR_INVAL;
+       }
 
        if ((info->flash_id & FLASH_VENDMASK) != (INTEL_MANUFACT & FLASH_VENDMASK))
-       return ERR_UNKNOWN_FLASH_VENDOR;
+               return ERR_UNKNOWN_FLASH_VENDOR;
 
-    prot = 0;
-    for (sect=s_first; sect<=s_last; ++sect) {
+       prot = 0;
+       for (sect=s_first; sect<=s_last; ++sect) {
                if (info->protect[sect]) prot++;
        }
 
        if (prot) return ERR_PROTECTED;
 
-    /*
-     * Disable interrupts which might cause a timeout
-     * here. Remember that our exception vectors are
-     * at address 0 in the flash, and we don't want a
-     * (ticker) exception to happen while the flash
-     * chip is in programming mode.
-     */
-    flag = disable_interrupts();
+       /*
+        * Disable interrupts which might cause a timeout
+        * here. Remember that our exception vectors are
+        * at address 0 in the flash, and we don't want a
+        * (ticker) exception to happen while the flash
+        * chip is in programming mode.
+        */
 
-    /* Start erase on unprotected sectors */
-    for (sect = s_first; sect<=s_last && !ctrlc(); sect++) {
+       flag = disable_interrupts();
 
-       printf("Erasing sector %2d ... ", sect);
+       /* Start erase on unprotected sectors */
+       for (sect = s_first; sect<=s_last && !ctrlc(); sect++) {
 
-       /* arm simple, non interrupt dependent timer */
-       reset_timer_masked();
+               printf("Erasing sector %2d ... ", sect);
+
+               /* arm simple, non interrupt dependent timer */
+               reset_timer_masked();
 
-       if (info->protect[sect] == 0) { /* not protected */
+               if (info->protect[sect] == 0) { /* not protected */
                        u32 * volatile addr = (u32 * volatile)(info->start[sect]);
 
-                       /* erase sector:                                    */
+                       /* erase sector:                                    */
                        /* The strata flashs are aligned side by side on    */
                        /* the data bus, so we have to write the commands   */
-                       /* to both chips here:                              */
+                       /* to both chips here:                              */
 
                        *addr = 0x00200020;     /* erase setup */
                        *addr = 0x00D000D0;     /* erase confirm */
 
                        while ((*addr & 0x00800080) != 0x00800080) {
-               if (get_timer_masked() > CFG_FLASH_ERASE_TOUT) {
+                               if (get_timer_masked() > CFG_FLASH_ERASE_TOUT) {
                                        *addr = 0x00B000B0; /* suspend erase*/
                                        *addr = 0x00FF00FF; /* read mode    */
-                   rc = ERR_TIMOUT;
-                   goto outahere;
-               }
-           }
-
+                                       rc = ERR_TIMOUT;
+                                       goto outahere;
+                               }
+                       }
                        *addr = 0x00500050; /* clear status register cmd.   */
-                       *addr = 0x00FF00FF; /* resest to read mode          */
-
+                       *addr = 0x00FF00FF; /* reset to read mode           */
+               }
+               printf("ok.\n");
        }
-               
-       printf("ok.\n");
-    }
-
        if (ctrlc()) printf("User Interrupt!\n");
 
 outahere:
-
-    /* allow flash to settle - wait 10 ms */
-    udelay_masked(10000);
+       /* allow flash to settle - wait 10 ms */
+       udelay_masked(10000);
 
        if (flag) enable_interrupts();
 
-    return rc;
+       return rc;
 }
 
-
 /**
- * write_word: - copy memory to flash
- * 
- * @param info:
- * @param dest:
- * @param data: 
- * @return:
+ * write_long: - copy memory to flash, assume a bank of 2 devices with 16bit each
  */
 
-static int write_word (flash_info_t *info, ulong dest, ushort data)
+static int write_long (flash_info_t *info, ulong dest, ulong data)
 {
-    ushort *addr = (ushort *)dest, val;
-    int rc = ERR_OK;
-    int flag;
+       u32 * volatile addr = (u32 * volatile)dest, val;
+       int rc = ERR_OK;
+       int flag;
+
+       /* read array command - just for the case... */
+       *addr = 0x00FF00FF;
 
        /* Check if Flash is (sufficiently) erased */
        if ((*addr & data) != data) return ERR_NOT_ERASED;
 
-    /*
-     * Disable interrupts which might cause a timeout
-     * here. Remember that our exception vectors are
-     * at address 0 in the flash, and we don't want a
-     * (ticker) exception to happen while the flash
-     * chip is in programming mode.
-     */
-    flag = disable_interrupts();
-
-    /* clear status register command */
-    *addr = 0x50;
-
-    /* program set-up command */
-    *addr = 0x40;
-
-    /* latch address/data */
-    *addr = data;
-
-    /* arm simple, non interrupt dependent timer */
-    reset_timer_masked();
-
-    /* wait while polling the status register */
-       while(((val = *addr) & 0x80) != 0x80) {
-       if (get_timer_masked() > CFG_FLASH_WRITE_TOUT) {
-           rc = ERR_TIMOUT;
-                       *addr = 0xB0; /* suspend program command */
-           goto outahere;
+       /*
+        * Disable interrupts which might cause a timeout
+        * here. Remember that our exception vectors are
+        * at address 0 in the flash, and we don't want a
+        * (ticker) exception to happen while the flash
+        * chip is in programming mode.
+        */
+       flag = disable_interrupts();
+
+       /* clear status register command */
+       *addr = 0x00500050;
+
+       /* program set-up command */
+       *addr = 0x00400040;
+
+       /* latch address/data */
+       *addr = data;
+
+       /* arm simple, non interrupt dependent timer */
+       reset_timer_masked();
+
+       /* wait while polling the status register */
+       while(((val = *addr) & 0x00800080) != 0x00800080) {
+               if (get_timer_masked() > CFG_FLASH_WRITE_TOUT) {
+                       rc = ERR_TIMOUT;
+                       /* suspend program command */
+                       *addr = 0x00B000B0;
+                       goto outahere;
+               }
        }
-    }
-
-    if(val & 0x1A) {   /* check for error */
-        printf("\nFlash write error %02x at address %08lx\n",
-          (int)val, (unsigned long)dest);
-        if(val & (1<<3)) {
-           printf("Voltage range error.\n");
-           rc = ERR_PROG_ERROR;
-           goto outahere;
-        }
-        if(val & (1<<1)) {
-           printf("Device protect error.\n");
-           rc = ERR_PROTECTED;
-           goto outahere;
-        }
-        if(val & (1<<4)) {
-           printf("Programming error.\n");
-           rc = ERR_PROG_ERROR;
-           goto outahere;
-        }
-        rc = ERR_PROG_ERROR;
-        goto outahere;
-    }
 
-outahere:
+       /* check for errors */
+       if(val & 0x001A001A) {
+               printf("\nFlash write error %02x at address %08lx\n",
+                       (int)val, (unsigned long)dest);
+               if(val & 0x00080008) {
+                       printf("Voltage range error.\n");
+                       rc = ERR_PROG_ERROR;
+                       goto outahere;
+               }
+               if(val & 0x00020002) {
+                       printf("Device protect error.\n");
+                       rc = ERR_PROTECTED;
+                       goto outahere;
+               }
+               if(val & 0x00100010) {
+                       printf("Programming error.\n");
+                       rc = ERR_PROG_ERROR;
+                       goto outahere;
+               }
+               rc = ERR_PROG_ERROR;
+               goto outahere;
+       }
 
-       *addr = 0xFF; /* read array command */
+outahere:
+       /* read array command */
+       *addr = 0x00FF00FF;
        if (flag) enable_interrupts();
 
-    return rc;
+       return rc;
 }
 
 
 /**
  * write_buf: - Copy memory to flash.
- * 
- * @param info:         
+ *
+ * @param info:
  * @param src: source of copy transaction
- * @param addr:        where to copy to
- * @param cnt:         number of bytes to copy
+ * @param addr: where to copy to
+ * @param cnt: number of bytes to copy
  *
  * @return     error code
  */
 
+/* "long" version, uses 32bit words */
 int write_buff (flash_info_t *info, uchar *src, ulong addr, ulong cnt)
 {
-    ulong cp, wp;
-    ushort data;
-    int l;
-    int i, rc;
-
-    wp = (addr & ~1);  /* get lower word aligned address */
+       ulong cp, wp;
+       ulong data;
+       int l;
+       int i, rc;
+
+       wp = (addr & ~3);       /* get lower word aligned address */
+
+       /*
+        * handle unaligned start bytes
+        */
+       if ((l = addr - wp) != 0) {
+               data = 0;
+               for (i=0, cp=wp; i<l; ++i, ++cp) {
+                       data = (data >> 8) | (*(uchar *)cp << 24);
+               }
+               for (; i<4 && cnt>0; ++i) {
+                       data = (data >> 8) | (*src++ << 24);
+                       --cnt;
+                       ++cp;
+               }
+               for (; cnt==0 && i<4; ++i, ++cp) {
+                       data = (data >> 8) | (*(uchar *)cp << 24);
+               }
 
-    /*
-     * handle unaligned start bytes
-     */
-    if ((l = addr - wp) != 0) {
-       data = 0;
-       for (i=0, cp=wp; i<l; ++i, ++cp) {
-           data = (data >> 8) | (*(uchar *)cp << 8);
-       }
-       for (; i<2 && cnt>0; ++i) {
-           data = (data >> 8) | (*src++ << 8);
-           --cnt;
-           ++cp;
-       }
-       for (; cnt==0 && i<2; ++i, ++cp) {
-           data = (data >> 8) | (*(uchar *)cp << 8);
+               if ((rc = write_long(info, wp, data)) != 0) {
+                       return (rc);
+               }
+               wp += 4;
        }
 
-       if ((rc = write_word(info, wp, data)) != 0) {
-           return (rc);
-       }
-       wp += 2;
-    }
-
-    /*
-     * handle word aligned part
-     */
-    while (cnt >= 2) {
-       /* data = *((vushort*)src); */
-       data = *((ushort*)src);
-       if ((rc = write_word(info, wp, data)) != 0) {
-           return (rc);
+       /*
+        * handle word aligned part
+        */
+       while (cnt >= 4) {
+               data = *((ulong*)src);
+               if ((rc = write_long(info, wp, data)) != 0) {
+                       return (rc);
+               }
+               src += 4;
+               wp  += 4;
+               cnt -= 4;
        }
-       src += 2;
-       wp  += 2;
-       cnt -= 2;
-    }
 
        if (cnt == 0) return ERR_OK;
 
-    /*
-     * handle unaligned tail bytes
-     */
-    data = 0;
-    for (i=0, cp=wp; i<2 && cnt>0; ++i, ++cp) {
-       data = (data >> 8) | (*src++ << 8);
-       --cnt;
-    }
-    for (; i<2; ++i, ++cp) {
-       data = (data >> 8) | (*(uchar *)cp << 8);
-    }
-
-    return write_word(info, wp, data);
+       /*
+        * handle unaligned tail bytes
+        */
+       data = 0;
+       for (i=0, cp=wp; i<4 && cnt>0; ++i, ++cp) {
+               data = (data >> 8) | (*src++ << 24);
+               --cnt;
+       }
+       for (; i<4; ++i, ++cp) {
+               data = (data >> 8) | (*(uchar *)cp << 24);
+       }
+
+       return write_long(info, wp, data);
 }