Robot team project

Dependencies:   QEI Motordriver ros_lib_melodic

Revision:
15:7c9bf41dd187
Parent:
14:08047fde54f6
Child:
16:11282b7ee726
--- a/main.cpp	Tue Nov 19 12:42:43 2019 +0000
+++ b/main.cpp	Tue Nov 19 15:28:02 2019 +0000
@@ -88,11 +88,11 @@
                 }
         }
         
-    A.speed(0);
-    B.speed(0);
-    
-    wheel_B.reset();
-    wheel_A.reset();
+//    A.speed(0);
+//    B.speed(0);
+//    
+//    wheel_B.reset();
+//    wheel_A.reset();
 
 }
 
@@ -120,44 +120,14 @@
             move(0.5, 0.5, 10000);
             break;
             
-        case default:
-            A.speed(0);
-            B.speed(0);
-    }
+            }
     A.speed(0);
     B.speed(0);
-//    switch(motor_dir.data) {
-//        case 0:
-//            motor_left.stop();
-//            motor_right.stop();
-//            break;
-//            
-//        // Move forward
-//        case 1:
-//            move("forward", -0.5, -0.5); 
-//            break;
-//    
-//        // Move left
-//        case 2:
-//            move("left", 0.5, -0.5, 3000, -1); 
-//            break;
-//            
-//        // Move right
-//        case 3:
-//            move("right", -0.5, 0.5, 3000, 1); 
-//            break;
-//            
-//        // Reverse
-//        case 4:
-//            move("reverse", 0.5, 0.5, 5691, -1);
-//            break;
-//    }
+    
+    wheel_B.reset();
+    wheel_A.reset();
 }
 
-
-
-
-
 int main() 
 {
     ros::NodeHandle  nh;