As promised in the previous article.
Let’s look at direct kinematics.
Where – translation matrix with respect to a axis, and
– rotational matrix with respect to a axis.
H – homogeneous transformation matrix, which contains the position and rotation of the endpoint in global coordinates. ( is already included in
because there is no difference where
is located on this link)