Given:

I want to simulate an so given the we can have:
For this particular robot the only way to give a force feedback is to apply a torque so:
where is the Jacobian matrix.
But there are 2 torques to be summed: the torque of motor and that of the human :
Then the total torque will be:Also remember that:Then:What is really felt by the human is the Force of the human itself and the velocity which is controlled by both and , then:$$ F = Z_p(s) \cdot \Large \dot{\normalsize X}\normalsize _h \cdot \frac{1}{s}
- $Z_p(s)$ is the [[HCR - Definition of 'Impedance'|Impedance]] **perceived** by the human. ![[Pasted image 20220328165717.png]] And: ![[Pasted image 20220328165734.png]]