Used internal conversion from radians message to jaco angles to convert the trajectory point.
Added comments that explain angle unpacking.