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
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
|
#include "kernel.h"
#include "system.h"
#include "panic.h"
#include "mmu-meg-fx.h"
#include "lcd.h"
#include <stdio.h>
enum
{
TIMER4_MASK = (1 << 14),
LCD_MASK = (1 << 16),
DMA0_MASK = (1 << 17),
DMA1_MASK = (1 << 18),
DMA2_MASK = (1 << 19),
DMA3_MASK = (1 << 20),
ALARM_MASK = (1 << 30),
};
int system_memory_guard(int newmode)
{
(void)newmode;
return 0;
}
extern void timer4(void);
extern void dma0(void); /* free */
extern void dma1(void);
extern void dma3(void);
void irq(void)
{
int intpending = INTPND;
SRCPND = intpending; /* Clear this interrupt. */
INTPND = intpending; /* Clear this interrupt. */
/* Timer 4 */
if ((intpending & TIMER4_MASK) != 0)
timer4();
else
{
/* unexpected interrupt */
}
}
void system_reboot(void)
{
WTCON = 0;
WTCNT = WTDAT = 1 ;
WTCON = 0x21;
for(;;)
;
}
void system_init(void)
{
/* Turn off un-needed devices */
/* Turn off all of the UARTS */
CLKCON &= ~( (1<<10) | (1<<11) |(1<<12) );
/* Turn off AC97 and Camera */
CLKCON &= ~( (1<<19) | (1<<20) );
/* Turn off USB host */
CLKCON &= ~(1 << 6);
/* Turn off NAND flash controller */
CLKCON &= ~(1 << 4);
}
#ifdef HAVE_ADJUSTABLE_CPU_FREQ
void set_cpu_frequency(long frequency)
{
if (frequency == CPUFREQ_MAX)
{
asm volatile("mov r0, #0\n"
"mrc p15, 0, r0, c1, c0, 0\n"
"orr r0, r0, #3<<30\n" /* set to Asynchronous mode*/
"mcr p15, 0, r0, c1, c0, 0" : : : "r0");
FREQ = CPUFREQ_MAX;
}
else
{
asm volatile("mov r0, #0\n"
"mrc p15, 0, r0, c1, c0, 0\n"
"bic r0, r0, #3<<30\n" /* set to FastBus mode*/
"mcr p15, 0, r0, c1, c0, 0" : : : "r0");
FREQ = CPUFREQ_NORMAL;
}
}
#endif
|
