Refactoring: use variables for intermediate penalties
New penalty for previous velocity