1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <common.h>
15#include <command.h>
16#include <net.h>
17#include <netdev.h>
18#include <asm/processor.h>
19#include <asm/io.h>
20
21#if defined(CONFIG_OF_LIBFDT)
22#include <fdt_support.h>
23#endif
24
25DECLARE_GLOBAL_DATA_PTR;
26
27int checkcpu (void)
28{
29 volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
30 ulong clock = gd->cpu_clk;
31 u32 pvr = get_pvr ();
32 u32 spridr = in_be32(&immr->sysconf.spridr);
33 char buf1[32], buf2[32];
34
35 puts ("CPU: ");
36
37 switch (spridr & 0xffff0000) {
38 case SPR_5121E:
39 puts ("MPC5121e ");
40 break;
41 default:
42 printf ("Unknown part ID %08x ", spridr & 0xffff0000);
43 }
44 printf ("rev. %d.%d, Core ", SVR_MJREV (spridr), SVR_MNREV (spridr));
45
46 switch (pvr & 0xffff0000) {
47 case PVR_E300C4:
48 puts ("e300c4 ");
49 break;
50 default:
51 puts ("unknown ");
52 }
53 printf ("at %s MHz, CSB at %s MHz (RSR=0x%04lx)\n",
54 strmhz(buf1, clock),
55 strmhz(buf2, gd->arch.csb_clk),
56 gd->arch.reset_status & 0xffff);
57 return 0;
58}
59
60
61int
62do_reset (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
63{
64 ulong msr;
65 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
66
67
68 __asm__ __volatile__ ("mfmsr %0":"=r" (msr):);
69
70 msr &= ~( MSR_EE | MSR_IR | MSR_DR);
71 __asm__ __volatile__ ("mtmsr %0"::"r" (msr));
72
73
74
75
76 out_be32(&immap->reset.rpr, 0x52535445);
77
78
79 while (!(in_be32(&immap->reset.rcer) & RCER_CRE))
80 ;
81
82 printf ("Resetting the board.\n");
83 udelay(200);
84
85
86 out_be32(&immap->reset.rcr, RCR_SWHR);
87
88
89 return 1;
90}
91
92
93
94
95
96unsigned long get_tbclk (void)
97{
98 ulong tbclk;
99
100 tbclk = (gd->bus_clk + 3L) / 4L;
101
102 return tbclk;
103}
104
105
106#if defined(CONFIG_WATCHDOG)
107void watchdog_reset (void)
108{
109 int re_enable = disable_interrupts ();
110
111
112 volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
113 out_be32(&immr->wdt.swsrr, 0x556c);
114 out_be32(&immr->wdt.swsrr, 0xaa39);
115
116 if (re_enable)
117 enable_interrupts ();
118}
119#endif
120
121#ifdef CONFIG_OF_LIBFDT
122
123#ifdef CONFIG_OF_SUPPORT_OLD_DEVICE_TREES
124
125
126
127
128
129
130
131static void old_ft_cpu_setup(void *blob, bd_t *bd)
132{
133
134
135
136
137 uchar enetaddr[6];
138
139
140
141
142
143 eth_getenv_enetaddr("ethaddr", enetaddr);
144 do_fixup_by_prop(blob, "device_type", "network", 8,
145 "local-mac-address", enetaddr, 6, 0);
146 do_fixup_by_prop(blob, "device_type", "network", 8,
147 "address", enetaddr, 6, 0);
148
149
150
151
152 do_fixup_by_prop_u32(blob, "device_type", "soc", 4,
153 "bus-frequency", bd->bi_ipsfreq, 0);
154}
155#endif
156
157static void ft_clock_setup(void *blob, bd_t *bd)
158{
159 char *cpu_path = "/cpus/" OF_CPU;
160
161
162
163
164 do_fixup_by_path_u32(blob, cpu_path,
165 "timebase-frequency", OF_TBCLK, 1);
166 do_fixup_by_path_u32(blob, cpu_path,
167 "bus-frequency", bd->bi_busfreq, 1);
168 do_fixup_by_path_u32(blob, cpu_path,
169 "clock-frequency", bd->bi_intfreq, 1);
170
171
172
173 do_fixup_by_compat_u32(blob, OF_SOC_COMPAT,
174 "bus-frequency", bd->bi_ipsfreq, 1);
175}
176
177void ft_cpu_setup(void *blob, bd_t *bd)
178{
179#ifdef CONFIG_OF_SUPPORT_OLD_DEVICE_TREES
180 old_ft_cpu_setup(blob, bd);
181#endif
182 ft_clock_setup(blob, bd);
183#ifdef CONFIG_HAS_ETH0
184 fdt_fixup_ethernet(blob);
185#endif
186 fdt_fixup_memory(blob, (u64)bd->bi_memstart, (u64)bd->bi_memsize);
187}
188#endif
189
190#ifdef CONFIG_MPC512x_FEC
191
192
193
194
195
196int cpu_eth_init(bd_t *bis)
197{
198 return mpc512x_fec_initialize(bis);
199}
200#endif
201