fixes #31 Replanning done