humanoid_planner_2d: Getter for path costs from SBPL