added FF replan part
Merge pull request #10 from Imara90/Imara_ffpla

added FF replan part