Refactored ShapeMath methods into CollisionGeometry classes