Publish robot state position in joint-to-marker-choreonoid test