board/genietv/flash.c

   1 /*
   2  * (C) Copyright 2000-2011
   3  * Wolfgang Denk, DENX Software Engineering, wd@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 <mpc8xx.h>
  26
  27 flash_info_t    flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
  28
  29 /*-----------------------------------------------------------------------
  30  * Functions
  31  */
  32 static ulong flash_get_size(vu_long *addr, flash_info_t *info);
  33 static int write_word(flash_info_t *info, ulong dest, ulong data);
  34 static void flash_get_offsets(ulong base, flash_info_t *info);
  35
  36 /*-----------------------------------------------------------------------
  37  */
  38
  39 unsigned long flash_init(void)
  40 {
  41         unsigned long size_b0;
  42         int i;
  43
  44         /* Init: no FLASHes known */
  45         for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; ++i)
  46                 flash_info[i].flash_id = FLASH_UNKNOWN;
  47
  48         /* Detect size */
  49         size_b0 = flash_get_size((vu_long *)CONFIG_SYS_FLASH_BASE,
  50                         &flash_info[0]);
  51
  52         /* Setup offsets */
  53         flash_get_offsets(CONFIG_SYS_FLASH_BASE, &flash_info[0]);
  54
  55 #if CONFIG_SYS_MONITOR_BASE >= CONFIG_SYS_FLASH_BASE
  56         /* Monitor protection ON by default */
  57         flash_protect(FLAG_PROTECT_SET,
  58                       CONFIG_SYS_MONITOR_BASE,
  59                       CONFIG_SYS_MONITOR_BASE+monitor_flash_len-1,
  60                       &flash_info[0]);
  61 #endif
  62
  63         flash_info[0].size = size_b0;
  64
  65         return size_b0;
  66 }
  67
  68 /*-----------------------------------------------------------------------
  69  * Fix this to support variable sector sizes
  70 */
  71 static void flash_get_offsets(ulong base, flash_info_t *info)
  72 {
  73         int i;
  74
  75         /* set up sector start address table */
  76         if ((info->flash_id & FLASH_TYPEMASK) == FLASH_AM040) {
  77                 /* set sector offsets for bottom boot block type        */
  78                 for (i = 0; i < info->sector_count; i++)
  79                         info->start[i] = base + (i * 0x00010000);
  80         }
  81 }
  82
  83 /*-----------------------------------------------------------------------
  84  */
  85 void flash_print_info(flash_info_t *info)
  86 {
  87         int i;
  88
  89         if (info->flash_id == FLASH_UNKNOWN) {
  90                 puts("missing or unknown FLASH type\n");
  91                 return;
  92         }
  93
  94         switch (info->flash_id & FLASH_VENDMASK) {
  95         case FLASH_MAN_AMD:
  96                 printf("AMD ");
  97                 break;
  98         case FLASH_MAN_FUJ:
  99                 printf("FUJITSU ");
 100                 break;
 101         case FLASH_MAN_BM:
 102                 printf("BRIGHT MICRO ");
 103                 break;
 104         default:
 105                 printf("Unknown Vendor ");
 106                 break;
 107         }
 108
 109         switch (info->flash_id & FLASH_TYPEMASK) {
 110         case FLASH_AM040:
 111                 printf("29F040 or 29LV040 (4 Mbit, uniform sectors)\n");
 112                 break;
 113         case FLASH_AM400B:
 114                 printf("AM29LV400B (4 Mbit, bottom boot sect)\n");
 115                 break;
 116         case FLASH_AM400T:
 117                 printf("AM29LV400T (4 Mbit, top boot sector)\n");
 118                 break;
 119         case FLASH_AM800B:
 120                 printf("AM29LV800B (8 Mbit, bottom boot sect)\n");
 121                 break;
 122         case FLASH_AM800T:
 123                 printf("AM29LV800T (8 Mbit, top boot sector)\n");
 124                 break;
 125         case FLASH_AM160B:
 126                 printf("AM29LV160B (16 Mbit, bottom boot sect)\n");
 127                 break;
 128         case FLASH_AM160T:
 129                 printf("AM29LV160T (16 Mbit, top boot sector)\n");
 130                 break;
 131         case FLASH_AM320B:
 132                 printf("AM29LV320B (32 Mbit, bottom boot sect)\n");
 133                 break;
 134         case FLASH_AM320T:
 135                 printf("AM29LV320T (32 Mbit, top boot sector)\n");
 136                 break;
 137         default:
 138                 printf("Unknown Chip Type\n");
 139                 break;
 140         }
 141
 142         if (info->size >> 20) {
 143                 printf("  Size: %ld MB in %d Sectors\n",
 144                         info->size >> 20,
 145                         info->sector_count);
 146         } else {
 147                 printf("  Size: %ld KB in %d Sectors\n",
 148                         info->size >> 10,
 149                         info->sector_count);
 150         }
 151
 152         puts("  Sector Start Addresses:");
 153
 154         for (i = 0; i < info->sector_count; ++i) {
 155                 if ((i % 5) == 0)
 156                         puts("\n   ");
 157
 158                 printf(" %08lX%s",
 159                         info->start[i],
 160                         info->protect[i] ? " (RO)" : "     ");
 161         }
 162
 163         putc('\n');
 164         return;
 165 }
 166 /*-----------------------------------------------------------------------
 167  */
 168
 169 /*
 170  * The following code cannot be run from FLASH!
 171  */
 172
 173 static ulong flash_get_size(vu_long *addr, flash_info_t *info)
 174 {
 175         short i;
 176         volatile unsigned char *caddr;
 177         char value;
 178
 179         caddr = (volatile unsigned char *)addr ;
 180
 181         /* Write auto select command: read Manufacturer ID */
 182
 183         debug("Base address is: %8p\n", caddr);
 184
 185         caddr[0x0555] = 0xAA;
 186         caddr[0x02AA] = 0x55;
 187         caddr[0x0555] = 0x90;
 188
 189         value = caddr[0];
 190
 191         debug("Manufact ID: %02x\n", value);
 192
 193         switch (value) {
 194         case 0x1: /* AMD_MANUFACT */
 195                 info->flash_id = FLASH_MAN_AMD;
 196                 break;
 197         case 0x4: /* FUJ_MANUFACT */
 198                 info->flash_id = FLASH_MAN_FUJ;
 199                 break;
 200         default:
 201                 info->flash_id = FLASH_UNKNOWN;
 202                 info->sector_count = 0;
 203                 info->size = 0;
 204                 break;
 205         }
 206
 207         value = caddr[1];                       /* device ID            */
 208
 209         debug("Device ID: %02x\n", value);
 210
 211         switch (value) {
 212         case AMD_ID_LV040B:
 213                 info->flash_id += FLASH_AM040;
 214                 info->sector_count = 8;
 215                 info->size = 0x00080000;
 216                 break;                          /* => 512Kb             */
 217
 218         default:
 219                 info->flash_id = FLASH_UNKNOWN;
 220                 return 0;                       /* => no or unknown flash */
 221         }
 222
 223         flash_get_offsets((ulong)addr, &flash_info[0]);
 224
 225         /* check for protected sectors */
 226         for (i = 0; i < info->sector_count; i++) {
 227                 /*
 228                  * read sector protection at sector address,
 229                  * (A7 .. A0) = 0x02
 230                  * D0 = 1 if protected
 231                  */
 232                 caddr = (volatile unsigned char *)(info->start[i]);
 233                 info->protect[i] = caddr[2] & 1;
 234         }
 235
 236         /*
 237          * Prevent writes to uninitialized FLASH.
 238          */
 239         if (info->flash_id != FLASH_UNKNOWN) {
 240                 caddr = (volatile unsigned char *)info->start[0];
 241                 *caddr = 0xF0;  /* reset bank */
 242         }
 243
 244         return info->size;
 245 }
 246
 247 int     flash_erase(flash_info_t *info, int s_first, int s_last)
 248 {
 249         volatile unsigned char *addr =
 250                 (volatile unsigned char *)(info->start[0]);
 251         int flag, prot, sect, l_sect;
 252         ulong start, now, last;
 253
 254         if ((s_first < 0) || (s_first > s_last)) {
 255                 if (info->flash_id == FLASH_UNKNOWN)
 256                         printf("- missing\n");
 257                 else
 258                         printf("- no sectors to erase\n");
 259
 260                 return 1;
 261         }
 262
 263         if ((info->flash_id == FLASH_UNKNOWN) ||
 264             (info->flash_id > FLASH_AMD_COMP)) {
 265                 printf("Can't erase unknown flash type - aborted\n");
 266                 return 1;
 267         }
 268
 269         prot = 0;
 270         for (sect = s_first; sect <= s_last; ++sect) {
 271                 if (info->protect[sect])
 272                         prot++;
 273         }
 274
 275         if (prot) {
 276                 printf("- Warning: %d protected sectors will not be erased!\n",
 277                         prot);
 278         } else {
 279                 printf("\n");
 280         }
 281
 282         l_sect = -1;
 283
 284         /* Disable interrupts which might cause a timeout here */
 285         flag = disable_interrupts();
 286
 287         addr[0x0555] = 0xAA;
 288         addr[0x02AA] = 0x55;
 289         addr[0x0555] = 0x80;
 290         addr[0x0555] = 0xAA;
 291         addr[0x02AA] = 0x55;
 292
 293         /* Start erase on unprotected sectors */
 294         for (sect = s_first; sect <= s_last; sect++) {
 295                 if (info->protect[sect] == 0) { /* not protected */
 296                         addr = (volatile unsigned char *)(info->start[sect]);
 297                         addr[0] = 0x30;
 298                         l_sect = sect;
 299                 }
 300         }
 301
 302         /* re-enable interrupts if necessary */
 303         if (flag)
 304                 enable_interrupts();
 305
 306         /* wait at least 80us - let's wait 1 ms */
 307         udelay(1000);
 308
 309         /*
 310          * We wait for the last triggered sector
 311          */
 312         if (l_sect < 0)
 313                 goto DONE;
 314
 315         start = get_timer(0);
 316         last  = start;
 317         addr = (volatile unsigned char *)(info->start[l_sect]);
 318
 319         while ((addr[0] & 0xFF) != 0xFF) {
 320
 321                 now = get_timer(start);
 322
 323                 if (now > CONFIG_SYS_FLASH_ERASE_TOUT) {
 324                         printf("Timeout\n");
 325                         return 1;
 326                 }
 327                 /* show that we're waiting */
 328                 if ((now - last) > 1000) {      /* every second */
 329                         putc('.');
 330                         last = now;
 331                 }
 332         }
 333
 334 DONE:
 335         /* reset to read mode */
 336         addr = (volatile unsigned char *)info->start[0];
 337
 338         addr[0] = 0xF0; /* reset bank */
 339
 340         printf(" done\n");
 341         return 0;
 342 }
 343
 344 /*-----------------------------------------------------------------------
 345  * Copy memory to flash, returns:
 346  * 0 - OK
 347  * 1 - write timeout
 348  * 2 - Flash not erased
 349  */
 350
 351 int write_buff(flash_info_t *info, uchar *src, ulong addr, ulong cnt)
 352 {
 353         ulong cp, wp, data;
 354         int i, l, rc;
 355
 356         wp = (addr & ~3);       /* get lower word aligned address */
 357
 358         /*
 359          * handle unaligned start bytes
 360          */
 361         l = addr - wp;
 362
 363         if (l != 0) {
 364                 data = 0;
 365                 for (i = 0, cp = wp; i < l; ++i, ++cp)
 366                         data = (data << 8) | (*(uchar *)cp);
 367
 368                 for (; i < 4 && cnt > 0; ++i) {
 369                         data = (data << 8) | *src++;
 370                         --cnt;
 371                         ++cp;
 372                 }
 373                 for (; cnt == 0 && i < 4; ++i, ++cp)
 374                         data = (data << 8) | (*(uchar *)cp);
 375
 376                 rc = write_word(info, wp, data);
 377
 378                 if (rc != 0)
 379                         return rc;
 380
 381                 wp += 4;
 382         }
 383
 384         /*
 385          * handle word aligned part
 386          */
 387         while (cnt >= 4) {
 388                 data = 0;
 389                 for (i = 0; i < 4; ++i)
 390                         data = (data << 8) | *src++;
 391
 392                 rc = write_word(info, wp, data);
 393
 394                 if (rc != 0)
 395                         return rc;
 396
 397                 wp  += 4;
 398                 cnt -= 4;
 399         }
 400
 401         if (cnt == 0)
 402                 return 0;
 403
 404         /*
 405          * handle unaligned tail bytes
 406          */
 407         data = 0;
 408         for (i = 0, cp = wp; i < 4 && cnt > 0; ++i, ++cp) {
 409                 data = (data << 8) | *src++;
 410                 --cnt;
 411         }
 412         for (; i < 4; ++i, ++cp)
 413                 data = (data << 8) | (*(uchar *)cp);
 414
 415         return write_word(info, wp, data);
 416 }
 417
 418 /*-----------------------------------------------------------------------
 419  * Write a word to Flash, returns:
 420  * 0 - OK
 421  * 1 - write timeout
 422  * 2 - Flash not erased
 423  */
 424 static int write_word(flash_info_t *info, ulong dest, ulong data)
 425 {
 426         volatile unsigned char *cdest, *cdata;
 427         volatile unsigned char *addr =
 428                 (volatile unsigned char *)(info->start[0]);
 429         ulong start;
 430         int flag, count = 4 ;
 431
 432         cdest = (volatile unsigned char *)dest ;
 433         cdata = (volatile unsigned char *)&data ;
 434
 435         /* Check if Flash is (sufficiently) erased */
 436         if ((*((vu_long *)dest) & data) != data)
 437                 return 2;
 438
 439         while (count--) {
 440
 441                 /* Disable interrupts which might cause a timeout here */
 442                 flag = disable_interrupts();
 443
 444                 addr[0x0555] = 0xAA;
 445                 addr[0x02AA] = 0x55;
 446                 addr[0x0555] = 0xA0;
 447
 448                 *cdest = *cdata;
 449
 450                 /* re-enable interrupts if necessary */
 451                 if (flag)
 452                         enable_interrupts();
 453
 454                 /* data polling for D7 */
 455                 start = get_timer(0);
 456                 while ((*cdest ^ *cdata) & 0x80) {
 457                         if (get_timer(start) > CONFIG_SYS_FLASH_WRITE_TOUT)
 458                                 return 1;
 459                 }
 460
 461                 cdata++ ;
 462                 cdest++ ;
 463         }
 464         return 0;
 465 }