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)