From b0ba370bfbf6159ab90f79475ac69124553cc50f Mon Sep 17 00:00:00 2001
From: Vegard Storheil Eriksen <zyp@jvnv.net>
Date: Sat, 20 Jul 2013 09:55:09 +0200
Subject: Added multithreading test for QEMU.

---
 main.cpp | 46 ++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 46 insertions(+)
 create mode 100644 main.cpp

(limited to 'main.cpp')

diff --git a/main.cpp b/main.cpp
new file mode 100644
index 0000000..7fe7f73
--- /dev/null
+++ b/main.cpp
@@ -0,0 +1,46 @@
+#include <stdint.h>
+#include <os/time.h>
+#include <os/thread.h>
+#include <util/semihosting.h>
+
+void idle_main() {
+	// QEMU does not support SLEEPONEXIT yet, so we need to keep at least one thread ready at all times.
+	// By executing wfi in a loop, we force the cpu into sleep until next systick (or other interrupt), regardless of whether other threads are ready or not.
+	// This has the consequence that we sleep for up to 1ms each time we've interated through the ready queue, even if other threads are still ready.
+	
+	while(1) {
+		asm volatile("wfi");
+		Thread::yield();
+	}
+}
+
+uint32_t idle_stack[1024];
+
+Thread idle_thread(idle_stack, sizeof(idle_stack), idle_main);
+
+void foo_main() {
+	while(1) {
+		semihosting_print("foo\n");
+		Thread::sleep(2000);
+	}
+}
+
+uint32_t foo_stack[1024];
+
+Thread foo_thread(foo_stack, sizeof(foo_stack), foo_main);
+
+int main() {
+	// Initialize system timer.
+	STK.LOAD = 12500000 / 1000; // 1000 Hz.
+	STK.CTRL = 0x07;
+	
+	idle_thread.start();
+	foo_thread.start();
+	
+	for(int i = 0; i < 5; i++) {
+		semihosting_print("main\n");
+		Thread::sleep(5000);
+	}
+	
+	semihosting_exit();
+}
-- 
cgit v1.2.3