Update computation of the derivative of inertia matrix and angular momentum and its derivative