gazebo構建仿真場景並製作機器人模型

仿真軟件介紹與製作sdf模型文件：https://blog.csdn.net/kevin_chan04/article/details/78467218

構建仿真場景：https://blog.csdn.net/qq_36355662/article/details/80030372

編寫xacro仿真模型文件和rviz launch文件：https://zhuanlan.zhihu.com/p/67741739

gazebo中構建一個仿真的地圖非常的簡單，因爲他提供了很多的地圖模型，可以直接拖到界面中使用，但是首先需要下載相關的模型：

1.模型下載

1、直接從終端下載，執行以下命令

cd ~/.gazebo/

mkdir -p models
cd ~/.gazebo/models/
wget http://file.ncnynl.com/ros/gazebo_models.txt
wget -i gazebo_models.txt
ls model.tar.g* | xargs -n1 tar xzvf

2.利用百度網盤和國內官網下載

全部模型有大約200多M，但在線下載速度非常慢，晚上離開實驗室早上來了就下完了。不過現在小夥伴已經將其共享至網盤，可直接下載，然後將其解壓至~/.gazebo/models裏。

鏈接：http://pan.baidu.com/s/1pKaeg0F 密碼：cmxc （來自rosclub.cn）

百度網盤和國內官網並沒有及時保持和官網同步更新，推薦大家還是通過官網下載，實在是慢的話可以通過百度網盤和ExBot ROS 專區下載。

下載後把文件放在.gazebo下的models

1.1製作簡單的場景地圖

製作簡單的矩形場地可以直接進入 Edit-->Building Editor,然後選擇牆壁拖拽即可，如圖所示，編輯完成之後選擇File-->save as-->選擇目錄，編輯名字，即可保存一個文件夾，裏面有兩個文件後綴名分別爲.config和.sdf格式。再次點擊File-->exit,點擊確認之後退出，再次點擊File->Save World As選擇目錄即可保存地圖，地圖格式爲xxx.world。

2.製作機器人模型

2.1定義機器人主體部分

爲了在 gazebo 中導入機器人模型，你需要先完成 URDF 模型。在這裏我們將使用.xacro文件，雖然這可能更復雜，但是對於代碼開發來說其功能非常強大。

我們首先將機器人的經常用到的值，使用變量進行定義，主要包括常用常數以及機器人屬性：

    <!-- PROPERTY LIST --> 
    <xacro:property name="M_PI" value="3.1415926"/> 
    <!--圓柱體的定義需要長度length及半徑radius-->   
  <xacro:property name="base_radius" value="0.20"/>    
 <xacro:property name="base_length" value="0.16"/>   
  <!--輪子也是一種圓柱體，同時要通過關節與主體連接 -->   
  <xacro:property name="wheel_radius" value="0.06"/>  
   <xacro:property name="wheel_length" value="0.025"/>   
  <!--關節的位置屬性定義，由於關節需要將主體與輪子無縫連接，因此在x或者y方向上，一般定義爲主體半徑大小 --> 
    <xacro:property name="wheel_joint_y" value="0.19"/>     
<xacro:property name="wheel_joint_z" value="0.05"/>     
<!-- -->     <xacro:property name="caster_radius" value="0.015"/>       
<!-- wheel_radius - ( base_length/2 - wheel_joint_z) -->     
<xacro:property name="caster_joint_x" value="0.18"/>

接下來進行顏色定義：

 <!-- Defining the colors used in this robot -->     
<material name="yellow">
         <color rgba="1 0.4 0 1"/>
     </material>
     <material name="black"> 
        <color rgba="0 0 0 0.95"/>
     </material>     <material name="gray">
         <color rgba="0.75 0.75 0.75 1"/>
     </material>

通過宏定義機器人的輪子，方便代碼複用：

<xacro:macro name="wheel" 
params="prefix reflect"> 
<joint name="${prefix_wheel_joint} " type="continuous"> 
<!--continuous 表示是可以360度旋轉的joint-->
     <origin xyz="0 ${reflect*wheel_joint_y} 
${-wheel_joint_z}" rpy="0 0 0"/> 
    <parent link="base_link"/>
     <child link="${prefix}_wheel_link"/>
     <axis xyz="0 1 0"/>
 </joint>
 <link name="${prefix}_wheel_link">
             <visual>
                 <origin xyz="0 0 0" rpy="${M_PI/2} 0 0" />
                 <geometry>
                     <cylinder radius="${wheel_radius}" length = "${wheel_length}"/>
                 </geometry>
                 <material name="gray" />
             </visual> </link> </xacro:macro>

