board/pcs440ep/flash.c

   1 /*
   2  * (C) Copyright 2006
   3  * Stefan Roese, DENX Software Engineering, sr@denx.de.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25 #include <asm/processor.h>
  26
  27 #ifndef CFG_FLASH_READ0
  28 #define CFG_FLASH_READ0         0x0000  /* 0 is standard                        */
  29 #define CFG_FLASH_READ1         0x0001  /* 1 is standard                        */
  30 #define CFG_FLASH_READ2         0x0002  /* 2 is standard                        */
  31 #endif
  32
  33 flash_info_t    flash_info[CFG_MAX_FLASH_BANKS]; /* info for FLASH chips        */
  34
  35 /*
  36  * Functions
  37  */
  38 static int write_word(flash_info_t *info, ulong dest, ulong data);
  39 static ulong flash_get_size(vu_long *addr, flash_info_t *info);
  40
  41 unsigned long flash_init(void)
  42 {
  43         unsigned long size_b0, size_b1;
  44         int i;
  45         unsigned long base_b0, base_b1;
  46
  47         /* Init: no FLASHes known */
  48         for (i = 0; i < CFG_MAX_FLASH_BANKS; ++i) {
  49                 flash_info[i].flash_id = FLASH_UNKNOWN;
  50         }
  51
  52         /* Static FLASH Bank configuration here - FIXME XXX */
  53
  54         base_b0 = FLASH_BASE0_PRELIM;
  55         size_b0 = flash_get_size ((vu_long *) base_b0, &flash_info[0]);
  56
  57         if (flash_info[0].flash_id == FLASH_UNKNOWN) {
  58                 printf ("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
  59                                 size_b0, size_b0 << 20);
  60         }
  61
  62         base_b1 = FLASH_BASE1_PRELIM;
  63         size_b1 = flash_get_size ((vu_long *) base_b1, &flash_info[1]);
  64
  65         return (size_b0 + size_b1);
  66 }
  67
  68 void flash_print_info(flash_info_t *info)
  69 {
  70         int i;
  71         int k;
  72         int size;
  73         int erased;
  74         volatile unsigned long *flash;
  75
  76         if (info->flash_id == FLASH_UNKNOWN) {
  77                 printf ("missing or unknown FLASH type\n");
  78                 return;
  79         }
  80
  81         switch (info->flash_id & FLASH_VENDMASK) {
  82         case FLASH_MAN_AMD:     printf ("AMD ");                break;
  83         case FLASH_MAN_FUJ:     printf ("FUJITSU ");            break;
  84         case FLASH_MAN_SST:     printf ("SST ");                break;
  85         case FLASH_MAN_EXCEL:   printf ("Excel Semiconductor "); break;
  86         default:                printf ("Unknown Vendor ");     break;
  87         }
  88
  89         switch (info->flash_id & FLASH_TYPEMASK) {
  90         case FLASH_AM400B:      printf ("AM29LV400B (4 Mbit, bottom boot sect)\n");
  91                 break;
  92         case FLASH_AM400T:      printf ("AM29LV400T (4 Mbit, top boot sector)\n");
  93                 break;
  94         case FLASH_AM040:       printf ("AM29LV040B (4 Mbit, uniform sector size)\n");
  95                 break;
  96         case FLASH_AM800B:      printf ("AM29LV800B (8 Mbit, bottom boot sect)\n");
  97                 break;
  98         case FLASH_AM800T:      printf ("AM29LV800T (8 Mbit, top boot sector)\n");
  99                 break;
 100         case FLASH_AM160B:      printf ("AM29LV160B (16 Mbit, bottom boot sect)\n");
 101                 break;
 102         case FLASH_AM160T:      printf ("AM29LV160T (16 Mbit, top boot sector)\n");
 103                 break;
 104         case FLASH_AM320T:      printf ("AM29LV320T (32 M, top sector)\n");
 105                 break;
 106         case FLASH_AM320B:      printf ("AM29LV320B (32 M, bottom sector)\n");
 107                 break;
 108         case FLASH_AMDL322T:    printf ("AM29DL322T (32 M, top sector)\n");
 109                 break;
 110         case FLASH_AMDL322B:    printf ("AM29DL322B (32 M, bottom sector)\n");
 111                 break;
 112         case FLASH_AMDL323T:    printf ("AM29DL323T (32 M, top sector)\n");
 113                 break;
 114         case FLASH_AMDL323B:    printf ("AM29DL323B (32 M, bottom sector)\n");
 115                 break;
 116         case FLASH_SST020:      printf ("SST39LF/VF020 (2 Mbit, uniform sector size)\n");
 117                 break;
 118         case FLASH_SST040:      printf ("SST39LF/VF040 (4 Mbit, uniform sector size)\n");
 119                 break;
 120         default:                printf ("Unknown Chip Type\n");
 121                 break;
 122         }
 123
 124         printf ("  Size: %ld MB in %d Sectors\n",
 125                 info->size >> 20, info->sector_count);
 126
 127         printf ("  Sector Start Addresses:");
 128         for (i=0; i<info->sector_count; ++i) {
 129 #ifdef CFG_FLASH_EMPTY_INFO
 130                 /*
 131                  * Check if whole sector is erased
 132                  */
 133                 if (i != (info->sector_count-1))
 134                         size = info->start[i+1] - info->start[i];
 135                 else
 136                         size = info->start[0] + info->size - info->start[i];
 137                 erased = 1;
 138                 flash = (volatile unsigned long *)info->start[i];
 139                 size = size >> 2;        /* divide by 4 for longword access */
 140                 for (k=0; k<size; k++) {
 141                         if (*flash++ != 0xffffffff) {
 142                                 erased = 0;
 143                                 break;
 144                         }
 145                 }
 146
 147                 if ((i % 5) == 0)
 148                         printf ("\n   ");
 149                 /* print empty and read-only info */
 150                 printf (" %08lX%s%s",
 151                         info->start[i],
 152                         erased ? " E" : "  ",
 153                         info->protect[i] ? "RO " : "   ");
 154 #else
 155                 if ((i % 5) == 0)
 156                         printf ("\n   ");
 157                 printf (" %08lX%s",
 158                         info->start[i],
 159                         info->protect[i] ? " (RO)" : "     ");
 160 #endif
 161
 162         }
 163         printf ("\n");
 164         return;
 165 }
 166
 167 /*
 168  * The following code cannot be run from FLASH!
 169  */
 170 static ulong flash_get_size(vu_long *addr, flash_info_t *info)
 171 {
 172         short i;
 173         short n;
 174         volatile CFG_FLASH_WORD_SIZE value;
 175         ulong base = (ulong)addr;
 176         volatile CFG_FLASH_WORD_SIZE *addr2 = (volatile CFG_FLASH_WORD_SIZE *)addr;
 177
 178         /* Write auto select command: read Manufacturer ID */
 179         addr2[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00AA00AA;
 180         addr2[CFG_FLASH_ADDR1] = (CFG_FLASH_WORD_SIZE)0x00550055;
 181         addr2[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00900090;
 182
 183         value = addr2[CFG_FLASH_READ0];
 184
 185         switch (value) {
 186         case (CFG_FLASH_WORD_SIZE)AMD_MANUFACT:
 187                 info->flash_id = FLASH_MAN_AMD;
 188                 break;
 189         case (CFG_FLASH_WORD_SIZE)FUJ_MANUFACT:
 190                 info->flash_id = FLASH_MAN_FUJ;
 191                 break;
 192         case (CFG_FLASH_WORD_SIZE)SST_MANUFACT:
 193                 info->flash_id = FLASH_MAN_SST;
 194                 break;
 195         case (CFG_FLASH_WORD_SIZE)EXCEL_MANUFACT:
 196                 info->flash_id = FLASH_MAN_EXCEL;
 197                 break;
 198         default:
 199                 info->flash_id = FLASH_UNKNOWN;
 200                 info->sector_count = 0;
 201                 info->size = 0;
 202                 return (0);                     /* no or unknown flash  */
 203         }
 204
 205         value = addr2[CFG_FLASH_READ1];         /* device ID            */
 206
 207         switch (value) {
 208         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV400T:
 209                 info->flash_id += FLASH_AM400T;
 210                 info->sector_count = 11;
 211                 info->size = 0x00080000;
 212                 break;                          /* => 0.5 MB            */
 213
 214         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV400B:
 215                 info->flash_id += FLASH_AM400B;
 216                 info->sector_count = 11;
 217                 info->size = 0x00080000;
 218                 break;                          /* => 0.5 MB            */
 219
 220         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV040B:
 221                 info->flash_id += FLASH_AM040;
 222                 info->sector_count = 8;
 223                 info->size = 0x0080000; /* => 512 ko */
 224                 break;
 225
 226         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV800T:
 227                 info->flash_id += FLASH_AM800T;
 228                 info->sector_count = 19;
 229                 info->size = 0x00100000;
 230                 break;                          /* => 1 MB              */
 231
 232         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV800B:
 233                 info->flash_id += FLASH_AM800B;
 234                 info->sector_count = 19;
 235                 info->size = 0x00100000;
 236                 break;                          /* => 1 MB              */
 237
 238         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV160T:
 239                 info->flash_id += FLASH_AM160T;
 240                 info->sector_count = 35;
 241                 info->size = 0x00200000;
 242                 break;                          /* => 2 MB              */
 243
 244         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV160B:
 245                 info->flash_id += FLASH_AM160B;
 246                 info->sector_count = 35;
 247                 info->size = 0x00200000;
 248                 break;                          /* => 2 MB              */
 249
 250         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV320T:
 251                 info->flash_id += FLASH_AM320T;
 252                 info->sector_count = 71;
 253                 info->size = 0x00400000;  break;        /* => 4 MB      */
 254
 255         case (CFG_FLASH_WORD_SIZE)AMD_ID_LV320B:
 256                 info->flash_id += FLASH_AM320B;
 257                 info->sector_count = 71;
 258                 info->size = 0x00400000;  break;        /* => 4 MB      */
 259
 260         case (CFG_FLASH_WORD_SIZE)AMD_ID_DL322T:
 261                 info->flash_id += FLASH_AMDL322T;
 262                 info->sector_count = 71;
 263                 info->size = 0x00400000;  break;        /* => 4 MB      */
 264
 265         case (CFG_FLASH_WORD_SIZE)AMD_ID_DL322B:
 266                 info->flash_id += FLASH_AMDL322B;
 267                 info->sector_count = 71;
 268                 info->size = 0x00400000;  break;        /* => 4 MB      */
 269
 270         case (CFG_FLASH_WORD_SIZE)AMD_ID_DL323T:
 271                 info->flash_id += FLASH_AMDL323T;
 272                 info->sector_count = 71;
 273                 info->size = 0x00400000;  break;        /* => 4 MB      */
 274
 275         case (CFG_FLASH_WORD_SIZE)AMD_ID_DL323B:
 276                 info->flash_id += FLASH_AMDL323B;
 277                 info->sector_count = 71;
 278                 info->size = 0x00400000;  break;        /* => 4 MB      */
 279
 280         case (CFG_FLASH_WORD_SIZE)SST_ID_xF020:
 281                 info->flash_id += FLASH_SST020;
 282                 info->sector_count = 64;
 283                 info->size = 0x00040000;
 284                 break;                          /* => 256 kB            */
 285
 286         case (CFG_FLASH_WORD_SIZE)SST_ID_xF040:
 287                 info->flash_id += FLASH_SST040;
 288                 info->sector_count = 128;
 289                 info->size = 0x00080000;
 290                 break;                          /* => 512 kB            */
 291
 292         default:
 293                 info->flash_id = FLASH_UNKNOWN;
 294                 return (0);                     /* => no or unknown flash */
 295
 296         }
 297
 298         /* set up sector start address table */
 299         if (((info->flash_id & FLASH_VENDMASK) == FLASH_MAN_SST) ||
 300             ((info->flash_id & FLASH_TYPEMASK) == FLASH_AM640U)) {
 301                 for (i = 0; i < info->sector_count; i++)
 302                         info->start[i] = base + (i * 0x00001000);
 303         } else if ((info->flash_id & FLASH_TYPEMASK) == FLASH_AM040) {
 304                 for (i = 0; i < info->sector_count; i++)
 305                         info->start[i] = base + (i * 0x00010000);
 306         } else if (((info->flash_id & FLASH_TYPEMASK) == FLASH_AMDL322B) ||
 307                    ((info->flash_id & FLASH_TYPEMASK) == FLASH_AMDL323B) ||
 308                    ((info->flash_id & FLASH_TYPEMASK) == FLASH_AM320B) ||
 309                    ((info->flash_id & FLASH_TYPEMASK) == FLASH_AMDL324B)) {
 310                 /* set sector offsets for bottom boot block type        */
 311                 for (i=0; i<8; ++i) {           /*  8 x 8k boot sectors */
 312                         info->start[i] = base;
 313                         base += 8 << 10;
 314                 }
 315                 while (i < info->sector_count) {        /* 64k regular sectors  */
 316                         info->start[i] = base;
 317                         base += 64 << 10;
 318                         ++i;
 319                 }
 320         } else if (((info->flash_id & FLASH_TYPEMASK) == FLASH_AMDL322T) ||
 321                    ((info->flash_id & FLASH_TYPEMASK) == FLASH_AMDL323T) ||
 322                    ((info->flash_id & FLASH_TYPEMASK) == FLASH_AM320T) ||
 323                    ((info->flash_id & FLASH_TYPEMASK) == FLASH_AMDL324T)) {
 324                 /* set sector offsets for top boot block type           */
 325                 base += info->size;
 326                 i = info->sector_count;
 327                 for (n=0; n<8; ++n) {           /*  8 x 8k boot sectors */
 328                         base -= 8 << 10;
 329                         --i;
 330                         info->start[i] = base;
 331                 }
 332                 while (i > 0) {                 /* 64k regular sectors  */
 333                         base -= 64 << 10;
 334                         --i;
 335                         info->start[i] = base;
 336                 }
 337         } else {
 338                 if (info->flash_id & FLASH_BTYPE) {
 339                         /* set sector offsets for bottom boot block type        */
 340                         info->start[0] = base + 0x00000000;
 341                         info->start[1] = base + 0x00004000;
 342                         info->start[2] = base + 0x00006000;
 343                         info->start[3] = base + 0x00008000;
 344                         for (i = 4; i < info->sector_count; i++) {
 345                                 info->start[i] = base + (i * 0x00010000) - 0x00030000;
 346                         }
 347                 } else {
 348                         /* set sector offsets for top boot block type           */
 349                         i = info->sector_count - 1;
 350                         info->start[i--] = base + info->size - 0x00004000;
 351                         info->start[i--] = base + info->size - 0x00006000;
 352                         info->start[i--] = base + info->size - 0x00008000;
 353                         for (; i >= 0; i--) {
 354                                 info->start[i] = base + i * 0x00010000;
 355                         }
 356                 }
 357         }
 358
 359         /* check for protected sectors */
 360         for (i = 0; i < info->sector_count; i++) {
 361                 /* read sector protection at sector address, (A7 .. A0) = 0x02 */
 362                 /* D0 = 1 if protected */
 363                 addr2 = (volatile CFG_FLASH_WORD_SIZE *)(info->start[i]);
 364                 if ((info->flash_id & FLASH_VENDMASK) != FLASH_MAN_AMD)
 365                         info->protect[i] = 0;
 366                 else
 367                         info->protect[i] = addr2[CFG_FLASH_READ2] & 1;
 368         }
 369
 370         /*
 371          * Prevent writes to uninitialized FLASH.
 372          */
 373         if (info->flash_id != FLASH_UNKNOWN) {
 374                 addr2 = (CFG_FLASH_WORD_SIZE *)info->start[0];
 375                 *addr2 = (CFG_FLASH_WORD_SIZE)0x00F000F0;       /* reset bank */
 376         }
 377
 378         return (info->size);
 379 }
 380
 381
 382 int flash_erase(flash_info_t *info, int s_first, int s_last)
 383 {
 384         volatile CFG_FLASH_WORD_SIZE *addr = (CFG_FLASH_WORD_SIZE *)(info->start[0]);
 385         volatile CFG_FLASH_WORD_SIZE *addr2;
 386         int flag, prot, sect, l_sect;
 387         ulong start, now, last;
 388
 389         if ((s_first < 0) || (s_first > s_last)) {
 390                 if (info->flash_id == FLASH_UNKNOWN)
 391                         printf ("- missing\n");
 392                 else
 393                         printf ("- no sectors to erase\n");
 394                 return 1;
 395         }
 396
 397         if (info->flash_id == FLASH_UNKNOWN) {
 398                 printf ("Can't erase unknown flash type - aborted\n");
 399                 return 1;
 400         }
 401
 402         prot = 0;
 403         for (sect=s_first; sect<=s_last; ++sect)
 404                 if (info->protect[sect])
 405                         prot++;
 406
 407         if (prot)
 408                 printf ("- Warning: %d protected sectors will not be erased!\n", prot);
 409         else
 410                 printf ("\n");
 411
 412         l_sect = -1;
 413
 414         /* Disable interrupts which might cause a timeout here */
 415         flag = disable_interrupts();
 416
 417         /* Start erase on unprotected sectors */
 418         for (sect = s_first; sect<=s_last; sect++) {
 419                 if (info->protect[sect] == 0) { /* not protected */
 420                         addr2 = (CFG_FLASH_WORD_SIZE *)(info->start[sect]);
 421                         if ((info->flash_id & FLASH_VENDMASK) == FLASH_MAN_SST) {
 422                                 addr[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00AA00AA;
 423                                 addr[CFG_FLASH_ADDR1] = (CFG_FLASH_WORD_SIZE)0x00550055;
 424                                 addr[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00800080;
 425                                 addr[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00AA00AA;
 426                                 addr[CFG_FLASH_ADDR1] = (CFG_FLASH_WORD_SIZE)0x00550055;
 427                                 addr2[0] = (CFG_FLASH_WORD_SIZE)0x00300030;  /* sector erase */
 428
 429                                 /* re-enable interrupts if necessary */
 430                                 if (flag) {
 431                                         enable_interrupts();
 432                                         flag = 0;
 433                                 }
 434
 435                                 /* data polling for D7 */
 436                                 start = get_timer (0);
 437                                 while ((addr2[0] & (CFG_FLASH_WORD_SIZE)0x00800080) !=
 438                                        (CFG_FLASH_WORD_SIZE)0x00800080) {
 439                                         if (get_timer(start) > CFG_FLASH_WRITE_TOUT)
 440                                                 return (1);
 441                                 }
 442                         } else {
 443                                 if (sect == s_first) {
 444                                         addr[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00AA00AA;
 445                                         addr[CFG_FLASH_ADDR1] = (CFG_FLASH_WORD_SIZE)0x00550055;
 446                                         addr[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00800080;
 447                                         addr[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00AA00AA;
 448                                         addr[CFG_FLASH_ADDR1] = (CFG_FLASH_WORD_SIZE)0x00550055;
 449                                 }
 450                                 addr2[0] = (CFG_FLASH_WORD_SIZE)0x00300030;  /* sector erase */
 451                         }
 452                         l_sect = sect;
 453                 }
 454         }
 455
 456         /* re-enable interrupts if necessary */
 457         if (flag)
 458                 enable_interrupts();
 459
 460         /* wait at least 80us - let's wait 1 ms */
 461         udelay (1000);
 462
 463         /*
 464          * We wait for the last triggered sector
 465          */
 466         if (l_sect < 0)
 467                 goto DONE;
 468
 469         start = get_timer (0);
 470         last  = start;
 471         addr = (CFG_FLASH_WORD_SIZE *)(info->start[l_sect]);
 472         while ((addr[0] & (CFG_FLASH_WORD_SIZE)0x00800080) != (CFG_FLASH_WORD_SIZE)0x00800080) {
 473                 if ((now = get_timer(start)) > CFG_FLASH_ERASE_TOUT) {
 474                         printf ("Timeout\n");
 475                         return 1;
 476                 }
 477                 /* show that we're waiting */
 478                 if ((now - last) > 1000) {      /* every second */
 479                         putc ('.');
 480                         last = now;
 481                 }
 482         }
 483
 484 DONE:
 485         /* reset to read mode */
 486         addr = (CFG_FLASH_WORD_SIZE *)info->start[0];
 487         addr[0] = (CFG_FLASH_WORD_SIZE)0x00F000F0;      /* reset bank */
 488
 489         printf (" done\n");
 490         return 0;
 491 }
 492
 493 /*
 494  * Copy memory to flash, returns:
 495  * 0 - OK
 496  * 1 - write timeout
 497  * 2 - Flash not erased
 498  */
 499 int write_buff(flash_info_t *info, uchar *src, ulong addr, ulong cnt)
 500 {
 501         ulong cp, wp, data;
 502         int i, l, rc;
 503
 504         wp = (addr & ~3);       /* get lower word aligned address */
 505
 506         /*
 507          * handle unaligned start bytes
 508          */
 509         if ((l = addr - wp) != 0) {
 510                 data = 0;
 511                 for (i=0, cp=wp; i<l; ++i, ++cp) {
 512                         data = (data << 8) | (*(uchar *)cp);
 513                 }
 514                 for (; i<4 && cnt>0; ++i) {
 515                         data = (data << 8) | *src++;
 516                         --cnt;
 517                         ++cp;
 518                 }
 519                 for (; cnt==0 && i<4; ++i, ++cp) {
 520                         data = (data << 8) | (*(uchar *)cp);
 521                 }
 522
 523                 if ((rc = write_word(info, wp, data)) != 0) {
 524                         return (rc);
 525                 }
 526                 wp += 4;
 527         }
 528
 529         /*
 530          * handle word aligned part
 531          */
 532         while (cnt >= 4) {
 533                 data = 0;
 534                 for (i=0; i<4; ++i)
 535                         data = (data << 8) | *src++;
 536                 if ((rc = write_word(info, wp, data)) != 0)
 537                         return (rc);
 538                 wp  += 4;
 539                 cnt -= 4;
 540         }
 541
 542         if (cnt == 0)
 543                 return (0);
 544
 545         /*
 546          * handle unaligned tail bytes
 547          */
 548         data = 0;
 549         for (i=0, cp=wp; i<4 && cnt>0; ++i, ++cp) {
 550                 data = (data << 8) | *src++;
 551                 --cnt;
 552         }
 553         for (; i<4; ++i, ++cp)
 554                 data = (data << 8) | (*(uchar *)cp);
 555
 556         return (write_word(info, wp, data));
 557 }
 558
 559 /*
 560  * Write a word to Flash, returns:
 561  * 0 - OK
 562  * 1 - write timeout
 563  * 2 - Flash not erased
 564  */
 565 static int write_word(flash_info_t *info, ulong dest, ulong data)
 566 {
 567         volatile CFG_FLASH_WORD_SIZE *addr2 = (CFG_FLASH_WORD_SIZE *)(info->start[0]);
 568         volatile CFG_FLASH_WORD_SIZE *dest2 = (CFG_FLASH_WORD_SIZE *)dest;
 569         volatile CFG_FLASH_WORD_SIZE *data2 = (CFG_FLASH_WORD_SIZE *)&data;
 570         ulong start;
 571         int flag;
 572         int i;
 573
 574         /* Check if Flash is (sufficiently) erased */
 575         if ((*((vu_long *)dest) & data) != data)
 576                 return (2);
 577
 578         /* Disable interrupts which might cause a timeout here */
 579         flag = disable_interrupts();
 580
 581         for (i=0; i<4/sizeof(CFG_FLASH_WORD_SIZE); i++) {
 582                 addr2[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00AA00AA;
 583                 addr2[CFG_FLASH_ADDR1] = (CFG_FLASH_WORD_SIZE)0x00550055;
 584                 addr2[CFG_FLASH_ADDR0] = (CFG_FLASH_WORD_SIZE)0x00A000A0;
 585
 586                 dest2[i] = data2[i];
 587
 588                 /* re-enable interrupts if necessary */
 589                 if (flag)
 590                         enable_interrupts();
 591
 592                 /* data polling for D7 */
 593                 start = get_timer (0);
 594                 while ((dest2[i] & (CFG_FLASH_WORD_SIZE)0x00800080) !=
 595                        (data2[i] & (CFG_FLASH_WORD_SIZE)0x00800080)) {
 596                         if (get_timer(start) > CFG_FLASH_WRITE_TOUT)
 597                                 return (1);
 598                 }
 599         }
 600
 601         return (0);
 602 }