Data Sheet

56
ArmKinematics.Forward(angle_rad, &CurrentPose);
Once moved to desired pose angle_rad(array) gets the end effector’s pose
and runs forward kinematics; then CurrentPose sets the pose. This function
returns the end effectors transform matric (4x4).