fixed velocity formula, made more readible and simple