armTransform

代码说明：

  This function finds the forward kinematics of the RA-01 Robotic Arm made by Images SI, Inc. The RA-01 has five degrees of freedom. This funciton 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".