Added more flexible queue-pruning criteria for the SBA* algorithm. Made the test-planners program more flexible.