Stabile robot force control hard contro by Haipeng