以前にもハマったことがある記憶があるので,メモ.

TF2にはStaticTransformBroadcasterというクラスがあり,TF2で追加された /tf_static というstatic transformをブロードキャストすることができます.使い方はこんな感じ:

import tf2_ros
from geometry_msgs.msg import TransformStamped

tf_sb = tf2_ros.StaticTransformBroadcaster()
tform = TransformStamped()
tform.header.frame_id = 'hoge'
# いろいろやる
tf_sb.sendTransform(tform)

ただ,一つのノードで複数のTransformをブロードキャストすると, rostopic echo /tf_static で最後の変換しか表示されません.

tf_sb.sendTransform(transform1)
tf_sb.sendTransform(transform2)
tf_sb.sendTransform(transform3)
# transform3しか使えない

どうやらStaticTransformBroadcasterは一つのTransformしか保持することができないらしいです.複数のTransformをブロードキャストしたいときは,まとめて送りましょう.

tforms = [transform1, transform2, transform3]
tf_sb.sendTransform(tforms)

ちなみにタプルを使うと Inbound TCP/IP connection failed: 'tuple' object has no attribute 'header' というエラーが出てダメな模様.リストを使いましょう.

複数クラスでStatic Transformを作るときは,結構めんどくさいです.TransformStampedを返すようにする等しないといけないみたいですね.