X-Git-Url: https://git.realraum.at/?p=201903hackathon.git;a=blobdiff_plain;f=cpp%2FopenCVnaiveObstacleAvoidance%2FopenCVnaiveObstacleAvoidance.cpp;h=9758346188cdc816784c9d463457b170ef714221;hp=5849e230eed226f0fd7943c2aee151569e7005be;hb=b29fe0f6a0089c39b6e0e4c770abdcbb669ce01a;hpb=2797a0bcf45a0f16d07877723f4f60d76d7ed6e6

diff --git a/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp b/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp
index 5849e23..9758346 100644
--- a/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp
+++ b/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp
@@ -59,6 +59,9 @@ class MyListener : public IDepthDataListener
     const string bobbycar_left = "l";
     const string bobbycar_right = "r";
 
+    uint8_t bobbycar_reversing = 254;
+    royale::Vector<royale::String> boobycar_reversing_script ={"s","b","b","b","b","r","b","r","b","r","b"};
+
 public :
 
 
@@ -265,6 +268,11 @@ private:
 
     void naiveObstacleAvoidanceDemo()
     {
+        if (bobbycar_reversing<boobycar_reversing_script.size()) {
+            std::cout << boobycar_reversing_script.at(bobbycar_reversing++);
+        }
+
+
         bool free_paths[num_dist_columns_];
         if (naiveIsObstaclePresent(free_paths))
         {
@@ -284,6 +292,7 @@ private:
             } else {
                 // std::cout << "STOP" << std::endl;
                 std::cout << bobbycar_stop << std::endl;
+                bobbycar_reversing = 0;
             }
         } else {
             std::cout << bobbycar_forward << std::endl;