Correctly calculate vertical speed.