Fix waitForProgramNotRunning

Author: urfeex

src/example_robot_wrapper.cpp

@@ -68,13 +68,20 @@ void ExampleRobotWrapper::initializeRobotWithDashboard()
 
 void ExampleRobotWrapper::handleRobotProgramState(bool program_running)
 {
+  // Print the text in green so we see it better
   std::cout << "\033[1;32mProgram running: " << std::boolalpha << program_running << "\033[0m\n" << std::endl;
-  program_running_ = program_running;
   if (program_running)
   {
     std::lock_guard<std::mutex> lk(program_running_mutex_);
+    program_running_ = program_running;
     program_running_cv_.notify_one();
   }
+  else
+  {
+    std::lock_guard<std::mutex> lk(program_not_running_mutex_);
+    program_running_ = program_running;
+    program_not_running_cv_.notify_one();
+  }
 }
 
 void ExampleRobotWrapper::startRTDECommununication(const bool consume_data)