Fix refinment of footstep by using relative transformation to the
previous footstep