Autolabor Simulation Base 模块介绍

功能介绍

Autolabor Simulation Base 主要用于模拟差速转向的移动机器人底盘,其运作模式为订阅 ROS速度信息 ,根据底盘自身参数限制(这里主要限制因素有最大速度与最大加速度),以及设置的噪音参数模拟小车运行速度。并根据速度控制小车在X-Y平面中行驶。

小车在运行过程中会发布 ROS里程计信息 此处里程计数据中包含噪声,用于模拟真实情况下的里程计数据。

同时该模块会发布两个坐标转换信息

  • 里程计坐标系 ——> 小车底盘坐标系 的坐标转换
  • 小车底盘坐标系 ——> 真实坐标系 的坐标转换

note

在ROS中坐标转换树中,一个子节点最多只能有一个父节点。作为子节点 小车底盘坐标系 不能同时拥有两个坐标系(里程计坐标系,*真实坐标系),所以在坐标转换树中将真实坐标系* 作为 小车底盘坐标系 的子节点。

节点信息

订阅话题

话题名称:/cmd_vel

消息类型:geometry_msgs/Twist

话题说明:用于控制机器人地盘运动的速度指令

geometry_msgs/Twist 数据类型说明

geometry_msgs/Vector3 linear    线速度 单位为 m/s
  float64 x                     前后移动的速度,+表示向前,-表示向后
  float64 y                     左右移动的速度,+表示向左,-表示向右
  float64 z                     上下移动的速度,+表示向上,-表示向下
geometry_msgs/Vector3 angular   角速度 单位为 rad/s
  float64 x                     横滚角速度,正负号依据右手法则决定
  float64 y                     俯仰角速度,正负号依据右手法则决定
  float64 z                     航向角速度,俯视小车时,+表示逆时针旋转,-表示顺时针旋转

小车使用差速转向,仅能前后运动,所以在 线速度 中只有 X分量 有数据,其余分量为0
小车在水平面行驶,仅能水平转动,所以在 角速度 中只有 Z分量 有数据,其余分量为0

发布话题

话题名称:/odom

消息类型:nav_msgs/Odometry

话题说明:发布机器人的轮速里程计信息(此处数据带有噪音)

nav_msgs/Odometry 数据类型说明

std_msgs/Header header                     数据头信息
  uint32 seq                               数据序列号
  time stamp                               数据时间戳信息
  string frame_id                          姿态数据(pose)所处的坐标系
string child_frame_id                      速度数据(twist)所在的坐标系
geometry_msgs/PoseWithCovariance pose
  geometry_msgs/Pose pose                  里程计姿态数据信息
    geometry_msgs/Point position           里程计姿态数据的位置信息
      float64 x
      float64 y
      float64 z
    geometry_msgs/Quaternion orientation   里程计姿态数据的方向信息(四元数)
      float64 x
      float64 y
      float64 z
      float64 w
  float64[36] covariance                   姿态数据的协方差矩阵(x, y, z, roll, pitch, yaw)
geometry_msgs/TwistWithCovariance twist    里程计速度数据信息
  geometry_msgs/Twist twist
    geometry_msgs/Vector3 linear           线速度信息
      float64 x
      float64 y
      float64 z
    geometry_msgs/Vector3 angular          角速度信息
      float64 x
      float64 y
      float64 z
  float64[36] covariance                   速度信息的协方差矩阵(vx, vy, vz, v_roll, v_pitch, v_yaw)

节点参数


参数名称:~odom_frame

参数类型:string

默认数据:odom

参数说明:里程计坐标系的名称


参数名称:~base_link_frame

参数类型:string

默认数据:base_link

参数说明:小车坐标系的名称


参数名称:~real_map_frame

参数类型:string

默认数据:real_map

参数说明:真实坐标系的名称


参数名称:~noise_v_linear

参数类型:double

默认数据:0.0

参数限制:必须大于等于0

参数说明:模拟行驶过程中在线速度中添加白噪音的标准差,单位为m/s,默认为不添加噪音


参数名称:~noise_v_theta

参数类型:double

默认数据:0.0

参数限制:必须大于等于0

参数说明:模拟行驶过程中在角速度中添加白噪音的标准差,单位为rad/s,默认为不添加噪音


参数名称:~max_a_linear

参数类型:double

默认数据:999.0

参数限制:必须大于0

参数说明:小车底盘行驶最大线加速度,单位为 m/s^2, 默认是一个比较大的值,在正常模拟情况下。小车能直接达到所给的速度


参数名称:~max_a_theta

参数类型:double

默认数据:999.0

参数限制:必须大于0

参数说明:小车底盘行驶最大角加速度,单位为 rad/s^2, 默认是一个比较大的值,在正常模拟情况下。小车能直接达到所给的速度


参数名称:~max_v_linear

参数类型:double

默认数据:1.0

参数限制:必须大于0

参数说明:小车底盘行驶线速度绝对值的最大值,单位为 m/s,比如在默认情况下,小车行驶速度为 -1.0 m/s \leq v \leq 1.0 m/s, 当控制速度超出这个范围,小车按照离控制速度最近的极值运行


参数名称:~max_v_theta

参数类型:double

默认数据:1.57

