1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <common.h>
25#include <asm/ppc4xx.h>
26#include <asm/processor.h>
27
28
29
30
31#include "../common/flash.c"
32
33
34
35
36static ulong flash_get_size (vu_long * addr, flash_info_t * info);
37static void flash_get_offsets (ulong base, flash_info_t * info);
38
39
40
41
42unsigned long flash_init (void)
43{
44 unsigned long size_b0;
45 int i;
46 uint pbcr;
47 unsigned long base_b0;
48 int size_val = 0;
49
50
51 for (i=0; i<CONFIG_SYS_MAX_FLASH_BANKS; ++i) {
52 flash_info[i].flash_id = FLASH_UNKNOWN;
53 }
54
55
56
57 size_b0 = flash_get_size((vu_long *)FLASH_BASE0_PRELIM, &flash_info[0]);
58
59 if (flash_info[0].flash_id == FLASH_UNKNOWN) {
60 printf ("## Unknown FLASH on Bank 0 - Size = 0x%08lx = %ld MB\n",
61 size_b0, size_b0<<20);
62 }
63
64
65 flash_get_offsets (-size_b0, &flash_info[0]);
66
67
68 mtdcr(EBC0_CFGADDR, PB0CR);
69 pbcr = mfdcr(EBC0_CFGDATA);
70 mtdcr(EBC0_CFGADDR, PB0CR);
71 base_b0 = -size_b0;
72 switch (size_b0) {
73 case 1 << 20:
74 size_val = 0;
75 break;
76 case 2 << 20:
77 size_val = 1;
78 break;
79 case 4 << 20:
80 size_val = 2;
81 break;
82 case 8 << 20:
83 size_val = 3;
84 break;
85 case 16 << 20:
86 size_val = 4;
87 break;
88 }
89 pbcr = (pbcr & 0x0001ffff) | base_b0 | (size_val << 17);
90 mtdcr(EBC0_CFGDATA, pbcr);
91
92
93 (void)flash_protect(FLAG_PROTECT_SET,
94 -CONFIG_SYS_MONITOR_LEN,
95 0xffffffff,
96 &flash_info[0]);
97
98 flash_info[0].size = size_b0;
99
100 return (size_b0);
101}
102