Fixing SimplePlanner