Grasped object weight compensation algorithm in reference to impedance controlled robots