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#include <common.h>
32#include <mpc5xxx.h>
33#include <pci.h>
34#include <command.h>
35#include <netdev.h>
36
37#include "mt46v16m16-75.h"
38
39void init_power_switch(void);
40
41static void sdram_start(int hi_addr)
42{
43 long hi_addr_bit = hi_addr ? 0x01000000 : 0;
44
45
46 *(vu_long *) MPC5XXX_SDRAM_CTRL =
47 SDRAM_CONTROL | 0x80000000 | hi_addr_bit;
48 __asm__ volatile ("sync");
49
50
51 *(vu_long *) MPC5XXX_SDRAM_CTRL =
52 SDRAM_CONTROL | 0x80000002 | hi_addr_bit;
53 __asm__ volatile ("sync");
54
55
56 *(vu_long *) MPC5XXX_SDRAM_MODE = SDRAM_EMODE;
57 __asm__ volatile ("sync");
58
59
60 *(vu_long *) MPC5XXX_SDRAM_MODE = SDRAM_MODE | 0x04000000;
61 __asm__ volatile ("sync");
62
63
64 *(vu_long *) MPC5XXX_SDRAM_CTRL =
65 SDRAM_CONTROL | 0x80000002 | hi_addr_bit;
66 __asm__ volatile ("sync");
67
68
69 *(vu_long *) MPC5XXX_SDRAM_CTRL =
70 SDRAM_CONTROL | 0x80000004 | hi_addr_bit;
71 __asm__ volatile ("sync");
72
73
74 *(vu_long *) MPC5XXX_SDRAM_MODE = SDRAM_MODE;
75 __asm__ volatile ("sync");
76
77
78 *(vu_long *) MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | hi_addr_bit;
79 __asm__ volatile ("sync");
80}
81
82
83
84
85
86
87
88phys_size_t initdram(int board_type)
89{
90 ulong dramsize = 0;
91 ulong test1, test2;
92
93
94 *(vu_long *) MPC5XXX_SDRAM_CS0CFG = 0x0000001e;
95 *(vu_long *) MPC5XXX_SDRAM_CS1CFG = 0x80000000;
96 __asm__ volatile ("sync");
97
98
99 *(vu_long *) MPC5XXX_SDRAM_CONFIG1 = SDRAM_CONFIG1;
100 *(vu_long *) MPC5XXX_SDRAM_CONFIG2 = SDRAM_CONFIG2;
101 __asm__ volatile ("sync");
102
103
104 *(vu_long *) MPC5XXX_CDM_PORCFG = SDRAM_TAPDELAY;
105 __asm__ volatile ("sync");
106
107
108 sdram_start(0);
109 test1 = get_ram_size((long *) CONFIG_SYS_SDRAM_BASE, 0x80000000);
110 sdram_start(1);
111 test2 = get_ram_size((long *) CONFIG_SYS_SDRAM_BASE, 0x80000000);
112
113 if (test1 > test2) {
114 sdram_start(0);
115 dramsize = test1;
116 } else {
117 dramsize = test2;
118 }
119
120
121 if (dramsize < (1 << 20)) {
122 dramsize = 0;
123 }
124
125
126 if (dramsize > 0) {
127 *(vu_long *) MPC5XXX_SDRAM_CS0CFG =
128 0x13 + __builtin_ffs(dramsize >> 20) - 1;
129
130 *(vu_long *) MPC5XXX_SDRAM_CS1CFG = dramsize + 0x0000001e;
131 } else {
132#if 0
133 *(vu_long *) MPC5XXX_SDRAM_CS0CFG = 0;
134
135 *(vu_long *) MPC5XXX_SDRAM_CS1CFG = dramsize + 0x0000001e;
136#else
137 *(vu_long *) MPC5XXX_SDRAM_CS0CFG =
138 0x13 + __builtin_ffs(0x08000000 >> 20) - 1;
139
140 *(vu_long *) MPC5XXX_SDRAM_CS1CFG = 0x08000000 + 0x0000001e;
141#endif
142 }
143
144#if 0
145
146 sdram_start(0);
147 get_ram_size((ulong *) (CONFIG_SYS_SDRAM_BASE + dramsize), 0x80000000);
148 sdram_start(1);
149 get_ram_size((ulong *) (CONFIG_SYS_SDRAM_BASE + dramsize), 0x80000000);
150 sdram_start(0);
151#endif
152
153
154 *(vu_long *) MPC5XXX_SDRAM_CS1CFG = dramsize;
155
156 init_power_switch();
157 return (dramsize);
158}
159
160int checkboard(void)
161{
162 puts("Board: esd ParaFinder (pf5200)\n");
163 return 0;
164}
165
166void flash_preinit(void)
167{
168
169
170
171
172
173
174 *(vu_long *) MPC5XXX_BOOTCS_CFG &= ~0x1;
175}
176
177void flash_afterinit(ulong size)
178{
179 if (size == 0x02000000) {
180
181 *(vu_long *) MPC5XXX_BOOTCS_START =
182 *(vu_long *) MPC5XXX_CS0_START =
183 START_REG(CONFIG_SYS_BOOTCS_START | size);
184 *(vu_long *) MPC5XXX_BOOTCS_STOP =
185 *(vu_long *) MPC5XXX_CS0_STOP =
186 STOP_REG(CONFIG_SYS_BOOTCS_START | size, size);
187 }
188}
189
190#ifdef CONFIG_PCI
191static struct pci_controller hose;
192
193extern void pci_mpc5xxx_init(struct pci_controller *);
194
195void pci_init_board(void) {
196 pci_mpc5xxx_init(&hose);
197}
198#endif
199
200#if defined(CONFIG_CMD_IDE) && defined(CONFIG_IDE_RESET)
201
202void init_ide_reset(void)
203{
204 debug("init_ide_reset\n");
205
206
207 *(vu_long *) MPC5XXX_WU_GPIO_ENABLE |= GPIO_PSC1_4;
208 *(vu_long *) MPC5XXX_WU_GPIO_DIR |= GPIO_PSC1_4;
209}
210
211void ide_set_reset(int idereset)
212{
213 debug("ide_reset(%d)\n", idereset);
214
215 if (idereset) {
216 *(vu_long *) MPC5XXX_WU_GPIO_DATA_O &= ~GPIO_PSC1_4;
217 } else {
218 *(vu_long *) MPC5XXX_WU_GPIO_DATA_O |= GPIO_PSC1_4;
219 }
220}
221#endif
222
223#define MPC5XXX_SIMPLEIO_GPIO_ENABLE (MPC5XXX_GPIO + 0x0004)
224#define MPC5XXX_SIMPLEIO_GPIO_DIR (MPC5XXX_GPIO + 0x000C)
225#define MPC5XXX_SIMPLEIO_GPIO_DATA_OUTPUT (MPC5XXX_GPIO + 0x0010)
226#define MPC5XXX_SIMPLEIO_GPIO_DATA_INPUT (MPC5XXX_GPIO + 0x0014)
227
228#define MPC5XXX_INTERRUPT_GPIO_ENABLE (MPC5XXX_GPIO + 0x0020)
229#define MPC5XXX_INTERRUPT_GPIO_DIR (MPC5XXX_GPIO + 0x0028)
230#define MPC5XXX_INTERRUPT_GPIO_DATA_OUTPUT (MPC5XXX_GPIO + 0x002C)
231#define MPC5XXX_INTERRUPT_GPIO_STATUS (MPC5XXX_GPIO + 0x003C)
232
233#define GPIO_WU6 0x40000000UL
234#define GPIO_USB0 0x00010000UL
235#define GPIO_USB9 0x08000000UL
236#define GPIO_USB9S 0x00080000UL
237
238void init_power_switch(void)
239{
240 debug("init_power_switch\n");
241
242
243 *(vu_long *) MPC5XXX_WU_GPIO_DATA_O |= GPIO_WU6;
244 *(vu_long *) MPC5XXX_WU_GPIO_ENABLE |= GPIO_WU6;
245 *(vu_long *) MPC5XXX_WU_GPIO_DIR |= GPIO_WU6;
246 __asm__ volatile ("sync");
247
248 *(vu_long *) MPC5XXX_SIMPLEIO_GPIO_DATA_OUTPUT &= ~GPIO_USB0;
249 *(vu_long *) MPC5XXX_SIMPLEIO_GPIO_ENABLE |= GPIO_USB0;
250 *(vu_long *) MPC5XXX_SIMPLEIO_GPIO_DIR |= GPIO_USB0;
251 __asm__ volatile ("sync");
252
253 *(vu_long *) MPC5XXX_INTERRUPT_GPIO_DATA_OUTPUT &= ~GPIO_USB9;
254 *(vu_long *) MPC5XXX_INTERRUPT_GPIO_ENABLE &= ~GPIO_USB9;
255 __asm__ volatile ("sync");
256
257 if ((*(vu_long *) MPC5XXX_INTERRUPT_GPIO_STATUS & GPIO_USB9S) == 0) {
258 *(vu_long *) MPC5XXX_SIMPLEIO_GPIO_DATA_OUTPUT |= GPIO_USB0;
259 __asm__ volatile ("sync");
260 }
261 *(vu_char *) CONFIG_SYS_CS1_START = 0x02;
262 __asm__ volatile ("sync");
263
264 *(vu_char *) (CONFIG_SYS_CS1_START + 1) = 0x02;
265 __asm__ volatile ("sync");
266}
267
268int board_eth_init(bd_t *bis)
269{
270 return pci_eth_init(bis);
271}
272
273void power_set_reset(int power)
274{
275 debug("ide_set_reset(%d)\n", power);
276
277 if (power) {
278 *(vu_long *) MPC5XXX_WU_GPIO_DATA_O &= ~GPIO_WU6;
279 *(vu_long *) MPC5XXX_INTERRUPT_GPIO_DATA_OUTPUT &= ~GPIO_USB9;
280 } else {
281 *(vu_long *) MPC5XXX_WU_GPIO_DATA_O |= GPIO_WU6;
282 if ((*(vu_long *) MPC5XXX_INTERRUPT_GPIO_STATUS & GPIO_USB9S) ==
283 0) {
284 *(vu_long *) MPC5XXX_SIMPLEIO_GPIO_DATA_OUTPUT |=
285 GPIO_USB0;
286 }
287
288 }
289}
290
291int do_poweroff(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
292{
293 power_set_reset(1);
294 return (0);
295}
296
297U_BOOT_CMD(poweroff, 1, 1, do_poweroff, "Switch off power", "");
298
299int phypower(int flag)
300{
301 u32 addr;
302 vu_long *reg;
303 int status;
304 pci_dev_t dev;
305
306 dev = PCI_BDF(0, 0x18, 0);
307 status = pci_read_config_dword(dev, PCI_BASE_ADDRESS_1, &addr);
308 if (status == 0) {
309 reg = (vu_long *) (addr + 0x00000040);
310 *reg |= 0x40000000;
311 __asm__ volatile ("sync");
312
313 reg = (vu_long *) (addr + 0x001000c);
314 *reg |= 0x20000000;
315 __asm__ volatile ("sync");
316
317 reg = (vu_long *) (addr + 0x0010004);
318 if (flag != 0) {
319 *reg &= ~0x20000000;
320 } else {
321 *reg |= 0x20000000;
322 }
323 __asm__ volatile ("sync");
324 }
325 return (status);
326}
327
328int do_phypower(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
329{
330 int status;
331
332 if (argv[1][0] == '0') {
333 status = phypower(0);
334 } else {
335 status = phypower(1);
336 }
337 return (0);
338}
339
340U_BOOT_CMD(phypower, 2, 2, do_phypower,
341 "Switch power of ethernet phy", "");
342
343int do_writepci(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
344{
345 unsigned int addr;
346 unsigned int size;
347 int i;
348 volatile unsigned long *ptr;
349
350 addr = simple_strtol(argv[1], NULL, 16);
351 size = simple_strtol(argv[2], NULL, 16);
352
353 printf("\nWriting at addr %08x, size %08x.\n", addr, size);
354
355 while (1) {
356 ptr = (volatile unsigned long *)addr;
357 for (i = 0; i < (size >> 2); i++) {
358 *ptr++ = i;
359 }
360
361
362 if (ctrlc()) {
363 puts("\nAbort\n");
364 return 0;
365 }
366 putc('.');
367 }
368 return 0;
369}
370
371U_BOOT_CMD(writepci, 3, 1, do_writepci,
372 "Write some data to pcibus",
373 "<addr> <size>\n"
374 ""
375);
376