定義機器人的支撐輪：

 <!-- Macro for robot caster --> 
    <xacro:macro name="caster" params="prefix reflect"> 
        <joint name="${prefix}_caster_joint" type="continuous">
         <!---(base_length/2 + caster_radius)表示一半在外面，一半在裏面-->
             <origin xyz="${reflect*caster_joint_x} 0 ${-(base_length/2 + caster_radius)}" rpy="0 0 0"/>
             <parent link="base_link"/> 
            <child link="${prefix}_caster_link"/> 
            <axis xyz="0 1 0"/> 
        </joint> 
         <link name="${prefix}_caster_link"> 
            <visual> 
                <origin xyz="0 0 0" rpy="0 0 0"/> 
                <geometry>
                     <sphere radius="${caster_radius}" /> 
                </geometry>
                 <material name="black" /> 
            </visual>
         </link>
     </xacro:macro>

定義機器人主體：

   <xacro:macro name="mbot_base">
             <link name="base_link">
             <visual>
                 <origin xyz=" 0 0 0" rpy="0 0 0" /> 
                <geometry>
                     <cylinder length="${base_length}" radius="${base_radius}"/> 
                </geometry> 
                <material name="yellow" /> 
            </visual> 
        </link> 
         <wheel prefix="left" reflect="-1"/>
         <wheel prefix="right" reflect="1"/>
          <caster prefix="front" reflect="-1"/>
         <caster prefix="back" reflect="1"/>     </xacro:macro>

<visual></visual>中內容爲在rviz 中顯示相應的模型，collision中的內容爲gazebo中的物理模型。

        <link name="base_link">
            <visual>
                <origin xyz=" 0 0 0" rpy="0 0 0" />
                <geometry>
                    <cylinder length="${base_length}" radius="${base_radius}"/>
                </geometry>
                <material name="yellow" />
            </visual>
            <collision>
                <origin xyz=" 0 0 0" rpy="0 0 0" />
                <geometry>
                    <cylinder length="${base_length}" radius="${base_radius}"/>
                </geometry>
            </collision> 
            併爲該關節設置物理慣性
            <cylinder_inertial_matrix  m="${base_mass}" r="${base_radius}" h="${base_length}" />
        </link>

設置機器人主體與地圖的關聯，地圖爲parent,主體味child,相對關係有origin xyz確定

      <joint name="base_footprint_joint" type="fixed">
            <origin xyz="0 0 ${base_length/2 + caster_radius*2}" rpy="0 0 0" />        
            <parent link="base_footprint"/>
            <child link="base_link" />
        </joint>

完整代碼如下：

