Do you really need a Vector3Stamped publisher? The vector inside TransformStamped is not sufficient? Is it not redundant? Is this a requirement for SoT?