[pose_broadcaster] Check for valid pose before attempting to publish a tf for it (backport #1479)

[pose_broadcaster] Check for valid pose before attempting to publish a tf for it (backport #1479) #565