completed sparse planner class, unit test still needed