【环境配置】gazebo搭建仿真机器人研究动态障碍物算法

已于 2023-01-17 14:18:33 修改
阅读量6.2k 收藏 119
点赞数 17
分类专栏： 导航避障 文章标签： 自动驾驶
于 2021-11-08 15:01:26 首次发布
本文为博主原创文章，未经博主允许不得转载。
本文链接：https://blog.csdn.net/xi_shui/article/details/121207613
版权
本文详细记录了作者在ROS中搭建仿真环境的过程，包括Gazebo的使用，四轮机器人模型从麦克纳姆轮转换为阿克曼模型的配置，以及障碍物小车的设定。作者遇到困难后决定基于现有模型进行修改，并成功添加了Velodyne激光雷达。此外，还介绍了如何为动态障碍物添加碰撞属性。
摘要由CSDN通过智能技术生成

0前言

最近由于实验过程中遇到一些问题,打算直接仿真了,利用一个月时间把整体的仿真环境搭建出来,这里对最近的学习成果,进行梳理.

1Gazebo

学习准备:

  • urdf基本语法
  • xacro基本语法
  • 一个机器人包含:link and joint,link代表每一节刚体,joint代表刚体之间的运动关系
  • ros_control插件,用于代替实体驱动板或者下位控制器

搭建步骤:

  1. solidworks导出stl dae文件(可选)
  2. 宏定义
  3. 刚体,关节定义
  4. 由于gazebo是物理引擎,每个部分必须包含惯性矩阵和碰撞属性,颜色跟RVIZ系统不一样,需要另外设置
  5. 为关节添加传动属性
  6. ros_control配置,每个传动关节订阅的话题和发布的话题,用于控制和检测
  7. 移动机器人可设置差速模型(可选)
  8. ros话题与发布配置一些底层驱动文件,如差速模型,阿克曼模型

2准备搭建

2.1工程移植

因为我的研究方向是算法,一些工作自己去做,偏离了搭建仿真环境的本意,我就直接download别人的SolidWorks文件和Gazebo仿真环境,在这些模型的基础上,修改成自己心仪的仿真环境,由于源文件工程是麦克纳姆轮的转向灵活,但是仿真模型里卡顿,我打算将其改成阿卡曼模型,正好熟悉一些整个机器人配置过程,待续…
在这里插入图片描述

四轮阿克曼模型

	<!-- skid steering plugin -->
	<xacro:macro name="skid_steering" params="broadcastOdomTF">
    <gazebo>
      <plugin name="skid_steer_drive_controller" filename="libgazebo_ros_skid_steer_drive.so">
			<robotNamespace>/summit_xl</robotNamespace>
		    <updateRate>100.0</updateRate>
		    <leftFrontJoint>joint_front_left_wheel</leftFrontJoint>  
		    <rightFrontJoint>joint_front_right_wheel</rightFrontJoint>
		    <leftRearJoint>joint_back_left_wheel</leftRearJoint>
		    <rightRearJoint>joint_back_right_wheel</rightRearJoint>
			<covariance_x>0.0001</covariance_x>
			<covariance_y>0.0001</covariance_y>
			<covariance_yaw>0.01</covariance_yaw>
		    <!-- wheelSeparation>0.566</wheelSeparation --> <!-- real parameter value -->
		    <wheelSeparation>1.5</wheelSeparation> <!-- works a bit better in Gazebo -->
		    <wheelDiameter>0.234</wheelDiameter>
		    <robotBaseFrame>base_footprint</robotBaseFrame>
		    <torque>50</torque>
		    <commandTopic>/summit_xl_control/cmd_vel</commandTopic>
		    <odometryTopic>odom</odometryTopic>
		    <odometryFrame>/odom</odometryFrame>
		    <broadcastTF>${broadcastOdomTF}</broadcastTF>
      </plugin>
    </gazebo>
  </xacro:macro>

两轮差速

        <!-- controller -->
 	<xacro:macro name="diff">
          <gazebo>
              <plugin name="differential_drive_controller"
                      filename="libgazebo_ros_diff_drive.so">
                  <rosDebugLevel>Debug</rosDebugLevel>
                  <publishWheelTF>true</publishWheelTF>
                  <robotNamespace>/summit_xl</robotNamespace>
                  <publishTf>1</publishTf>
                  <publishWheelJointState>true</publishWheelJointState>
                  <alwaysOn>true</alwaysOn>
                  <updateRate>100.0</updateRate>
                  <legacyMode>true</legacyMode>
                  <leftJoint>joint_back_left_wheel</leftJoint>
                  <rightJoint>joint_back_right_wheel</rightJoint>
                  <wheelSeparation>1.5</wheelSeparation>
                  <wheelDiameter>0.234</wheelDiameter>
                  <broadcastTF>1</broadcastTF>
                  <wheelTorque>30</wheelTorque>
                  <wheelAcceleration>1.8</wheelAcceleration>
                  <commandTopic>/summit_xl_control/cmd_vel</commandTopic>
                  <odometryFrame>odom</odometryFrame>
                  <odometryTopic>odom</odometryTopic>
                  <robotBaseFrame>base_footprint</robotBaseFrame>
              </plugin>
          </gazebo>
  </xacro:macro>

障碍物小车,用于轨迹控制作为动态障碍物的一部分

<?xml version="1.0"?>

<!-- racecar.urdf.xacro

