ROS学习笔记20 —— rospy中tf树的发布_ros publish tf python

1. TF数据的发送

使用tf.TransformBroadcaster类完成tf树的发布，有两个函数：

• 法1： sendTransform(translation,rotation,time,child,parent)
• 法2：sendTransformMessage(transform)

法1：发送手动封装的tf数据

sendTransform(translation,rotation,time,child,parent)需要将父子farme之间的平移、旋转手动打时间戳，然后发给/tf

案例1：

#!/usr/bin/env python  
# -*- coding:utf-8 -*-  
import tf
import rospy

if __name__ == '__main__':
	rospy.init_node('tf_test_node')
	br = tf.TransformBroadcaster()
	while not rospy.is_shutdown():
		br.sendTransform((1,2,0),
				tf.transformations.quaternion_from_euler(0,0,0),
				rospy.Time.now(),"world","test") 
1
2
3
4
5
6
7
8
9
10
11
12

案例2：

#!/usr/bin/env python  
# -*- coding:utf-8 -*-  

import rospy  
import math  
import tf   
  
if __name__ == '__main__':  
    rospy.init_node('py_tf_broadcaster')
    
    br = tf.TransformBroadcaster()

    x=1.0 
    y=2.0
    z=3.0  
    roll=0 
    pitch=0
    yaw=1.57 
    rate = rospy.Rate(1)
    while not rospy.is_shutdown(): 
        yaw=yaw+0.1   
        br.sendTransform((x,y,z),  
                     tf.transformations.quaternion_from_euler(roll,pitch,yaw),  
                     rospy.Time.now(),  
                     "base_link",  
                     "link1")  
        rate.sleep()  

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28

法2：发布已经封装好的tf数据

sendTransformMessage(transform)发送的是已经封装好的Message

案例：

#!/usr/bin/env python  
# -*- coding:utf-8 -*-  

import rospy 
import geometry_msgs.msg
import tf2_ros.transform_broadcaster
import math  
import tf   
  
if __name__ == '__main__':  
    rospy.init_node('py_tf_broadcaster')
   
    m=tf.TransformBroadcaster()
    t = geometry_msgs.msg.TransformStamped()
    t.header.frame_id = 'base_link'
    t.header.stamp = rospy.Time(0)
    t.child_frame_id = 'link1'
    t.transform.translation.x = 1
    t.transform.translation.y = 2
    t.transform.translation.z = 3
    t.transform.rotation.w=1
    t.transform.rotation.x=0
    t.transform.rotation.y=0
    t.transform.rotation.z=0
	
	#输入相对原点的值和欧拉角
    rate = rospy.Rate(1)
    while not rospy.is_shutdown():
        m.sendTransformMessage(t)
        rate.sleep()  

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31

2. TF树的查看

（1）查看当前tf树：

rosrun rqt_tf_tree rqt_tf_tree
1

（2）查看两个frame的变换关系

rosrun tf tf_echo [reference_frame] [target_frame]
1

（3）根据当前tf树创建一个pdf图

rosrun tf view_frames
1

3. 定义位姿的常用API

（1）定义空间点和空间向量

（2）定义四元数

（3）欧拉角、位姿矩阵及四元数的转换

参考：

• https://www.icourse163.org/course/ISCAS-1002580008