optimize Collision code: SAT/GJK/Manifold/Resolve and doc