Two-way D* algorithm for path planning and replanning
planning algorithms .