This file defines a model of a Traxxas(R) E-Maxx(R) #3905 RC (Radio Controlled)
truck.

Lengths are measured in meters, angles are measured in radians, and masses are
measured in kilograms. All of these values are approximations.

To work with Gazebo, each link must have an inertial element, even if
the link only serves to connect two joints. To be visible in Gazebo, a link
must have a collision element. Furthermore, the link must have a Gazebo
material.

Traxxas(R), E-Maxx(R), and Titan(R) are registered trademarks of Traxxas
Management, LLC. em_3905.urdf.xacro was independently created by Wunderkammer
Laboratory, and neither em_3905.urdf.xacro nor Wunderkammer Laboratory is
affiliated with, sponsored by, approved by, or endorsed by Traxxas Management,
LLC. Mabuchi Motor(R) is a registered trademark of Mabuchi Motor Co., Ltd.
Corporation Japan. All other trademarks and service marks are the property of
their respective owners.

Copyright (c) 2011-2014 Wunderkammer Laboratory

Licensed under the Apache License, Version 2.0 (the "License");
you may not use this file except in compliance with the License.
You may obtain a copy of the License at

  http://www.apache.org/licenses/LICENSE-2.0

Unless required by applicable law or agreed to in writing, software
distributed under the License is distributed on an "AS IS" BASIS,
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
See the License for the specific language governing permissions and
limitations under the License.
-->

