2 * (C) Copyright 2000-2003
3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5 * See file CREDITS for list of people who contributed to this
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25 * CPU specific code for the MPC5xxx CPUs
33 #include <asm/processor.h>
35 #if defined(CONFIG_OF_LIBFDT)
37 #include <libfdt_env.h>
40 DECLARE_GLOBAL_DATA_PTR;
44 ulong clock = gd->cpu_clk;
46 #ifndef CONFIG_MGT5100
54 printf (" (JTAG ID %08lx)", *(vu_long *)MPC5XXX_CDM_JTAGID);
67 printf("Unknown MPC5xxx");
71 printf (" v%d.%d, Core v%d.%d", SVR_MJREV (svr), SVR_MNREV (svr),
72 PVR_MAJ(pvr), PVR_MIN(pvr));
74 printf (" at %s MHz\n", strmhz (buf, clock));
78 /* ------------------------------------------------------------------------- */
81 do_reset (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
84 /* Interrupts and MMU off */
85 __asm__ __volatile__ ("mfmsr %0":"=r" (msr):);
87 msr &= ~(MSR_ME | MSR_EE | MSR_IR | MSR_DR);
88 __asm__ __volatile__ ("mtmsr %0"::"r" (msr));
90 /* Charge the watchdog timer */
91 *(vu_long *)(MPC5XXX_GPT0_COUNTER) = 0x0001000f;
92 *(vu_long *)(MPC5XXX_GPT0_ENABLE) = 0x9004; /* wden|ce|timer_ms */
99 /* ------------------------------------------------------------------------- */
102 * Get timebase clock frequency (like cpu_clk in Hz)
105 unsigned long get_tbclk (void)
109 tbclk = (gd->bus_clk + 3L) / 4L;
114 /* ------------------------------------------------------------------------- */
116 #ifdef CONFIG_OF_LIBFDT
117 static void do_fixup(void *fdt, const char *node, const char *prop,
118 const void *val, int len, int create)
122 debug("Updating property '%s/%s' = ", node, prop);
123 for (i = 0; i < len; i++)
124 debug(" %.2x", *(u8*)(val+i));
127 int rc = fdt_find_and_setprop(fdt, node, prop, val, len, create);
129 printf("Unable to update property %s:%s, err=%s\n",
130 node, prop, fdt_strerror(rc));
133 static void do_fixup_u32(void *fdt, const char *node, const char *prop,
136 val = cpu_to_fdt32(val);
137 do_fixup(fdt, node, prop, &val, sizeof(val), create);
140 void ft_cpu_setup(void *blob, bd_t *bd)
142 int div = in_8((void*)CFG_MBAR + 0x204) & 0x0020 ? 8 : 4;
143 char * cpu_path = "/cpus/" OF_CPU;
144 char * eth_path = "/" OF_SOC "/ethernet@3000";
146 do_fixup_u32(blob, cpu_path, "timebase-frequency", OF_TBCLK, 1);
147 do_fixup_u32(blob, cpu_path, "bus-frequency", bd->bi_busfreq, 1);
148 do_fixup_u32(blob, cpu_path, "clock-frequency", bd->bi_intfreq, 1);
149 do_fixup_u32(blob, "/" OF_SOC, "bus-frequency", bd->bi_ipbfreq, 1);
150 do_fixup_u32(blob, "/" OF_SOC, "system-frequency",
151 bd->bi_busfreq*div, 1);
152 do_fixup(blob, eth_path, "mac-address", bd->bi_enetaddr, 6, 0);
153 do_fixup(blob, eth_path, "local-mac-address", bd->bi_enetaddr, 6, 0);