Add a script to publish JointState to TF