Compliant control of constrained robot manipulators