A Jacobian formulation for efficient simulation of multibody chain dynamics