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
|
#include "demo.h"
static struct cpu cpu0, cpu1, cpu2, cpu3;
struct cpu *__cpus[] = { &cpu0, &cpu1, &cpu2, &cpu3 };
static volatile unsigned boot_done;
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_read(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_write(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;
}
static void cmd_cache(char **tokens)
{
void *ptr;
unsigned cpu;
if (parse_cpu(tokens, &cpu) < 0 || parse_ptr(tokens, &ptr) < 0)
return;
cache_debug(cpu, ptr);
}
static void bsp_main(void)
{
boot_done = 0;
run_cpu(1);
while (!boot_done);
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, "read"))
cmd_read(&tokens);
else if (!strcmp(cmd, "write"))
cmd_write(&tokens);
else if (!strcmp(cmd, "cache"))
cmd_cache(&tokens);
else
print("unknown command '%s'", cmd);
}
}
static void ap_main(void)
{
if (this_cpu->num < NUM_CPUS - 1)
run_cpu(this_cpu->num + 1);
else
boot_done = 1;
halt_cpu(this_cpu->num);
while (1) {
}
}
void reset(void)
{
if (this_cpu->num == 0)
console_init();
print("exited reset");
if (this_cpu->num == 0)
bsp_main();
else
ap_main();
}
|
