Get current end-effector pose

[anhtuduong]

ee pose will be published to this topic:

 self.pub_ee_pose = ros.Publisher("/ur5/ee_pose", geometry_msgs.msg.Pose, queue_size=1, tcp_nodelay=True)