A single holonomic robot is supposed to reach its goal by avoiding collision with moving obstacles. We use velocity obstacle formulation to perform goal reaching obstacle avoidance in a dynamic environment.
We try to calculate an optimal velocity such that the agent reaches the goal while avoiding the obstacles using collision cone constraints.
We perform a sampling based method to generate different velocities within a range and then find the optimal velocity with minimum cost.
