Planning with fixed feet progress - interpolation working