diff --git a/tmp/lanelet2_extension/include/lanelet2_extension/visualization/visualization.hpp b/tmp/lanelet2_extension/include/lanelet2_extension/visualization/visualization.hpp index 4d4e7992..c904c43a 100644 --- a/tmp/lanelet2_extension/include/lanelet2_extension/visualization/visualization.hpp +++ b/tmp/lanelet2_extension/include/lanelet2_extension/visualization/visualization.hpp @@ -275,12 +275,14 @@ visualization_msgs::msg::MarkerArray crosswalkAreasAsMarkerArray( const rclcpp::Duration & duration = rclcpp::Duration(0, 0)); /** - * [pedestrianPolygonMarkingsAsMarkerArray creates marker array to visualize pedestrian polygon markings] + * [pedestrianPolygonMarkingsAsMarkerArray creates marker array to visualize pedestrian polygon + * markings] * @param pedestrian_polygon_markings [pedestrian marking polygon] * @param c [color of the marker] */ visualization_msgs::msg::MarkerArray pedestrianPolygonMarkingsAsMarkerArray( - const lanelet::ConstLineStrings3d & pedestrian_polygon_markings, const std_msgs::msg::ColorRGBA & c); + const lanelet::ConstLineStrings3d & pedestrian_polygon_markings, + const std_msgs::msg::ColorRGBA & c); /** * [pedestrianLineMarkingsAsMarkerArray creates marker array to visualize pedestrian line markings] diff --git a/tmp/lanelet2_extension/lib/visualization.cpp b/tmp/lanelet2_extension/lib/visualization.cpp index 1f25eb48..0c48008c 100644 --- a/tmp/lanelet2_extension/lib/visualization.cpp +++ b/tmp/lanelet2_extension/lib/visualization.cpp @@ -975,14 +975,16 @@ visualization_msgs::msg::MarkerArray visualization::crosswalkAreasAsMarkerArray( } visualization_msgs::msg::MarkerArray visualization::pedestrianPolygonMarkingsAsMarkerArray( - const lanelet::ConstLineStrings3d & pedestrian_polygon_markings, const std_msgs::msg::ColorRGBA & c) + const lanelet::ConstLineStrings3d & pedestrian_polygon_markings, + const std_msgs::msg::ColorRGBA & c) { visualization_msgs::msg::MarkerArray marker_array; if (pedestrian_polygon_markings.empty()) { return marker_array; } - visualization_msgs::msg::Marker polygon_marker = createPolygonMarker("pedestrian_polygon_marking", c); + visualization_msgs::msg::Marker polygon_marker = + createPolygonMarker("pedestrian_polygon_marking", c); for (const auto & linestring : pedestrian_polygon_markings) { lanelet::ConstPolygon3d polygon; if (utils::lineStringToPolygon(linestring, &polygon)) { @@ -1008,16 +1010,14 @@ visualization_msgs::msg::MarkerArray visualization::pedestrianLineMarkingsAsMark if (pedestrian_line_markings.empty()) { return marker_array; } - + const float lss = 0.1; // line string size visualization_msgs::msg::Marker line_marker; - visualization::initLineStringMarker( - &line_marker, "map", "pedestrian_line_marking", c); + visualization::initLineStringMarker(&line_marker, "map", "pedestrian_line_marking", c); for (const auto & linestring : pedestrian_line_markings) { - if ((linestring.size() < 3) && (linestring.front().id() != linestring.back().id())){ + if ((linestring.size() < 3) && (linestring.front().id() != linestring.back().id())) { pushLineStringMarker(&line_marker, linestring, c, lss); - } }