
Lol smth
Dependencies: LocalPositionSystem MMA8451Q Motor_Driver Sensors mbed
Fork of TDP_main_BartFork by
Diff: main.cpp
- 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.. +// +// } +// +// +// } +// }