flash.c 9.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2000-2003
  4. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  5. *
  6. * Copyright (C) 2004-2007 Freescale Semiconductor, Inc.
  7. * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
  8. */
  9. #include <common.h>
  10. #include <irq_func.h>
  11. #include <asm/immap.h>
  12. #ifndef CONFIG_SYS_FLASH_CFI
  13. typedef unsigned short FLASH_PORT_WIDTH;
  14. typedef volatile unsigned short FLASH_PORT_WIDTHV;
  15. #define FPW FLASH_PORT_WIDTH
  16. #define FPWV FLASH_PORT_WIDTHV
  17. #define FLASH_CYCLE1 0x5555
  18. #define FLASH_CYCLE2 0x2aaa
  19. #define SYNC __asm__("nop")
  20. /*-----------------------------------------------------------------------
  21. * Functions
  22. */
  23. ulong flash_get_size(FPWV * addr, flash_info_t * info);
  24. int flash_get_offsets(ulong base, flash_info_t * info);
  25. int write_word(flash_info_t * info, FPWV * dest, u16 data);
  26. static inline void spin_wheel(void);
  27. flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
  28. ulong flash_init(void)
  29. {
  30. ulong size = 0;
  31. ulong fbase = 0;
  32. fbase = (ulong) CONFIG_SYS_FLASH_BASE;
  33. flash_get_size((FPWV *) fbase, &flash_info[0]);
  34. flash_get_offsets((ulong) fbase, &flash_info[0]);
  35. fbase += flash_info[0].size;
  36. size += flash_info[0].size;
  37. /* Protect monitor and environment sectors */
  38. flash_protect(FLAG_PROTECT_SET,
  39. CONFIG_SYS_MONITOR_BASE,
  40. CONFIG_SYS_MONITOR_BASE + monitor_flash_len - 1, &flash_info[0]);
  41. return size;
  42. }
  43. int flash_get_offsets(ulong base, flash_info_t * info)
  44. {
  45. int i;
  46. if ((info->flash_id & FLASH_VENDMASK) == FLASH_MAN_SST) {
  47. info->start[0] = base;
  48. info->protect[0] = 0;
  49. for (i = 1; i < CONFIG_SYS_SST_SECT; i++) {
  50. info->start[i] = info->start[i - 1]
  51. + CONFIG_SYS_SST_SECTSZ;
  52. info->protect[i] = 0;
  53. }
  54. }
  55. return ERR_OK;
  56. }
  57. void flash_print_info(flash_info_t * info)
  58. {
  59. int i;
  60. switch (info->flash_id & FLASH_VENDMASK) {
  61. case FLASH_MAN_SST:
  62. printf("SST ");
  63. break;
  64. default:
  65. printf("Unknown Vendor ");
  66. break;
  67. }
  68. switch (info->flash_id & FLASH_TYPEMASK) {
  69. case FLASH_SST6401B:
  70. printf("SST39VF6401B\n");
  71. break;
  72. default:
  73. printf("Unknown Chip Type\n");
  74. return;
  75. }
  76. if (info->size > 0x100000) {
  77. int remainder;
  78. printf(" Size: %ld", info->size >> 20);
  79. remainder = (info->size % 0x100000);
  80. if (remainder) {
  81. remainder >>= 10;
  82. remainder = (int)((float)
  83. (((float)remainder / (float)1024) *
  84. 10000));
  85. printf(".%d ", remainder);
  86. }
  87. printf("MB in %d Sectors\n", info->sector_count);
  88. } else
  89. printf(" Size: %ld KB in %d Sectors\n",
  90. info->size >> 10, info->sector_count);
  91. printf(" Sector Start Addresses:");
  92. for (i = 0; i < info->sector_count; ++i) {
  93. if ((i % 5) == 0)
  94. printf("\n ");
  95. printf(" %08lX%s",
  96. info->start[i], info->protect[i] ? " (RO)" : " ");
  97. }
  98. printf("\n");
  99. }
  100. /*
  101. * The following code cannot be run from FLASH!
  102. */
  103. ulong flash_get_size(FPWV * addr, flash_info_t * info)
  104. {
  105. u16 value;
  106. addr[FLASH_CYCLE1] = (FPWV) 0x00AA00AA; /* for Atmel, Intel ignores this */
  107. addr[FLASH_CYCLE2] = (FPWV) 0x00550055; /* for Atmel, Intel ignores this */
  108. addr[FLASH_CYCLE1] = (FPWV) 0x00900090; /* selects Intel or Atmel */
  109. switch (addr[0] & 0xffff) {
  110. case (u8) SST_MANUFACT:
  111. info->flash_id = FLASH_MAN_SST;
  112. value = addr[1];
  113. break;
  114. default:
  115. printf("Unknown Flash\n");
  116. info->flash_id = FLASH_UNKNOWN;
  117. info->sector_count = 0;
  118. info->size = 0;
  119. *addr = (FPW) 0x00F000F0;
  120. return (0); /* no or unknown flash */
  121. }
  122. switch (value) {
  123. case (u16) SST_ID_xF6401B:
  124. info->flash_id += FLASH_SST6401B;
  125. break;
  126. default:
  127. info->flash_id = FLASH_UNKNOWN;
  128. break;
  129. }
  130. info->sector_count = 0;
  131. info->size = 0;
  132. info->sector_count = CONFIG_SYS_SST_SECT;
  133. info->size = CONFIG_SYS_SST_SECT * CONFIG_SYS_SST_SECTSZ;
  134. /* reset ID mode */
  135. *addr = (FPWV) 0x00F000F0;
  136. if (info->sector_count > CONFIG_SYS_MAX_FLASH_SECT) {
  137. printf("** ERROR: sector count %d > max (%d) **\n",
  138. info->sector_count, CONFIG_SYS_MAX_FLASH_SECT);
  139. info->sector_count = CONFIG_SYS_MAX_FLASH_SECT;
  140. }
  141. return (info->size);
  142. }
  143. int flash_erase(flash_info_t * info, int s_first, int s_last)
  144. {
  145. FPWV *addr;
  146. int flag, prot, sect, count;
  147. ulong type, start;
  148. int rcode = 0, flashtype = 0;
  149. if ((s_first < 0) || (s_first > s_last)) {
  150. if (info->flash_id == FLASH_UNKNOWN)
  151. printf("- missing\n");
  152. else
  153. printf("- no sectors to erase\n");
  154. return 1;
  155. }
  156. type = (info->flash_id & FLASH_VENDMASK);
  157. switch (type) {
  158. case FLASH_MAN_SST:
  159. flashtype = 1;
  160. break;
  161. default:
  162. type = (info->flash_id & FLASH_VENDMASK);
  163. printf("Can't erase unknown flash type %08lx - aborted\n",
  164. info->flash_id);
  165. return 1;
  166. }
  167. prot = 0;
  168. for (sect = s_first; sect <= s_last; ++sect) {
  169. if (info->protect[sect]) {
  170. prot++;
  171. }
  172. }
  173. if (prot)
  174. printf("- Warning: %d protected sectors will not be erased!\n",
  175. prot);
  176. else
  177. printf("\n");
  178. flag = disable_interrupts();
  179. start = get_timer(0);
  180. if ((s_last - s_first) == (CONFIG_SYS_SST_SECT - 1)) {
  181. if (prot == 0) {
  182. addr = (FPWV *) info->start[0];
  183. addr[FLASH_CYCLE1] = 0x00AA; /* unlock */
  184. addr[FLASH_CYCLE2] = 0x0055; /* unlock */
  185. addr[FLASH_CYCLE1] = 0x0080; /* erase mode */
  186. addr[FLASH_CYCLE1] = 0x00AA; /* unlock */
  187. addr[FLASH_CYCLE2] = 0x0055; /* unlock */
  188. *addr = 0x0030; /* erase chip */
  189. count = 0;
  190. start = get_timer(0);
  191. while ((*addr & 0x0080) != 0x0080) {
  192. if (count++ > 0x10000) {
  193. spin_wheel();
  194. count = 0;
  195. }
  196. if (get_timer(start) > CONFIG_SYS_FLASH_ERASE_TOUT) {
  197. printf("Timeout\n");
  198. *addr = 0x00F0; /* reset to read mode */
  199. return 1;
  200. }
  201. }
  202. *addr = 0x00F0; /* reset to read mode */
  203. printf("\b. done\n");
  204. if (flag)
  205. enable_interrupts();
  206. return 0;
  207. } else if (prot == CONFIG_SYS_SST_SECT) {
  208. return 1;
  209. }
  210. }
  211. /* Start erase on unprotected sectors */
  212. for (sect = s_first; sect <= s_last; sect++) {
  213. if (info->protect[sect] == 0) { /* not protected */
  214. addr = (FPWV *) (info->start[sect]);
  215. printf(".");
  216. /* arm simple, non interrupt dependent timer */
  217. start = get_timer(0);
  218. switch (flashtype) {
  219. case 1:
  220. {
  221. FPWV *base; /* first address in bank */
  222. flag = disable_interrupts();
  223. base = (FPWV *) (CONFIG_SYS_FLASH_BASE); /* First sector */
  224. base[FLASH_CYCLE1] = 0x00AA; /* unlock */
  225. base[FLASH_CYCLE2] = 0x0055; /* unlock */
  226. base[FLASH_CYCLE1] = 0x0080; /* erase mode */
  227. base[FLASH_CYCLE1] = 0x00AA; /* unlock */
  228. base[FLASH_CYCLE2] = 0x0055; /* unlock */
  229. *addr = 0x0050; /* erase sector */
  230. if (flag)
  231. enable_interrupts();
  232. while ((*addr & 0x0080) != 0x0080) {
  233. if (get_timer(start) >
  234. CONFIG_SYS_FLASH_ERASE_TOUT) {
  235. printf("Timeout\n");
  236. *addr = 0x00F0; /* reset to read mode */
  237. rcode = 1;
  238. break;
  239. }
  240. }
  241. *addr = 0x00F0; /* reset to read mode */
  242. break;
  243. }
  244. } /* switch (flashtype) */
  245. }
  246. }
  247. printf(" done\n");
  248. if (flag)
  249. enable_interrupts();
  250. return rcode;
  251. }
  252. int write_buff(flash_info_t * info, uchar * src, ulong addr, ulong cnt)
  253. {
  254. ulong wp, count;
  255. u16 data;
  256. int rc;
  257. if (info->flash_id == FLASH_UNKNOWN)
  258. return 4;
  259. /* get lower word aligned address */
  260. wp = addr;
  261. /* handle unaligned start bytes */
  262. if (wp & 1) {
  263. data = *((FPWV *) wp);
  264. data = (data << 8) | *src;
  265. if ((rc = write_word(info, (FPWV *) wp, data)) != 0)
  266. return (rc);
  267. wp++;
  268. cnt -= 1;
  269. src++;
  270. }
  271. while (cnt >= 2) {
  272. /*
  273. * handle word aligned part
  274. */
  275. count = 0;
  276. data = *((FPWV *) src);
  277. if ((rc = write_word(info, (FPWV *) wp, data)) != 0)
  278. return (rc);
  279. wp += 2;
  280. src += 2;
  281. cnt -= 2;
  282. if (count++ > 0x800) {
  283. spin_wheel();
  284. count = 0;
  285. }
  286. }
  287. /* handle word aligned part */
  288. if (cnt) {
  289. /* handle word aligned part */
  290. count = 0;
  291. data = *((FPWV *) wp);
  292. data = (data & 0x00FF) | (*src << 8);
  293. if ((rc = write_word(info, (FPWV *) wp, data)) != 0)
  294. return (rc);
  295. wp++;
  296. src++;
  297. cnt -= 1;
  298. if (count++ > 0x800) {
  299. spin_wheel();
  300. count = 0;
  301. }
  302. }
  303. if (cnt == 0)
  304. return ERR_OK;
  305. return ERR_OK;
  306. }
  307. /*-----------------------------------------------------------------------
  308. * Write a word to Flash
  309. * A word is 16 bits, whichever the bus width of the flash bank
  310. * (not an individual chip) is.
  311. *
  312. * returns:
  313. * 0 - OK
  314. * 1 - write timeout
  315. * 2 - Flash not erased
  316. */
  317. int write_word(flash_info_t * info, FPWV * dest, u16 data)
  318. {
  319. ulong start;
  320. int flag;
  321. int res = 0; /* result, assume success */
  322. FPWV *base; /* first address in flash bank */
  323. /* Check if Flash is (sufficiently) erased */
  324. if ((*dest & (u8) data) != (u8) data) {
  325. return (2);
  326. }
  327. base = (FPWV *) (CONFIG_SYS_FLASH_BASE);
  328. /* Disable interrupts which might cause a timeout here */
  329. flag = disable_interrupts();
  330. base[FLASH_CYCLE1] = (u8) 0x00AA00AA; /* unlock */
  331. base[FLASH_CYCLE2] = (u8) 0x00550055; /* unlock */
  332. base[FLASH_CYCLE1] = (u8) 0x00A000A0; /* selects program mode */
  333. *dest = data; /* start programming the data */
  334. /* re-enable interrupts if necessary */
  335. if (flag)
  336. enable_interrupts();
  337. start = get_timer(0);
  338. /* data polling for D7 */
  339. while (res == 0
  340. && (*dest & (u8) 0x00800080) != (data & (u8) 0x00800080)) {
  341. if (get_timer(start) > CONFIG_SYS_FLASH_WRITE_TOUT) {
  342. *dest = (u8) 0x00F000F0; /* reset bank */
  343. res = 1;
  344. }
  345. }
  346. *dest++ = (u8) 0x00F000F0; /* reset bank */
  347. return (res);
  348. }
  349. static inline void spin_wheel(void)
  350. {
  351. static int p = 0;
  352. static char w[] = "\\/-";
  353. printf("\010%c", w[p]);
  354. (++p == 3) ? (p = 0) : 0;
  355. }
  356. #endif