1 files changed, 31 insertions, 5 deletions
diff --git a/main.c b/main.c
index e640a6b..9a95465 100644
--- a/main.c
+++ b/main.c
@@ -1,21 +1,26 @@
 #include <stm32l476xx.h>
 #include <clock.h>
+#include <heap.h>
+#include <task.h>
 
 /**
  * Accomplishments:
  *   - GPIO in/out
  *   - got to 80MHz clock
+ *   - basic heap
+ *   - multitask, can exit
  */
 
 void pulse(uint8_t byte);
+void kmain(void);
 
 int main(void)
 {
+	asm("cpsid i");
+
 	// prepare flash latency for 40MHz operation
 	FLASH->ACR &= ~(FLASH_ACR_LATENCY);
-	FLASH->ACR |= FLASH_ACR_LATENCY_2WS;
-
-	clock_init();
+	FLASH->ACR |= FLASH_ACR_LATENCY_4WS;
 
 	RCC->AHB2ENR |= RCC_AHB2ENR_GPIOAEN;	// A clk enable
 	GPIOA->MODER &= ~(GPIO_MODER_MODE5 | GPIO_MODER_MODE6);	// A5 -> output, A0 input
@@ -24,16 +29,37 @@ int main(void)
 	GPIOA->PUPDR |= GPIO_PUPDR_PUPD5_0 | GPIO_PUPDR_PUPD6_0; // pulldown for button (1)
 	//if (GPIOA->IDR & 0x01)
 
+	clock_init();
+	task_init(kmain);
+
+	while (1);
+}
+
+void task(void);
+void kmain(void)
+{
+	asm("cpsie i");
+
+	task_start(task, 1024);
 	while (1) {
+		GPIOA->BSRR |= 1 << 6;
 		delay(500);
-		GPIOA->BSRR |= 1 << 5;
 		GPIOA->BRR |= 1 << 6;
 		delay(500);
-		GPIOA->BSRR |= 1 << 6;
+	}
+}
+
+void task(void)
+{
+	while (1) {
+		GPIOA->BSRR |= 1 << 5;
+		delay(200);
 		GPIOA->BRR |= 1 << 5;
+		delay(200);
 	}
 }
 
+
 void _exit(int code)
 { for (;;); }