参数限制:必须大于0

参数说明:小车底盘行驶角速度绝对值的最大值,单位为 rad/s,说明与 max_v_linear 类似


参数名称:~rate

参数类型:int

默认数据:30

参数限制:必须大于0

参数说明:小车模拟行驶更新位置的频率,也是里程计信息发布的频率,这个值越大,小车模拟行驶越平滑,同时需要计算量也就越大


使用示例

以下的实验步骤必须在安装好ROS环境以及编译Autolabor Simulation功能包的基础下进行,如果您还未执行上述操作,请先参考前面的使用文档。假设ROS工作目录为 ~/catkin_ws,并且Autolabor Simulation的源码放在 ~/catkin_ws/src 中,如果你的环境和上述不一致,需要在下面的脚本中做相应的替换。

进入ROS工作目录

cd ~/catkin_ws

编译模拟器(如果您已经编译过,可忽略此步)

catkin_make

添加模拟器相关环境变量

source devel/setup.bash

进入autolabor_simulation_base包的launch文件夹

roscd autolabor_simulation_base/launch

创建ROS脚本文件

echo '<!-- autolabor_simulation_base demo -->
<launch>
    <arg name="model" />
    <arg name="gui" default="false" />

    <param name="use_sim_time" value="false"/>
    <param name="robot_description" textfile="$(find autolabor_description)/urdf/autolabor_pro1.urdf" />
    <param name="use_gui" value="$(arg gui)" />

    <node pkg="autolabor_simulation_base" type="simulation_base_node" name="autolabor_driver" output="screen">
        <param name="odom_frame" value="odom"/>
        <param name="base_link_frame" value="base_link"/>
        <param name="real_map_frame" value="real_map"/>

        <param name="noise_v_linear" value="0"/>
        <param name="noise_v_theta" value="0"/>

        <param name="max_a_linear" value="999.0"/>
        <param name="max_a_theta" value="999.0"/>

        <param name="max_v_linear" value="1.0"/>
        <param name="max_v_theta" value="1.57"/>

        <param name="rate" value="100"/>
    </node>

    <node name="keyboard_control" pkg="autolabor_keyboard_control" type="keyboard_control_node">
        <param name="linear_min" value="0.2" />
        <param name="linear_max" value="1.0" />
        <param name="linear_step" value="0.2" />

        <param name="angular_min" value="0.5" />
        <param name="angular_max" value="1.57" />
        <param name="angular_step" value="0.5" />
    </node>

    <node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" />
    <node name="robot_state_publisher" pkg="robot_state_publisher" type="state_publisher" />
    <node name="rviz" pkg="rviz" type="rviz"/>
</launch>
' > demo_simulation_base.launch

执行刚才我们建立的ROS脚本

roslaunch autolabor_simulation_base demo_simulation_base.launch

此时我们会发现打开了一个窗口,如图所示

rviz窗口

在rviz的左侧Displays窗口,找到 Global Options -> Fixed Frame,并将后面的值选成odom,如下图

修改Fixed Frame

点击rviz左下角的Add按钮,在跳出的窗口中选择 rviz -> TF,并单击OK按钮

Add TF

同上操作步骤,点击rviz左下角的Add按钮,添加 rviz -> RobotModel,并单击OK按钮

Add RobotModel

我们在中间区域看到一个小黄车,此时我们就可以使用键盘上的上,下,左,右控制小车行进。

控制小车行驶

我们再来详细看一下坐标转换关系,关闭小车模型,将视窗放大。

TF转换关系

根据默认设置,base_link表示小车坐标系,随着通过键盘控制,base_link坐标系在移动,在中间两个静止的坐标系分别是odom(里程计编码器)和real_map(真实坐标系)。由于我们没有设置里程计噪音real_map和odom始终重合,也就意味着里程计信息完全准确。

这个时候我们可以尝试修改ROS脚本文件demo_simulation_base.launch,将noise_v_linear改成0.2,noise_v_theta改成0.5。

首先在刚才打开Terminal的窗口使用Ctrl+C,结束之前的命令,并输入下面内容。

sed -i 's/<param name="noise_v_linear" value="0"\/>/<param name="noise_v_linear" value="0.2"\/>/' demo_simulation_base.launch
sed -i 's/<param name="noise_v_theta" value="0"\/>/<param name="noise_v_theta" value="0.5"\/>/' demo_simulation_base.launch

此时再运行该脚本

roslaunch autolabor_simulation_base demo_simulation_base.launch

按照上面的方法在rviz中添加tf数据显示

带噪音的情况

会发现在小车行驶过程中,odom和real_map之间发生相对变化,这个变化就是里程计偏离真实位置的情况。

©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 151,511评论 1 330
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 64,495评论 1 273
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 101,595评论 0 225
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 42,558评论 0 190
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 50,715评论 3 270
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 39,672评论 1 192
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 31,112评论 2 291
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 29,837评论 0 181
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 33,417评论 0 228
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 29,928评论 2 232
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 31,316评论 1 242
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 27,773评论 2 234
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 32,253评论 3 220
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 25,827评论 0 8
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 26,440评论 0 180
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 34,523评论 2 249
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 34,583评论 2 249

推荐阅读更多精彩内容