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
35#include <common.h>
36#include <mpc5xxx.h>
37#include <net.h>
38#include <pci.h>
39#include <asm/processor.h>
40#include <asm/io.h>
41#include "eeprom.h"
42#if defined(CONFIG_DIGSY_REV5)
43#include "is45s16800a2.h"
44#include <mtd/cfi_flash.h>
45#include <flash.h>
46#else
47#include "is42s16800a-7t.h"
48#endif
49#include <libfdt.h>
50#include <fdt_support.h>
51#include <i2c.h>
52#include <mb862xx.h>
53
54DECLARE_GLOBAL_DATA_PTR;
55
56extern int usb_cpu_init(void);
57
58#if defined(CONFIG_DIGSY_REV5)
59
60
61
62
63void flash_cmd_reset(flash_info_t *info)
64{
65 flash_write_cmd(info, 0, 0, AMD_CMD_RESET);
66}
67#endif
68
69#ifndef CONFIG_SYS_RAMBOOT
70static void sdram_start(int hi_addr)
71{
72 long hi_addr_bit = hi_addr ? 0x01000000 : 0;
73 long control = SDRAM_CONTROL | hi_addr_bit;
74
75
76 out_be32((void *)MPC5XXX_SDRAM_CTRL, control | 0x80000000);
77
78
79 out_be32((void *)MPC5XXX_SDRAM_CTRL, control | 0x80000002);
80
81
82 out_be32((void *)MPC5XXX_SDRAM_CTRL, control | 0x80000004);
83
84
85 out_be32((void *)MPC5XXX_SDRAM_MODE, SDRAM_MODE);
86
87
88 out_be32((void *)MPC5XXX_SDRAM_CTRL, control);
89}
90#endif
91
92
93
94
95
96
97
98phys_size_t initdram(int board_type)
99{
100 ulong dramsize = 0;
101 ulong dramsize2 = 0;
102 uint svr, pvr;
103#ifndef CONFIG_SYS_RAMBOOT
104 ulong test1, test2;
105
106
107 out_be32((void *)MPC5XXX_SDRAM_CS0CFG, 0x0000001C);
108 out_be32((void *)MPC5XXX_SDRAM_CS1CFG, 0x80000000);
109
110
111 out_be32((void *)MPC5XXX_SDRAM_CONFIG1, SDRAM_CONFIG1);
112 out_be32((void *)MPC5XXX_SDRAM_CONFIG2, SDRAM_CONFIG2);
113
114
115 sdram_start(0);
116 test1 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x08000000);
117 sdram_start(1);
118 test2 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x08000000);
119 if (test1 > test2) {
120 sdram_start(0);
121 dramsize = test1;
122 } else {
123 dramsize = test2;
124 }
125
126
127 if (dramsize < (1 << 20))
128 dramsize = 0;
129
130
131 if (dramsize > 0) {
132 out_be32((void *)MPC5XXX_SDRAM_CS0CFG,
133 (0x13 + __builtin_ffs(dramsize >> 20) - 1));
134 } else {
135 out_be32((void *)MPC5XXX_SDRAM_CS0CFG, 0);
136 }
137
138
139 out_be32((void *)MPC5XXX_SDRAM_CS1CFG, dramsize + 0x0000001C);
140
141
142 test1 = get_ram_size((long *)(CONFIG_SYS_SDRAM_BASE + dramsize),
143 0x08000000);
144 dramsize2 = test1;
145
146
147 if (dramsize2 < (1 << 20))
148 dramsize2 = 0;
149
150
151 if (dramsize2 > 0) {
152 out_be32((void *)MPC5XXX_SDRAM_CS1CFG, (dramsize |
153 (0x13 + __builtin_ffs(dramsize2 >> 20) - 1)));
154 } else {
155 out_be32((void *)MPC5XXX_SDRAM_CS1CFG, dramsize);
156 }
157
158#else
159
160
161 dramsize = in_be32((void *)MPC5XXX_SDRAM_CS0CFG) & 0xFF;
162 if (dramsize >= 0x13)
163 dramsize = (1 << (dramsize - 0x13)) << 20;
164 else
165 dramsize = 0;
166
167
168 dramsize2 = in_be32((void *)MPC5XXX_SDRAM_CS1CFG) & 0xFF;
169 if (dramsize2 >= 0x13)
170 dramsize2 = (1 << (dramsize2 - 0x13)) << 20;
171 else
172 dramsize2 = 0;
173
174#endif
175
176
177
178
179
180
181
182
183
184
185 svr = get_svr();
186 pvr = get_pvr();
187 if ((SVR_MJREV(svr) >= 2) &&
188 (PVR_MAJ(pvr) == 1) && (PVR_MIN(pvr) == 4))
189 out_be32((void *)MPC5XXX_SDRAM_SDELAY, 0x04);
190
191 return dramsize + dramsize2;
192}
193
194int checkboard(void)
195{
196 char buf[64];
197 int i = getenv_f("serial#", buf, sizeof(buf));
198
199 puts ("Board: InterControl digsyMTC");
200#if defined(CONFIG_DIGSY_REV5)
201 puts (" rev5");
202#endif
203 if (i > 0) {
204 puts(", ");
205 puts(buf);
206 }
207 putc('\n');
208
209 return 0;
210}
211
212#if defined(CONFIG_VIDEO)
213
214#define GPIO_USB1_0 0x00010000
215#define GPIO_USB1_9 0x08
216
217#define GPIO_EE_DO 0x10
218#define GPIO_EE_CTS 0x20
219#define GPIO_EE_DI 0x10000000
220#define GPIO_EE_CLK 0x20000000
221
222#define GPT_GPIO_ON 0x00000034
223
224static void exbo_hw_init(void)
225{
226 struct mpc5xxx_gpt *gpt = (struct mpc5xxx_gpt *)MPC5XXX_GPT;
227 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio *)MPC5XXX_GPIO;
228 struct mpc5xxx_wu_gpio *wu_gpio =
229 (struct mpc5xxx_wu_gpio *)MPC5XXX_WU_GPIO;
230
231
232 gpio->port_config &= 0xFF8FFFFF;
233
234
235 setbits_be32(&gpio->simple_ddr,
236 GPIO_USB1_0 | GPIO_EE_CLK | GPIO_EE_DI);
237 clrbits_be32(&gpio->simple_ode,
238 GPIO_USB1_0 | GPIO_EE_CLK | GPIO_EE_DI);
239 clrbits_be32(&gpio->simple_dvo,
240 GPIO_USB1_0 | GPIO_EE_CLK | GPIO_EE_DI);
241 setbits_be32(&gpio->simple_gpioe,
242 GPIO_USB1_0 | GPIO_EE_CLK | GPIO_EE_DI);
243
244
245 clrbits_8(&wu_gpio->ddr, GPIO_EE_DO | GPIO_EE_CTS);
246 setbits_8(&wu_gpio->enable, GPIO_EE_DO | GPIO_EE_CTS);
247
248
249 clrbits_8(&gpio->sint_ode, GPIO_USB1_9);
250 setbits_8(&gpio->sint_ddr, GPIO_USB1_9);
251 clrbits_8(&gpio->sint_inten, GPIO_USB1_9);
252 setbits_8(&gpio->sint_dvo, GPIO_USB1_9);
253 setbits_8(&gpio->sint_gpioe, GPIO_USB1_9);
254
255
256 out_be32(&gpt[0].emsr, GPT_GPIO_ON);
257
258 out_be32(&gpt[1].emsr, GPT_GPIO_ON);
259
260
261 setbits_be32(&gpio->simple_dvo, GPIO_USB1_0);
262}
263#else
264static inline void exbo_hw_init(void) {}
265#endif
266
267int board_early_init_r(void)
268{
269#ifdef CONFIG_MPC52XX_SPI
270 struct mpc5xxx_gpt *gpt = (struct mpc5xxx_gpt*)MPC5XXX_GPT;
271#endif
272
273
274
275
276
277
278 clrbits_be32((void *)MPC5XXX_ADDECR, (1 << 25));
279
280 setbits_be32((void *)MPC5XXX_ADDECR, (1 << 17));
281
282 setbits_be32((void *)MPC5XXX_ADDECR, (1 << 16));
283
284#if defined(CONFIG_USB_OHCI_NEW) && defined(CONFIG_SYS_USB_OHCI_CPU_INIT)
285
286 usb_cpu_init();
287#endif
288#ifdef CONFIG_MPC52XX_SPI
289
290 out_be32(&gpt[6].emsr, 0x00000034);
291
292 out_be32(&gpt[7].emsr, 0x00000034);
293#endif
294
295 return (0);
296}
297
298void board_get_enetaddr (uchar * enet)
299{
300 ushort read = 0;
301 ushort addr_of_eth_addr = 0;
302 ushort len_sys = 0;
303 ushort len_sys_cfg = 0;
304
305
306 eeprom_read(EEPROM_ADDR, EEPROM_ADDR_IDENT, (uchar *)&read, 2);
307 if (read != EEPROM_IDENT)
308 return;
309
310
311 eeprom_read(EEPROM_ADDR, EEPROM_ADDR_LEN_SYS, (uchar *)&len_sys, 2);
312 eeprom_read(EEPROM_ADDR, EEPROM_ADDR_LEN_SYSCFG,
313 (uchar *)&len_sys_cfg, 2);
314 addr_of_eth_addr = (len_sys + len_sys_cfg + EEPROM_ADDR_ETHADDR) << 1;
315 if (addr_of_eth_addr >= EEPROM_LEN)
316 return;
317
318 eeprom_read(EEPROM_ADDR, addr_of_eth_addr, enet, 6);
319}
320
321int misc_init_r(void)
322{
323 pci_dev_t devbusfn;
324 uchar enetaddr[6];
325
326
327 devbusfn = pci_find_device(PCI_VENDOR_ID_FUJITSU,
328 PCI_DEVICE_ID_CORAL_PA, 0);
329 if (devbusfn != -1)
330 exbo_hw_init();
331
332 if (!eth_getenv_enetaddr("ethaddr", enetaddr)) {
333 board_get_enetaddr(enetaddr);
334 eth_setenv_enetaddr("ethaddr", enetaddr);
335 }
336
337 return 0;
338}
339
340#ifdef CONFIG_PCI
341static struct pci_controller hose;
342
343extern void pci_mpc5xxx_init(struct pci_controller *);
344
345void pci_init_board(void)
346{
347 pci_mpc5xxx_init(&hose);
348}
349#endif
350
351#ifdef CONFIG_CMD_IDE
352
353#ifdef CONFIG_IDE_RESET
354
355void init_ide_reset(void)
356{
357 debug ("init_ide_reset\n");
358
359
360 setbits_be32((void *)MPC5XXX_WU_GPIO_DATA_O, (1 << 25));
361
362 setbits_be32((void *)MPC5XXX_WU_GPIO_ODE, (1 << 25));
363
364 setbits_be32((void *)MPC5XXX_WU_GPIO_DIR, (1 << 25));
365
366 setbits_be32((void *)MPC5XXX_WU_GPIO_ENABLE, (1 << 25));
367
368}
369
370void ide_set_reset(int idereset)
371{
372 debug ("ide_reset(%d)\n", idereset);
373
374
375 clrbits_be32((void *)MPC5XXX_WU_GPIO_DATA_O, (1 << 25));
376
377 setbits_be32((void *)MPC5XXX_WU_GPIO_ODE, (1 << 25));
378
379 setbits_be32((void *)MPC5XXX_WU_GPIO_DIR, (1 << 25));
380
381 setbits_be32((void *)MPC5XXX_WU_GPIO_ENABLE, (1 << 25));
382
383 udelay(10000);
384
385
386 setbits_be32((void *)MPC5XXX_WU_GPIO_DATA_O, (1 << 25));
387
388 setbits_be32((void *)MPC5XXX_WU_GPIO_ODE, (1 << 25));
389
390 setbits_be32((void *)MPC5XXX_WU_GPIO_DIR, (1 << 25));
391
392 setbits_be32((void *)MPC5XXX_WU_GPIO_ENABLE, (1 << 25));
393}
394#endif
395#endif
396
397#if defined(CONFIG_OF_LIBFDT) && defined(CONFIG_OF_BOARD_SETUP)
398static void ft_delete_node(void *fdt, const char *compat)
399{
400 int off = -1;
401 int ret;
402
403 off = fdt_node_offset_by_compatible(fdt, -1, compat);
404 if (off < 0) {
405 printf("Could not find %s node.\n", compat);
406 return;
407 }
408
409 ret = fdt_del_node(fdt, off);
410 if (ret < 0)
411 printf("Could not delete %s node.\n", compat);
412}
413#if defined(CONFIG_SYS_UPDATE_FLASH_SIZE)
414static void ft_adapt_flash_base(void *blob)
415{
416 flash_info_t *dev = &flash_info[0];
417 int off;
418 struct fdt_property *prop;
419 int len;
420 u32 *reg, *reg2;
421
422 off = fdt_node_offset_by_compatible(blob, -1, "fsl,mpc5200b-lpb");
423 if (off < 0) {
424 printf("Could not find fsl,mpc5200b-lpb node.\n");
425 return;
426 }
427
428
429 prop = fdt_get_property_w(blob, off, "ranges", &len);
430 if (prop) {
431 reg = reg2 = (u32 *)&prop->data[0];
432
433 reg[2] = dev->start[0];
434 reg[3] = dev->size;
435 fdt_setprop(blob, off, "ranges", reg2, len);
436 } else
437 printf("Could not find ranges\n");
438}
439
440extern ulong flash_get_size (phys_addr_t base, int banknum);
441
442
443int update_flash_size (int flash_size)
444{
445 volatile struct mpc5xxx_mmap_ctl *mm =
446 (struct mpc5xxx_mmap_ctl *) CONFIG_SYS_MBAR;
447 flash_info_t *dev;
448 int i;
449 int size = 0;
450 unsigned long base = 0x0;
451 u32 *cs_reg = (u32 *)&mm->cs0_start;
452
453 for (i = 0; i < 2; i++) {
454 dev = &flash_info[i];
455
456 if (dev->size) {
457
458 base -= dev->size;
459 out_be32(cs_reg, START_REG(base));
460 cs_reg++;
461 out_be32(cs_reg, STOP_REG(base, dev->size));
462 cs_reg++;
463
464 size += flash_get_size(base, i);
465 }
466 }
467 flash_protect_default();
468 gd->bd->bi_flashstart = base;
469 return 0;
470}
471#endif
472
473void ft_board_setup(void *blob, bd_t *bd)
474{
475 int phy_addr = CONFIG_PHY_ADDR;
476 char eth_path[] = "/soc5200@f0000000/mdio@3000/ethernet-phy@0";
477
478 ft_cpu_setup(blob, bd);
479
480
481
482
483#if defined(CONFIG_DIGSY_REV5)
484 ft_delete_node(blob, "dallas,ds1339");
485#else
486 ft_delete_node(blob, "mc,rv3029c2");
487#endif
488#if defined(CONFIG_SYS_UPDATE_FLASH_SIZE)
489#ifdef CONFIG_FDT_FIXUP_NOR_FLASH_SIZE
490
491 fdt_fixup_nor_flash_size(blob);
492#endif
493 ft_adapt_flash_base(blob);
494#endif
495
496 do_fixup_by_path(blob, eth_path, "reg", &phy_addr, sizeof(int), 0);
497}
498#endif
499