Lol smth

Dependencies:   LocalPositionSystem MMA8451Q Motor_Driver Sensors mbed

Fork of TDP_main_BartFork by Yelfie

Revision:
18:d947ea4bab72
Parent:
17:de8b3111ddc5
--- a/main.cpp	Wed Mar 18 16:55:14 2015 +0000
+++ b/main.cpp	Thu Mar 19 21:49:25 2015 +0000
@@ -151,26 +151,29 @@
 //       if (driveMode == REGULAR) {
 //          measureSensors();
 //          switch (sensorsCheckSum) {
-//            case 74: //all right are white,else is good TURN RIGHT
-//                break;
-//            case 78: //RLD is black, all else good
+//            case 0: // all black, turn around by 180 degrees 
+//                  break;
+//            case 30: //all right are white, left all black >> turn right(move left wheel)
 //                break;
-//            case 90: //RLU is black,all else good
+//            case 46: //left 5 white, right only 3 black >> turn right
+//                  break;
+//            case 94: //normal startting position, half of right and half of left are white, (move right wheel)
 //                break;
-//            
-//            case 94: //keep straight
+//            case 104: //right all white, left half white >> turn right 90 degrees
+//                break;
+//            case 154: //right 4 white, left only 6 black >> turn left
+//                  break;
+//            case 174: //left all white, right all black >> turn left (move right wheel)
 //                pc.printf ("only Right is white \n");
 //                break;
-//            case 95 :   //RRU is white
+//            case 194 :   //left all white, right half white >> go straight, turn right if 194 goes to 204
 //                pc.printf ("only Left is white \n");
 //                break;
-//            case 103 :  //RRD is white all else normal
+//            case 204 :  //all sensors are white
 //                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;