Two-Joint Robot Dynamics with impedance controller

In this work, two-joint robot is controlled with impedience controller method. Impedience controller diagram is constructed in model.

In this work, two-joint robot is controlled with impedance controller method. Impedance controller diagram is constructed in model. External torques are modelled as pulse function. You can tune Kp and Kd values and observe how external force effects your robot positions.