Fix robot force control