From 7772ea4579a45bcf63ebd5e68be66ba1a9c72dfa Mon Sep 17 00:00:00 2001
From: Clyne Sullivan <tullivan99@gmail.com>
Date: Fri, 11 Nov 2016 15:02:17 -0500
Subject: chibios!

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

(limited to 'main.cpp')

diff --git a/main.cpp b/main.cpp
new file mode 100644
index 0000000..f2a55af
--- /dev/null
+++ b/main.cpp
@@ -0,0 +1,32 @@
+#include <ch.h>
+#include <hal.h>
+
+#include <vex/lcd.hpp>
+#include <vex/digital.hpp>
+#include <vex/vexspi.h>
+
+int main(void) {
+	// init chibios
+	halInit();
+	chSysInit();
+
+	// init robot
+	digital::setMode(1, 1);
+	lcd::init();
+	spi::init();
+
+	int led = 1; // for led toggle
+
+	while (1) {
+		// update
+		lcd::flush();
+		spi::update();
+
+		lcd::printn(0, 0, spi::getJoystick(1).Ch1);
+
+		digital::setLed(1, led);
+		led ^= 1;
+
+		chThdSleepMilliseconds(100);
+	}
+}
-- 
cgit v1.2.3