Calculating Inverse Kinematics of a 6-DOF Robot with all revolute joints
The inverse_kinematics function returns the joint angles of a 6 degrees of freedom Robot Manipulator with all revolute joints, using the user input end effector's parameters (x y z coordinates, and roll-pitch-yaw angles), and necessary DH parameters providing the Robot's structure (a, alpha and d).