Forward Kinematics of RA-01 Robotic Arm

This function finds the forward kinematics of the RA-01 Robotic Arm made by Images SI, Inc., New York. The RA-01 has five degrees of freedom. This function outputs two vectors. The first vector is the forward kinematics of the central position of the end effector, while the second vector is the forward kinematics of a finger of the end effector (a gripper). Note that it does not matter which finger it is as the position of one finger is simply the negative of the other hence, the value gotten for the y-direction is actually "plus or minus y".