Control of Physical Human Robot Interaction