Motion planning and control of a robot manipulator subject to force constraints.pdf