Fixed inertial bugs with CRB algorithm on floating bases