A framework for multi-contact multi-body dynamic simulation and haptic display.