Forward Kinematic Of Six Degree Of Freedom For FANUC LR Mate 200iB.