Add preliminary support for different SBPL planners