implement setup and hypervisor

1 files changed, 10 insertions, 0 deletions

diff --git a/robot/setup.c b/robot/setup.c
index 0652911..10001c7 100644
--- a/robot/setup.c
+++ b/robot/setup.c
@@ -1,11 +1,21 @@
 #include <pololu/orangutan.h>
+#include <stdlib.h>
 
 #include "consts.h"
+#include "halt.h"
+#include "modes.h"
 #include "setup.h"
 
 void w2_setup_main() {
 	serial_set_baud_rate(W2_SERIAL_BAUD);
 
+	// reset underside leds
+	red_led(0);
+	green_led(0);
+
+	// clear lcd
+	clear();
+
 	// indicate startup done
 	play("L50 c>c");
 }