MATLAB Answers

Why RRT planner doesn't reach the goal state?

5 views (last 30 days)
Hello everyone,
It is about motion planning using RRT algorithm.
There are start and goal positions
start = [0.5, 0.5 0];
goal = [2.5, 0.2, 0];
could you please explain me why the red line doesn't reach the goal state exactly?
If to run programm in Matlab in SoInInfo it is indicated that the plan is found.


Sign in to comment.

Accepted Answer

Cam Salzberger
Cam Salzberger on 6 Jul 2020
Hello Kseniya,
The plannerRRTStar class has a GoalReachedFcn that checks if the state of one of the RRT nodes is sufficiently close to the goal to call it "complete". There needs to be some level of tolerance, since in the continuous state space, the robot will never exactly reach the goal. The default GoalReachedFcn is nav.algs.checkIfGoalIsReached, which uses a tolerance of 0.5 meters, and the chart shows the robot reaching within that tolerance.
If you want to use a more precise GoalReachedFcn, you can easily implement your own. The code in nav.algs.checkIfGoalIsReached is very simple, so it'd be easy to copy it and modify the tolerance distance to be smaller.

  1 Comment

Kseniya Kalita
Kseniya Kalita on 7 Jul 2020
Hello Sam,
I am really grateful for your understanding and fast answer. I am very new for robotics related topics, but with your answer now i understand it better, thank you so much!

Sign in to comment.

More Answers (0)

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!