Lol smth

Dependencies:   LocalPositionSystem MMA8451Q Motor_Driver Sensors mbed

Fork of TDP_main_BartFork by Yelfie

Revision:
14:3844d1dacece
Parent:
12:bb21b76b6375
Child:
15:6453cd351452
--- a/main.cpp	Wed Mar 11 01:21:20 2015 +0000
+++ b/main.cpp	Wed Mar 11 14:00:37 2015 +0000
@@ -82,44 +82,44 @@
     wait(1); //give time to set up the system
     
     sensorTimer.start(); // start timer for sensors
-    
-    
-    pc.printf("Start...");
-    
+    shoot (0.3);
     
-    while (1) {
-       
-       if (driveMode == REGULAR) {
-          measureSensors();
-          switch (sensorsCheckSum) {
-            case 1: //right right is 1*1 + 0 + 0+ 0+0 +0 
-                pc.printf ("only Right is white \n");
-                break;
-            case 4 :   //0*0 + 2*2 + 0 + 0 + 0
-                pc.printf ("only Left is white \n");
-                break;
-            case 5 :  //1*1 + 2*2 + 0 + 0 
-                pc.printf ("both are white \n");
-                break;
-//          case 91: 
-//            driveMode = SQUARE; //if all sensors are white you're in the square
+   // pc.printf("Start...");
+//    
+//    
+//    while (1) {
+//       
+//       if (driveMode == REGULAR) {
+//          measureSensors();
+//          switch (sensorsCheckSum) {
+//            case 1: //right right is 1*1 + 0 + 0+ 0+0 +0 
+//                pc.printf ("only Right is white \n");
+//                break;
+//            case 4 :   //0*0 + 2*2 + 0 + 0 + 0
+//                pc.printf ("only Left is white \n");
+//                break;
+//            case 5 :  //1*1 + 2*2 + 0 + 0 
+//                pc.printf ("both are white \n");
+//                break;
+////          case 91: 
+////            driveMode = SQUARE; //if all sensors are white you're in the square
+////            break;
+//          default: //checksum is zero , all are black
+//            pc.printf ("BLACK BLACK");
 //            break;
-          default: //checksum is zero , all are black
-            pc.printf ("BLACK BLACK");
-            break;
-          } 
-              
-        
-           
-        }
-       else { //if (driveMode == SQUARE}
-        //implement the square searching thing..
-       
-       }
-       
-       
-    }
-    
+//          } 
+//              
+//        
+//           
+//        }
+//       else { //if (driveMode == SQUARE}
+//        //implement the square searching thing..
+//       
+//       }
+//       
+//       
+//    }
+//    
         
 }