Colin Stearns / Mbed 2 deprecated qcControl

QC Control software

Dependencies:   mbed

Fork of dgps by Colin Stearns

Diff: main.cpp

Revision:
32:9cb7bc3fc9e0
Parent:
26:06f1c9d70e9f
Child:
34:c0b13ce5408c
--- a/main.cpp	Tue Apr 22 15:40:23 2014 +0000
+++ b/main.cpp	Wed Apr 23 01:43:17 2014 +0000
@@ -133,6 +133,7 @@
     getPS().closeConnection();
     //Main Loop
         while(1){
+            GPSHandle::getGPSHand().run();
             USB::getSerial().printf("Requesting commands from egg...\r\n");
             wait_us(100000);
             CommandHandle::getCommandHand().run();
@@ -143,6 +144,9 @@
                 ImageHandle::getImageHand().run();
                 USB::getSerial().printf("sent all data\r\n");
                 wait_us(100000);
+                GPSHandle::getGPSHand().next_waypoint();
+            }else{
+                USB::getSerial().printf("Not close enough to waypoint for image\r\n");
             }
             wait_us(1000000);
         //}