[pose_broadcaster] Check for valid pose before attempting to publish a tf for it

[pose_broadcaster] Check for valid pose before attempting to publish a tf for it #542