<robot name="obstacle" xmlns:xacro="http://www.ros.org/wiki/xacro">
  <!-- include sensors -->

  <!-- Degree-to-radian conversions -->
  <xacro:property name="degrees_45" value="0.785398163"/>
  <xacro:property name="degrees_90" value="1.57079633"/>

  <!-- chassis_length is measured along the x axis, chassis_width
       along the y axis, and chassis_height along the z axis. -->
  <xacro:property name="chassis_length" value="0.258"/>
  <xacro:property name="chassis_width" value="0.168"/>
  <xacro:property name="chassis_height" value="0.01"/>
  <xacro:property name="chassis_mass" value="2.788"/>

  <!-- battery_dist is the distance between the inner edges of the
       batteries. battery_comp_depth is the battery compartment depth.
       battery_length is measured along the x axis, battery_width
       along the y axis, and battery_height along the z axis. -->
  <xacro:property name="battery_x_offset" value="0.055"/>
  <xacro:property name="battery_dist" value="0.065"/>
  <xacro:property name="battery_comp_depth" value="0.02"/>
  <xacro:property name="battery_comp_angle" value="0.34906585"/>
  <xacro:property name="battery_length" value="0.16"/>
  <xacro:property name="battery_width" value="0.047"/>
  <xacro:property name="battery_height" value="0.024"/>
  <xacro:property name="battery_mass" value="0.5025"/>

  <!-- hub_dia and tire_dia are the diameters of the hub and tire,
       respectively. hex_hub_depth is the distance that the hex hub is
       inset from the outer edge of the tire. It is set so that each wheel
       is a "zero offset" wheel. hex_hub_depth = tire_width / 2 -
       axle_length. -->
  <xacro:property name="hub_dia" value="0.09652"/>
  <xacro:property name="tire_dia" value="0.14605"/>
  <xacro:property name="tire_width" value="0.0889"/>
  <xacro:property name="hex_hub_depth" value="0.01445"/>
  <xacro:property name="wheel_mass" value="0.29"/>

  <!-- hex_hub_dist is the distance between left and right hex hubs when
       the shock absorbers are fully extended. axle_length is the distance
       from a U joint to the corresponding hex hub. wheel_travel is the
       vertical wheel travel. -->
  <xacro:property name="wheelbase" value="0.335"/>
  <xacro:property name="hex_hub_dist" value="0.365"/>
  <xacro:property name="axle_length" value="0.03"/>
  <xacro:property name="wheel_travel" value="0.084"/>
  <xacro:property name="shock_z_offset" value="0.0655"/>

  <!-- shock_eff_limit is 2 * ((shock_stroke / 2) * shock_spring_constant) N.
       shock_stroke is 0.028575 meters. shock_spring_constant, an approximation
       of a Traxxas Ultra Shock shock absorber spring's constant, is
       437.817 N/m. -->
  <xacro:property name="shock_eff_limit" value="12.5106"/>
  <xacro:property name="shock_vel_limit" value="1000"/>

  <!-- The specifications for a Titan(R) 550 motor could not be found, so the
       stall torque of a Mabuchi Motor(R) RS-550VC-7525 motor was used instead.

       num_spur_gear_teeth = 68
       num_pinion_gear_teeth = 19
       final_gear_ratio = (num_spur_gear_teeth / num_pinion_gear_teeth) *
         5.22 = 18.68
       stall_torque = 0.549 N m
       axle_eff_limit = ((2 * stall_torque) * final_gear_ratio) / 4 =
         5.12766 N m

       max_speed = 40 mph (30+ mph) = 17.8816 m/s
       axle_vel_limit = (2 * pi) * (max_speed / (pi * tire_dia)) =
         244.8696 rad/s -->
  <xacro:property name="axle_eff_limit" value="5.12766"/>
  <xacro:property name="axle_vel_limit" value="244.8696"/>

  <!-- These constants are used to simulate a Traxxas 2056 servo operated at
       6 V. servo_stall_torque is measured in N m. servo_no_load_speed is
       measured in rad/s. -->
  <xacro:property name="servo_stall_torque" value="0.5649"/>
  <xacro:property name="servo_no_load_speed" value="4.553"/>

  <xacro:property name="layer_mass"   value="0.0" />
  <xacro:property name="layer_x" value="0.40"/>
  <xacro:property name="layer_y" value="0.18"/>
  <xacro:property name="layer_z" value="0.01"/>
  <xacro:property name="layer_height" value="0.08"/>

  <material name="battery_mat">
    <color rgba="0 0 1 1"/>
  </material>
  <material name="chassis_mat">
    <color rgba="0.5 0.5 0.5 1"/>
  </material>
  <material name="tire_mat">
    <color rgba="0 0 0 1"/>
  </material>
  <material name="yellow">
    <color rgba="1 0.4 0 1"/>
  </material>

  <!-- Null inertial element. This is needed to make the model work with
       Gazebo. -->
  <xacro:macro name="null_inertial">
    <inertial>
      <mass value="0.001"/>
      <inertia ixx="0.001" ixy="0" ixz="0" iyy="0.001" iyz="0" izz="0.001"/>
    </inertial>
  </xacro:macro>

  <!-- Inertia of a solid cuboid. Width is measured along the x axis, depth
       along the y axis, and height along the z axis. -->
  <xacro:macro name="solid_cuboid_inertial"
               params="width depth height mass *origin">
    <inertial>
      <xacro:insert_block name="origin"/>
      <mass value="${mass}"/>
      <inertia ixx="${mass * (depth * depth + height * height) / 12}"
               ixy="0" ixz="0"
               iyy="${mass * (width * width + height * height) / 12}"
               iyz="0"
               izz="${mass * (width * width + depth * depth) / 12}"/>
    </inertial>
  </xacro:macro>

  <!-- Inertia of a thick-walled cylindrical tube with open ends. Height is
       measured along the z axis, which is the tube's axis. inner_rad and
       outer_rad are the tube's inner and outer radii, respectively. -->
  <xacro:macro name="thick_walled_tube_inertial"
               params="inner_rad outer_rad height mass">
    <inertial>
      <mass value="${mass}"/>
      <inertia ixx="${(1 / 12) * mass * (3 * (inner_rad * inner_rad +
                    outer_rad * outer_rad) + height * height)}"
               ixy="0" ixz="0"
               iyy="${(1 / 12) * mass * (3 * (inner_rad * inner_rad +
                    outer_rad * outer_rad) + height * height)}"
               iyz="0"
               izz="${mass * (inner_rad * inner_rad +
                    outer_rad * outer_rad) / 2}"/>
    </inertial>
  </xacro:macro>

  <!-- Battery -->
  <xacro:macro name="battery" params="prefix reflect">
    <joint name="chassis_to_${prefix}_battery" type="fixed">
      <parent link="chassis"/>
      <child link="${prefix}_battery_offset"/>
      <origin xyz="${battery_x_offset - battery_length / 2}
                   ${reflect * battery_dist / 2}
                   0"
              rpy="${reflect * battery_comp_angle} 0 0"/>
    </joint>

    <link name="${prefix}_battery_offset">
      <xacro:null_inertial/>
    </link>

    <joint name="offset_to_${prefix}_battery" type="fixed">
      <parent link="${prefix}_battery_offset"/>
      <child link="${prefix}_battery"/>
      <origin xyz="0
                   ${reflect * battery_width / 2}
                   ${(battery_height / 2) - battery_comp_depth}"/>
    </joint>

    <link name="${prefix}_battery">
      <visual>
        <geometry>
          <box size="${battery_length} ${battery_width} ${battery_height}"/>
        </geometry>
        <material name="battery_mat"/>
      </visual>

      <collision>
        <geometry>
          <box size="${battery_length} ${battery_width} ${battery_height}"/>
        </geometry>
      </collision>

      <xacro:solid_cuboid_inertial
         width="${battery_length}" depth="${battery_width}"
         height="${battery_height}" mass="${battery_mass}">
        <origin/>
      </xacro:solid_cuboid_inertial>
    </link>

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

  <!-- Shock absorber -->
  <xacro:macro name="shock"
               params="lr_prefix fr_prefix lr_reflect fr_reflect child">
    <joint name="${lr_prefix}_${fr_prefix}_shock" type="prismatic">
      <parent link="chassis"/>
      <child link="${child}"/>

      <origin xyz="${fr_reflect * wheelbase / 2}
                   ${lr_reflect * ((hex_hub_dist / 2) - axle_length)}
                   ${(wheel_travel / 2) - shock_z_offset}"/>
      <axis xyz="0 0 -1"/>
      <limit lower="${-wheel_travel / 2}" upper="${wheel_travel / 2}"
             effort="${shock_eff_limit}" velocity="${shock_vel_limit}"/>
    </joint>
    <transmission name="${lr_prefix}_${fr_prefix}_shock_trans">
      <type>transmission_interface/SimpleTransmission</type>
      <joint name="${lr_prefix}_${fr_prefix}_shock">
        <hardwareInterface>hardware_interface/EffortJointInterface</hardwareInterface>
      </joint>
      <actuator name="${lr_prefix}_${fr_prefix}_shock_act">
        <!-- This hardwareInterface element exists for compatibility
             with ROS Hydro. -->
        <hardwareInterface>hardware_interface/EffortJointInterface</hardwareInterface>
        <mechanicalReduction>1</mechanicalReduction>
      </actuator>
    </transmission>
  </xacro:macro>

  <!-- The "wheel" macro defines an axle carrier, axle, and wheel. -->
  <xacro:macro name="wheel" params="lr_prefix fr_prefix lr_reflect">
    <link name="${lr_prefix}_${fr_prefix}_axle_carrier">
      <xacro:null_inertial/>
    </link>

    <!-- The left and right axles have the same axis so that identical
         rotation values cause the wheels to rotate in the same direction. -->
    <joint name="${lr_prefix}_${fr_prefix}_axle" type="continuous">
      <parent link="${lr_prefix}_${fr_prefix}_axle_carrier"/>
      <child link="${lr_prefix}_${fr_prefix}_wheel"/>
      <origin rpy="${degrees_90} 0 0"/>
      <axis xyz="0 0 -1"/>
      <limit effort="${axle_eff_limit}" velocity="${axle_vel_limit}"/>
    </joint>
    <transmission name="${lr_prefix}_${fr_prefix}_axle_trans">
      <type>transmission_interface/SimpleTransmission</type>
      <joint name="${lr_prefix}_${fr_prefix}_axle">
        <hardwareInterface>hardware_interface/EffortJointInterface</hardwareInterface>
      </joint>
      <actuator name="${lr_prefix}_${fr_prefix}_axle_act">
        <!-- This hardwareInterface element exists for compatibility
             with ROS Hydro. -->
        <hardwareInterface>hardware_interface/EffortJointInterface</hardwareInterface>
        <mechanicalReduction>1</mechanicalReduction>
      </actuator>
    </transmission>

    <link name="${lr_prefix}_${fr_prefix}_wheel">
      <visual>
        <origin xyz="0
                     ${lr_reflect * (axle_length - (tire_width /
                     2 - hex_hub_depth))}
                     0"/>
        <geometry>
          <cylinder radius="${tire_dia / 2}" length="${tire_width}"/>
        </geometry>
        <material name="tire_mat"/>
      </visual>

      <collision>
        <origin xyz="0
                     ${lr_reflect * (axle_length - (tire_width /
                     2 - hex_hub_depth))}
                     0"/>
        <geometry>
          <cylinder radius="${tire_dia / 2}" length="${tire_width}"/>
        </geometry>
      </collision>

      <xacro:thick_walled_tube_inertial
          inner_rad="${hub_dia / 2}" outer_rad="${tire_dia / 2}"
          height="${tire_width}" mass="${wheel_mass}"/>
    </link>

    <gazebo reference="${lr_prefix}_${fr_prefix}_wheel">
      <material>Gazebo/Black</material>
    </gazebo>
  </xacro:macro>

  <!-- Front wheel -->
  <xacro:macro name="front_wheel"
               params="lr_prefix fr_prefix lr_reflect fr_reflect">
    <xacro:shock lr_prefix="${lr_prefix}" fr_prefix="${fr_prefix}"
                 lr_reflect="${lr_reflect}" fr_reflect="${fr_reflect}"
                 child="${lr_prefix}_steering_link"/>

    <link name="${lr_prefix}_steering_link">
      <xacro:null_inertial/>
    </link>

    <joint name="${lr_prefix}_steering_joint" type="revolute">
      <parent link="${lr_prefix}_steering_link"/>
      <child link="${lr_prefix}_${fr_prefix}_axle_carrier"/>
      <axis xyz="0 0 1"/>
      <limit lower="${-degrees_45}" upper="${degrees_45}"
             effort="${servo_stall_torque}" velocity="${servo_no_load_speed}"/>
    </joint>
    <transmission name="${lr_prefix}_steering_trans">
      <type>transmission_interface/SimpleTransmission</type>
      <joint name="${lr_prefix}_steering_joint">
        <hardwareInterface>hardware_interface/EffortJointInterface</hardwareInterface>
      </joint>
      <actuator name="${lr_prefix}_steering_act">
        <!-- This hardwareInterface element exists for compatibility
             with ROS Hydro. -->
        <hardwareInterface>hardware_interface/EffortJointInterface</hardwareInterface>
        <mechanicalReduction>1</mechanicalReduction>
      </actuator>
    </transmission>

    <xacro:wheel lr_prefix="${lr_prefix}" fr_prefix="${fr_prefix}"
                 lr_reflect="${lr_reflect}"/>
  </xacro:macro>

  <!-- Rear wheel -->
  <xacro:macro name="rear_wheel"
               params="lr_prefix fr_prefix lr_reflect fr_reflect">
    <xacro:shock lr_prefix="${lr_prefix}" fr_prefix="${fr_prefix}"
                 lr_reflect="${lr_reflect}" fr_reflect="${fr_reflect}"
                 child="${lr_prefix}_${fr_prefix}_axle_carrier"/>
    <xacro:wheel lr_prefix="${lr_prefix}" fr_prefix="${fr_prefix}"
                 lr_reflect="${lr_reflect}"/>
  </xacro:macro>

  <!-- chassis for sensors -->
  <xacro:macro name="layer" params="layer parent m x y z *joint_pose">
    <joint name="${layer}_joint" type="fixed">
      <xacro:insert_block name="joint_pose"/>
      <parent link="${parent}"/>
      <child link="${layer}_link" />
    </joint>

    <link name="${layer}_link">
      <visual>
        <origin xyz="0 0 0" rpy="0 0 0" />
        <geometry>
          <box size="${x} ${y} ${z}" />
        </geometry>
        <material name="yellow" />
      </visual>
      <collision>
        <origin xyz="0 0 0" rpy="0 0 0" />
        <geometry>
          <box size="${x} ${y} ${z}" />
        </geometry>
      </collision>
      <xacro:solid_cuboid_inertial
              width="${x}" depth="${y}"
              height="${z}" mass="${m}">
        <origin xyz="0 0 ${-z / 2}"/>
      </xacro:solid_cuboid_inertial>
    </link>

    <gazebo reference="${layer}_link">
      <material>Gazebo/Orange</material>
    </gazebo>
  </xacro:macro>

  <link name="base_footprint"/>
  <!-- base_link must have geometry so that its axes can be displayed in
       rviz. -->
  <link name="base_link">
    <visual>
      <geometry>
        <box size="0.01 0.01 0.01"/>
      </geometry>
      <material name="chassis_mat"/>
    </visual>
  </link>
  <gazebo reference="base_link">
    <material>Gazebo/Grey</material>
  </gazebo>

  <joint name="base_footprint_to_base_link" type="fixed">
    <parent link="base_footprint"/>
    <child link="base_link"/>
    <origin xyz="0 0 ${(wheel_travel/2)+shock_z_offset}" />
  </joint>

  <!-- Chassis -->
  <link name="chassis">
    <visual>W
      <origin xyz="0 0 ${-chassis_height / 2}"/>
      <geometry>
        <box size="${chassis_length} ${chassis_width} ${chassis_height}"/>
      </geometry>
      <material name="chassis_mat"/>
    </visual>

    <collision>
      <origin xyz="0 0 ${-chassis_height / 2}"/>
      <geometry>
        <box size="${chassis_length} ${chassis_width} ${chassis_height}"/>
      </geometry>
    </collision>

    <xacro:solid_cuboid_inertial
        width="${chassis_length}" depth="${chassis_width}"
        height="${chassis_height}" mass="${chassis_mass}">
      <origin xyz="0 0 ${-chassis_height / 2}"/>
    </xacro:solid_cuboid_inertial>
  </link>
  <gazebo reference="chassis">
    <material>Gazebo/Grey</material>
  </gazebo>

  <joint name="base_link_to_chassis" type="fixed">
    <parent link="base_link"/>
    <child link="chassis"/>
  </joint>

  <!-- Batteries -->
  <xacro:battery prefix="left" reflect="1"/>
  <xacro:battery prefix="right" reflect="-1"/>

  <!-- Wheels -->
  <xacro:front_wheel lr_prefix="left" fr_prefix="front"
                     lr_reflect="1" fr_reflect="1"/>
  <xacro:front_wheel lr_prefix="right" fr_prefix="front"
                     lr_reflect="-1" fr_reflect="1"/>
  <xacro:rear_wheel lr_prefix="left" fr_prefix="rear"
                    lr_reflect="1" fr_reflect="-1"/>
  <xacro:rear_wheel lr_prefix="right" fr_prefix="rear"
                    lr_reflect="-1" fr_reflect="-1"/>

  <gazebo>
    <plugin name="gazebo_ros_control" filename="libgazebo_ros_control.so">
    <legacyModeNS>true</legacyModeNS>
    <robotSimType>gazebo_ros_control/DefaultRobotHWSim</robotSimType>
    <robotNamespace>/obstacle</robotNamespace>
    </plugin>
  </gazebo>

