Dynamic force/motion control of cooperative robot systems