public static void add(Capsule c, Vector3 p) { c.origin.x += p.x; c.origin.y += p.y; c.origin.z += p.z; }
public static void sub(Capsule c, Vector3 p) { c.origin.x -= p.x; c.origin.y -= p.y; c.origin.z -= p.z; }
public Capsule(Capsule capsule) { origin = new Vector3(capsule.origin); direction = new Vector3(capsule.direction); radius = capsule.radius; }