Robotic Manipulator Transformation Matrix

Function to compute homogeneous transformation matrix from base to end effector for a robotic manipulator

This function computes the homogeneous transformation matrix from base to end-effector. The function takes the Denavit–Hartenberg or DH parameter vectors as input and returns the homogeneous transformation matrix and intermediary homogeneous transformation matrices.