David Baraff: Analytical methods for dynamic simulation of non-penetrating rigid bodies. SIGGRAPH 1989: 223-232