1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34#include <common.h>
35#include <asm/ppc4xx.h>
36#include <asm/processor.h>
37
38#undef DEBUG
39
40#ifdef DEBUG
41#define DEBUGF(x...) printf(x)
42#else
43#define DEBUGF(x...)
44#endif
45
46#define BOOT_SMALL_FLASH 0x40
47#define FLASH_ONBD_N 2
48#define FLASH_SRAM_SEL 1
49#define FLASH_ONBD_N 2
50#define FLASH_SRAM_SEL 1
51
52#define BOOT_SMALL_FLASH_VAL 4
53#define FLASH_ONBD_N_VAL 2
54#define FLASH_SRAM_SEL_VAL 1
55
56flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
57
58static unsigned long flash_addr_table[8][CONFIG_SYS_MAX_FLASH_BANKS] = {
59 {0xFF800000, 0xFF880000, 0xFFC00000},
60 {0xFF900000, 0xFF980000, 0xFFC00000},
61 {0x00000000, 0x00000000, 0x00000000},
62 {0x00000000, 0x00000000, 0x00000000},
63 {0xFFE00000, 0xFFF00000, 0xFF800000},
64 {0xFFF00000, 0xFFF80000, 0xFF800000},
65 {0x00000000, 0x00000000, 0x00000000},
66 {0x00000000, 0x00000000, 0x00000000}
67};
68
69
70
71
72#include "../common/flash.c"
73
74
75
76
77static ulong flash_get_size(vu_long * addr, flash_info_t * info);
78static int write_word(flash_info_t * info, ulong dest, ulong data);
79
80
81
82
83unsigned long flash_init(void)
84{
85 unsigned long total_b = 0;
86 unsigned long size_b[CONFIG_SYS_MAX_FLASH_BANKS];
87 unsigned char *fpga_base = (unsigned char *)CONFIG_SYS_FPGA_BASE;
88 unsigned char switch_status;
89 unsigned short index = 0;
90 int i;
91
92
93 switch_status = *fpga_base;
94
95
96 if (switch_status & BOOT_SMALL_FLASH) {
97 index += BOOT_SMALL_FLASH_VAL;
98 }
99 if (switch_status & FLASH_ONBD_N) {
100 index += FLASH_ONBD_N_VAL;
101 }
102 if (switch_status & FLASH_SRAM_SEL) {
103 index += FLASH_SRAM_SEL_VAL;
104 }
105
106 DEBUGF("\n");
107 DEBUGF("FLASH: Index: %d\n", index);
108
109
110 for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; ++i) {
111 flash_info[i].flash_id = FLASH_UNKNOWN;
112 flash_info[i].sector_count = -1;
113 flash_info[i].size = 0;
114
115
116 if (flash_addr_table[index][i] == 0) {
117 continue;
118 }
119
120
121 size_b[i] =
122 flash_get_size((vu_long *) flash_addr_table[index][i],
123 &flash_info[i]);
124 flash_info[i].size = size_b[i];
125 if (flash_info[i].flash_id == FLASH_UNKNOWN) {
126 printf
127 ("## Unknown FLASH on Bank %d - Size = 0x%08lx = %ld MB\n",
128 i, size_b[i], size_b[i] << 20);
129 flash_info[i].sector_count = -1;
130 flash_info[i].size = 0;
131 }
132
133
134 (void)flash_protect(FLAG_PROTECT_SET, CONFIG_SYS_MONITOR_BASE,
135 CONFIG_SYS_MONITOR_BASE + CONFIG_SYS_MONITOR_LEN - 1,
136 &flash_info[i]);
137#ifdef CONFIG_ENV_IS_IN_FLASH
138 (void)flash_protect(FLAG_PROTECT_SET, CONFIG_ENV_ADDR,
139 CONFIG_ENV_ADDR + CONFIG_ENV_SECT_SIZE - 1,
140 &flash_info[i]);
141 (void)flash_protect(FLAG_PROTECT_SET, CONFIG_ENV_ADDR_REDUND,
142 CONFIG_ENV_ADDR_REDUND + CONFIG_ENV_SECT_SIZE - 1,
143 &flash_info[i]);
144#endif
145
146 total_b += flash_info[i].size;
147 }
148
149 return total_b;
150}
151