Rigid body simulation with interactions resolution algorithm from Nonconvex Rigid Bodies with Stacking [Bridson - Siggraph 03]