utils.hpp

Go to the documentation of this file.

 
#ifndef SUP_SUBSIM_COMMON_UTILS_IPP_
#define SUP_SUBSIM_COMMON_UTILS_IPP_
 
// System headers
#include <string>
 
// Third party headers
 
 
// Local headers
#include <rad/smAdapter.hpp>
#include <rad/mal/request.hpp>
#include <rad/activity.hpp>
#include <sup/subsim/common/config.hpp>
 
namespace sup::subsim::common {
 
  template <class EVENT_DONE, class EVENT_ERR>
  void EmulateEvent(const IConfig& config,
                    rad::SMAdapter& sm,
                    const std::string cmd,
                    rad::ThreadActivity* activity) {
 
    // In case data is not found, it takes the default value
    auto delay = config.GetReplyDelay(cmd).value_or(0);
    auto repl_ok = config.GetReplyOk(cmd).value_or(true);
    const auto msg = config.GetReplyErrorMessage(cmd).value_or("Generic Error");
 
    RAD_LOG_INFO() << "Reply msg: " << msg;
    if (delay > 0) {
        RAD_LOG_DEBUG() << "Reply delay: " << delay;
        int total = 0;
        int increment = int(delay/100);
        RAD_LOG_DEBUG() << "Increment: " << increment;
        while (total < delay) {
            if (activity->IsStopRequested()) {
                sm.PostEvent(rad::UniqueEvent(new EVENT_ERR(cmd + " has been stopped !" )));
                return;
              }
            std::this_thread::sleep_for(std::chrono::milliseconds(increment));
            total += increment;
            RAD_LOG_DEBUG() << "Total Time: " << total << " [ms]";
          }
      }
    if (repl_ok) {
        sm.PostEvent(rad::UniqueEvent(new EVENT_DONE));
      } else {
        sm.PostEvent(rad::UniqueEvent(new EVENT_ERR(msg )));
      }
  }
 
 
}  // namespace
 
#include "utils.ipp"
#endif  // SUP_SUBSIM_COMMON_UTILS_IPP_