multibody model update step