教程 | 阿克曼结构移动机器人的gazebo仿真（七）

最新推荐文章于 2024-05-23 18:16:39 发布

天之博特TIANBOT

最新推荐文章于 2024-05-23 18:16:39 发布

阅读量1.6k

点赞数

CC 4.0 BY-SA版权

分类专栏： TIANRACER F1TENTH 阿克曼结构移动机器⼈的gazebo仿真文章标签：自动驾驶人工智能机器学习

本文链接：https://blog.youkuaiyun.com/TIANBOT/article/details/124858516

本教程详细介绍了如何在Gazebo环境中配置阿克曼结构移动机器人的里程计，并使用gmapping进行二维地图构建。通过订阅/gazebo/link_states话题获取数据，发布里程计信息，然后安装并运行gmapping进行建图。最后，保存地图并设置rviz以便后续导航使用。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

第七章、配置小车里程计并用gmapping建图

1 前言

上一节写了用键盘控制节点控制仿真小车运动，这一节需要配置小车的里程计，并且在room_mini这个world中进行gmapping建图。

2 配置小车里程计

◇通过gazebo节点获取odom

从/gazebo/link_states话题中读取gazebo_msgs/LinKStates消息，再从msg.name.index中提取racebot::base_footprint位姿数据，将数据整理打包发布为里程计信息，在racebot_control/scripts中新建文件gazebo_odometry.py,代码如下：

#!/usr/bin/env python
'''
This script makes Gazebo less fail by translating gazebo status messages to odometry data.
Since Gazebo also publishes data faster than normal odom data, this script caps the update to 20hz.
Winter Guerra
'''
import rospy
from nav_msgs.msg import Odometry
from geometry_msgs.msg import Pose, Twist, Transform, TransformStamped
from gazebo_msgs.msg import LinkStates
from std_msgs.msg import Header
import numpy as np
import math
import tf2_ros
class OdometryNode:
    # Set publishers
    pub_odom = rospy.Publisher('/odom', Odometry, queue_size=1)
    def __init__(self):
        # init internals
        self.last_received_pose = Pose()
        self.last_received_twist = Twist()
        self.last_recieved_stamp = None
        # Set the update rate
        rospy.Timer(rospy.Duration(.05), self.timer_callback) # 20hz
        self.tf_pub = tf2_ros.TransformBroadcaster()
        # Set subscribers
        rospy.Subscriber('/gazebo/link_states', LinkStates, self.sub_robot_pose_update)
    def sub_robot_pose_update(self, msg):
        # Find the index of the racecar
        try:
            arrayIndex = msg.name.index('racebot::base_footprint')
        except ValueError as e:
            # Wait for Gazebo to startup