ur5_safe_cartesian. Translate geometry_msgs/Pose messages (cartesian pose) to sensor_msgs/JointState messages (joint positions) for the Universal Robots UR5 with reachability and static collision checking