Constrained Robot Motion in Presence of Stiff and Compliant Contact