Simulation Framework for MultiBody Systems