Add start and goal setters

[hubacji1/rrts.git] / src / rrts.cc

diff --git a/src/rrts.cc b/src/rrts.cc
index 8e175a27ff787335c10337175a3c24c498c6bd7f..46f289eb2b08f68ae69893e70f7a68895b01409f 100644 (file)
--- a/src/rrts.cc
+++ b/src/rrts.cc
@@ -278,6 +278,20 @@ RRTS::set_imax_reset(unsigned int i)
        this->_imax = i;
 }
 
+void
+RRTS::set_goal(double x, double y, double b, double e)
+{
+       this->goal_ = RRTGoal(x, y, b, e);
+}
+
+void
+RRTS::set_start(double x, double y, double h)
+{
+       this->nodes_.front().x(x);
+       this->nodes_.front().y(y);
+       this->nodes_.front().h(h);
+}
+
 unsigned int
 RRTS::icnt() const
 {