HOMOGENEOUS TRANSFORMATION MATRIX

𝑐𝑜𝑠𝜃𝑖 −𝑠𝑖𝑛𝜃𝑖 0 𝑎𝑖−1

𝑠𝑖𝑛𝜃𝑖 𝑐𝑜𝑠𝛼𝑖−1 𝑐𝑜𝑠𝜃𝑖 𝑐𝑜𝑠𝛼𝑖−1 −𝑠𝑖𝑛𝛼𝑖−1 −𝑠𝑖𝑛𝛼𝑖−1 𝑑𝑖
[ ]
𝑠𝑖𝑛𝜃𝑖 𝑠𝑖𝑛𝛼𝑖−1 𝑐𝑜𝑠𝜃𝑖 𝑠𝑖𝑛𝛼𝑖−1 𝑐𝑜𝑠𝛼𝑖−1 𝑐𝑜𝑠𝛼𝑖−1 𝑑𝑖
0 0 0 1

DH TABLE
a 𝛼 𝑑 𝜃
𝑎1 0 0 𝜃1
𝑎2 0 0 𝜃2
𝑎3 0 0 𝜃3
𝑎4 0 0 𝜃4

𝑐𝑜𝑠𝜃1 −𝑠𝑖𝑛𝜃1 0 𝑎1
𝑠𝑖𝑛𝜃1 𝑐𝑜𝑠𝜃1 0 0
0 𝑇1 =[ ]
0 0 1 0
0 0 0 1

𝑐𝑜𝑠𝜃2 −𝑠𝑖𝑛𝜃2 0 𝑎2
𝑠𝑖𝑛𝜃2 𝑐𝑜𝑠𝜃2 0 0
1 𝑇2 =[ ]
0 0 1 0
0 0 0 1

𝑐𝑜𝑠𝜃3 −𝑠𝑖𝑛𝜃3 0 𝑎3
𝑠𝑖𝑛𝜃3 𝑐𝑜𝑠𝜃3 0 0
2 𝑇3 =[ ]
0 0 1 0
0 0 0 1

𝑐𝑜𝑠𝜃4 −𝑠𝑖𝑛𝜃4 0 𝑎4
𝑠𝑖𝑛𝜃4 𝑐𝑜𝑠𝜃4 0 0
3 𝑇4 =[ ]
0 0 1 0
0 0 0 0