drivers/mtd/cfi_flash.c

   1 /*
   2  * (C) Copyright 2002-2004
   3  * Brad Kemp, Seranoa Networks, Brad.Kemp@seranoa.com
   4  *
   5  * Copyright (C) 2003 Arabella Software Ltd.
   6  * Yuli Barcohen <yuli@arabellasw.com>
   7  *
   8  * Copyright (C) 2004
   9  * Ed Okerson
  10  *
  11  * Copyright (C) 2006
  12  * Tolunay Orkun <listmember@orkun.us>
  13  *
  14  * See file CREDITS for list of people who contributed to this
  15  * project.
  16  *
  17  * This program is free software; you can redistribute it and/or
  18  * modify it under the terms of the GNU General Public License as
  19  * published by the Free Software Foundation; either version 2 of
  20  * the License, or (at your option) any later version.
  21  *
  22  * This program is distributed in the hope that it will be useful,
  23  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  24  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  25  * GNU General Public License for more details.
  26  *
  27  * You should have received a copy of the GNU General Public License
  28  * along with this program; if not, write to the Free Software
  29  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  30  * MA 02111-1307 USA
  31  *
  32  */
  33
  34 /* The DEBUG define must be before common to enable debugging */
  35 /* #define DEBUG        */
  36
  37 #include <common.h>
  38 #include <asm/processor.h>
  39 #include <asm/io.h>
  40 #include <asm/byteorder.h>
  41 #include <environment.h>
  42
  43 /*
  44  * This file implements a Common Flash Interface (CFI) driver for
  45  * U-Boot.
  46  *
  47  * The width of the port and the width of the chips are determined at
  48  * initialization.  These widths are used to calculate the address for
  49  * access CFI data structures.
  50  *
  51  * References
  52  * JEDEC Standard JESD68 - Common Flash Interface (CFI)
  53  * JEDEC Standard JEP137-A Common Flash Interface (CFI) ID Codes
  54  * Intel Application Note 646 Common Flash Interface (CFI) and Command Sets
  55  * Intel 290667-008 3 Volt Intel StrataFlash Memory datasheet
  56  * AMD CFI Specification, Release 2.0 December 1, 2001
  57  * AMD/Spansion Application Note: Migration from Single-byte to Three-byte
  58  *   Device IDs, Publication Number 25538 Revision A, November 8, 2001
  59  *
  60  * Define CONFIG_SYS_WRITE_SWAPPED_DATA, if you have to swap the Bytes between
  61  * reading and writing ... (yes there is such a Hardware).
  62  */
  63
  64 #ifndef CONFIG_SYS_FLASH_BANKS_LIST
  65 #define CONFIG_SYS_FLASH_BANKS_LIST { CONFIG_SYS_FLASH_BASE }
  66 #endif
  67
  68 #define FLASH_CMD_CFI                   0x98
  69 #define FLASH_CMD_READ_ID               0x90
  70 #define FLASH_CMD_RESET                 0xff
  71 #define FLASH_CMD_BLOCK_ERASE           0x20
  72 #define FLASH_CMD_ERASE_CONFIRM         0xD0
  73 #define FLASH_CMD_WRITE                 0x40
  74 #define FLASH_CMD_PROTECT               0x60
  75 #define FLASH_CMD_PROTECT_SET           0x01
  76 #define FLASH_CMD_PROTECT_CLEAR         0xD0
  77 #define FLASH_CMD_CLEAR_STATUS          0x50
  78 #define FLASH_CMD_READ_STATUS           0x70
  79 #define FLASH_CMD_WRITE_TO_BUFFER       0xE8
  80 #define FLASH_CMD_WRITE_BUFFER_PROG     0xE9
  81 #define FLASH_CMD_WRITE_BUFFER_CONFIRM  0xD0
  82
  83 #define FLASH_STATUS_DONE               0x80
  84 #define FLASH_STATUS_ESS                0x40
  85 #define FLASH_STATUS_ECLBS              0x20
  86 #define FLASH_STATUS_PSLBS              0x10
  87 #define FLASH_STATUS_VPENS              0x08
  88 #define FLASH_STATUS_PSS                0x04
  89 #define FLASH_STATUS_DPS                0x02
  90 #define FLASH_STATUS_R                  0x01
  91 #define FLASH_STATUS_PROTECT            0x01
  92
  93 #define AMD_CMD_RESET                   0xF0
  94 #define AMD_CMD_WRITE                   0xA0
  95 #define AMD_CMD_ERASE_START             0x80
  96 #define AMD_CMD_ERASE_SECTOR            0x30
  97 #define AMD_CMD_UNLOCK_START            0xAA
  98 #define AMD_CMD_UNLOCK_ACK              0x55
  99 #define AMD_CMD_WRITE_TO_BUFFER         0x25
 100 #define AMD_CMD_WRITE_BUFFER_CONFIRM    0x29
 101
 102 #define AMD_STATUS_TOGGLE               0x40
 103 #define AMD_STATUS_ERROR                0x20
 104
 105 #define ATM_CMD_UNLOCK_SECT             0x70
 106 #define ATM_CMD_SOFTLOCK_START          0x80
 107 #define ATM_CMD_LOCK_SECT               0x40
 108
 109 #define FLASH_OFFSET_MANUFACTURER_ID    0x00
 110 #define FLASH_OFFSET_DEVICE_ID          0x01
 111 #define FLASH_OFFSET_DEVICE_ID2         0x0E
 112 #define FLASH_OFFSET_DEVICE_ID3         0x0F
 113 #define FLASH_OFFSET_CFI                0x55
 114 #define FLASH_OFFSET_CFI_ALT            0x555
 115 #define FLASH_OFFSET_CFI_RESP           0x10
 116 #define FLASH_OFFSET_PRIMARY_VENDOR     0x13
 117 /* extended query table primary address */
 118 #define FLASH_OFFSET_EXT_QUERY_T_P_ADDR 0x15
 119 #define FLASH_OFFSET_WTOUT              0x1F
 120 #define FLASH_OFFSET_WBTOUT             0x20
 121 #define FLASH_OFFSET_ETOUT              0x21
 122 #define FLASH_OFFSET_CETOUT             0x22
 123 #define FLASH_OFFSET_WMAX_TOUT          0x23
 124 #define FLASH_OFFSET_WBMAX_TOUT         0x24
 125 #define FLASH_OFFSET_EMAX_TOUT          0x25
 126 #define FLASH_OFFSET_CEMAX_TOUT         0x26
 127 #define FLASH_OFFSET_SIZE               0x27
 128 #define FLASH_OFFSET_INTERFACE          0x28
 129 #define FLASH_OFFSET_BUFFER_SIZE        0x2A
 130 #define FLASH_OFFSET_NUM_ERASE_REGIONS  0x2C
 131 #define FLASH_OFFSET_ERASE_REGIONS      0x2D
 132 #define FLASH_OFFSET_PROTECT            0x02
 133 #define FLASH_OFFSET_USER_PROTECTION    0x85
 134 #define FLASH_OFFSET_INTEL_PROTECTION   0x81
 135
 136 #define CFI_CMDSET_NONE                 0
 137 #define CFI_CMDSET_INTEL_EXTENDED       1
 138 #define CFI_CMDSET_AMD_STANDARD         2
 139 #define CFI_CMDSET_INTEL_STANDARD       3
 140 #define CFI_CMDSET_AMD_EXTENDED         4
 141 #define CFI_CMDSET_MITSU_STANDARD       256
 142 #define CFI_CMDSET_MITSU_EXTENDED       257
 143 #define CFI_CMDSET_SST                  258
 144 #define CFI_CMDSET_INTEL_PROG_REGIONS   512
 145
 146 #ifdef CONFIG_SYS_FLASH_CFI_AMD_RESET /* needed for STM_ID_29W320DB on UC100 */
 147 # undef  FLASH_CMD_RESET
 148 # define FLASH_CMD_RESET        AMD_CMD_RESET /* use AMD-Reset instead */
 149 #endif
 150
 151 typedef union {
 152         unsigned char c;
 153         unsigned short w;
 154         unsigned long l;
 155         unsigned long long ll;
 156 } cfiword_t;
 157
 158 #define NUM_ERASE_REGIONS       4 /* max. number of erase regions */
 159
 160 static uint flash_offset_cfi[2] = { FLASH_OFFSET_CFI, FLASH_OFFSET_CFI_ALT };
 161 static uint flash_verbose = 1;
 162
 163 /* use CONFIG_SYS_MAX_FLASH_BANKS_DETECT if defined */
 164 #ifdef CONFIG_SYS_MAX_FLASH_BANKS_DETECT
 165 # define CFI_MAX_FLASH_BANKS    CONFIG_SYS_MAX_FLASH_BANKS_DETECT
 166 #else
 167 # define CFI_MAX_FLASH_BANKS    CONFIG_SYS_MAX_FLASH_BANKS
 168 #endif
 169
 170 flash_info_t flash_info[CFI_MAX_FLASH_BANKS];   /* FLASH chips info */
 171
 172 /*
 173  * Check if chip width is defined. If not, start detecting with 8bit.
 174  */
 175 #ifndef CONFIG_SYS_FLASH_CFI_WIDTH
 176 #define CONFIG_SYS_FLASH_CFI_WIDTH      FLASH_CFI_8BIT
 177 #endif
 178
 179 /* CFI standard query structure */
 180 struct cfi_qry {
 181         u8      qry[3];
 182         u16     p_id;
 183         u16     p_adr;
 184         u16     a_id;
 185         u16     a_adr;
 186         u8      vcc_min;
 187         u8      vcc_max;
 188         u8      vpp_min;
 189         u8      vpp_max;
 190         u8      word_write_timeout_typ;
 191         u8      buf_write_timeout_typ;
 192         u8      block_erase_timeout_typ;
 193         u8      chip_erase_timeout_typ;
 194         u8      word_write_timeout_max;
 195         u8      buf_write_timeout_max;
 196         u8      block_erase_timeout_max;
 197         u8      chip_erase_timeout_max;
 198         u8      dev_size;
 199         u16     interface_desc;
 200         u16     max_buf_write_size;
 201         u8      num_erase_regions;
 202         u32     erase_region_info[NUM_ERASE_REGIONS];
 203 } __attribute__((packed));
 204
 205 struct cfi_pri_hdr {
 206         u8      pri[3];
 207         u8      major_version;
 208         u8      minor_version;
 209 } __attribute__((packed));
 210
 211 static void __flash_write8(u8 value, void *addr)
 212 {
 213         __raw_writeb(value, addr);
 214 }
 215
 216 static void __flash_write16(u16 value, void *addr)
 217 {
 218         __raw_writew(value, addr);
 219 }
 220
 221 static void __flash_write32(u32 value, void *addr)
 222 {
 223         __raw_writel(value, addr);
 224 }
 225
 226 static void __flash_write64(u64 value, void *addr)
 227 {
 228         /* No architectures currently implement __raw_writeq() */
 229         *(volatile u64 *)addr = value;
 230 }
 231
 232 static u8 __flash_read8(void *addr)
 233 {
 234         return __raw_readb(addr);
 235 }
 236
 237 static u16 __flash_read16(void *addr)
 238 {
 239         return __raw_readw(addr);
 240 }
 241
 242 static u32 __flash_read32(void *addr)
 243 {
 244         return __raw_readl(addr);
 245 }
 246
 247 static u64 __flash_read64(void *addr)
 248 {
 249         /* No architectures currently implement __raw_readq() */
 250         return *(volatile u64 *)addr;
 251 }
 252
 253 #ifdef CONFIG_CFI_FLASH_USE_WEAK_ACCESSORS
 254 void flash_write8(u8 value, void *addr)__attribute__((weak, alias("__flash_write8")));
 255 void flash_write16(u16 value, void *addr)__attribute__((weak, alias("__flash_write16")));
 256 void flash_write32(u32 value, void *addr)__attribute__((weak, alias("__flash_write32")));
 257 void flash_write64(u64 value, void *addr)__attribute__((weak, alias("__flash_write64")));
 258 u8 flash_read8(void *addr)__attribute__((weak, alias("__flash_read8")));
 259 u16 flash_read16(void *addr)__attribute__((weak, alias("__flash_read16")));
 260 u32 flash_read32(void *addr)__attribute__((weak, alias("__flash_read32")));
 261 u64 flash_read64(void *addr)__attribute__((weak, alias("__flash_read64")));
 262 #else
 263 #define flash_write8    __flash_write8
 264 #define flash_write16   __flash_write16
 265 #define flash_write32   __flash_write32
 266 #define flash_write64   __flash_write64
 267 #define flash_read8     __flash_read8
 268 #define flash_read16    __flash_read16
 269 #define flash_read32    __flash_read32
 270 #define flash_read64    __flash_read64
 271 #endif
 272
 273 /*-----------------------------------------------------------------------
 274  */
 275 #if defined(CONFIG_ENV_IS_IN_FLASH) || defined(CONFIG_ENV_ADDR_REDUND) || (CONFIG_SYS_MONITOR_BASE >= CONFIG_SYS_FLASH_BASE)
 276 flash_info_t *flash_get_info(ulong base)
 277 {
 278         int i;
 279         flash_info_t * info = 0;
 280
 281         for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; i++) {
 282                 info = & flash_info[i];
 283                 if (info->size && info->start[0] <= base &&
 284                     base <= info->start[0] + info->size - 1)
 285                         break;
 286         }
 287
 288         return i == CONFIG_SYS_MAX_FLASH_BANKS ? 0 : info;
 289 }
 290 #endif
 291
 292 unsigned long flash_sector_size(flash_info_t *info, flash_sect_t sect)
 293 {
 294         if (sect != (info->sector_count - 1))
 295                 return info->start[sect + 1] - info->start[sect];
 296         else
 297                 return info->start[0] + info->size - info->start[sect];
 298 }
 299
 300 /*-----------------------------------------------------------------------
 301  * create an address based on the offset and the port width
 302  */
 303 static inline void *
 304 flash_map (flash_info_t * info, flash_sect_t sect, uint offset)
 305 {
 306         unsigned int byte_offset = offset * info->portwidth;
 307
 308         return (void *)(info->start[sect] + byte_offset);
 309 }
 310
 311 static inline void flash_unmap(flash_info_t *info, flash_sect_t sect,
 312                 unsigned int offset, void *addr)
 313 {
 314 }
 315
 316 /*-----------------------------------------------------------------------
 317  * make a proper sized command based on the port and chip widths
 318  */
 319 static void flash_make_cmd(flash_info_t *info, u32 cmd, void *cmdbuf)
 320 {
 321         int i;
 322         int cword_offset;
 323         int cp_offset;
 324 #if defined(__LITTLE_ENDIAN) || defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 325         u32 cmd_le = cpu_to_le32(cmd);
 326 #endif
 327         uchar val;
 328         uchar *cp = (uchar *) cmdbuf;
 329
 330         for (i = info->portwidth; i > 0; i--){
 331                 cword_offset = (info->portwidth-i)%info->chipwidth;
 332 #if defined(__LITTLE_ENDIAN) || defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 333                 cp_offset = info->portwidth - i;
 334                 val = *((uchar*)&cmd_le + cword_offset);
 335 #else
 336                 cp_offset = i - 1;
 337                 val = *((uchar*)&cmd + sizeof(u32) - cword_offset - 1);
 338 #endif
 339                 cp[cp_offset] = (cword_offset >= sizeof(u32)) ? 0x00 : val;
 340         }
 341 }
 342
 343 #ifdef DEBUG
 344 /*-----------------------------------------------------------------------
 345  * Debug support
 346  */
 347 static void print_longlong (char *str, unsigned long long data)
 348 {
 349         int i;
 350         char *cp;
 351
 352         cp = (char *) &data;
 353         for (i = 0; i < 8; i++)
 354                 sprintf (&str[i * 2], "%2.2x", *cp++);
 355 }
 356
 357 static void flash_printqry (struct cfi_qry *qry)
 358 {
 359         u8 *p = (u8 *)qry;
 360         int x, y;
 361
 362         for (x = 0; x < sizeof(struct cfi_qry); x += 16) {
 363                 debug("%02x : ", x);
 364                 for (y = 0; y < 16; y++)
 365                         debug("%2.2x ", p[x + y]);
 366                 debug(" ");
 367                 for (y = 0; y < 16; y++) {
 368                         unsigned char c = p[x + y];
 369                         if (c >= 0x20 && c <= 0x7e)
 370                                 debug("%c", c);
 371                         else
 372                                 debug(".");
 373                 }
 374                 debug("\n");
 375         }
 376 }
 377 #endif
 378
 379
 380 /*-----------------------------------------------------------------------
 381  * read a character at a port width address
 382  */
 383 static inline uchar flash_read_uchar (flash_info_t * info, uint offset)
 384 {
 385         uchar *cp;
 386         uchar retval;
 387
 388         cp = flash_map (info, 0, offset);
 389 #if defined(__LITTLE_ENDIAN) || defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 390         retval = flash_read8(cp);
 391 #else
 392         retval = flash_read8(cp + info->portwidth - 1);
 393 #endif
 394         flash_unmap (info, 0, offset, cp);
 395         return retval;
 396 }
 397
 398 /*-----------------------------------------------------------------------
 399  * read a word at a port width address, assume 16bit bus
 400  */
 401 static inline ushort flash_read_word (flash_info_t * info, uint offset)
 402 {
 403         ushort *addr, retval;
 404
 405         addr = flash_map (info, 0, offset);
 406         retval = flash_read16 (addr);
 407         flash_unmap (info, 0, offset, addr);
 408         return retval;
 409 }
 410
 411
 412 /*-----------------------------------------------------------------------
 413  * read a long word by picking the least significant byte of each maximum
 414  * port size word. Swap for ppc format.
 415  */
 416 static ulong flash_read_long (flash_info_t * info, flash_sect_t sect,
 417                               uint offset)
 418 {
 419         uchar *addr;
 420         ulong retval;
 421
 422 #ifdef DEBUG
 423         int x;
 424 #endif
 425         addr = flash_map (info, sect, offset);
 426
 427 #ifdef DEBUG
 428         debug ("long addr is at %p info->portwidth = %d\n", addr,
 429                info->portwidth);
 430         for (x = 0; x < 4 * info->portwidth; x++) {
 431                 debug ("addr[%x] = 0x%x\n", x, flash_read8(addr + x));
 432         }
 433 #endif
 434 #if defined(__LITTLE_ENDIAN) || defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 435         retval = ((flash_read8(addr) << 16) |
 436                   (flash_read8(addr + info->portwidth) << 24) |
 437                   (flash_read8(addr + 2 * info->portwidth)) |
 438                   (flash_read8(addr + 3 * info->portwidth) << 8));
 439 #else
 440         retval = ((flash_read8(addr + 2 * info->portwidth - 1) << 24) |
 441                   (flash_read8(addr + info->portwidth - 1) << 16) |
 442                   (flash_read8(addr + 4 * info->portwidth - 1) << 8) |
 443                   (flash_read8(addr + 3 * info->portwidth - 1)));
 444 #endif
 445         flash_unmap(info, sect, offset, addr);
 446
 447         return retval;
 448 }
 449
 450 /*
 451  * Write a proper sized command to the correct address
 452  */
 453 static void flash_write_cmd (flash_info_t * info, flash_sect_t sect,
 454                              uint offset, u32 cmd)
 455 {
 456
 457         void *addr;
 458         cfiword_t cword;
 459
 460         addr = flash_map (info, sect, offset);
 461         flash_make_cmd (info, cmd, &cword);
 462         switch (info->portwidth) {
 463         case FLASH_CFI_8BIT:
 464                 debug ("fwc addr %p cmd %x %x 8bit x %d bit\n", addr, cmd,
 465                        cword.c, info->chipwidth << CFI_FLASH_SHIFT_WIDTH);
 466                 flash_write8(cword.c, addr);
 467                 break;
 468         case FLASH_CFI_16BIT:
 469                 debug ("fwc addr %p cmd %x %4.4x 16bit x %d bit\n", addr,
 470                        cmd, cword.w,
 471                        info->chipwidth << CFI_FLASH_SHIFT_WIDTH);
 472                 flash_write16(cword.w, addr);
 473                 break;
 474         case FLASH_CFI_32BIT:
 475                 debug ("fwc addr %p cmd %x %8.8lx 32bit x %d bit\n", addr,
 476                        cmd, cword.l,
 477                        info->chipwidth << CFI_FLASH_SHIFT_WIDTH);
 478                 flash_write32(cword.l, addr);
 479                 break;
 480         case FLASH_CFI_64BIT:
 481 #ifdef DEBUG
 482                 {
 483                         char str[20];
 484
 485                         print_longlong (str, cword.ll);
 486
 487                         debug ("fwrite addr %p cmd %x %s 64 bit x %d bit\n",
 488                                addr, cmd, str,
 489                                info->chipwidth << CFI_FLASH_SHIFT_WIDTH);
 490                 }
 491 #endif
 492                 flash_write64(cword.ll, addr);
 493                 break;
 494         }
 495
 496         /* Ensure all the instructions are fully finished */
 497         sync();
 498
 499         flash_unmap(info, sect, offset, addr);
 500 }
 501
 502 static void flash_unlock_seq (flash_info_t * info, flash_sect_t sect)
 503 {
 504         flash_write_cmd (info, sect, info->addr_unlock1, AMD_CMD_UNLOCK_START);
 505         flash_write_cmd (info, sect, info->addr_unlock2, AMD_CMD_UNLOCK_ACK);
 506 }
 507
 508 /*-----------------------------------------------------------------------
 509  */
 510 static int flash_isequal (flash_info_t * info, flash_sect_t sect,
 511                           uint offset, uchar cmd)
 512 {
 513         void *addr;
 514         cfiword_t cword;
 515         int retval;
 516
 517         addr = flash_map (info, sect, offset);
 518         flash_make_cmd (info, cmd, &cword);
 519
 520         debug ("is= cmd %x(%c) addr %p ", cmd, cmd, addr);
 521         switch (info->portwidth) {
 522         case FLASH_CFI_8BIT:
 523                 debug ("is= %x %x\n", flash_read8(addr), cword.c);
 524                 retval = (flash_read8(addr) == cword.c);
 525                 break;
 526         case FLASH_CFI_16BIT:
 527                 debug ("is= %4.4x %4.4x\n", flash_read16(addr), cword.w);
 528                 retval = (flash_read16(addr) == cword.w);
 529                 break;
 530         case FLASH_CFI_32BIT:
 531                 debug ("is= %8.8x %8.8lx\n", flash_read32(addr), cword.l);
 532                 retval = (flash_read32(addr) == cword.l);
 533                 break;
 534         case FLASH_CFI_64BIT:
 535 #ifdef DEBUG
 536                 {
 537                         char str1[20];
 538                         char str2[20];
 539
 540                         print_longlong (str1, flash_read64(addr));
 541                         print_longlong (str2, cword.ll);
 542                         debug ("is= %s %s\n", str1, str2);
 543                 }
 544 #endif
 545                 retval = (flash_read64(addr) == cword.ll);
 546                 break;
 547         default:
 548                 retval = 0;
 549                 break;
 550         }
 551         flash_unmap(info, sect, offset, addr);
 552
 553         return retval;
 554 }
 555
 556 /*-----------------------------------------------------------------------
 557  */
 558 static int flash_isset (flash_info_t * info, flash_sect_t sect,
 559                         uint offset, uchar cmd)
 560 {
 561         void *addr;
 562         cfiword_t cword;
 563         int retval;
 564
 565         addr = flash_map (info, sect, offset);
 566         flash_make_cmd (info, cmd, &cword);
 567         switch (info->portwidth) {
 568         case FLASH_CFI_8BIT:
 569                 retval = ((flash_read8(addr) & cword.c) == cword.c);
 570                 break;
 571         case FLASH_CFI_16BIT:
 572                 retval = ((flash_read16(addr) & cword.w) == cword.w);
 573                 break;
 574         case FLASH_CFI_32BIT:
 575                 retval = ((flash_read32(addr) & cword.l) == cword.l);
 576                 break;
 577         case FLASH_CFI_64BIT:
 578                 retval = ((flash_read64(addr) & cword.ll) == cword.ll);
 579                 break;
 580         default:
 581                 retval = 0;
 582                 break;
 583         }
 584         flash_unmap(info, sect, offset, addr);
 585
 586         return retval;
 587 }
 588
 589 /*-----------------------------------------------------------------------
 590  */
 591 static int flash_toggle (flash_info_t * info, flash_sect_t sect,
 592                          uint offset, uchar cmd)
 593 {
 594         void *addr;
 595         cfiword_t cword;
 596         int retval;
 597
 598         addr = flash_map (info, sect, offset);
 599         flash_make_cmd (info, cmd, &cword);
 600         switch (info->portwidth) {
 601         case FLASH_CFI_8BIT:
 602                 retval = flash_read8(addr) != flash_read8(addr);
 603                 break;
 604         case FLASH_CFI_16BIT:
 605                 retval = flash_read16(addr) != flash_read16(addr);
 606                 break;
 607         case FLASH_CFI_32BIT:
 608                 retval = flash_read32(addr) != flash_read32(addr);
 609                 break;
 610         case FLASH_CFI_64BIT:
 611                 retval = ( (flash_read32( addr ) != flash_read32( addr )) ||
 612                            (flash_read32(addr+4) != flash_read32(addr+4)) );
 613                 break;
 614         default:
 615                 retval = 0;
 616                 break;
 617         }
 618         flash_unmap(info, sect, offset, addr);
 619
 620         return retval;
 621 }
 622
 623 /*
 624  * flash_is_busy - check to see if the flash is busy
 625  *
 626  * This routine checks the status of the chip and returns true if the
 627  * chip is busy.
 628  */
 629 static int flash_is_busy (flash_info_t * info, flash_sect_t sect)
 630 {
 631         int retval;
 632
 633         switch (info->vendor) {
 634         case CFI_CMDSET_INTEL_PROG_REGIONS:
 635         case CFI_CMDSET_INTEL_STANDARD:
 636         case CFI_CMDSET_INTEL_EXTENDED:
 637                 retval = !flash_isset (info, sect, 0, FLASH_STATUS_DONE);
 638                 break;
 639         case CFI_CMDSET_AMD_STANDARD:
 640         case CFI_CMDSET_AMD_EXTENDED:
 641 #ifdef CONFIG_FLASH_CFI_LEGACY
 642         case CFI_CMDSET_AMD_LEGACY:
 643 #endif
 644                 retval = flash_toggle (info, sect, 0, AMD_STATUS_TOGGLE);
 645                 break;
 646         default:
 647                 retval = 0;
 648         }
 649         debug ("flash_is_busy: %d\n", retval);
 650         return retval;
 651 }
 652
 653 /*-----------------------------------------------------------------------
 654  *  wait for XSR.7 to be set. Time out with an error if it does not.
 655  *  This routine does not set the flash to read-array mode.
 656  */
 657 static int flash_status_check (flash_info_t * info, flash_sect_t sector,
 658                                ulong tout, char *prompt)
 659 {
 660         ulong start;
 661
 662 #if CONFIG_SYS_HZ != 1000
 663         tout *= CONFIG_SYS_HZ/1000;
 664 #endif
 665
 666         /* Wait for command completion */
 667         start = get_timer (0);
 668         while (flash_is_busy (info, sector)) {
 669                 if (get_timer (start) > tout) {
 670                         printf ("Flash %s timeout at address %lx data %lx\n",
 671                                 prompt, info->start[sector],
 672                                 flash_read_long (info, sector, 0));
 673                         flash_write_cmd (info, sector, 0, info->cmd_reset);
 674                         return ERR_TIMOUT;
 675                 }
 676                 udelay (1);             /* also triggers watchdog */
 677         }
 678         return ERR_OK;
 679 }
 680
 681 /*-----------------------------------------------------------------------
 682  * Wait for XSR.7 to be set, if it times out print an error, otherwise
 683  * do a full status check.
 684  *
 685  * This routine sets the flash to read-array mode.
 686  */
 687 static int flash_full_status_check (flash_info_t * info, flash_sect_t sector,
 688                                     ulong tout, char *prompt)
 689 {
 690         int retcode;
 691
 692         retcode = flash_status_check (info, sector, tout, prompt);
 693         switch (info->vendor) {
 694         case CFI_CMDSET_INTEL_PROG_REGIONS:
 695         case CFI_CMDSET_INTEL_EXTENDED:
 696         case CFI_CMDSET_INTEL_STANDARD:
 697                 if ((retcode != ERR_OK)
 698                     && !flash_isequal (info, sector, 0, FLASH_STATUS_DONE)) {
 699                         retcode = ERR_INVAL;
 700                         printf ("Flash %s error at address %lx\n", prompt,
 701                                 info->start[sector]);
 702                         if (flash_isset (info, sector, 0, FLASH_STATUS_ECLBS |
 703                                          FLASH_STATUS_PSLBS)) {
 704                                 puts ("Command Sequence Error.\n");
 705                         } else if (flash_isset (info, sector, 0,
 706                                                 FLASH_STATUS_ECLBS)) {
 707                                 puts ("Block Erase Error.\n");
 708                                 retcode = ERR_NOT_ERASED;
 709                         } else if (flash_isset (info, sector, 0,
 710                                                 FLASH_STATUS_PSLBS)) {
 711                                 puts ("Locking Error\n");
 712                         }
 713                         if (flash_isset (info, sector, 0, FLASH_STATUS_DPS)) {
 714                                 puts ("Block locked.\n");
 715                                 retcode = ERR_PROTECTED;
 716                         }
 717                         if (flash_isset (info, sector, 0, FLASH_STATUS_VPENS))
 718                                 puts ("Vpp Low Error.\n");
 719                 }
 720                 flash_write_cmd (info, sector, 0, info->cmd_reset);
 721                 break;
 722         default:
 723                 break;
 724         }
 725         return retcode;
 726 }
 727
 728 /*-----------------------------------------------------------------------
 729  */
 730 static void flash_add_byte (flash_info_t * info, cfiword_t * cword, uchar c)
 731 {
 732 #if defined(__LITTLE_ENDIAN) && !defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 733         unsigned short  w;
 734         unsigned int    l;
 735         unsigned long long ll;
 736 #endif
 737
 738         switch (info->portwidth) {
 739         case FLASH_CFI_8BIT:
 740                 cword->c = c;
 741                 break;
 742         case FLASH_CFI_16BIT:
 743 #if defined(__LITTLE_ENDIAN) && !defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 744                 w = c;
 745                 w <<= 8;
 746                 cword->w = (cword->w >> 8) | w;
 747 #else
 748                 cword->w = (cword->w << 8) | c;
 749 #endif
 750                 break;
 751         case FLASH_CFI_32BIT:
 752 #if defined(__LITTLE_ENDIAN) && !defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 753                 l = c;
 754                 l <<= 24;
 755                 cword->l = (cword->l >> 8) | l;
 756 #else
 757                 cword->l = (cword->l << 8) | c;
 758 #endif
 759                 break;
 760         case FLASH_CFI_64BIT:
 761 #if defined(__LITTLE_ENDIAN) && !defined(CONFIG_SYS_WRITE_SWAPPED_DATA)
 762                 ll = c;
 763                 ll <<= 56;
 764                 cword->ll = (cword->ll >> 8) | ll;
 765 #else
 766                 cword->ll = (cword->ll << 8) | c;
 767 #endif
 768                 break;
 769         }
 770 }
 771
 772 /*
 773  * Loop through the sector table starting from the previously found sector.
 774  * Searches forwards or backwards, dependent on the passed address.
 775  */
 776 static flash_sect_t find_sector (flash_info_t * info, ulong addr)
 777 {
 778         static flash_sect_t saved_sector = 0; /* previously found sector */
 779         flash_sect_t sector = saved_sector;
 780
 781         while ((info->start[sector] < addr)
 782                         && (sector < info->sector_count - 1))
 783                 sector++;
 784         while ((info->start[sector] > addr) && (sector > 0))
 785                 /*
 786                  * also decrements the sector in case of an overshot
 787                  * in the first loop
 788                  */
 789                 sector--;
 790
 791         saved_sector = sector;
 792         return sector;
 793 }
 794
 795 /*-----------------------------------------------------------------------
 796  */
 797 static int flash_write_cfiword (flash_info_t * info, ulong dest,
 798                                 cfiword_t cword)
 799 {
 800         void *dstaddr = (void *)dest;
 801         int flag;
 802         flash_sect_t sect = 0;
 803         char sect_found = 0;
 804
 805         /* Check if Flash is (sufficiently) erased */
 806         switch (info->portwidth) {
 807         case FLASH_CFI_8BIT:
 808                 flag = ((flash_read8(dstaddr) & cword.c) == cword.c);
 809                 break;
 810         case FLASH_CFI_16BIT:
 811                 flag = ((flash_read16(dstaddr) & cword.w) == cword.w);
 812                 break;
 813         case FLASH_CFI_32BIT:
 814                 flag = ((flash_read32(dstaddr) & cword.l) == cword.l);
 815                 break;
 816         case FLASH_CFI_64BIT:
 817                 flag = ((flash_read64(dstaddr) & cword.ll) == cword.ll);
 818                 break;
 819         default:
 820                 flag = 0;
 821                 break;
 822         }
 823         if (!flag)
 824                 return ERR_NOT_ERASED;
 825
 826         /* Disable interrupts which might cause a timeout here */
 827         flag = disable_interrupts ();
 828
 829         switch (info->vendor) {
 830         case CFI_CMDSET_INTEL_PROG_REGIONS:
 831         case CFI_CMDSET_INTEL_EXTENDED:
 832         case CFI_CMDSET_INTEL_STANDARD:
 833                 flash_write_cmd (info, 0, 0, FLASH_CMD_CLEAR_STATUS);
 834                 flash_write_cmd (info, 0, 0, FLASH_CMD_WRITE);
 835                 break;
 836         case CFI_CMDSET_AMD_EXTENDED:
 837         case CFI_CMDSET_AMD_STANDARD:
 838 #ifdef CONFIG_FLASH_CFI_LEGACY
 839         case CFI_CMDSET_AMD_LEGACY:
 840 #endif
 841                 sect = find_sector(info, dest);
 842                 flash_unlock_seq (info, sect);
 843                 flash_write_cmd (info, sect, info->addr_unlock1, AMD_CMD_WRITE);
 844                 sect_found = 1;
 845                 break;
 846         }
 847
 848         switch (info->portwidth) {
 849         case FLASH_CFI_8BIT:
 850                 flash_write8(cword.c, dstaddr);
 851                 break;
 852         case FLASH_CFI_16BIT:
 853                 flash_write16(cword.w, dstaddr);
 854                 break;
 855         case FLASH_CFI_32BIT:
 856                 flash_write32(cword.l, dstaddr);
 857                 break;
 858         case FLASH_CFI_64BIT:
 859                 flash_write64(cword.ll, dstaddr);
 860                 break;
 861         }
 862
 863         /* re-enable interrupts if necessary */
 864         if (flag)
 865                 enable_interrupts ();
 866
 867         if (!sect_found)
 868                 sect = find_sector (info, dest);
 869
 870         return flash_full_status_check (info, sect, info->write_tout, "write");
 871 }
 872
 873 #ifdef CONFIG_SYS_FLASH_USE_BUFFER_WRITE
 874
 875 static int flash_write_cfibuffer (flash_info_t * info, ulong dest, uchar * cp,
 876                                   int len)
 877 {
 878         flash_sect_t sector;
 879         int cnt;
 880         int retcode;
 881         void *src = cp;
 882         void *dst = (void *)dest;
 883         void *dst2 = dst;
 884         int flag = 0;
 885         uint offset = 0;
 886         unsigned int shift;
 887         uchar write_cmd;
 888
 889         switch (info->portwidth) {
 890         case FLASH_CFI_8BIT:
 891                 shift = 0;
 892                 break;
 893         case FLASH_CFI_16BIT:
 894                 shift = 1;
 895                 break;
 896         case FLASH_CFI_32BIT:
 897                 shift = 2;
 898                 break;
 899         case FLASH_CFI_64BIT:
 900                 shift = 3;
 901                 break;
 902         default:
 903                 retcode = ERR_INVAL;
 904                 goto out_unmap;
 905         }
 906
 907         cnt = len >> shift;
 908
 909         while ((cnt-- > 0) && (flag == 0)) {
 910                 switch (info->portwidth) {
 911                 case FLASH_CFI_8BIT:
 912                         flag = ((flash_read8(dst2) & flash_read8(src)) ==
 913                                 flash_read8(src));
 914                         src += 1, dst2 += 1;
 915                         break;
 916                 case FLASH_CFI_16BIT:
 917                         flag = ((flash_read16(dst2) & flash_read16(src)) ==
 918                                 flash_read16(src));
 919                         src += 2, dst2 += 2;
 920                         break;
 921                 case FLASH_CFI_32BIT:
 922                         flag = ((flash_read32(dst2) & flash_read32(src)) ==
 923                                 flash_read32(src));
 924                         src += 4, dst2 += 4;
 925                         break;
 926                 case FLASH_CFI_64BIT:
 927                         flag = ((flash_read64(dst2) & flash_read64(src)) ==
 928                                 flash_read64(src));
 929                         src += 8, dst2 += 8;
 930                         break;
 931                 }
 932         }
 933         if (!flag) {
 934                 retcode = ERR_NOT_ERASED;
 935                 goto out_unmap;
 936         }
 937
 938         src = cp;
 939         sector = find_sector (info, dest);
 940
 941         switch (info->vendor) {
 942         case CFI_CMDSET_INTEL_PROG_REGIONS:
 943         case CFI_CMDSET_INTEL_STANDARD:
 944         case CFI_CMDSET_INTEL_EXTENDED:
 945                 write_cmd = (info->vendor == CFI_CMDSET_INTEL_PROG_REGIONS) ?
 946                                         FLASH_CMD_WRITE_BUFFER_PROG : FLASH_CMD_WRITE_TO_BUFFER;
 947                 flash_write_cmd (info, sector, 0, FLASH_CMD_CLEAR_STATUS);
 948                 flash_write_cmd (info, sector, 0, FLASH_CMD_READ_STATUS);
 949                 flash_write_cmd (info, sector, 0, write_cmd);
 950                 retcode = flash_status_check (info, sector,
 951                                               info->buffer_write_tout,
 952                                               "write to buffer");
 953                 if (retcode == ERR_OK) {
 954                         /* reduce the number of loops by the width of
 955                          * the port */
 956                         cnt = len >> shift;
 957                         flash_write_cmd (info, sector, 0, cnt - 1);
 958                         while (cnt-- > 0) {
 959                                 switch (info->portwidth) {
 960                                 case FLASH_CFI_8BIT:
 961                                         flash_write8(flash_read8(src), dst);
 962                                         src += 1, dst += 1;
 963                                         break;
 964                                 case FLASH_CFI_16BIT:
 965                                         flash_write16(flash_read16(src), dst);
 966                                         src += 2, dst += 2;
 967                                         break;
 968                                 case FLASH_CFI_32BIT:
 969                                         flash_write32(flash_read32(src), dst);
 970                                         src += 4, dst += 4;
 971                                         break;
 972                                 case FLASH_CFI_64BIT:
 973                                         flash_write64(flash_read64(src), dst);
 974                                         src += 8, dst += 8;
 975                                         break;
 976                                 default:
 977                                         retcode = ERR_INVAL;
 978                                         goto out_unmap;
 979                                 }
 980                         }
 981                         flash_write_cmd (info, sector, 0,
 982                                          FLASH_CMD_WRITE_BUFFER_CONFIRM);
 983                         retcode = flash_full_status_check (
 984                                 info, sector, info->buffer_write_tout,
 985                                 "buffer write");
 986                 }
 987
 988                 break;
 989
 990         case CFI_CMDSET_AMD_STANDARD:
 991         case CFI_CMDSET_AMD_EXTENDED:
 992                 flash_unlock_seq(info,0);
 993
 994 #ifdef CONFIG_FLASH_SPANSION_S29WS_N
 995                 offset = ((unsigned long)dst - info->start[sector]) >> shift;
 996 #endif
 997                 flash_write_cmd(info, sector, offset, AMD_CMD_WRITE_TO_BUFFER);
 998                 cnt = len >> shift;
 999                 flash_write_cmd(info, sector, offset, (uchar)cnt - 1);
1000
1001                 switch (info->portwidth) {
1002                 case FLASH_CFI_8BIT:
1003                         while (cnt-- > 0) {
1004                                 flash_write8(flash_read8(src), dst);
1005                                 src += 1, dst += 1;
1006                         }
1007                         break;
1008                 case FLASH_CFI_16BIT:
1009                         while (cnt-- > 0) {
1010                                 flash_write16(flash_read16(src), dst);
1011                                 src += 2, dst += 2;
1012                         }
1013                         break;
1014                 case FLASH_CFI_32BIT:
1015                         while (cnt-- > 0) {
1016                                 flash_write32(flash_read32(src), dst);
1017                                 src += 4, dst += 4;
1018                         }
1019                         break;
1020                 case FLASH_CFI_64BIT:
1021                         while (cnt-- > 0) {
1022                                 flash_write64(flash_read64(src), dst);
1023                                 src += 8, dst += 8;
1024                         }
1025                         break;
1026                 default:
1027                         retcode = ERR_INVAL;
1028                         goto out_unmap;
1029                 }
1030
1031                 flash_write_cmd (info, sector, 0, AMD_CMD_WRITE_BUFFER_CONFIRM);
1032                 retcode = flash_full_status_check (info, sector,
1033                                                    info->buffer_write_tout,
1034                                                    "buffer write");
1035                 break;
1036
1037         default:
1038                 debug ("Unknown Command Set\n");
1039                 retcode = ERR_INVAL;
1040                 break;
1041         }
1042
1043 out_unmap:
1044         return retcode;
1045 }
1046 #endif /* CONFIG_SYS_FLASH_USE_BUFFER_WRITE */
1047
1048
1049 /*-----------------------------------------------------------------------
1050  */
1051 int flash_erase (flash_info_t * info, int s_first, int s_last)
1052 {
1053         int rcode = 0;
1054         int prot;
1055         flash_sect_t sect;
1056
1057         if (info->flash_id != FLASH_MAN_CFI) {
1058                 puts ("Can't erase unknown flash type - aborted\n");
1059                 return 1;
1060         }
1061         if ((s_first < 0) || (s_first > s_last)) {
1062                 puts ("- no sectors to erase\n");
1063                 return 1;
1064         }
1065
1066         prot = 0;
1067         for (sect = s_first; sect <= s_last; ++sect) {
1068                 if (info->protect[sect]) {
1069                         prot++;
1070                 }
1071         }
1072         if (prot) {
1073                 printf ("- Warning: %d protected sectors will not be erased!\n",
1074                         prot);
1075         } else if (flash_verbose) {
1076                 putc ('\n');
1077         }
1078
1079
1080         for (sect = s_first; sect <= s_last; sect++) {
1081                 if (info->protect[sect] == 0) { /* not protected */
1082                         switch (info->vendor) {
1083                         case CFI_CMDSET_INTEL_PROG_REGIONS:
1084                         case CFI_CMDSET_INTEL_STANDARD:
1085                         case CFI_CMDSET_INTEL_EXTENDED:
1086                                 flash_write_cmd (info, sect, 0,
1087                                                  FLASH_CMD_CLEAR_STATUS);
1088                                 flash_write_cmd (info, sect, 0,
1089                                                  FLASH_CMD_BLOCK_ERASE);
1090                                 flash_write_cmd (info, sect, 0,
1091                                                  FLASH_CMD_ERASE_CONFIRM);
1092                                 break;
1093                         case CFI_CMDSET_AMD_STANDARD:
1094                         case CFI_CMDSET_AMD_EXTENDED:
1095                                 flash_unlock_seq (info, sect);
1096                                 flash_write_cmd (info, sect,
1097                                                 info->addr_unlock1,
1098                                                 AMD_CMD_ERASE_START);
1099                                 flash_unlock_seq (info, sect);
1100                                 flash_write_cmd (info, sect, 0,
1101                                                  AMD_CMD_ERASE_SECTOR);
1102                                 break;
1103 #ifdef CONFIG_FLASH_CFI_LEGACY
1104                         case CFI_CMDSET_AMD_LEGACY:
1105                                 flash_unlock_seq (info, 0);
1106                                 flash_write_cmd (info, 0, info->addr_unlock1,
1107                                                 AMD_CMD_ERASE_START);
1108                                 flash_unlock_seq (info, 0);
1109                                 flash_write_cmd (info, sect, 0,
1110                                                 AMD_CMD_ERASE_SECTOR);
1111                                 break;
1112 #endif
1113                         default:
1114                                 debug ("Unkown flash vendor %d\n",
1115                                        info->vendor);
1116                                 break;
1117                         }
1118
1119                         if (flash_full_status_check
1120                             (info, sect, info->erase_blk_tout, "erase")) {
1121                                 rcode = 1;
1122                         } else if (flash_verbose)
1123                                 putc ('.');
1124                 }
1125         }
1126
1127         if (flash_verbose)
1128                 puts (" done\n");
1129
1130         return rcode;
1131 }
1132
1133 /*-----------------------------------------------------------------------
1134  */
1135 void flash_print_info (flash_info_t * info)
1136 {
1137         int i;
1138
1139         if (info->flash_id != FLASH_MAN_CFI) {
1140                 puts ("missing or unknown FLASH type\n");
1141                 return;
1142         }
1143
1144         printf ("%s FLASH (%d x %d)",
1145                 info->name,
1146                 (info->portwidth << 3), (info->chipwidth << 3));
1147         if (info->size < 1024*1024)
1148                 printf ("  Size: %ld kB in %d Sectors\n",
1149                         info->size >> 10, info->sector_count);
1150         else
1151                 printf ("  Size: %ld MB in %d Sectors\n",
1152                         info->size >> 20, info->sector_count);
1153         printf ("  ");
1154         switch (info->vendor) {
1155                 case CFI_CMDSET_INTEL_PROG_REGIONS:
1156                         printf ("Intel Prog Regions");
1157                         break;
1158                 case CFI_CMDSET_INTEL_STANDARD:
1159                         printf ("Intel Standard");
1160                         break;
1161                 case CFI_CMDSET_INTEL_EXTENDED:
1162                         printf ("Intel Extended");
1163                         break;
1164                 case CFI_CMDSET_AMD_STANDARD:
1165                         printf ("AMD Standard");
1166                         break;
1167                 case CFI_CMDSET_AMD_EXTENDED:
1168                         printf ("AMD Extended");
1169                         break;
1170 #ifdef CONFIG_FLASH_CFI_LEGACY
1171                 case CFI_CMDSET_AMD_LEGACY:
1172                         printf ("AMD Legacy");
1173                         break;
1174 #endif
1175                 default:
1176                         printf ("Unknown (%d)", info->vendor);
1177                         break;
1178         }
1179         printf (" command set, Manufacturer ID: 0x%02X, Device ID: 0x%02X",
1180                 info->manufacturer_id, info->device_id);
1181         if (info->device_id == 0x7E) {
1182                 printf("%04X", info->device_id2);
1183         }
1184         printf ("\n  Erase timeout: %ld ms, write timeout: %ld ms\n",
1185                 info->erase_blk_tout,
1186                 info->write_tout);
1187         if (info->buffer_size > 1) {
1188                 printf ("  Buffer write timeout: %ld ms, "
1189                         "buffer size: %d bytes\n",
1190                 info->buffer_write_tout,
1191                 info->buffer_size);
1192         }
1193
1194         puts ("\n  Sector Start Addresses:");
1195         for (i = 0; i < info->sector_count; ++i) {
1196                 if ((i % 5) == 0)
1197                         printf ("\n");
1198 #ifdef CONFIG_SYS_FLASH_EMPTY_INFO
1199                 int k;
1200                 int size;
1201                 int erased;
1202                 volatile unsigned long *flash;
1203
1204                 /*
1205                  * Check if whole sector is erased
1206                  */
1207                 size = flash_sector_size(info, i);
1208                 erased = 1;
1209                 flash = (volatile unsigned long *) info->start[i];
1210                 size = size >> 2;       /* divide by 4 for longword access */
1211                 for (k = 0; k < size; k++) {
1212                         if (*flash++ != 0xffffffff) {
1213                                 erased = 0;
1214                                 break;
1215                         }
1216                 }
1217
1218                 /* print empty and read-only info */
1219                 printf ("  %08lX %c %s ",
1220                         info->start[i],
1221                         erased ? 'E' : ' ',
1222                         info->protect[i] ? "RO" : "  ");
1223 #else   /* ! CONFIG_SYS_FLASH_EMPTY_INFO */
1224                 printf ("  %08lX   %s ",
1225                         info->start[i],
1226                         info->protect[i] ? "RO" : "  ");
1227 #endif
1228         }
1229         putc ('\n');
1230         return;
1231 }
1232
1233 /*-----------------------------------------------------------------------
1234  * This is used in a few places in write_buf() to show programming
1235  * progress.  Making it a function is nasty because it needs to do side
1236  * effect updates to digit and dots.  Repeated code is nasty too, so
1237  * we define it once here.
1238  */
1239 #ifdef CONFIG_FLASH_SHOW_PROGRESS
1240 #define FLASH_SHOW_PROGRESS(scale, dots, digit, dots_sub) \
1241         if (flash_verbose) { \
1242                 dots -= dots_sub; \
1243                 if ((scale > 0) && (dots <= 0)) { \
1244                         if ((digit % 5) == 0) \
1245                                 printf ("%d", digit / 5); \
1246                         else \
1247                                 putc ('.'); \
1248                         digit--; \
1249                         dots += scale; \
1250                 } \
1251         }
1252 #else
1253 #define FLASH_SHOW_PROGRESS(scale, dots, digit, dots_sub)
1254 #endif
1255
1256 /*-----------------------------------------------------------------------
1257  * Copy memory to flash, returns:
1258  * 0 - OK
1259  * 1 - write timeout
1260  * 2 - Flash not erased
1261  */
1262 int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt)
1263 {
1264         ulong wp;
1265         uchar *p;
1266         int aln;
1267         cfiword_t cword;
1268         int i, rc;
1269 #ifdef CONFIG_SYS_FLASH_USE_BUFFER_WRITE
1270         int buffered_size;
1271 #endif
1272 #ifdef CONFIG_FLASH_SHOW_PROGRESS
1273         int digit = CONFIG_FLASH_SHOW_PROGRESS;
1274         int scale = 0;
1275         int dots  = 0;
1276
1277         /*
1278          * Suppress if there are fewer than CONFIG_FLASH_SHOW_PROGRESS writes.
1279          */
1280         if (cnt >= CONFIG_FLASH_SHOW_PROGRESS) {
1281                 scale = (int)((cnt + CONFIG_FLASH_SHOW_PROGRESS - 1) /
1282                         CONFIG_FLASH_SHOW_PROGRESS);
1283         }
1284 #endif
1285
1286         /* get lower aligned address */
1287         wp = (addr & ~(info->portwidth - 1));
1288
1289         /* handle unaligned start */
1290         if ((aln = addr - wp) != 0) {
1291                 cword.l = 0;
1292                 p = (uchar *)wp;
1293                 for (i = 0; i < aln; ++i)
1294                         flash_add_byte (info, &cword, flash_read8(p + i));
1295
1296                 for (; (i < info->portwidth) && (cnt > 0); i++) {
1297                         flash_add_byte (info, &cword, *src++);
1298                         cnt--;
1299                 }
1300                 for (; (cnt == 0) && (i < info->portwidth); ++i)
1301                         flash_add_byte (info, &cword, flash_read8(p + i));
1302
1303                 rc = flash_write_cfiword (info, wp, cword);
1304                 if (rc != 0)
1305                         return rc;
1306
1307                 wp += i;
1308                 FLASH_SHOW_PROGRESS(scale, dots, digit, i);
1309         }
1310
1311         /* handle the aligned part */
1312 #ifdef CONFIG_SYS_FLASH_USE_BUFFER_WRITE
1313         buffered_size = (info->portwidth / info->chipwidth);
1314         buffered_size *= info->buffer_size;
1315         while (cnt >= info->portwidth) {
1316                 /* prohibit buffer write when buffer_size is 1 */
1317                 if (info->buffer_size == 1) {
1318                         cword.l = 0;
1319                         for (i = 0; i < info->portwidth; i++)
1320                                 flash_add_byte (info, &cword, *src++);
1321                         if ((rc = flash_write_cfiword (info, wp, cword)) != 0)
1322                                 return rc;
1323                         wp += info->portwidth;
1324                         cnt -= info->portwidth;
1325                         continue;
1326                 }
1327
1328                 /* write buffer until next buffered_size aligned boundary */
1329                 i = buffered_size - (wp % buffered_size);
1330                 if (i > cnt)
1331                         i = cnt;
1332                 if ((rc = flash_write_cfibuffer (info, wp, src, i)) != ERR_OK)
1333                         return rc;
1334                 i -= i & (info->portwidth - 1);
1335                 wp += i;
1336                 src += i;
1337                 cnt -= i;
1338                 FLASH_SHOW_PROGRESS(scale, dots, digit, i);
1339         }
1340 #else
1341         while (cnt >= info->portwidth) {
1342                 cword.l = 0;
1343                 for (i = 0; i < info->portwidth; i++) {
1344                         flash_add_byte (info, &cword, *src++);
1345                 }
1346                 if ((rc = flash_write_cfiword (info, wp, cword)) != 0)
1347                         return rc;
1348                 wp += info->portwidth;
1349                 cnt -= info->portwidth;
1350                 FLASH_SHOW_PROGRESS(scale, dots, digit, info->portwidth);
1351         }
1352 #endif /* CONFIG_SYS_FLASH_USE_BUFFER_WRITE */
1353
1354         if (cnt == 0) {
1355                 return (0);
1356         }
1357
1358         /*
1359          * handle unaligned tail bytes
1360          */
1361         cword.l = 0;
1362         p = (uchar *)wp;
1363         for (i = 0; (i < info->portwidth) && (cnt > 0); ++i) {
1364                 flash_add_byte (info, &cword, *src++);
1365                 --cnt;
1366         }
1367         for (; i < info->portwidth; ++i)
1368                 flash_add_byte (info, &cword, flash_read8(p + i));
1369
1370         return flash_write_cfiword (info, wp, cword);
1371 }
1372
1373 /*-----------------------------------------------------------------------
1374  */
1375 #ifdef CONFIG_SYS_FLASH_PROTECTION
1376
1377 int flash_real_protect (flash_info_t * info, long sector, int prot)
1378 {
1379         int retcode = 0;
1380
1381         switch (info->vendor) {
1382                 case CFI_CMDSET_INTEL_PROG_REGIONS:
1383                 case CFI_CMDSET_INTEL_STANDARD:
1384                 case CFI_CMDSET_INTEL_EXTENDED:
1385                         flash_write_cmd (info, sector, 0,
1386                                          FLASH_CMD_CLEAR_STATUS);
1387                         flash_write_cmd (info, sector, 0, FLASH_CMD_PROTECT);
1388                         if (prot)
1389                                 flash_write_cmd (info, sector, 0,
1390                                         FLASH_CMD_PROTECT_SET);
1391                         else
1392                                 flash_write_cmd (info, sector, 0,
1393                                         FLASH_CMD_PROTECT_CLEAR);
1394                         break;
1395                 case CFI_CMDSET_AMD_EXTENDED:
1396                 case CFI_CMDSET_AMD_STANDARD:
1397                         /* U-Boot only checks the first byte */
1398                         if (info->manufacturer_id == (uchar)ATM_MANUFACT) {
1399                                 if (prot) {
1400                                         flash_unlock_seq (info, 0);
1401                                         flash_write_cmd (info, 0,
1402                                                         info->addr_unlock1,
1403                                                         ATM_CMD_SOFTLOCK_START);
1404                                         flash_unlock_seq (info, 0);
1405                                         flash_write_cmd (info, sector, 0,
1406                                                         ATM_CMD_LOCK_SECT);
1407                                 } else {
1408                                         flash_write_cmd (info, 0,
1409                                                         info->addr_unlock1,
1410                                                         AMD_CMD_UNLOCK_START);
1411                                         if (info->device_id == ATM_ID_BV6416)
1412                                                 flash_write_cmd (info, sector,
1413                                                         0, ATM_CMD_UNLOCK_SECT);
1414                                 }
1415                         }
1416                         break;
1417 #ifdef CONFIG_FLASH_CFI_LEGACY
1418                 case CFI_CMDSET_AMD_LEGACY:
1419                         flash_write_cmd (info, sector, 0, FLASH_CMD_CLEAR_STATUS);
1420                         flash_write_cmd (info, sector, 0, FLASH_CMD_PROTECT);
1421                         if (prot)
1422                                 flash_write_cmd (info, sector, 0, FLASH_CMD_PROTECT_SET);
1423                         else
1424                                 flash_write_cmd (info, sector, 0, FLASH_CMD_PROTECT_CLEAR);
1425 #endif
1426         };
1427
1428         if ((retcode =
1429              flash_full_status_check (info, sector, info->erase_blk_tout,
1430                                       prot ? "protect" : "unprotect")) == 0) {
1431
1432                 info->protect[sector] = prot;
1433
1434                 /*
1435                  * On some of Intel's flash chips (marked via legacy_unlock)
1436                  * unprotect unprotects all locking.
1437                  */
1438                 if ((prot == 0) && (info->legacy_unlock)) {
1439                         flash_sect_t i;
1440
1441                         for (i = 0; i < info->sector_count; i++) {
1442                                 if (info->protect[i])
1443                                         flash_real_protect (info, i, 1);
1444                         }
1445                 }
1446         }
1447         return retcode;
1448 }
1449
1450 /*-----------------------------------------------------------------------
1451  * flash_read_user_serial - read the OneTimeProgramming cells
1452  */
1453 void flash_read_user_serial (flash_info_t * info, void *buffer, int offset,
1454                              int len)
1455 {
1456         uchar *src;
1457         uchar *dst;
1458
1459         dst = buffer;
1460         src = flash_map (info, 0, FLASH_OFFSET_USER_PROTECTION);
1461         flash_write_cmd (info, 0, 0, FLASH_CMD_READ_ID);
1462         memcpy (dst, src + offset, len);
1463         flash_write_cmd (info, 0, 0, info->cmd_reset);
1464         flash_unmap(info, 0, FLASH_OFFSET_USER_PROTECTION, src);
1465 }
1466
1467 /*
1468  * flash_read_factory_serial - read the device Id from the protection area
1469  */
1470 void flash_read_factory_serial (flash_info_t * info, void *buffer, int offset,
1471                                 int len)
1472 {
1473         uchar *src;
1474
1475         src = flash_map (info, 0, FLASH_OFFSET_INTEL_PROTECTION);
1476         flash_write_cmd (info, 0, 0, FLASH_CMD_READ_ID);
1477         memcpy (buffer, src + offset, len);
1478         flash_write_cmd (info, 0, 0, info->cmd_reset);
1479         flash_unmap(info, 0, FLASH_OFFSET_INTEL_PROTECTION, src);
1480 }
1481
1482 #endif /* CONFIG_SYS_FLASH_PROTECTION */
1483
1484 /*-----------------------------------------------------------------------
1485  * Reverse the order of the erase regions in the CFI QRY structure.
1486  * This is needed for chips that are either a) correctly detected as
1487  * top-boot, or b) buggy.
1488  */
1489 static void cfi_reverse_geometry(struct cfi_qry *qry)
1490 {
1491         unsigned int i, j;
1492         u32 tmp;
1493
1494         for (i = 0, j = qry->num_erase_regions - 1; i < j; i++, j--) {
1495                 tmp = qry->erase_region_info[i];
1496                 qry->erase_region_info[i] = qry->erase_region_info[j];
1497                 qry->erase_region_info[j] = tmp;
1498         }
1499 }
1500
1501 /*-----------------------------------------------------------------------
1502  * read jedec ids from device and set corresponding fields in info struct
1503  *
1504  * Note: assume cfi->vendor, cfi->portwidth and cfi->chipwidth are correct
1505  *
1506  */
1507 static void cmdset_intel_read_jedec_ids(flash_info_t *info)
1508 {
1509         flash_write_cmd(info, 0, 0, FLASH_CMD_RESET);
1510         flash_write_cmd(info, 0, 0, FLASH_CMD_READ_ID);
1511         udelay(1000); /* some flash are slow to respond */
1512         info->manufacturer_id = flash_read_uchar (info,
1513                                         FLASH_OFFSET_MANUFACTURER_ID);
1514         info->device_id = flash_read_uchar (info,
1515                                         FLASH_OFFSET_DEVICE_ID);
1516         flash_write_cmd(info, 0, 0, FLASH_CMD_RESET);
1517 }
1518
1519 static int cmdset_intel_init(flash_info_t *info, struct cfi_qry *qry)
1520 {
1521         info->cmd_reset = FLASH_CMD_RESET;
1522
1523         cmdset_intel_read_jedec_ids(info);
1524         flash_write_cmd(info, 0, info->cfi_offset, FLASH_CMD_CFI);
1525
1526 #ifdef CONFIG_SYS_FLASH_PROTECTION
1527         /* read legacy lock/unlock bit from intel flash */
1528         if (info->ext_addr) {
1529                 info->legacy_unlock = flash_read_uchar (info,
1530                                 info->ext_addr + 5) & 0x08;
1531         }
1532 #endif
1533
1534         return 0;
1535 }
1536
1537 static void cmdset_amd_read_jedec_ids(flash_info_t *info)
1538 {
1539         flash_write_cmd(info, 0, 0, AMD_CMD_RESET);
1540         flash_unlock_seq(info, 0);
1541         flash_write_cmd(info, 0, info->addr_unlock1, FLASH_CMD_READ_ID);
1542         udelay(1000); /* some flash are slow to respond */
1543
1544         info->manufacturer_id = flash_read_uchar (info,
1545                                         FLASH_OFFSET_MANUFACTURER_ID);
1546
1547         switch (info->chipwidth){
1548         case FLASH_CFI_8BIT:
1549                 info->device_id = flash_read_uchar (info,
1550                                                 FLASH_OFFSET_DEVICE_ID);
1551                 if (info->device_id == 0x7E) {
1552                         /* AMD 3-byte (expanded) device ids */
1553                         info->device_id2 = flash_read_uchar (info,
1554                                                 FLASH_OFFSET_DEVICE_ID2);
1555                         info->device_id2 <<= 8;
1556                         info->device_id2 |= flash_read_uchar (info,
1557                                                 FLASH_OFFSET_DEVICE_ID3);
1558                 }
1559                 break;
1560         case FLASH_CFI_16BIT:
1561                 info->device_id = flash_read_word (info,
1562                                                 FLASH_OFFSET_DEVICE_ID);
1563                 break;
1564         default:
1565                 break;
1566         }
1567         flash_write_cmd(info, 0, 0, AMD_CMD_RESET);
1568 }
1569
1570 static int cmdset_amd_init(flash_info_t *info, struct cfi_qry *qry)
1571 {
1572         info->cmd_reset = AMD_CMD_RESET;
1573
1574         cmdset_amd_read_jedec_ids(info);
1575         flash_write_cmd(info, 0, info->cfi_offset, FLASH_CMD_CFI);
1576
1577         return 0;
1578 }
1579
1580 #ifdef CONFIG_FLASH_CFI_LEGACY
1581 static void flash_read_jedec_ids (flash_info_t * info)
1582 {
1583         info->manufacturer_id = 0;
1584         info->device_id       = 0;
1585         info->device_id2      = 0;
1586
1587         switch (info->vendor) {
1588         case CFI_CMDSET_INTEL_PROG_REGIONS:
1589         case CFI_CMDSET_INTEL_STANDARD:
1590         case CFI_CMDSET_INTEL_EXTENDED:
1591                 cmdset_intel_read_jedec_ids(info);
1592                 break;
1593         case CFI_CMDSET_AMD_STANDARD:
1594         case CFI_CMDSET_AMD_EXTENDED:
1595                 cmdset_amd_read_jedec_ids(info);
1596                 break;
1597         default:
1598                 break;
1599         }
1600 }
1601
1602 /*-----------------------------------------------------------------------
1603  * Call board code to request info about non-CFI flash.
1604  * board_flash_get_legacy needs to fill in at least:
1605  * info->portwidth, info->chipwidth and info->interface for Jedec probing.
1606  */
1607 static int flash_detect_legacy(phys_addr_t base, int banknum)
1608 {
1609         flash_info_t *info = &flash_info[banknum];
1610
1611         if (board_flash_get_legacy(base, banknum, info)) {
1612                 /* board code may have filled info completely. If not, we
1613                    use JEDEC ID probing. */
1614                 if (!info->vendor) {
1615                         int modes[] = {
1616                                 CFI_CMDSET_AMD_STANDARD,
1617                                 CFI_CMDSET_INTEL_STANDARD
1618                         };
1619                         int i;
1620
1621                         for (i = 0; i < sizeof(modes) / sizeof(modes[0]); i++) {
1622                                 info->vendor = modes[i];
1623                                 info->start[0] =
1624                                         (ulong)map_physmem(base,
1625                                                            info->portwidth,
1626                                                            MAP_NOCACHE);
1627                                 if (info->portwidth == FLASH_CFI_8BIT
1628                                         && info->interface == FLASH_CFI_X8X16) {
1629                                         info->addr_unlock1 = 0x2AAA;
1630                                         info->addr_unlock2 = 0x5555;
1631                                 } else {
1632                                         info->addr_unlock1 = 0x5555;
1633                                         info->addr_unlock2 = 0x2AAA;
1634                                 }
1635                                 flash_read_jedec_ids(info);
1636                                 debug("JEDEC PROBE: ID %x %x %x\n",
1637                                                 info->manufacturer_id,
1638                                                 info->device_id,
1639                                                 info->device_id2);
1640                                 if (jedec_flash_match(info, info->start[0]))
1641                                         break;
1642                                 else
1643                                         unmap_physmem((void *)info->start[0],
1644                                                       MAP_NOCACHE);
1645                         }
1646                 }
1647
1648                 switch(info->vendor) {
1649                 case CFI_CMDSET_INTEL_PROG_REGIONS:
1650                 case CFI_CMDSET_INTEL_STANDARD:
1651                 case CFI_CMDSET_INTEL_EXTENDED:
1652                         info->cmd_reset = FLASH_CMD_RESET;
1653                         break;
1654                 case CFI_CMDSET_AMD_STANDARD:
1655                 case CFI_CMDSET_AMD_EXTENDED:
1656                 case CFI_CMDSET_AMD_LEGACY:
1657                         info->cmd_reset = AMD_CMD_RESET;
1658                         break;
1659                 }
1660                 info->flash_id = FLASH_MAN_CFI;
1661                 return 1;
1662         }
1663         return 0; /* use CFI */
1664 }
1665 #else
1666 static inline int flash_detect_legacy(phys_addr_t base, int banknum)
1667 {
1668         return 0; /* use CFI */
1669 }
1670 #endif
1671
1672 /*-----------------------------------------------------------------------
1673  * detect if flash is compatible with the Common Flash Interface (CFI)
1674  * http://www.jedec.org/download/search/jesd68.pdf
1675  */
1676 static void flash_read_cfi (flash_info_t *info, void *buf,
1677                 unsigned int start, size_t len)
1678 {
1679         u8 *p = buf;
1680         unsigned int i;
1681
1682         for (i = 0; i < len; i++)
1683                 p[i] = flash_read_uchar(info, start + i);
1684 }
1685
1686 static int __flash_detect_cfi (flash_info_t * info, struct cfi_qry *qry)
1687 {
1688         int cfi_offset;
1689
1690         /* We do not yet know what kind of commandset to use, so we issue
1691            the reset command in both Intel and AMD variants, in the hope
1692            that AMD flash roms ignore the Intel command. */
1693         flash_write_cmd (info, 0, 0, AMD_CMD_RESET);
1694         flash_write_cmd (info, 0, 0, FLASH_CMD_RESET);
1695
1696         for (cfi_offset=0;
1697              cfi_offset < sizeof(flash_offset_cfi) / sizeof(uint);
1698              cfi_offset++) {
1699                 flash_write_cmd (info, 0, flash_offset_cfi[cfi_offset],
1700                                  FLASH_CMD_CFI);
1701                 if (flash_isequal (info, 0, FLASH_OFFSET_CFI_RESP, 'Q')
1702                     && flash_isequal (info, 0, FLASH_OFFSET_CFI_RESP + 1, 'R')
1703                     && flash_isequal (info, 0, FLASH_OFFSET_CFI_RESP + 2, 'Y')) {
1704                         flash_read_cfi(info, qry, FLASH_OFFSET_CFI_RESP,
1705                                         sizeof(struct cfi_qry));
1706                         info->interface = le16_to_cpu(qry->interface_desc);
1707
1708                         info->cfi_offset = flash_offset_cfi[cfi_offset];
1709                         debug ("device interface is %d\n",
1710                                info->interface);
1711                         debug ("found port %d chip %d ",
1712                                info->portwidth, info->chipwidth);
1713                         debug ("port %d bits chip %d bits\n",
1714                                info->portwidth << CFI_FLASH_SHIFT_WIDTH,
1715                                info->chipwidth << CFI_FLASH_SHIFT_WIDTH);
1716
1717                         /* calculate command offsets as in the Linux driver */
1718                         info->addr_unlock1 = 0x555;
1719                         info->addr_unlock2 = 0x2aa;
1720
1721                         /*
1722                          * modify the unlock address if we are
1723                          * in compatibility mode
1724                          */
1725                         if (    /* x8/x16 in x8 mode */
1726                                 ((info->chipwidth == FLASH_CFI_BY8) &&
1727                                         (info->interface == FLASH_CFI_X8X16)) ||
1728                                 /* x16/x32 in x16 mode */
1729                                 ((info->chipwidth == FLASH_CFI_BY16) &&
1730                                         (info->interface == FLASH_CFI_X16X32)))
1731                         {
1732                                 info->addr_unlock1 = 0xaaa;
1733                                 info->addr_unlock2 = 0x555;
1734                         }
1735
1736                         info->name = "CFI conformant";
1737                         return 1;
1738                 }
1739         }
1740
1741         return 0;
1742 }
1743
1744 static int flash_detect_cfi (flash_info_t * info, struct cfi_qry *qry)
1745 {
1746         debug ("flash detect cfi\n");
1747
1748         for (info->portwidth = CONFIG_SYS_FLASH_CFI_WIDTH;
1749              info->portwidth <= FLASH_CFI_64BIT; info->portwidth <<= 1) {
1750                 for (info->chipwidth = FLASH_CFI_BY8;
1751                      info->chipwidth <= info->portwidth;
1752                      info->chipwidth <<= 1)
1753                         if (__flash_detect_cfi(info, qry))
1754                                 return 1;
1755         }
1756         debug ("not found\n");
1757         return 0;
1758 }
1759
1760 /*
1761  * Manufacturer-specific quirks. Add workarounds for geometry
1762  * reversal, etc. here.
1763  */
1764 static void flash_fixup_amd(flash_info_t *info, struct cfi_qry *qry)
1765 {
1766         /* check if flash geometry needs reversal */
1767         if (qry->num_erase_regions > 1) {
1768                 /* reverse geometry if top boot part */
1769                 if (info->cfi_version < 0x3131) {
1770                         /* CFI < 1.1, try to guess from device id */
1771                         if ((info->device_id & 0x80) != 0)
1772                                 cfi_reverse_geometry(qry);
1773                 } else if (flash_read_uchar(info, info->ext_addr + 0xf) == 3) {
1774                         /* CFI >= 1.1, deduct from top/bottom flag */
1775                         /* note: ext_addr is valid since cfi_version > 0 */
1776                         cfi_reverse_geometry(qry);
1777                 }
1778         }
1779 }
1780
1781 static void flash_fixup_atmel(flash_info_t *info, struct cfi_qry *qry)
1782 {
1783         int reverse_geometry = 0;
1784
1785         /* Check the "top boot" bit in the PRI */
1786         if (info->ext_addr && !(flash_read_uchar(info, info->ext_addr + 6) & 1))
1787                 reverse_geometry = 1;
1788
1789         /* AT49BV6416(T) list the erase regions in the wrong order.
1790          * However, the device ID is identical with the non-broken
1791          * AT49BV642D they differ in the high byte.
1792          */
1793         if (info->device_id == 0xd6 || info->device_id == 0xd2)
1794                 reverse_geometry = !reverse_geometry;
1795
1796         if (reverse_geometry)
1797                 cfi_reverse_geometry(qry);
1798 }
1799
1800 static void flash_fixup_stm(flash_info_t *info, struct cfi_qry *qry)
1801 {
1802         /* check if flash geometry needs reversal */
1803         if (qry->num_erase_regions > 1) {
1804                 /* reverse geometry if top boot part */
1805                 if (info->cfi_version < 0x3131) {
1806                         /* CFI < 1.1, guess by device id (M29W320{DT,ET} only) */
1807                         if (info->device_id == 0x22CA ||
1808                             info->device_id == 0x2256) {
1809                                 cfi_reverse_geometry(qry);
1810                         }
1811                 }
1812         }
1813 }
1814
1815 /*
1816  * The following code cannot be run from FLASH!
1817  *
1818  */
1819 ulong flash_get_size (phys_addr_t base, int banknum)
1820 {
1821         flash_info_t *info = &flash_info[banknum];
1822         int i, j;
1823         flash_sect_t sect_cnt;
1824         phys_addr_t sector;
1825         unsigned long tmp;
1826         int size_ratio;
1827         uchar num_erase_regions;
1828         int erase_region_size;
1829         int erase_region_count;
1830         struct cfi_qry qry;
1831
1832         memset(&qry, 0, sizeof(qry));
1833
1834         info->ext_addr = 0;
1835         info->cfi_version = 0;
1836 #ifdef CONFIG_SYS_FLASH_PROTECTION
1837         info->legacy_unlock = 0;
1838 #endif
1839
1840         info->start[0] = (ulong)map_physmem(base, info->portwidth, MAP_NOCACHE);
1841
1842         if (flash_detect_cfi (info, &qry)) {
1843                 info->vendor = le16_to_cpu(qry.p_id);
1844                 info->ext_addr = le16_to_cpu(qry.p_adr);
1845                 num_erase_regions = qry.num_erase_regions;
1846
1847                 if (info->ext_addr) {
1848                         info->cfi_version = (ushort) flash_read_uchar (info,
1849                                                 info->ext_addr + 3) << 8;
1850                         info->cfi_version |= (ushort) flash_read_uchar (info,
1851                                                 info->ext_addr + 4);
1852                 }
1853
1854 #ifdef DEBUG
1855                 flash_printqry (&qry);
1856 #endif
1857
1858                 switch (info->vendor) {
1859                 case CFI_CMDSET_INTEL_PROG_REGIONS:
1860                 case CFI_CMDSET_INTEL_STANDARD:
1861                 case CFI_CMDSET_INTEL_EXTENDED:
1862                         cmdset_intel_init(info, &qry);
1863                         break;
1864                 case CFI_CMDSET_AMD_STANDARD:
1865                 case CFI_CMDSET_AMD_EXTENDED:
1866                         cmdset_amd_init(info, &qry);
1867                         break;
1868                 default:
1869                         printf("CFI: Unknown command set 0x%x\n",
1870                                         info->vendor);
1871                         /*
1872                          * Unfortunately, this means we don't know how
1873                          * to get the chip back to Read mode. Might
1874                          * as well try an Intel-style reset...
1875                          */
1876                         flash_write_cmd(info, 0, 0, FLASH_CMD_RESET);
1877                         return 0;
1878                 }
1879
1880                 /* Do manufacturer-specific fixups */
1881                 switch (info->manufacturer_id) {
1882                 case 0x0001:
1883                         flash_fixup_amd(info, &qry);
1884                         break;
1885                 case 0x001f:
1886                         flash_fixup_atmel(info, &qry);
1887                         break;
1888                 case 0x0020:
1889                         flash_fixup_stm(info, &qry);
1890                         break;
1891                 }
1892
1893                 debug ("manufacturer is %d\n", info->vendor);
1894                 debug ("manufacturer id is 0x%x\n", info->manufacturer_id);
1895                 debug ("device id is 0x%x\n", info->device_id);
1896                 debug ("device id2 is 0x%x\n", info->device_id2);
1897                 debug ("cfi version is 0x%04x\n", info->cfi_version);
1898
1899                 size_ratio = info->portwidth / info->chipwidth;
1900                 /* if the chip is x8/x16 reduce the ratio by half */
1901                 if ((info->interface == FLASH_CFI_X8X16)
1902                     && (info->chipwidth == FLASH_CFI_BY8)) {
1903                         size_ratio >>= 1;
1904                 }
1905                 debug ("size_ratio %d port %d bits chip %d bits\n",
1906                        size_ratio, info->portwidth << CFI_FLASH_SHIFT_WIDTH,
1907                        info->chipwidth << CFI_FLASH_SHIFT_WIDTH);
1908                 debug ("found %d erase regions\n", num_erase_regions);
1909                 sect_cnt = 0;
1910                 sector = base;
1911                 for (i = 0; i < num_erase_regions; i++) {
1912                         if (i > NUM_ERASE_REGIONS) {
1913                                 printf ("%d erase regions found, only %d used\n",
1914                                         num_erase_regions, NUM_ERASE_REGIONS);
1915                                 break;
1916                         }
1917
1918                         tmp = le32_to_cpu(qry.erase_region_info[i]);
1919                         debug("erase region %u: 0x%08lx\n", i, tmp);
1920
1921                         erase_region_count = (tmp & 0xffff) + 1;
1922                         tmp >>= 16;
1923                         erase_region_size =
1924                                 (tmp & 0xffff) ? ((tmp & 0xffff) * 256) : 128;
1925                         debug ("erase_region_count = %d erase_region_size = %d\n",
1926                                 erase_region_count, erase_region_size);
1927                         for (j = 0; j < erase_region_count; j++) {
1928                                 if (sect_cnt >= CONFIG_SYS_MAX_FLASH_SECT) {
1929                                         printf("ERROR: too many flash sectors\n");
1930                                         break;
1931                                 }
1932                                 info->start[sect_cnt] =
1933                                         (ulong)map_physmem(sector,
1934                                                            info->portwidth,
1935                                                            MAP_NOCACHE);
1936                                 sector += (erase_region_size * size_ratio);
1937
1938                                 /*
1939                                  * Only read protection status from
1940                                  * supported devices (intel...)
1941                                  */
1942                                 switch (info->vendor) {
1943                                 case CFI_CMDSET_INTEL_PROG_REGIONS:
1944                                 case CFI_CMDSET_INTEL_EXTENDED:
1945                                 case CFI_CMDSET_INTEL_STANDARD:
1946                                         info->protect[sect_cnt] =
1947                                                 flash_isset (info, sect_cnt,
1948                                                              FLASH_OFFSET_PROTECT,
1949                                                              FLASH_STATUS_PROTECT);
1950                                         break;
1951                                 default:
1952                                         /* default: not protected */
1953                                         info->protect[sect_cnt] = 0;
1954                                 }
1955
1956                                 sect_cnt++;
1957                         }
1958                 }
1959
1960                 info->sector_count = sect_cnt;
1961                 info->size = 1 << qry.dev_size;
1962                 /* multiply the size by the number of chips */
1963                 info->size *= size_ratio;
1964                 info->buffer_size = 1 << le16_to_cpu(qry.max_buf_write_size);
1965                 tmp = 1 << qry.block_erase_timeout_typ;
1966                 info->erase_blk_tout = tmp *
1967                         (1 << qry.block_erase_timeout_max);
1968                 tmp = (1 << qry.buf_write_timeout_typ) *
1969                         (1 << qry.buf_write_timeout_max);
1970
1971                 /* round up when converting to ms */
1972                 info->buffer_write_tout = (tmp + 999) / 1000;
1973                 tmp = (1 << qry.word_write_timeout_typ) *
1974                         (1 << qry.word_write_timeout_max);
1975                 /* round up when converting to ms */
1976                 info->write_tout = (tmp + 999) / 1000;
1977                 info->flash_id = FLASH_MAN_CFI;
1978                 if ((info->interface == FLASH_CFI_X8X16) &&
1979                     (info->chipwidth == FLASH_CFI_BY8)) {
1980                         /* XXX - Need to test on x8/x16 in parallel. */
1981                         info->portwidth >>= 1;
1982                 }
1983
1984                 flash_write_cmd (info, 0, 0, info->cmd_reset);
1985         }
1986
1987         return (info->size);
1988 }
1989
1990 void flash_set_verbose(uint v)
1991 {
1992         flash_verbose = v;
1993 }
1994
1995 /*-----------------------------------------------------------------------
1996  */
1997 unsigned long flash_init (void)
1998 {
1999         unsigned long size = 0;
2000         int i;
2001 #if defined(CONFIG_SYS_FLASH_AUTOPROTECT_LIST)
2002         struct apl_s {
2003                 ulong start;
2004                 ulong size;
2005         } apl[] = CONFIG_SYS_FLASH_AUTOPROTECT_LIST;
2006 #endif
2007
2008 #ifdef CONFIG_SYS_FLASH_PROTECTION
2009         /* read environment from EEPROM */
2010         char s[64];
2011         getenv_r ("unlock", s, sizeof(s));
2012 #endif
2013
2014 #define BANK_BASE(i)    (((phys_addr_t [CFI_MAX_FLASH_BANKS])CONFIG_SYS_FLASH_BANKS_LIST)[i])
2015
2016         /* Init: no FLASHes known */
2017         for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; ++i) {
2018                 flash_info[i].flash_id = FLASH_UNKNOWN;
2019
2020                 if (!flash_detect_legacy (BANK_BASE(i), i))
2021                         flash_get_size (BANK_BASE(i), i);
2022                 size += flash_info[i].size;
2023                 if (flash_info[i].flash_id == FLASH_UNKNOWN) {
2024 #ifndef CONFIG_SYS_FLASH_QUIET_TEST
2025                         printf ("## Unknown FLASH on Bank %d "
2026                                 "- Size = 0x%08lx = %ld MB\n",
2027                                 i+1, flash_info[i].size,
2028                                 flash_info[i].size << 20);
2029 #endif /* CONFIG_SYS_FLASH_QUIET_TEST */
2030                 }
2031 #ifdef CONFIG_SYS_FLASH_PROTECTION
2032                 else if ((s != NULL) && (strcmp(s, "yes") == 0)) {
2033                         /*
2034                          * Only the U-Boot image and it's environment
2035                          * is protected, all other sectors are
2036                          * unprotected (unlocked) if flash hardware
2037                          * protection is used (CONFIG_SYS_FLASH_PROTECTION)
2038                          * and the environment variable "unlock" is
2039                          * set to "yes".
2040                          */
2041                         if (flash_info[i].legacy_unlock) {
2042                                 int k;
2043
2044                                 /*
2045                                  * Disable legacy_unlock temporarily,
2046                                  * since flash_real_protect would
2047                                  * relock all other sectors again
2048                                  * otherwise.
2049                                  */
2050                                 flash_info[i].legacy_unlock = 0;
2051
2052                                 /*
2053                                  * Legacy unlocking (e.g. Intel J3) ->
2054                                  * unlock only one sector. This will
2055                                  * unlock all sectors.
2056                                  */
2057                                 flash_real_protect (&flash_info[i], 0, 0);
2058
2059                                 flash_info[i].legacy_unlock = 1;
2060
2061                                 /*
2062                                  * Manually mark other sectors as
2063                                  * unlocked (unprotected)
2064                                  */
2065                                 for (k = 1; k < flash_info[i].sector_count; k++)
2066                                         flash_info[i].protect[k] = 0;
2067                         } else {
2068                                 /*
2069                                  * No legancy unlocking -> unlock all sectors
2070                                  */
2071                                 flash_protect (FLAG_PROTECT_CLEAR,
2072                                                flash_info[i].start[0],
2073                                                flash_info[i].start[0]
2074                                                + flash_info[i].size - 1,
2075                                                &flash_info[i]);
2076                         }
2077                 }
2078 #endif /* CONFIG_SYS_FLASH_PROTECTION */
2079         }
2080
2081         /* Monitor protection ON by default */
2082 #if (CONFIG_SYS_MONITOR_BASE >= CONFIG_SYS_FLASH_BASE)
2083         flash_protect (FLAG_PROTECT_SET,
2084                        CONFIG_SYS_MONITOR_BASE,
2085                        CONFIG_SYS_MONITOR_BASE + monitor_flash_len  - 1,
2086                        flash_get_info(CONFIG_SYS_MONITOR_BASE));
2087 #endif
2088
2089         /* Environment protection ON by default */
2090 #ifdef CONFIG_ENV_IS_IN_FLASH
2091         flash_protect (FLAG_PROTECT_SET,
2092                        CONFIG_ENV_ADDR,
2093                        CONFIG_ENV_ADDR + CONFIG_ENV_SECT_SIZE - 1,
2094                        flash_get_info(CONFIG_ENV_ADDR));
2095 #endif
2096
2097         /* Redundant environment protection ON by default */
2098 #ifdef CONFIG_ENV_ADDR_REDUND
2099         flash_protect (FLAG_PROTECT_SET,
2100                        CONFIG_ENV_ADDR_REDUND,
2101                        CONFIG_ENV_ADDR_REDUND + CONFIG_ENV_SIZE_REDUND - 1,
2102                        flash_get_info(CONFIG_ENV_ADDR_REDUND));
2103 #endif
2104
2105 #if defined(CONFIG_SYS_FLASH_AUTOPROTECT_LIST)
2106         for (i = 0; i < (sizeof(apl) / sizeof(struct apl_s)); i++) {
2107                 debug("autoprotecting from %08x to %08x\n",
2108                       apl[i].start, apl[i].start + apl[i].size - 1);
2109                 flash_protect (FLAG_PROTECT_SET,
2110                                apl[i].start,
2111                                apl[i].start + apl[i].size - 1,
2112                                flash_get_info(apl[i].start));
2113         }
2114 #endif
2115
2116 #ifdef CONFIG_FLASH_CFI_MTD
2117         cfi_mtd_init();
2118 #endif
2119
2120         return (size);
2121 }