Fixed static_transform_publisher duplicate check, added rostest.