Expanding Polytope Algorithm

Making the objects interact

The EPA algorithm was implemented. It started out with some unexpected behaviour:

But later worked well:

Rotational dynamics was tried, I used by own algorithm for finding the exact collision point, this worked in some situations: