Diff: main.cpp

Revision:

0:65886aef87b1

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Mar 13 20:04:01 2015 +0000
@@ -0,0 +1,36 @@
+#include "mbed.h"
+#include "robotLibrary.h"
+
+int main()
+{
+    wait(4);
+    console1.printf("Started up\n");
+    console1.printf("USBTX: %d\n",USBTX);
+    console1.printf("USBRX: %d\n",USBRX);
+    console1.printf("p9: %d\n",p9);
+    console1.printf("p10: %d\n",p10);
+    console1.printf("console1 addr: %d\n",&console1);
+    console1.printf("bluetooth1 addr: %d\n",&bt);
+
+    robotSetup();
+    char data[50];
+
+    while(1) {
+        getBluetoothData();
+        if(isBluetoothDataValid()) {
+            // Enter your loop code below
+            //if(isBluetoothConnected()){
+            strcpy(returnBluetoothData(), data, 50);
+            int len = length(data);
+
+            // print it out
+            for (int i = 0; i < len; i++)
+                console1.putc(data[i]);
+        }
+        console1.printf("going...\n");
+        bt.printf("data");
+        bt.putc('\0');
+        wait(2);
+    }
+
+}
\ No newline at end of file