mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 00:37:46 +08:00
19 lines
616 B
Python
19 lines
616 B
Python
|
#!/usr/bin/env python
|
||
|
|
import rospy
|
||
|
|
from geometry_msgs.msg import PoseWithCovarianceStamped
|
||
|
|
from nav_msgs.msg import Odometry
|
||
|
|
|
||
|
|
def callback(data):
|
||
|
|
odom = Odometry()
|
||
|
|
odom.header = data.header
|
||
|
|
odom.child_frame_id = child_frame_id
|
||
|
|
odom.pose = data.pose
|
||
|
|
pub.publish(odom)
|
||
|
|
|
||
|
|
if __name__ == '__main__':
|
||
|
|
rospy.init_node('pose_to_odom', anonymous=True)
|
||
|
|
pub = rospy.Publisher('odom_combined', Odometry, queue_size=1)
|
||
|
|
child_frame_id = rospy.get_param('~child_frame_id', "base_footprint")
|
||
|
|
rospy.Subscriber("/robot_pose_ekf/odom_combined", PoseWithCovarianceStamped, callback)
|
||
|
|
rospy.spin()
|