Updated CarPositionControl implementation and unit test