<?xml version="1.0"?>
<robot name="mbot" xmlns:xacro="http://www.ros.org/wiki/xacro">

    <!-- PROPERTY LIST -->
    <xacro:property name="M_PI" value="3.1415926"/>
    <xacro:property name="base_mass"   value="20" /> 
    <xacro:property name="base_radius" value="0.2"/>
    <xacro:property name="base_length" value="0.16"/>

    <xacro:property name="wheel_mass"   value="2" />
    <xacro:property name="wheel_radius" value="0.06"/>
    <xacro:property name="wheel_length" value="0.025"/>
    <xacro:property name="wheel_joint_y" value="0.19"/>
    <xacro:property name="wheel_joint_z" value="0.05"/>

    <xacro:property name="caster_mass"    value="0.5" /> 
    <xacro:property name="caster_radius"  value="0.015"/> <!-- wheel_radius - ( base_length/2 - wheel_joint_z) -->
    <xacro:property name="caster_joint_x" value="0.18"/>

    <!-- Defining the colors used in this robot -->
    <material name="yellow">
        <color rgba="1 0.4 0 1"/>
    </material>
    <material name="black">
        <color rgba="0 0 0 0.95"/>
    </material>
    <material name="gray">
        <color rgba="0.75 0.75 0.75 1"/>
    </material>
    
    <!-- Macro for inertia matrix -->
    <xacro:macro name="sphere_inertial_matrix" params="m r">
        <inertial>
            <mass value="${m}" />
            <inertia ixx="${2*m*r*r/5}" ixy="0" ixz="0"
                iyy="${2*m*r*r/5}" iyz="0" 
                izz="${2*m*r*r/5}" />
        </inertial>
    </xacro:macro>

    <xacro:macro name="cylinder_inertial_matrix" params="m r h">
        <inertial>
            <mass value="${m}" />
            <inertia ixx="${m*(3*r*r+h*h)/12}" ixy = "0" ixz = "0"
                iyy="${m*(3*r*r+h*h)/12}" iyz = "0"
                izz="${m*r*r/2}" /> 
        </inertial>
    </xacro:macro>

    <!-- Macro for robot wheel -->
    <xacro:macro name="wheel" params="prefix reflect">
        <joint name="${prefix}_wheel_joint" type="continuous">
            <origin xyz="0 ${reflect*wheel_joint_y} ${-wheel_joint_z}" rpy="0 0 0"/>
            <parent link="base_link"/>
            <child link="${prefix}_wheel_link"/>
            <axis xyz="0 1 0"/>
        </joint>

        <link name="${prefix}_wheel_link">
            <visual>
                <origin xyz="0 0 0" rpy="${M_PI/2} 0 0" />
                <geometry>
                    <cylinder radius="${wheel_radius}" length = "${wheel_length}"/>
                </geometry>
                <material name="gray" />
            </visual>
            <collision>
                <origin xyz="0 0 0" rpy="${M_PI/2} 0 0" />
                <geometry>
                    <cylinder radius="${wheel_radius}" length = "${wheel_length}"/>
                </geometry>
            </collision>
            <cylinder_inertial_matrix  m="${wheel_mass}" r="${wheel_radius}" h="${wheel_length}" />
        </link>

        <gazebo reference="${prefix}_wheel_link">
            <material>Gazebo/Gray</material>
        </gazebo>

        <!-- Transmission is important to link the joints and the controller -->
        <transmission name="${prefix}_wheel_joint_trans">
            <type>transmission_interface/SimpleTransmission</type>
            <joint name="${prefix}_wheel_joint" >
                <hardwareInterface>hardware_interface/VelocityJointInterface</hardwareInterface>
            </joint>
            <actuator name="${prefix}_wheel_joint_motor">
                <hardwareInterface>hardware_interface/VelocityJointInterface</hardwareInterface>
                <mechanicalReduction>1</mechanicalReduction>
            </actuator>
        </transmission>
    </xacro:macro>

    <!-- Macro for robot caster -->
    <xacro:macro name="caster" params="prefix reflect">
        <joint name="${prefix}_caster_joint" type="continuous">
            <origin xyz="${reflect*caster_joint_x} 0 ${-(base_length/2 + caster_radius)}" rpy="0 0 0"/>
            <parent link="base_link"/>
            <child link="${prefix}_caster_link"/>
            <axis xyz="0 1 0"/>
        </joint>

        <link name="${prefix}_caster_link">
            <visual>
                <origin xyz="0 0 0" rpy="0 0 0"/>
                <geometry>
                    <sphere radius="${caster_radius}" />
                </geometry>
                <material name="black" />
            </visual>
            <collision>
                <origin xyz="0 0 0" rpy="0 0 0"/>
                <geometry>
                    <sphere radius="${caster_radius}" />
                </geometry>
            </collision>      
            <sphere_inertial_matrix  m="${caster_mass}" r="${caster_radius}" />
        </link>

        <gazebo reference="${prefix}_caster_link">
            <material>Gazebo/Black</material>
        </gazebo>
    </xacro:macro>

    <xacro:macro name="mbot_base_gazebo">
        <link name="base_footprint">
            <visual>
                <origin xyz="0 0 0" rpy="0 0 0" />
                <geometry>
                    <box size="0.001 0.001 0.001" />
                </geometry>
            </visual>
        </link>
        <gazebo reference="base_footprint">
            <turnGravityOff>false</turnGravityOff>
        </gazebo>

        <joint name="base_footprint_joint" type="fixed">
            <origin xyz="0 0 ${base_length/2 + caster_radius*2}" rpy="0 0 0" />        
            <parent link="base_footprint"/>
            <child link="base_link" />
        </joint>

        <link name="base_link">
            <visual>
                <origin xyz=" 0 0 0" rpy="0 0 0" />
                <geometry>
                    <cylinder length="${base_length}" radius="${base_radius}"/>
                </geometry>
                <material name="yellow" />
            </visual>
            <collision>
                <origin xyz=" 0 0 0" rpy="0 0 0" />
                <geometry>
                    <cylinder length="${base_length}" radius="${base_radius}"/>
                </geometry>
            </collision>   
            <cylinder_inertial_matrix  m="${base_mass}" r="${base_radius}" h="${base_length}" />
        </link>

        <gazebo reference="base_link">
            <material>Gazebo/Yellow</material>
        </gazebo>

        <wheel prefix="left"  reflect="-1"/>
        <wheel prefix="right" reflect="1"/>

        <caster prefix="front" reflect="-1"/>
        <caster prefix="back"  reflect="1"/>

        <!-- controller -->
        <gazebo>
            <plugin name="differential_drive_controller" 
                    filename="libgazebo_ros_diff_drive.so">
                <rosDebugLevel>Debug</rosDebugLevel>
                <publishWheelTF>true</publishWheelTF>
                <!--robotNamespace>/</robotNamespace-->
                <publishTf>1</publishTf>
                <publishWheelJointState>true</publishWheelJointState>
                <alwaysOn>true</alwaysOn>
                <updateRate>100.0</updateRate>
                <legacyMode>true</legacyMode>
                <leftJoint>left_wheel_joint</leftJoint>
                <rightJoint>right_wheel_joint</rightJoint>
                <wheelSeparation>${wheel_joint_y*2}</wheelSeparation>
                <wheelDiameter>${2*wheel_radius}</wheelDiameter>
                <broadcastTF>1</broadcastTF>
                <wheelTorque>30</wheelTorque>
                <wheelAcceleration>1.8</wheelAcceleration>
                <commandTopic>cmd_vel</commandTopic>
                <odometryFrame>odom</odometryFrame> 
                <odometryTopic>odom</odometryTopic> 
                <robotBaseFrame>base_footprint</robotBaseFrame>
            </plugin>
        </gazebo> 
    </xacro:macro>

