Merge pull request #4685 from rokuz/traffic-manager

Added traffic manager

1 files changed, 9 insertions, 0 deletions

diff --git a/geometry/polyline2d.hpp b/geometry/polyline2d.hpp
index 40b4a99da6..86dfe69972 100644
--- a/geometry/polyline2d.hpp
+++ b/geometry/polyline2d.hpp
@@ -115,6 +115,15 @@ public:
     return m_points.back();
   }
 
+  Polyline ExtractSegment(size_t segmentIndex, bool reversed)
+  {
+    if (segmentIndex + 1 >= m_points.size())
+      return Polyline();
+
+    return reversed ? Polyline(vector<Point<T>>{m_points[segmentIndex + 1], m_points[segmentIndex]}) :
+                      Polyline(vector<Point<T>>{m_points[segmentIndex], m_points[segmentIndex + 1]});
+  }
+
   vector<Point<T> > const & GetPoints() const { return m_points; }
   friend string DebugPrint(Polyline const & p) { return ::DebugPrint(p.m_points); }
 };