Colin Stearns / Mbed 2 deprecated qcControl

Dependencies:   mbed

Fork of dgps by Colin Stearns

Revision:
24:e65416d6de22
Parent:
20:81d5655fecc2
Parent:
23:497f8faa908e
Child:
25:b7f861fc8ddd
--- a/main.cpp	Tue Apr 22 04:26:31 2014 +0000
+++ b/main.cpp	Tue Apr 22 14:15:27 2014 +0000
@@ -5,6 +5,7 @@
 #include "handle/handleCamera.h"
 #include "handle/handleGPS.h"
 #include "handle/handleCommand.h"
+#include "mavcommands.h"
 
 Serial pc(USBTX,USBRX);
 Serial xbee(p9,p10);//tx, rx
@@ -105,9 +106,15 @@
 //    }
 //}
 
-
 int main()
 {
+
+    // Start Mav test
+    USB::getSerial().printf("Wait 20\n");
+    wait(20);
+    
+    // End mav test
+    
     //handlers
     //ImageHandle imageHand;
     //GPSHandle gpsHand;
@@ -117,13 +124,10 @@
     USB::getSerial().printf("Check GPS\n");
     USB::getSerial().printf("Connect to the wifly network now!\r\n");
     //XBEE::getTCPInterrupt().fall(&connection_lost);
-    
     //checking connection to egg before continuing
     getPS().openConnection();
     getPS().closeConnection();
-    
     //Main Loop
-    //while(1){
         while(1){
             USB::getSerial().printf("Requesting commands from egg...\r\n");
             wait_us(100000);