From 8d4edc2fcd003990228f505ce717c32b45831f2d Mon Sep 17 00:00:00 2001 From: Greg Watson Date: Thu, 20 Oct 2005 01:44:21 +0000 Subject: changes to support new ppc arch git-svn-id: svn://svn.coreboot.org/coreboot/trunk@2064 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1 --- src/pmc/altimus/mpc7410/setup.c | 88 +++++++++++++++++++++++++++++++++++++++++ 1 file changed, 88 insertions(+) create mode 100644 src/pmc/altimus/mpc7410/setup.c (limited to 'src/pmc/altimus/mpc7410/setup.c') diff --git a/src/pmc/altimus/mpc7410/setup.c b/src/pmc/altimus/mpc7410/setup.c new file mode 100644 index 0000000000..e8c214c7d8 --- /dev/null +++ b/src/pmc/altimus/mpc7410/setup.c @@ -0,0 +1,88 @@ +/* Copyright 2000 AG Electronics Ltd. */ +/* This code is distributed without warranty under the GPL v2 (see COPYING) */ + +#include "ppc.h" +#include "ppcreg.h" +#include "ppc74xx.h" + +extern void ppc_init_float_registers(const double *); +/*RODATA static const double dummy_float = 1.0;*/ +static const double dummy_float = 1.0; + +#define HID0_DCACHE HID0_DCE +#define MSR_DATA MSR_DR + +void ppc_setup_cpu(int icache) +{ + int type = ppc_getpvr() >> 16; + int version = ppc_getpvr() & 0xffff; + + if (type == 0xc) + { + if (version == 0x0200) + ppc_set1015(0x19000004); + else if (((version & 0xff00) == 0x0200) && + (version != 0x0209)) + ppc_set1015(0x01000000); + } + if (icache) + { + ppc_sethid0(HID0_NHR | HID0_BHT | HID0_ICE | HID0_ICFI + | HID0_BTIC | HID0_DCACHE); + ppc_sethid0(HID0_DPM | HID0_NHR | HID0_BHT | HID0_ICE + | HID0_BTIC | HID0_DCACHE); + } + else + { + ppc_sethid0(HID0_DPM | HID0_NHR | HID0_BHT | HID0_BTIC + | HID0_DCACHE); + } +#if 1 + /* if (type == 8 || type == 12) */ + { + ppc_setmsr(MSR_FP | MSR_DATA); + ppc_init_float_registers(&dummy_float); + } +#endif +} + +void ppc_enable_dcache(void) +{ + /* + * Already enabled in crt0.S + */ +#if 0 + unsigned hid0 = ppc_gethid0(); + ppc_sethid0(hid0 | HID0_DCFI | HID0_DCE); + ppc_sethid0(hid0 | HID0_DCE); +#endif +} + +void ppc_disable_dcache(void) +{ + unsigned hid0 = ppc_gethid0(); + ppc_sethid0(hid0 & ~HID0_DCE); +} + +void ppc_enable_mmu(void) +{ + unsigned msr = ppc_getmsr(); + ppc_setmsr(msr | MSR_DR | MSR_IR); +} + +void make_coherent(void *base, unsigned length) +{ + unsigned hid0 = ppc_gethid0(); + + if (hid0 & HID0_DCE) + { + unsigned i; + unsigned offset = 0x1f & (unsigned) base; + unsigned adjusted_base = (unsigned) base & ~0x1f; + for(i = 0; i < length + offset; i+= 32) + __asm__ volatile ("dcbf %1,%0" : : "r" (adjusted_base), "r" (i)); + if (hid0 & HID0_ICE) + for(i = 0; i < length + offset; i+= 32) + __asm__ volatile ("icbi %1,%0" : : "r" (adjusted_base), "r" (i)); + } +} -- cgit v1.2.3