working on velocity correction step