Added shortcutting to OMPLPlanner.