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
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
|
/*
*
*/
#include <bsp/consoleIo.h>
#include <libcpu/spr.h>
#include <bsp/residual.h>
#include <bsp/pci.h>
#include <bsp/openpic.h>
#include <bsp/irq.h>
#include <bsp.h>
#include <libcpu/bat.h>
extern void _return_to_ppcbug();
extern unsigned long __rtems_end;
RESIDUAL residualCopy;
#define INIT_STACK_SIZE 0x1000
#define INTR_STACK_SIZE 0x4000
void BSP_panic(char *s)
{
printk("RTEMS 4.x PANIC %s\n", s);
_return_to_ppcbug();
}
void _BSP_Fatal_error(unsigned int v)
{
printk("RTEMS 4.x PANIC ERROR %x\n", v);
_return_to_ppcbug();
}
void
boot_card(RESIDUAL* r3, void *r4, void* r5, char *additional_boot_options)
{
int err;
unsigned char *stack;
unsigned l2cr;
register unsigned char* intrStack;
register unsigned int intrNestingLevel = 0;
L1_caches_enables();
stack = ((unsigned char*) &__rtems_end) + INIT_STACK_SIZE;
intrStack = ((unsigned char*) &__rtems_end) + INIT_STACK_SIZE + INTR_STACK_SIZE;
asm volatile ("mtspr 273, %0" : "=r" (intrStack) : "0" (intrStack));
asm volatile ("mtspr 272, %0" : "=r" (intrNestingLevel) : "0" (intrNestingLevel));
residualCopy = *r3;
#define NO_DYNAMIC_EXCEPTION_VECTOR_INSTALL
#undef NO_DYNAMIC_EXCEPTION_VECTOR_INSTALL
#ifndef NO_DYNAMIC_EXCEPTION_VECTOR_INSTALL
initialize_exceptions();
#endif
select_console(CONSOLE_LOG);
/* We check that the keyboard is present and immediately
* select the serial console if not.
*/
err = kbdreset();
if (err) select_console(CONSOLE_SERIAL);
printk("Welcome to RTEMS 4.0.2 on Motorola MCP750\n\n\n");
printk("-----------------------------------------\n");
printk("Residuals are located at %x\n", (unsigned) r3);
printk("Additionnal boot options are %s\n", additional_boot_options);
printk("-----------------------------------------\n");
printk("Initial system stack at %x\n",stack);
l2cr = get_L2CR();
printk("Initial L2CR value = %x\n", l2cr);
if (! (l2cr & 0x80000000))
set_L2CR(0xb9A14000);
#ifdef TEST_RETURN_TO_PPCBUG
printk("Hit <Enter> to return to PPCBUG monitor\n");
printk("When Finished hit GO. It should print <Back from monitor>\n");
debug_getc();
_return_to_ppcbug();
printk("Back from monitor\n");
_return_to_ppcbug();
#endif /* TEST_RETURN_TO_PPCBUG */
/*
* Init MMU block address translation to enable hardware
* access
*/
/*
* PC legacy IO space used for inb/outb and all PC
* compatible hardware
*/
setdbat(1, 0x80000000, 0x80000000, 0x10000000, IO_PAGE);
/*
* PCI devices memory area. Needed to access OPENPIC features
* provided by the RAVEN
*/
setdbat(2, 0xc0000000, 0xc0000000, 0x08000000, IO_PAGE);
/*
* Must have acces to open pic PCI ACK registers
* provided by the RAVEN
*/
setdbat(3, 0xfeff0000, 0xfeff0000, 0x10000, IO_PAGE);
printk("Going to start PCI buses scanning and initialization\n");
InitializePCI();
printk("Number of PCI buses is found : %d\n", BusCountPCI());
#ifdef TEST_RAW_EXCEPTION_CODE
printk("Testing exception handling Part 1\n");
/*
* Cause a software exception
*/
__asm__ __volatile ("sc");
/*
* Check we can still catch exceptions
*/
printk("Testing exception handling Part 2\n");
__asm__ __volatile ("sc");
#endif
BSP_rtems_irq_mng_init(0);
printk("Init done\n");
debug_getc();
while(1);
}
|
