bit of cleanup and added A* 3D planner