Why RRT planner doesn't reach the goal state?
3 次查看(过去 30 天)
显示 更早的评论
Hello everyone,
I am trying to understand the example https://de.mathworks.com/help/nav/ref/plannerrrtstar.html.
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.
0 个评论
采纳的回答
Cam Salzberger
2020-7-6
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.
-Cam
更多回答(0 个)
另请参阅
类别
在 Help Center 和 File Exchange 中查找有关 Motion Planning 的更多信息
Community Treasure Hunt
Find the treasures in MATLAB Central and discover how the community can help you!
Start Hunting!