adden center of mass estimation