Added prevPos field to bodies
Added copy contstruct to vectors