When reset, reset bc, too

diff --git a/src/rrts.cc b/src/rrts.cc
index 107594bd6ec8d661cb7ec276239b4122bc69cdd0..03787b133d2c2d139dc985541debe5c1d8e5481a 100644 (file)
--- a/src/rrts.cc
+++ b/src/rrts.cc
@@ -458,6 +458,9 @@ RRTS::reset()
        this->nodes_.erase(this->nodes_.begin() + 1, this->nodes_.end());
        this->nv_.clear();
        this->nn_ = nullptr;
+       this->bc_.x(0);
+       this->bc_.y(0);
+       this->bc_.h(0);
 }
 
 } // namespace rrts