Correct formula for marching forward