Positions and Velocities swapped

Fixes bug described by @kalectro