Fixed some vector copying issues, still doesnt quite work. Blows up on full body.