Diff: main.cpp

Revision:

50:030da136eacb

Parent:

49:06721139d298

Child:

55:c2c10a521874

--- a/main.cpp	Sat Apr 26 04:03:20 2014 +0000
+++ b/main.cpp	Sat Apr 26 04:26:48 2014 +0000
@@ -137,26 +137,26 @@
     //Main Loop
     int count = 0;
         while(1){
-            USB::getSerial().printf("Running GPS...\r\n");
+            //USB::getSerial().printf("Running GPS...\r\n");
             GPSHandle::getGPSHand().run();
-            USB::getSerial().printf("Running Compass...\r\n");
+            //USB::getSerial().printf("Running Compass...\r\n");
             compassHandle::getCompassHand().run();
-            USB::getSerial().printf("Requesting commands from egg...\r\n");
             if(count % 100 == 0){
+                USB::getSerial().printf("Requesting commands from egg...\r\n");
                 wait_us(100000);
                 CommandHandle::getCommandHand().run();
                 wait_us(100000);
-            }
-            if(GPSHandle::getGPSHand().if_image_location()){
-                USB::getSerial().printf("Taking picture and sending...\r\n");
-                wait_us(100000);
-                ImageHandle::getImageHand().run();
-                USB::getSerial().printf("sent all data\r\n");
-                wait_us(100000);
-                GPSHandle::getGPSHand().next_waypoint();
-                wait_us(100000);
-            }else{
-                //USB::getSerial().printf("Not close enough to waypoint for image\r\n");
+                if(GPSHandle::getGPSHand().if_image_location()){
+                    USB::getSerial().printf("Taking picture and sending...\r\n");
+                    wait_us(100000);
+                    ImageHandle::getImageHand().run();
+                    USB::getSerial().printf("sent all data\r\n");
+                    wait_us(100000);
+                    GPSHandle::getGPSHand().next_waypoint();
+                    wait_us(100000);
+                }else{
+                    //USB::getSerial().printf("Not close enough to waypoint for image\r\n");
+                }
             }
             count++;
         //}