1 files changed, 115 insertions, 0 deletions
diff --git a/demo/main.c b/demo/main.c
new file mode 100644
index 0000000..988ef55
--- /dev/null
+++ b/demo/main.c
@@ -0,0 +1,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();
+}