15 #ifndef OPENSCENARIO_INTERPRETER__OPENSCENARIO_INTERPRETER_HPP_
16 #define OPENSCENARIO_INTERPRETER__OPENSCENARIO_INTERPRETER_HPP_
18 #include <boost/variant.hpp>
20 #include <lifecycle_msgs/msg/state.hpp>
21 #include <lifecycle_msgs/msg/transition.hpp>
30 #include <openscenario_interpreter_msgs/msg/context.hpp>
31 #include <rclcpp/rclcpp.hpp>
32 #include <rclcpp_lifecycle/lifecycle_node.hpp>
37 #define INTERPRETER_INFO_STREAM(...) \
38 RCLCPP_INFO_STREAM(get_logger(), "\x1b[32m" << __VA_ARGS__ << "\x1b[0m")
42 #define INTERPRETER_ERROR_STREAM(...) \
43 RCLCPP_INFO_STREAM(get_logger(), "\x1b[1;31m" << __VA_ARGS__ << "\x1b[0m")
51 using Context = openscenario_interpreter_msgs::msg::Context;
53 const rclcpp_lifecycle::LifecyclePublisher<Context>::SharedPtr publisher_of_context;
55 double local_frame_rate;
57 double local_real_time_factor;
65 std::shared_ptr<OpenScenario> script;
67 std::list<std::shared_ptr<ScenarioDefinition>> scenarios;
69 std::shared_ptr<rclcpp::TimerBase> timer;
73 boost::variant<common::junit::Pass, common::junit::Failure, common::junit::Error> result;
77 using Result = rclcpp_lifecycle::node_interfaces::LifecycleNodeInterface::CallbackReturn;
79 bool waiting_for_engagement_to_be_completed =
false;
91 auto engage()
const -> void;
99 auto on_activate(
const rclcpp_lifecycle::State &) -> Result
override;
101 auto on_cleanup(
const rclcpp_lifecycle::State &) -> Result
override;
103 auto on_configure(
const rclcpp_lifecycle::State &) -> Result
override;
105 auto on_deactivate(
const rclcpp_lifecycle::State &) -> Result
override;
107 auto on_error(
const rclcpp_lifecycle::State &) -> Result
override;
109 auto on_shutdown(
const rclcpp_lifecycle::State &) -> Result
override;
113 auto reset() -> void;
115 template <
typename T,
typename... Ts>
118 result = T(std::forward<decltype(
xs)>(
xs)...);
120 results.
name = boost::filesystem::path(osc_path).parent_path().parent_path().string();
122 const auto suite_name = boost::filesystem::path(osc_path).parent_path().filename().string();
124 const auto case_name = boost::filesystem::path(osc_path).stem().string();
126 boost::apply_visitor(
129 results.
testsuite(suite_name).testcase(case_name).pass.push_back(it);
132 results.
testsuite(suite_name).testcase(case_name).failure.push_back(it);
135 results.
testsuite(suite_name).testcase(case_name).error.push_back(it);
140 (boost::filesystem::path(output_directory) /
"result.junit.xml").c_str(),
" ");
143 template <
typename ExceptionHandler,
typename Thunk>
152 set<common::junit::Pass>();
153 return handle(action);
158 set<common::junit::Failure>(
"SimulationFailure", action.what());
159 return handle(action);
162 catch (
const AutowareError & error) {
163 set<common::junit::Error>(
"AutowareError", error.what());
164 return handle(error);
167 catch (
const SemanticError & error) {
168 set<common::junit::Error>(
"SemanticError", error.what());
169 return handle(error);
172 catch (
const SimulationError & error) {
173 set<common::junit::Error>(
"SimulationError", error.what());
174 return handle(error);
177 catch (
const SyntaxError & error) {
178 set<common::junit::Error>(
"SyntaxError", error.what());
179 return handle(error);
182 catch (
const std::exception & error)
184 set<common::junit::Error>(
"InternalError", error.what());
185 return handle(error);
190 set<common::junit::Error>(
"UnknownError",
"An unknown exception has occurred");
195 template <
typename TimeoutHandler,
typename Thunk>
216 return [
this](
const auto & statistics) {
219 "Your machine is not powerful enough to run the scenario at the specified frame rate ("
220 << local_frame_rate <<
" Hz). We recommend that you reduce the frame rate to "
221 << 1000.0 / statistics.template max<std::chrono::milliseconds>().count() <<
" or less.");
Definition: openscenario_interpreter.hpp:50
auto engage() const -> void
Definition: openscenario_interpreter.cpp:125
auto on_error(const rclcpp_lifecycle::State &) -> Result override
Definition: openscenario_interpreter.cpp:254
auto currentLocalFrameRate() const -> std::chrono::milliseconds
Definition: openscenario_interpreter.cpp:53
auto on_cleanup(const rclcpp_lifecycle::State &) -> Result override
Definition: openscenario_interpreter.cpp:247
auto defaultTimeoutHandler() const
Definition: openscenario_interpreter.hpp:203
auto engageable() const -> bool
Definition: openscenario_interpreter.cpp:136
auto on_shutdown(const rclcpp_lifecycle::State &) -> Result override
Definition: openscenario_interpreter.cpp:261
auto makeCurrentConfiguration() const -> traffic_simulator::Configuration
Definition: openscenario_interpreter.cpp:63
auto engaged() const -> bool
Definition: openscenario_interpreter.cpp:148
auto publishCurrentContext() const -> void
Definition: openscenario_interpreter.cpp:270
auto withTimeoutHandler(TimeoutHandler &&handle, Thunk &&thunk) -> decltype(auto)
Definition: openscenario_interpreter.hpp:196
auto withExceptionHandler(ExceptionHandler &&handle, Thunk &&thunk) -> decltype(auto)
Definition: openscenario_interpreter.hpp:144
auto on_activate(const rclcpp_lifecycle::State &) -> Result override
Definition: openscenario_interpreter.cpp:160
OPENSCENARIO_INTERPRETER_PUBLIC Interpreter(const rclcpp::NodeOptions &)
Definition: openscenario_interpreter.cpp:35
auto on_deactivate(const rclcpp_lifecycle::State &) -> Result override
Definition: openscenario_interpreter.cpp:240
auto set(Ts &&... xs) -> void
Definition: openscenario_interpreter.hpp:116
auto currentScenarioDefinition() const -> const std::shared_ptr< ScenarioDefinition > &
Definition: openscenario_interpreter.cpp:58
~Interpreter() override
Definition: openscenario_interpreter.cpp:51
auto on_configure(const rclcpp_lifecycle::State &) -> Result override
Definition: openscenario_interpreter.cpp:82
auto reset() -> void
Definition: openscenario_interpreter.cpp:283
Definition: simulator_core.hpp:458
Definition: simulator_core.hpp:525
Definition: custom_command_action.hpp:38
Definition: execution_timer.hpp:29
auto invoke(const std::string &tag, Thunk &&thunk)
Definition: execution_timer.hpp:98
auto getStatistics(const std::string &tag) -> const auto &
Definition: execution_timer.hpp:113
std::string String
Definition: string.hpp:24
constexpr auto overload(Ts &&... xs) -> typename utility::overloaded< typename std::decay< Ts >::type... >
Definition: overload.hpp:51
Definition: escape_sequence.hpp:22
Definition: junit5.hpp:25
#define OPENSCENARIO_INTERPRETER_PUBLIC
Definition: visibility.hpp:49
Definition: junit5.hpp:88
Definition: junit5.hpp:51
Definition: junit5.hpp:34
Definition: junit5.hpp:336
xs::string name
Definition: junit5.hpp:337
auto write_to(Ts &&... xs) const
Definition: junit5.hpp:381
auto testsuite(const xs::string &name) -> auto &
Definition: junit5.hpp:341
Definition: custom_command_action.hpp:32
Definition: configuration.hpp:30