WIP: [Feature] Add GJK-EPA algorithm for rigid body collision detection

[SonSang]

trafficstars

Description

Adding GJK-EPA algorithm for rigid body collision detection.

Related Issue

Resolves Genesis-Embodied-AI/Genesis#

Motivation and Context

GJK-EPA could be an alternative to MPR in terms of stability or efficiency.

How Has This Been / Can This Be Tested?

Running unit tests in test_rigid_physics_gjk.py.

Screenshots (if appropriate):

Checklist:

• [x] I read the CONTRIBUTING document.
• [ ] I followed the Submitting Code Changes section of CONTRIBUTING document.
• [x] I tagged the title correctly (including BUG FIX/FEATURE/MISC/BREAKING)
• [ ] I updated the documentation accordingly or no change is needed.
• [x] I tested my changes and added instructions on how to test it for reviewers.

• [ ] I have added tests to cover my changes.
• [ ] All new and existing tests passed.