Added systick based sleep().

1 files changed, 28 insertions, 0 deletions

diff --git a/time.h b/time.h
new file mode 100644
index 0000000..66d8e63
--- /dev/null
+++ b/time.h
@@ -0,0 +1,28 @@
+#ifndef TIME_H
+#define TIME_H
+
+#include "stm32.h"
+#include "interrupt.h"
+#include "thread.h"
+
+class Time {
+	friend void interrupt<Interrupt::SysTick>();
+	
+	private:
+		static volatile uint32_t systime;
+	
+	public:
+		static void init() {
+			STK.LOAD = 72000000 / 8 / 1000; // 1000 Hz.
+			STK.CTRL = 0x03;
+		}
+		
+		static void sleep(uint32_t ms) {
+			ms += systime;
+			while(systime < ms) {
+				Thread::yield();
+			}
+		}
+};
+
+#endif