Inverse Kinematics 6 Dof Robotic Arm, Try formulating the forward kinematics of the robot.