Hi! In this post I will explain the method for obtaining a set of equations to be able to identify the dynamic model of robot composed by several links even in presence of closed loops. In the previous post **I detailed how to obtain an expression of the forces and torques acting on the last link as a linear function of the robot parameters**. Now let us include the rest of the links.

We said that the spatial force acting on that robotic link is:

(1)

However, here the interest lays on **identifying** the inertial and mass parameters of the whole robotic structure and the effect of all links should be taken into account.

Defining as the **spatial force** at joint due to movement of alone. Then is the spatial force at i due to its own movement. The equivalent expression for the (1) would thus be (2) where it has been substituted by . And the superscript has been added to indicate that the vectors are expressed in terms of joint .

(2)

In this way, the total spatial force at joint, , it is the sum of the spatial forces $latex{^i}f_{ij}$ for all links distal to , following the results of:

(3)

The spatial force at joint its determined by the spatial force **transformation matrix** ,

(4)

So the forces and torques on link due to the movements of the link can be obtained by cascading a series of transformation matrices:

(5)

With this approach, the spatial forces of a serial chain robot can be easily expressed in a matrix:

$latex \left( \begin{array} {c} {^1}f_1 \\ {^2}f_2 \\ \vdots \\ {^n}f_n \end{array} \right) =\begin{bmatrix}

{^1}X_{1}^{F1}A_1 & {^1}X_{2}^{F2} A_2 & \dots & {^1}X_{n}^{Fn}A_n \\

0 & {^2}X_{2} ^{F2}A_2& \dots & {^2}X_{n} ^{Fn}A_n\\

\vdots & \vdots & \vdots & \ddots & \vdots \\

0 & 0 & \dots & {^n}X_{n}^{Fn}A_n

\end{bmatrix}

\left( \begin{array} {c} \phi_1 \\ \phi_2 \\ \vdots \\ \phi_n \end{array} \right) $ (6)

Or in compact form: Since only the torque can be usually measured around the axis , the spatial force can be projected around that rotation axis and simplifying (6) to:

(7)

Where,

However, for the very common manipulator with a **closed loop** such the one presented in before, equation (6) has to be adapted with the inclusion of the closed loop. In order to perform this adaptation, firstly (6) is modified so to include the spanning tree joints as the graph of Figure 1. That leads to an expression similar to for the matrix when a non-serial manipulator is modelled.

Once the reference systems have been established, following for example the D-H rules, we will be in the position of modifying equation (8) to include the closed loop. This will be explained in detail in the next posts together with the algebra of spatial forces. Be careful with the **D-H parameters** since there are multiple versions.

## Leave a Reply