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
|
#include "demo.h"
static struct cpu cpu0, cpu1, cpu2, cpu3;
struct cpu *__cpus[] = { &cpu0, &cpu1, &cpu2, &cpu3 };
static void cmd_run(char **tokens)
{
unsigned mask;
if (parse_cpu_mask(tokens, &mask) < 0)
return;
run_cpus(mask);
}
static void cmd_halt(char **tokens)
{
unsigned mask;
if (parse_cpu_mask(tokens, &mask) < 0)
return;
halt_cpus(mask);
}
static void cmd_rd(char **tokens)
{
void *ptr;
if (parse_aligned(tokens, &ptr) < 0 || expect_end(tokens) < 0)
return;
print("%p: %x", ptr, *(volatile unsigned *)ptr);
}
static void cmd_wr(char **tokens)
{
void *ptr;
unsigned val;
if (parse_aligned(tokens, &ptr) < 0 || parse_hex(tokens, &val) < 0 || expect_end(tokens) < 0)
return;
*(volatile unsigned *)ptr = val;
}
void bsp_main(void)
{
run_cpu(1);
while (!cpus_ready());
print("booted %u cpus", NUM_CPUS);
while (1) {
char input[64];
read_line(input, sizeof input);
char *tokens = input;
char *cmd = strtok_input(&tokens);
if (!cmd)
continue;
if (!strcmp(cmd, "run"))
cmd_run(&tokens);
else if (!strcmp(cmd, "halt"))
cmd_halt(&tokens);
else if (!strcmp(cmd, "rd"))
cmd_rd(&tokens);
else if (!strcmp(cmd, "wr"))
cmd_wr(&tokens);
else
print("unknown command '%s'", cmd);
}
}
void ap_main(void)
{
if (this_cpu->num < NUM_CPUS - 1)
run_cpu(this_cpu->num + 1);
halt_cpu(this_cpu->num);
while (1) {
}
}
void reset(void)
{
if (this_cpu->num == 0) {
console_init();
for (struct cpu **cpu = __cpus; cpu < __cpus + NUM_CPUS; ++cpu) {
}
}
print("core taken out of reset");
if (this_cpu->num == 0)
bsp_main();
else
ap_main();
}
|