</robot>

<?xml version="1.0"?>
<launch>
	    <!-- 设置launch文件的参数 -->
    <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"/>
    <!--模型车的起点放置位置-->
    <arg name="x_pos" default="-0.5"/>
    <arg name="y_pos" default="0"/>
    <arg name="z_pos" default="0.0"/>

	<!--运行gazebo仿真环境-->
	<include file="$(find gazebo_ros)/launch/empty_world.launch">
        	<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)"/>
		<arg name="world_name" value="$(find racecar_description)/worlds/actor_collisions.world"/>

               <!-- .world文件的地址-->
    	</include>

	<!-- 加载机器人模型描述参数 -->
	<param name="robot_description" command="$(find xacro)/xacro --inorder '$(find racecar_description)/urdf/racecar.urdf.xacro'"/>

    <param name="robot_description1" command="$(find xacro)/xacro --inorder '$(find racecar_description)/urdf/moving_obs.xacro'"/>

	<!--运行joint_state_publisher节点，发布机器人关节状态-->
	<!--<node name = "robot_state_publisher" pkg = "robot_state_publisher" type = "state_publisher">-->
	<node name= "robot_state_publisher" pkg= "robot_state_publisher" type= "robot_state_publisher">
		<param name="publish_frequency" type="double" value="20.0" />
		<remap from="/joint_states" to="/racecar/joint_states"/>
	</node>
	<node name= "robot_state_publisher1" pkg= "robot_state_publisher" type= "robot_state_publisher">
		<param name="publish_frequency" type="double" value="20.0" />
		<remap from="/joint_states" to="/obstacle/joint_states"/>
	</node>
	    <!-- 在gazebo中加载机器人模型-->
    <node name="urdf_spawner" pkg="gazebo_ros" type="spawn_model" respawn="false" output="screen"
          args="-urdf -model racecar -param robot_description -x $(arg x_pos) -y $(arg y_pos) -z $(arg z_pos)"/>


    <node name="urdf_spawner1" pkg="gazebo_ros" type="spawn_model" respawn="false" output="screen"
          args="-urdf -model obstacle -param robot_description1 -x 10 -y 10 -z 0"/>
	 <!-- 从yaml文件加载联合控制器的参数 -->
	<rosparam file="$(find bringup)/config/ctrl.yaml" command="load"/>
	<!-- 加载控制器 spawner -->
	<node name="controller_manager" pkg="controller_manager" type="spawner"
	      respawn="false" output="screen" ns="/racecar"
	      args="left_rear_wheel_velocity_controller       right_rear_wheel_velocity_controller
	            left_front_wheel_velocity_controller      right_front_wheel_velocity_controller
	            left_steering_hinge_position_controller   right_steering_hinge_position_controller
	            joint_state_controller"/>
	<!-- 加载控制器 spawner -->
	<node name="controller_manager1" pkg="controller_manager" type="spawner"
	      respawn="false" output="screen" ns="/obstacle"
	      args="left_rear_wheel_velocity_controller       right_rear_wheel_velocity_controller
	            left_front_wheel_velocity_controller      right_front_wheel_velocity_controller
	            left_steering_hinge_position_controller   right_steering_hinge_position_controller
	            joint_state_controller"/>


