Illustration of the CBF-RRT process for a unicycle model with 3 states. In the first step, an existing vertex in the tree is randomly selected. Note that the steering angle is free.
In the second step, a random steering direction is randomly sampled. This process allows the node to explore many potential directions to avoid local minima.
In the case where there are no nearby obstacles, the safe steer function will drive the system along the randomly selected angle for a pre-determined time.
In the case where there are (dynamic) obstacles nearby, the safe steer function will avoid the obstacles due to the control barrier function constraint in the control synthesis problem.
A simulation of the CBF-RRT algorithm for the unicycle model with dynamic obstacles. There are no nearby obstacles at the start so the robot can move directly toward the goal.
The obstacles are still far enough that the robot does not have to adjust its trajectory.
The robot has to adjust its trajectory to avoid collisions with the dynamic obstacles while trying to progress toward the goal.
The robot is able to avoid dynamic obstacles and reach its goal location.