A Geometric Algorithm for Robust Multibody Inertial Parameter Identification