<node pkg="racecar_description" type="servo_commands.py" name="servo_commands" output="screen">
</node>

</launch>

2.2工程确定

折腾来折腾去,我直接打算,在2019年全国智能车ROS仿真赛的环境基础进行修改了,因为自己太菜了,阿克曼模型的配置整不了.

安装velodyne16线激光雷达

  1. 下载velodyne源码
git clone https://bitbucket.org/DataspeedInc/velodyne_simulator.git

2.配置xacro
在机器人总xacro文件中添加下端代码(看了很多资料,各种乱七八糟的改,才发现就…fuck!),按实际修改:

  <xacro:include filename="$(find velodyne_description)/urdf/VLP-16.urdf.xacro"/>
    <xacro:VLP-16 parent="lidar_platform_link(根据自己的机器人修改就是把雷达安装在哪个link上)" name="VLD16" topic="/VLD16" organize_cloud="fasle" hz="10" samples="440" gpu="false">
    <origin xyz="-0.2 0 -0.07(坐标位置按照实际修改,显示一下慢慢修改)" rpy="0 0 0" />
  </xacro:VLP-16>

效果:
在这里插入图片描述在这里插入图片描述舒服了,二维激光和三维激光,深度相机,里程计都有了,再也…

3.人形模型

一般由于gazebo是基于物理引擎,没有碰撞属性,虽然深度相机可以观察到,但是激光雷达无法检测到,需要对移动障碍物添加碰撞属性,移动障碍物,在Gazebo中用到了< actor>标签.
参考:
gazebo之actor标签行人添加碰撞属性-little_miya

  1. 下载gazeo源码需要得到 libActorCollisionsPlugin.so, sudo 安装没有,需要下载带有源码版本
  2. 进入 /gazebo/examples/plugins/actor_collisions,新建build ,进行编译得到
    libActorCollisionsPlugin.so
    mkdir build
    cd build
    cmake ..
    make
  1. 将得到的.so文件复制到自带的gazebo 目录下
