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
|
/*
* GXemul demo: Multi-Processor test
*
* This file is in the Public Domain.
*/
#include "dev_cons.h"
#include "dev_mp.h"
#ifdef MIPS
/* Note: The ugly cast to a signed int (32-bit) causes the address to be
sign-extended correctly on MIPS when compiled in 64-bit mode */
#define PHYSADDR_OFFSET ((signed int)0xa0000000)
#else
#define PHYSADDR_OFFSET 0
#endif
#define PUTCHAR_ADDRESS (PHYSADDR_OFFSET + \
DEV_CONS_ADDRESS + DEV_CONS_PUTGETCHAR)
#define HALT_ADDRESS (PHYSADDR_OFFSET + \
DEV_CONS_ADDRESS + DEV_CONS_HALT)
#define NCPUS_ADDRESS (PHYSADDR_OFFSET + \
DEV_MP_ADDRESS + DEV_MP_NCPUS)
void printchar(char ch)
{
*((volatile unsigned char *) PUTCHAR_ADDRESS) = ch;
}
void halt(void)
{
*((volatile unsigned char *) HALT_ADDRESS) = 0;
}
void printstr(char *s)
{
while (*s)
printchar(*s++);
}
void printuint_internal(unsigned int u)
{
int z = u / 10;
if (z > 0)
printuint_internal(z);
printchar('0' + (u - z*10));
}
void printuint(unsigned int u)
{
if (u == 0)
printchar('0');
else
printuint_internal(u);
}
int get_nr_of_cpus(void)
{
return *((volatile int *) NCPUS_ADDRESS);
}
void f(void)
{
printstr("Multi-Processor demo\n");
printstr("--------------------\n\n");
printstr("Number of CPUs: ");
printuint(get_nr_of_cpus());
printstr("\n\n");
halt();
}
|
