“…The coordinate system {S i } is obtained from {S i−1 } via four sequential operations in the corresponding coordinate frames: taking the moving frame {S i } and frame {S i−1 } to be initially coincidental, we 1) translate along the z-axis by d i 1 , 2) rotate around the translated y-axis by θ i 1 , 3) rotate around the translated/rotated x-axis by θ i 2 , and finally, 4) translate along the translated and twice rotated z-axis by d i 2 (see Figure 2(b)). The parameters d i 1 , θ i 1 , θ i 2 , and d i 2 represent the configuration variables for the i-th segment and the homogeneous transformation matrix, which transforms vectors from coordinate frame {S i } to coordinate frame {S i−1 }, is given by [21]:…”