sudo cp libActorCollisionsPlugin.so /usr/lib/x86_64-linux-gnu/gazebo-9/plugins
  1. 测试t
gazebo actor_collisions.world(在/gazebo/examples/plugins/actor_collisions目录下)
  1. 借鉴world文件添加到自己的gazebo环境,我直接在launch文件中加载了它的原始world文件,没做修改

Gazebo动态障碍物三维激光雷达检测

B站链接

RockWang.
关注
  • 17
    点赞
  • 踩
  • 119
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 7
    评论
专栏目录
用gazebo 仿真器搭建仿真环境（机器人仿真学习3）
CHL的博客
03-21 864
虚拟机打开摄像头会导致蓝屏，解决错误中
Gazebo物理仿真环境搭建
li_de_kun的博客
03-21 464
Gazebo物理仿真环境搭建 文章目录Gazebo物理仿真环境搭建 运行命令gazebo注意请在摄像头连接的时候运行这个命令，否则可能会有报错 如果出现闪退，输入下面命令解决 echo "export SVGA_VGPU10=0" >> ~/.bashrc;source ~/.bashrc ROS的工作空间中新建一个gazebo机器人仿真工具包 cd ~/catkin_ws/src catkin_create_pkg mbot_gazebo std_msgs rospy roscp
ROS2进阶第二章 -- 使用Gazebo构建机器人仿真平台 -- 控制差速轮式机器人移动
weixin_45897172的博客
05-09 1252
概述： 上一篇博客：ROS2进阶第一章 – 从头开始构建一个可视化的差速轮式机器人模型 – 学习URDF机器人建模与xacro优化，我们使用urdf和xacro搞了一个差速轮式机器人的外形建模，并使用 rviz 可视化查看。 本文是此系列的第二章，我们将使用gazebo仿真环境创建一个世界，并将上一节制作的机器人加载到仿真环境中，在通过键盘控制节点来控制小车移动，并通过rviz实时察看 camera，kinect和lidar三种传感器的仿真效果。 参考资料 ROS2入门21讲——学习笔记（二）常用工具部分
【仿真环境】Gazebo添加动态障碍物并定义运动轨迹
RockWang的博客
12-28 6609
前言 打算研究一下激光雷达自动跟随功能的算法，研究算法之前需要搭建仿真环境，需求是一辆小车跟一个动态障碍物。 搭建 在Gazebo中放置一个立方体，然后右键编辑模型大小成自己的觉得合适的尺寸大小，保存。 重新打开Gazebo，放置保存模型，然后查看模型名字用于c++程序编写。 #include <ros/ros.h> #include <gazebo_msgs/ModelState.h> #include <geometry_msgs/Pose.h> #include &
gazebo中多架无人机仿真
最新发布
weixin_52641280的博客
07-21 473
将material文件夹中的scripts文件夹中的文件名称，修改为自己的名称，并将该文件中所涉及到beer的地方都修改为自己的标签名称；进入:~/PX4-Autopilot/Tools/sitl_gazebo目录，在world文件夹中添加自己创建的world文件。将material文件夹中的textures文件夹中的png更换为自己的png，并删除beer.png；将beer文件夹中的config和sdf文件中所涉及到beer的都更换为自己的标签。中的empty.world替换为自己创建的world。
Gazebo机器人仿真环境搭建包.zip
03-25
该工程包用于嵌入式ROS学习上面的Gazebo机器人仿真搭建包，将该工程包导入ROS的工作环境，我们就可以进行ROS的机器人仿真开发
gazebo中添加动态障碍物
kintzhao
12-06 4939
gazebo环境中添加动态障碍物，并且激光可见的障碍物. gazebo模型pose实时获取
Gazebo仿真
weixin_30307921的博客
03-14 709
1、建议在本地Ubuntu 16.04下运行仿真程序。目前Gazebo模拟器的兼容性是一大问题，在虚拟机或配置较低的电脑上可能无法运行。如果你的显卡是N卡，建议安装Ubuntu下的显卡驱动。 2、运行Gazebo仿真程序前，请将Gazebo升级到7.x版本以上（推荐7.9版本）。 查看Gazebo版本方法 gazebo -v #确认7.0以上，推荐7.9 升级方法 $ s...
Gazebo仿真环境搭建（04）
weixin_54989626的博客
08-01 1968
Gazebo 中创建仿真实现方式有两种: 1.直接添加内置组件创建仿真环境 1.1启动 Gazebo 并添加组件 1.2保存仿真环境 添加完毕后，选择 file —> Save World as 选择保存路径(功能包下: worlds 目录)，文件名自定义，后缀名设置为 .world 1.3 启动 <launch> <!-- 将 Urdf 文件的内容加载到参数服务器 --> <param name="robot_description" comman
从零开始的三维激光雷达SLAM教程第二讲（搭建Gazebo仿真环境，并添加动态障碍物）
qq_21043585的博客
03-30 6595
我们先在/opt/ros/xxx/share目录下找到turtlebot3的description功能包，为了不修改，我们把urdf文件托到自己功能包下修改，并增加VLP模块。VLP模块也要拖到自己功能包下，仿照velodyne_description中给的例子修改（需要注释掉inertial标签，因为激光的重量会造成机器人的翻倒）。在gazebo中添加地图也可以不显示GUI界面，后台运行，你操作机器人移动可以看激光雷达，在电脑运行不过来GUI的时候可以这么做，对虚拟机友好。
基于gazebo仿真环境的移动机器人导航仿真
zhao_sihu的博客
04-04 1707
实现移动机器人同时定位与建图技术和路径规划技术是让机器人真正智能化的前提。针对机器人自主导航问题，本文在gazebo仿真环境下，利用开源软件包Gmapping提供的算法完成了机器人的自定位与手动地图构建，在此基础上结合move_base软件包相关的路径规划算法完成了移动机器人自主移动建图、路径规划以及自主避障功能。仿真结果表明，该系统能够满足移动机器人在陌生环境下的自主导航需求
毕设&课设&项目&实训-基于ROS框架的 Robot 仿人足球机器人项目。功能 gazebo仿真环境、机器人运动控制.zip
02-05
在本项目中，Gazebo被用来创建Ikid机器人的虚拟环境，包括场地、障碍物、光照等，并且可以模拟机器人的运动和感知。 3. **机器人建模**：在ROS中，Ikid机器人的3D模型需要被精确地构建，包括其结构、关节、自由度等...
Baxter研究机器人的Gazebo仿真界面___下载.zip
04-16
总的来说，Baxter研究机器人的Gazebo仿真环境提供了一个强大的工具，使研究人员和学生能够在安全、可控的环境中进行机器人技术的探索和学习。通过深入理解和熟练使用这个仿真界面，你将能够更深入地理解机器人控制、...
室内移动机器人自主感知与导航[gazebo仿真与算法集成].zip
06-25
Gazebo仿真环境在其中起到了至关重要的作用，它为机器人研究提供了一个逼真的虚拟测试平台，可以进行算法验证和系统集成。以下是对这个主题的详细解释： 1. **室内移动机器人**：室内移动机器人是一种能够在室内...
ROS笔记之Gazebo机器人仿真（八）—— 机器人导航避障仿真
热门推荐
_微尘_的博客
02-06 1万+
1.引言   这章我们将介绍如何在Gazebo中实现机器人导航避障的仿真。 2.准备工作 （1）安装depthimage_to_laserscan功能包，主要功能是将深度图像转化为激光雷达数据。 （2）安装gmapping功能包。 （3）安装navigation功能包。 3.导航避障仿真 （1）在launch文件夹下创建gmapping_nav.launch &lt;?xml version="1...
《动手学ROS2》10.2 Gazebo仿真环境准备
生活不止眼前的苟且
05-31 3208
《动手学ROS2》10.2 Gazebo仿真环境准备 本系列教程作者：小鱼 公众号：鱼香ROS QQ交流群：139707339 教学视频地址：小鱼的B站 完整文档地址：鱼香ROS官网 版权声明：如非允许禁止转载与商业用途。 10.2 Gazebo仿真环境准备 上节，小鱼介绍了机器人的导航，其中我们知道导航三大组件通过传感器从环境中获取数据，接着又通过执行器作用于机器人以改变环境数据。 所以在开始进行SLAM导航进行导航之前，我们要在Gazebo中建立一个测试的环境，其实也很简单，利用Gazebo的画墙
Gazebo仿真环境的搭建
m0_68094390的博客
06-12 2622
不论是使用前面两种方法创建的.world 文件，还是从网络上下载的第三方仿真环境文件，要载入这些仿真环境首先需要在功能包下创建 worlds 文件夹，然后把仿真环境文件保存在该文件下，如果仿真环境还需要载入一些预定义的模型，那么同样在功能包下创建 models 文件夹，把与该仿真环境相关的预定义模型文件复制到 models 文件夹中。最后修改 Launch 文件，在载入 empty_world.launch文件的 标签下添加参数 world_name，同时为该参数设置仿真环境文件.world 的地址。
Gazebo機器人仿真學習探索筆記（三）機器人模型
zhangrelay的专栏
10-18 9491
gazebo_models：https://bitbucket.org/osrf/gazebo_models 附件-官网教程汇总-构建机器人模型-Build a RobotModel structure and requirements OverviewGazebo is able to dynamically load models into simulation either programmat
GAZEBO仿真
XUTWOTWO的博客
10-22 1424
首先建立一个功能包mrobot_gazebo (gazebo_plugins gazebo_ros gazebo_ros_control roscpp rospy) $ cd ~/catkin_ws/src $ catkin_create_pkg mrobot_gazebo gazebo_plugins gazebo_ros gazebo_ros_control roscpp rospy 另起一...
gazebo 管理障碍物生存时间
07-14
### 回答1： gazebo 是一种开源的多机器人模拟器，可用于仿真和测试机器人系统。它对于机器人导航和路径规划等应用至关重要。在 gazebo 中，我们可以通过管理障碍物的生存时间来模拟不同的场景和条件。 在 gazebo 中，我们可以使用模型插件来管理障碍物的生存时间。模型插件是一种用于扩展 gazebo 功能的机制，可以向模拟中的模型添加额外的功能。通过编写自定义的模型插件，我们可以控制障碍物的出现和消失时间。 为了管理障碍物的生存时间，我们需要在模型插件中使用定时器。定时器可以在指定的时间间隔内执行特定的函数。我们可以在这个函数中设置障碍物的出现和消失时间，通过在 gazebo 中添加和移除相应的模型。 当我们想要障碍物持续存在一段时间后消失时，我们可以在模型插件中启动一个定时器，设置特定的时间间隔后，调用一个函数来移除障碍物模型。同样地，当我们想要障碍物在一定时间后出现时，可以编写另一个函数来添加障碍物模型，并设置定时器在一段时间后调用该函数。 通过这样的方式，我们可以在 gazebo 中管理障碍物的生存时间，从而模拟不同的情况和场景。这对于机器人系统的仿真和测试非常有帮助，能够帮助我们评估机器人在不同环境下的导航能力和路径规划效果。 ### 回答2： Gazebo是一种开源的机器人仿真平台，它可以用于模拟机器人在不同环境中的行为。在使用Gazebo进行仿真时，可以通过多种方式来管理障碍物的生存时间。 首先，可以通过在仿真中设置障碍物的属性来控制其生存时间。在Gazebo中，可以为障碍物设置一个持续时间参数。这个参数可以控制障碍物在仿真中存在的时间长度。当超过指定的时间后，障碍物可以被自动删除或禁用，从而停止其对机器人行为的影响。 其次，可以通过编写脚本或程序来管理障碍物的生存时间。在Gazebo中，可以使用ROS（机器人操作系统）或其他编程语言来编写脚本或程序，通过对障碍物的控制来实现其生存时间的管理。例如，可以编写一个定时器来控制障碍物在指定的时间后被删除或禁用。 此外，还可以根据机器人的行为来动态管理障碍物的生存时间。在Gazebo中，可以使用传感器（如激光雷达或摄像头）来检测机器人与障碍物的距离或碰撞情况。当机器人与障碍物发生碰撞或距离过近时，可以立即删除或禁用障碍物，以模拟真实环境中对障碍物的动态管理。 总之，通过设置属性、编写脚本或程序以及根据机器人行为来管理障碍物的生存时间，可以在使用Gazebo进行仿真时有效地控制和模拟障碍物的存在和影响。
评论 7
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

RockWang.

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值