Diff: source/Movement.cpp

Revision:

96:1c6867536350

Parent:

94:0381e8b1beda

Child:

99:78d87027c85b

--- a/source/Movement.cpp	Tue May 02 15:29:50 2017 +0000
+++ b/source/Movement.cpp	Wed May 03 06:22:49 2017 +0000
@@ -190,7 +190,7 @@
 {
     float upper = getDistanceIR(2);                                             // get distance from upper Center Sensor
     float lower = getDistanceIR(3);                                             // get distance from Lower Center Sensor
-
+    printf("Current Search State: >%d<\r\n",search_state);
     switch (search_state) {
         case 0: //first cycle right
             turn_for_deg(60.0f);                                               // call function and start turning
@@ -249,6 +249,7 @@
             return 50;                                                          //main state machine set as Grabbing
 
         default:
+            printf("default State - move in search for brick\r\n");
             // error
             break;
     }