作业：ROS机器人小车建模仿真与SLAM

ROS机器人小车建模仿真与SLAM

## ROS中机器小车的仿真实验

一.建立模型

####1.创建功能包

mkdir -p catkin_ws/src
cd catkin_ws/src
catkin_init_workspace

导入依赖：

catkin_create_pkg jubot_demo urdf xacro 
cd jubot_demo/
mkdir urdf
mkdir launch
mkdir meshes
mkdir config

创建urdf,launch文件：

<launch>
 
  <!-- 将 urdf 文件内容设置进参数服务器 -->
  <param name="robot_description" textfile="$(find jubot_demo)/urdf/box_urdf.urdf" />
 
  <!-- 启动 rviz -->
  <!-- <node pkg="rviz" type="rviz" name="rviz" /> -->
  <node pkg="rviz" type="rviz" name="rviz" args="-d $(find jubot_demo)/config/rviz/show_four_wheel_car.rviz" />
 
  <!-- 启动机器人状态和关节状态发布节点 -->
  <node pkg="robot_state_publisher" type="robot_state_publisher" name="robot_state_publisher" />
  <node pkg="joint_state_publisher" type="joint_state_publisher" name="joint_state_publisher" />
 
  <!-- 启动图形化的控制关节运动节点 -->
  <node pkg="joint_state_publisher_gui" type="joint_state_publisher_gui" name="joint_state_publisher_gui" />
 
 
</launch>

urdf:

<!-- <robot name="mycar">
    <link name="base_link">
        <visual>
            <geometry>
                <box size="0.5 0.2 0.1" />
            </geometry>
        </visual>
    </link>
</robot> -->
 
 
 
<robot name="mycar">
  <!-- 设置 base_footprint  -->
  <link name="base_footprint">
    <visual>
      <geometry>
        <sphere radius="0.001" />
      </geometry>
    </visual>
  </link>
 
  <!-- 添加底盘 -->
  <!-- 
        参数
            形状:圆柱 
            半径:10     cm 
            高度:8      cm 
            离地:1.5    cm
 
    -->
  <link name="base_link">
    <visual>
      <geometry>
        <cylinder radius="0.1" length="0.08" />
      </geometry>
      <origin xyz="0 0 0" rpy="0 0 0" />
      <material name="yellow">
        <color rgba="0.8 0.3 0.1 0.5" />
      </material>
    </visual>
  </link>
 
  <joint name="base_link2base_footprint" type="fixed">
    <parent link="base_footprint" />
    <child link="base_link"/>
    <origin xyz="0 0 0.055" />
  </joint>
 
  <!-- 添加驱动轮 -->
  <!-- 添加驱动轮 -->
  <!--
        驱动轮是侧翻的圆柱
        参数
            半径: 3.25 cm
            宽度: 1.5  cm
            颜色: 黑色
        关节设置:
            x = 0
            y = 底盘的半径 + 轮胎宽度 / 2
            z = 离地间距 + 底盘长度 / 2 - 轮胎半径 = 1.5 + 4 - 3.25 = 2.25(cm)
            axis = 0 1 0
    -->
  <link name="left_wheel">
    <visual>
      <geometry>
        <cylinder radius="0.0325" length="0.015" />
      </geometry>
      <origin xyz="0 0 0" rpy="1.5705 0 0" />
      <material name="black">
        <color rgba="0.0 0.0 0.0 1.0" />
      </material>
    </visual>
 
  </link>
 
  <joint name="left_wheel2base_link" type="continuous">
    <parent link="base_link" />
    <child link="left_wheel" />
    <origin xyz="0 0.1 -0.0225" />
    <axis xyz="0 1 0" />
  </joint>
 
 
  <link name="right_wheel">
    <visual>
      <geometry>
        <cylinder radius="0.0325" length="0.015" />
      </geometry>
      <origin xyz="0 0 0" rpy="1.5705 0 0" />
      <material name="black">
        <color rgba="0.0 0.0 0.0 1.0" />
      </material>
    </visual>
 
  </link>
 
  <joint name="right_wheel2base_link" type="continuous">
    <parent link="base_link" />
    <child link="right_wheel" />
    <origin xyz="0 -0.1 -0.0225" />
    <axis xyz="0 1 0" />
 
  </joint>
 
 
  <!-- 添加万向轮(支撑轮) -->
  <!-- 添加万向轮(支撑轮) -->
  <!--
        参数
            形状: 球体
            半径: 0.75 cm
            颜色: 黑色
 
        关节设置:
            x = 自定义(底盘半径 - 万向轮半径) = 0.1 - 0.0075 = 0.0925(cm)
            y = 0
            z = 底盘长度 / 2 + 离地间距 / 2 = 0.08 / 2 + 0.015 / 2 = 0.0475 axis= 1 1 1
 
    -->
  <link name="front_wheel">
    <visual>
      <geometry>
        <sphere radius="0.0075" />
      </geometry>
      <origin xyz="0 0 0" rpy="0 0 0" />
      <material name="black">
        <color rgba="0.0 0.0 0.0 1.0" />
      </material>
    </visual>
  </link>
 
  <joint name="front_wheel2base_link" type="continuous">
    <parent link="base_link" />
    <child link="front_wheel" />
    <origin xyz="0.0925 0 -0.0475" />
    <axis xyz="1 1 1" />
  </joint>
 
  <link name="back_wheel">
    <visual>
      <geometry>
        <sphere radius="0.0075" />
      </geometry>
      <origin xyz="0 0 0" rpy="0 0 0" />
      <material name="black">
        <color rgba="0.0 0.0 0.0 1.0" />
      </material>
    </visual>
  </link>
 
  <joint name="back_wheel2base_link" type="continuous">
    <parent link="base_link" />
    <child link="back_wheel" />
    <origin xyz="-0.0925 0 -0.0475" />
    <axis xyz="1 1 1" />
  </joint>
</robot>

2.可视化

先编译配置launch文件，退到主目录catkin_ws下，执行catkin_make。

成功之后，再执行 catkin_make install。
然后在主目录catkin_make下配置环境变量source devel/setup.bash。

检测环境变量是否配置成功echo $ROS_PACKAGE_PATH。

再启动launch文件，完成可视化的建立：