Need to change leg-separation term...

from being solely dependent on final time to being met throughout motion