Implementation of D* lite for robotics control class