Add firsts, firsts getter

[hubacji1/iamcar.git] / base / rrtbase.cc

diff --git a/base/rrtbase.cc b/base/rrtbase.cc
index da51b5af802f5274dca94915b7657c883301d153..5768286c8f3c28c665980fdea2c623aed1727da2 100644 (file)
--- a/base/rrtbase.cc
+++ b/base/rrtbase.cc
@@ -139,6 +139,11 @@ std::vector<RRTNode *> &RRTBase::dnodes()
         return this->dnodes_;
 }
 
+std::queue<RRTNode *> &RRTBase::firsts()
+{
+        return this->firsts_;
+}
+
 PolygonObstacle &RRTBase::frame()
 {
         return this->frame_;