double q0[] = {f.x(), f.y(), f.h()};
double q1[] = {t.x(), t.y(), t.h()};
ReedsSheppStateSpace rsss(this->bc.mtr());
- rsss.sample(q0, q1, 0.5, cb_rs_steer, &this->steered());
+ rsss.sample(q0, q1, 0.05, cb_rs_steer, &this->steered());
}
void RRTS::join_steered(RRTNode *f)