</robot>

2.2編寫激光雷達模型文件lidar_gazebo.xacro文件

<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="laser">

    <xacro:macro name="rplidar" params="prefix:=laser">
        <!-- Create laser reference frame -->
        <link name="${prefix}_link">
            <inertial>
                <mass value="0.1" />
                <origin xyz="0 0 0" />
                <inertia ixx="0.01" ixy="0.0" ixz="0.0"
                         iyy="0.01" iyz="0.0"
                         izz="0.01" />
            </inertial>

            <visual>
                <origin xyz=" 0 0 0 " rpy="0 0 0" />
                <geometry>
                    <cylinder length="0.05" radius="0.05"/>
                </geometry>
                <material name="black"/>
            </visual>

            <collision>
                <origin xyz="0.0 0.0 0.0" rpy="0 0 0" />
                <geometry>
                    <cylinder length="0.06" radius="0.05"/>
                </geometry>
            </collision>
        </link>
        <gazebo reference="${prefix}_link">
            <material>Gazebo/Black</material>
        </gazebo>

        <gazebo reference="${prefix}_link">
            <sensor type="ray" name="rplidar">
                <pose>0 0 0 0 0 0</pose>
                <visualize>false</visualize>
                <update_rate>5.5</update_rate>
                <ray>
                    <scan>
                      <horizontal>
                        <samples>360</samples>
                        <resolution>1</resolution>
                        <min_angle>-3</min_angle>
                        <max_angle>3</max_angle>
                      </horizontal>
                    </scan>
                    <range>
                      <min>0.10</min>
                      <max>6.0</max>
                      <resolution>0.01</resolution>
                    </range>
                    <noise>
                      <type>gaussian</type>
                      <mean>0.0</mean>
                      <stddev>0.01</stddev>
                    </noise>
                </ray>
                <plugin name="gazebo_rplidar" filename="libgazebo_ros_laser.so">
                    <topicName>scan</topicName>
                    <frameName>laser_link</frameName>
                </plugin>
            </sensor>
        </gazebo>

    </xacro:macro>
</robot>

2.3編寫主文件mbot_with_laser_gazebo.xacro

