EE149 / Mbed 2 deprecated FinalProject

Final Project files for mBed development.

Dependencies:   m3pi mbed

Diff: control.c

Revision:
11:a30f30d3066e
Parent:
10:94b068b2ce1d
Child:
12:1aa6b8a74136
--- a/control.c	Sat Nov 15 23:03:06 2014 +0000
+++ b/control.c	Sun Nov 16 05:26:24 2014 +0000
@@ -12,6 +12,7 @@
 #include "main.h"
 extern m3pi pi;
 extern DigitalIn start_button;
+extern DigitalOut oled_2;
 
 void get_ps_file(char* moves)
 {
@@ -28,6 +29,24 @@
 void robot_loop()
 {    
     start:
+    pi.cls();
+    pi.locate(0,0);
+    pi.printf("PiCO");
+    pi.locate(0,1);
+    pi.printf("%f mV", pi.battery());
+    wait(.5);
+    while(start_button) {
+        oled_2 = 1;
+        wait(.5);
+        pi.locate(0,0);
+        pi.printf("Ready");
+        oled_2 = 0;
+    }
+    pi.cls();
+    pi.locate(0,0);
+    pi.printf("GO!");
+    wait(.5);
+
     while(1) {
         if(start_button) {
             pi.stop();