D* Lite Path Planning Algorithm