added test for initializing pos, prevPos, vel