<?xml version="1.0"?>
<robot name="arm" xmlns:xacro="http://www.ros.org/wiki/xacro">

    <xacro:include filename="$(find mbot_description)/urdf/xacro/gazebo/mbot_base_gazebo.xacro" />
    <xacro:include filename="$(find mbot_description)/urdf/xacro/sensors/lidar_gazebo.xacro" />

    <xacro:property name="lidar_offset_x" value="0" />
    <xacro:property name="lidar_offset_y" value="0" />
    <xacro:property name="lidar_offset_z" value="0.16" />

    <!-- lidar -->
    <joint name="lidar_joint" type="fixed">
        <origin xyz="${lidar_offset_x} ${lidar_offset_y} ${lidar_offset_z}" rpy="0 0 0" />
        <parent link="base_link"/>
        <child link="laser_link"/>
    </joint>

    <xacro:rplidar prefix="laser"/>

    <mbot_base_gazebo/>

</robot>

3.rviz launch文件編寫

這裏我們首先驗證，其是否可以在rviz中進行顯示，編寫rviz的launch文件。

joint_state_publisher、robot_state_publisher、rviz是進行機器人仿真的必備節點。

   <!-- 運行joint_state_publisher節點，發佈機器人的關節狀態  -->
	<node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" />

	<!-- 運行robot_state_publisher節點，發佈tf  -->
	<node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher" />

    <!-- 運行rviz可視化界面 args="-d $(find mbot_sim)/config/mbot.rviz"-->
	<node name="rviz" pkg="rviz" type="rviz"  required="true" />

同時運行我們剛剛設定好的xacro文件以及關節控制插件：

	<arg name="model" default="$(find xacro)/xacro --inorder '$(find mbot_sim)/urdf/xacro/mbot.xacro'" />
	<arg name="gui" default="true" />
    <!--命令行參數，表示執行此命令-->
	<param name="robot_description" command="$(arg model)" />

    <!-- 設置GUI參數，顯示關節控制插件 -->
	<param name="use_gui" value="$(arg gui)"/>

rviz launch文件完整內容：mbot_laser_gazebo.launch 文件，並加載自己構建的地圖rectangle2.world

<launch>

    <!-- 設置launch文件的參數 -->
    <arg name="world_name" value="$(find mbot_gazebo)/worlds/rectangle2.world"/>
    <arg name="paused" default="false"/>
    <arg name="use_sim_time" default="true"/>
    <arg name="gui" default="true"/>
    <arg name="headless" default="false"/>
    <arg name="debug" default="false"/>

    <!-- 運行gazebo仿真環境 -->
    <include file="$(find gazebo_ros)/launch/empty_world.launch">
        <arg name="world_name" value="$(arg world_name)" />
        <arg name="debug" value="$(arg debug)" />
        <arg name="gui" value="$(arg gui)" />
        <arg name="paused" value="$(arg paused)"/>
        <arg name="use_sim_time" value="$(arg use_sim_time)"/>
        <arg name="headless" value="$(arg headless)"/>
    </include>

    <!-- 運行joint_state_publisher節點，發佈機器人的關節狀態  -->
    <node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher" ></node> 

    <!-- 運行robot_state_publisher節點，發佈tf  -->
    <node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher"  output="screen" >
        <param name="publish_frequency" type="double" value="50.0" />
    </node>

    <!-- 在gazebo中加載機器人模型-->

    <!-- 加載機器人模型描述參數 -->
    <param name="robot_description" command="$(find xacro)/xacro --inorder '$(find mbot_description)/urdf/xacro/gazebo/mbot_with_laser_gazebo.xacro'" /> 

    <node name="urdf_spawner" pkg="gazebo_ros" type="spawn_model" respawn="false" output="screen"
          args="-urdf -model mbot -param robot_description"/> 
</launch>

gazebo構建仿真場景並製作機器人模型

1.模型下載

1.1製作簡單的場景地圖

2.製作機器人模型

3.rviz launch文件編寫

使用SSD實現目標檢測

ubuntu1604 Autoware 的安裝與官方Demo的運行

Autoware 構建點雲地圖

Velodyne VLP16 激光雷達使用(遇到問題要學會看文檔)

gitkragen上傳下載軟件包操作步驟

Mac下配置sublime實現LaTeX

https://yachay.unat.edu.pe/blog/index.php?comment_area=format_blog&comment_component=blog&comment_co

linux以太網驅動總結