WOLFRAM|DEMONSTRATIONS PROJECT

Breadth-First Search Robot Motion Planning

​
Q
2
P
1
This Demonstration shows a resolution-complete planner that finds the shortest path between an initial and final configuration of a two-link, planar-arm robot by using a breadth-first search. The robot operates in the workspace on the left that contains two small circular obstacles. The corresponding robot phase space on the right shows the configurations
q=(
θ
1
,
θ
2
)
, for which an arm intersects an obstacle. You can relocate obstacles in the workspace and change the initial and final positions. You can improve the resolution of the search grid by increasing
Q
and move the robot along the shortest path by increasing
P
.