summaryrefslogtreecommitdiff
path: root/cpu/xscale/start.S
diff options
context:
space:
mode:
Diffstat (limited to 'cpu/xscale/start.S')
-rw-r--r--cpu/xscale/start.S7
1 files changed, 6 insertions, 1 deletions
diff --git a/cpu/xscale/start.S b/cpu/xscale/start.S
index cc24c30bfa..e63fece8b2 100644
--- a/cpu/xscale/start.S
+++ b/cpu/xscale/start.S
@@ -175,10 +175,11 @@ OSTIMER_BASE: .word 0x40a00000
#define OIER 0x1C
/* Clock Manager Registers */
+#ifdef CFG_CPUSPEED
CC_BASE: .word 0x41300000
#define CCCR 0x00
cpuspeed: .word CFG_CPUSPEED
-
+#endif
/* RS: ??? */
.macro CPWAIT
mrc p15,0,r0,c2,c0,0
@@ -194,10 +195,14 @@ cpu_init_crit:
mov r1, #0x00
str r1, [r0, #ICMR]
+#ifdef CFG_CPUSPEED
/* set clock speed */
ldr r0, CC_BASE
ldr r1, cpuspeed
str r1, [r0, #CCCR]
+ mov r0, #3
+ mcr p14, 0, r0, c6, c0, 0
+#endif
/*
* before relocating, we have to setup RAM timing