In this work, we propose an approach to optimal control based on the A* algorithm. It employs a discrete approximation of the dynamic of the robot to estimate the cost-to-go function using the wavefront propagation algorithm. ...