Fixed adjustPositions, now need to ork on velocity change in rigid bodies.