X-Git-Url: https://git.realraum.at/?a=blobdiff_plain;f=cpp%2FopenCVnaiveObstacleAvoidance%2FopenCVnaiveObstacleAvoidance.cpp;h=cb97e7b0fc51c13384cf0df2c4865c5ad6af0483;hb=0e07bf0e102380c7ba033175b97ffbe1b020d28b;hp=f8ccfebc6b7905e3d96689c09ddaa8519d7457e3;hpb=bb6785d468ffb1de2cbf6d269780994b93ce82a1;p=201903hackathon.git

diff --git a/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp b/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp
index f8ccfeb..cb97e7b 100644
--- a/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp
+++ b/cpp/openCVnaiveObstacleAvoidance/openCVnaiveObstacleAvoidance.cpp
@@ -58,6 +58,10 @@ class MyListener : public IDepthDataListener
     const string bobbycar_forward = "f";
     const string bobbycar_left = "l";
     const string bobbycar_right = "r";
+    const string bobbycar_backward = "b";
+
+    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 +269,12 @@ private:
 
     void naiveObstacleAvoidanceDemo()
     {
+        if (bobbycar_reversing<boobycar_reversing_script.size()) {
+            std::cout << boobycar_reversing_script.at(bobbycar_reversing++) << std::endl;
+            return;
+        }
+
+
         bool free_paths[num_dist_columns_];
         if (naiveIsObstaclePresent(free_paths))
         {
@@ -284,6 +294,7 @@ private:
             } else {
                 // std::cout << "STOP" << std::endl;
                 std::cout << bobbycar_stop << std::endl;
+                bobbycar_reversing = 0;
             }
         } else {
             std::cout << bobbycar_forward << std::endl;
@@ -405,7 +416,8 @@ int main (int argc, char *argv[])
 
     // set an operation mode
     // if (cameraDevice->setUseCase ("MODE_5_45FPS_500") != royale::CameraStatus::SUCCESS)
-    if (cameraDevice->setUseCase ("MODE_9_10FPS_1000") != royale::CameraStatus::SUCCESS)
+    // if (cameraDevice->setUseCase ("MODE_9_10FPS_1000") != royale::CameraStatus::SUCCESS)
+    if (cameraDevice->setUseCase ("MODE_9_5FPS_2000") != royale::CameraStatus::SUCCESS)
     {
         cerr << "Error setting use case" << endl;
         return 1;