“…The total kinetic and potential energy of the model is calculated as follows: Substitute K 1 , K 2 , K 3 and P 1 , P 2 , P 3 from equations (12), (16), (20), (13), (17), (21) into (22): Applying the Lagrange equation with q i = θ i as the rotation angle at the joints, and Q i as the torque at the joint axes, the dynamic equations at the following stages are obtained 30,31 : The dynamic equations of each joint, written in matrix form as follows: Equation (25) can be expressed in the following general form: where…”