attribute.hpp

Go to the documentation of this file.

// Copyright 2015 TIER IV, Inc. All rights reserved.
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.
 
#ifndef OPENSCENARIO_INTERPRETER__READER__ATTRIBUTE_HPP_
#define OPENSCENARIO_INTERPRETER__READER__ATTRIBUTE_HPP_
 
#include <ament_index_cpp/get_package_share_directory.hpp>
#include <boost/algorithm/string/replace.hpp>
#include <concealer/execute.hpp>
#include <functional>
#include <openscenario_interpreter/reader/evaluate.hpp>
#include <openscenario_interpreter/syntax/parameter_type.hpp>
#include <openscenario_interpreter/utility/highlighter.hpp>
#include <pugixml.hpp>
#include <regex>
#include <scenario_simulator_exception/exception.hpp>
#include <string>
#include <unordered_map>
 
namespace openscenario_interpreter
{
inline namespace reader
{
template <typename Scope>
auto substitute(std::string attribute, Scope & scope)
{
  auto dirname = [](auto &&, auto && scope) { return scope.dirname(); };
 
  auto find_pkg_share = [](auto && package_name, auto &&) {
    return ament_index_cpp::get_package_share_directory(package_name);
  };
 
  auto ros2 = [](auto && arguments, auto &&) {
    auto remove_trailing_newline = [](auto && s) {
      while (s.back() == '\n') {
        s.pop_back();
      }
      return s;
    };
    if (auto && result = remove_trailing_newline(concealer::dollar("ros2 " + arguments));
        result.find('\n') != std::string::npos) {
      throw SyntaxError(
        "The substitution result by `$(ros2 ...)` must not contain a newline character. "
        "You gave `$(ros2 ",
        arguments, ")` and the result was ",
        std::quoted(boost::replace_all_copy(result, "\n", "\\n")),
        ", which is unacceptable for the reasons stated above.");
    } else {
      return result;
    }
  };
 
  auto var = [](auto && name, auto && scope) {
    // TODO: Return the value of the launch configuration variable instead of the OpenSCENARIO parameter.
    if (const auto found = scope.ref(name); found) {
      return boost::lexical_cast<String>(found);
    } else {
      return String();
    }
  };
 
  // NOTE: https://design.ros2.org/articles/roslaunch_xml.html#dynamic-configuration
  static const std::unordered_map<
    std::string, std::function<std::string(const std::string &, Scope &)> >
    substitutions{
      {"dirname", dirname},
      // TODO {"env", env},
      // TODO {"eval", eval},
      // TODO {"exec-in-package", exec_in_package},
      // TODO {"find-exec", find_exec},
      // TODO {"find-pkg-prefix", find_pkg_prefix},
      {"find-pkg-share", find_pkg_share},
      {"ros2",
       ros2},  // NOTE: TIER IV extension (Not included in the ROS 2 Launch XML Substitution)
      {"var", var},
    };
 
  static const auto pattern = std::regex(R"((.*)\$\‍((([\w-]+)\s?([^\)]*))\)(.*))");
 
  for (std::smatch result; std::regex_match(attribute, result, pattern);) {
    if (const auto iter = substitutions.find(result.str(3)); iter != std::end(substitutions)) {
      attribute = result.str(1) + std::get<1>(*iter)(result.str(4), scope) + result.str(5);
    } else {
      throw SyntaxError("Unknown substitution ", std::quoted(result.str(3)), " specified");
    }
  }
 
  return attribute;
}
 
template <typename T, typename Node, typename Scope>
auto readAttribute(const std::string & name, const Node & node, const Scope & scope) -> T
{
  auto is_openscenario_standard_expression = [](const auto & s) {
    return s.substr(0, 2) == "${" and s.back() == '}';
  };
 
  auto read_openscenario_standard_expression = [&](const auto & s) {
    return boost::lexical_cast<T>(evaluate(std::string(std::begin(s) + 2, std::end(s) - 1), scope));
  };
 
  auto is_openscenario_standard_parameter_reference = [](const auto & s) {
    return s.front() == '$';
  };
 
  auto read_openscenario_standard_parameter_reference = [&](const auto & s) {
    // TODO Use `return scope.template ref<T>(s.substr(1));`
    if (auto && object = scope.ref(s.substr(1)); object) {
      return boost::lexical_cast<T>(boost::lexical_cast<String>(object));
    } else {
      throw SyntaxError(
        "There is no parameter named ", std::quoted(s.substr(1)), " (Attribute ", std::quoted(name),
        " of class ", std::quoted(node.name()), " references this parameter)");
    }
  };
 
  auto read_openscenario_standard_literal = [&](const auto & s) {
    try {
      return boost::lexical_cast<T>(s);
    } catch (const boost::bad_lexical_cast &) {
      throw SyntaxError(
        "Value ", std::quoted(s), " specified for attribute ", std::quoted(name),
        " is invalid (Is not value of type ", makeTypename(typeid(T)), ")");
    }
  };
 
  // NOTE: https://www.asam.net/index.php?eID=dumpFile&t=f&f=4092&token=d3b6a55e911b22179e3c0895fe2caae8f5492467#_parameters
 
  if (const auto & attribute = node.attribute(name.c_str())) {
    // NOTE: `substitute` is TIER IV extension (Non-OpenSCENARIO standard)
    if (std::string value = substitute(attribute.value(), scope); value.empty()) {
      return T();
    } else if (is_openscenario_standard_expression(value)) {
      return read_openscenario_standard_expression(value);
    } else if (is_openscenario_standard_parameter_reference(value)) {
      return read_openscenario_standard_parameter_reference(value);
    } else {
      return read_openscenario_standard_literal(value);
    }
  } else {
    throw SyntaxError(
      "Required attribute ", std::quoted(name), " not specified for class ",
      std::quoted(node.name()));
  }
}
 
template <typename T, typename Node, typename Scope>
auto readAttribute(const std::string & name, const Node & node, const Scope & scope, T && value)
{
  if (node.attribute(name.c_str())) {
    return readAttribute<T>(name, node, scope);
  } else {
    return value;
  }
}
}  // namespace reader
}  // namespace openscenario_interpreter
 
#endif  // OPENSCENARIO_INTERPRETER__READER__ATTRIBUTE_HPP_