Robust set invariance for implicit robot force control in presence of contact model uncertainty