基于 Gazebo 的多机体仿真
本文介绍如何使用 Gazebo 仿真器配合软件在环仿真进行多机仿真(仅适用于 Linux )。 A different approach is used for simulation with and without ROS.
Multiple Vehicle with Gazebo (No ROS)
To simulate multiple iris or plane vehicles in Gazebo use the following commands in the terminal (from the root of the Firmware tree):
<model>
: The vehicle type/model to spawn, e.g.:iris
(default),plane
,standard_vtol
.<number_of_vehicles>
: The number of vehicles to spawn. Default is 3. Maximum is 255.<world>
: The world that the vehicle should be spawned into, e.g.:empty
(default)<script>
: Spawn multiple vehicles of different types (overriding the values in-m
and-n
). 例如:Supported vehicle types are:
iris
,plane
,standard_vtol
.The number after the colon indicates the number of vehicles (of that type) to spawn.
Maximum number of vehicles is 255.
<target>
: build target, e.g:px4_sitl_default
(default),px4_sitl_rtps
<label>
: specific label for model, e.g:rtps
Each vehicle instance is allocated a unique MAVLink system id (1, 2, 3, etc.). Vehicle instances are accessed from sequentially allocated PX4 remote UDP ports: 14540
- 14548
(additional instances are all accessed using the same remote UDP port: 14549
).
Video: Multiple VTOL
@
Build and Test (RTPS/DDS)
To simulate multiple vehicles based on RTPS/DDS in Gazebo, use the gazebo_sitl_multiple_run.sh
command in the terminal with the -t px4_sitl_rtps
option from the root of the PX4-Autopilot tree (as described above). Here we will use the -t px4_sitl_rtps
option, which sets that we will use RTPS for communicating with PX4 rather than the MAVLink Simulation API. This builds and runs the iris
model and by default also starts the microRTPS client (you can change the model using the -m
parameter).
Clone the PX4/PX4-Autopilot code, then build the SITL code
Source your environment:
运行启动文件:
The tutorial example opens the Gazebo client GUI showing two Iris vehicles in an empty world.
You can control the vehicles with QGroundControl or MAVROS in a similar way to how you would manage a single vehicle:
QGroundControl 中有一个下拉选项,你可以选择指定的飞行器。
MAVROS 要求你在 topic/service 路径之前包含合适的命名空间,(例如,你会用到 /uav1/mavros/mission/push )。
发生了什么?
For each simulated vehicle, the following is required:
Gazebo model: This is defined as
xacro
file inPX4-Autopilot/Tools/sitl_gazebo/models/rotors_description/urdf/<model>_base.xacro
see here. Currently, the modelxacro
file is assumed to end with base.xacro. 此模型应该有一个名为mavlink_udp_port
的参数, 该参数定义了与 px4 节点通信的 udp 端口。 模型的xacro
文件将用于生成包含您选择的 udp 端口的urdf
模型。 若要定义 udp 端口,请在每个飞行器的启动文件中设置mavlink_udp_port
,请参阅例子here。PX4 node: This is the SITL PX4 app. It communicates with the simulator, Gazebo, through the same UDP port defined in the Gazebo vehicle model, i.e.
mavlink_udp_port
. 要在 px4 sitl 应用程序端设置 udp 端口, 您需要在启动文件中设置SITL_UDP_PRT
参数, 以匹配前面讨论的mavlink_udp_port
, 请参阅 here。 启动文件中的开始文件路径由参数vehicle
和ID
产生,参考这里。 TheMAV_SYS_ID
for each vehicle in the startup file, see here, should match theID
for that vehicle in the launch file here. 这样能够帮助你确保启动文件和开始文件中的设置相同。
构建一个示例设置, 请按照以下步骤操作:
在gazebo中加载一个世界
对于每个飞行器来说
从 xacro 创建 urdf 模型, 加载gazebo模型并运行 px4 sitl 应用程序实例
运行mavros节点
To add a third iris to this simulation there are two main components to consider:
把
UAV3
添加到multi_uav_mavros_sitl.launch复制已经存在的四旋翼(
UAV1
或者UAV2
)把
ID
改为3
与gazebo的通信,选择一个不同的
mavlink_udp_port
端口MAVROS通信端口选择是通过在
fcu_url
中修改两个端口号。
创建一个开始文件,并按照如下方式修改:
复制已存在的iris rcs启动文件,(
iris_1
或iris_2
) ,重命名为iris_3
MAV_SYS_ID
值改为3
SITL_UDP_PRT
的值与mavlink_udp_port
相一致。第一个
mavlink start
端口和mavlink stream
端口值设置为相同值,用于和QGC通信。第二个
mavlink start
端口值应与启动文件fcu_url
中的值一致。
Multiple Vehicles using SDF Models
然后, 你可以使用 QGroundControl 和 MAVROS 控制多机,控制方式与单机类似。
对每一个仿真的飞行器,有如下要求:
Install xmlstarlet from your Linux terminal:
Use roslaunch with the multi_uav_mavros_sitl_sdf.launch launch file:
启动文件 multi_uav_mavros_sitl.launch
做了以下内容,
要在此模拟中添加第三个iris四旋翼, 需要考虑两个主要部分:
You can choose to do either of:
modify the single_vehicle_spawn_sdf.launch file to point to the location of your model by changing the line below to point to your model:
* copy your model into the folder indicated above (following the same path convention).
The
vehicle
argument is used to set thePX4_SIM_MODEL
environment variable, which is used by the default rcS (startup script) to find the corresponding startup settings file for the model. Within PX4 these startup files can be found in the PX4-Autopilot/ROMFS/px4fmu_common/init.d-posix/ directory. For example, here is the plane model's startup script. For this to work, the PX4 node in the launch file is passed arguments that specify the rcS file (etc/init.d/rcS) and the location of the rootfs etc directory ($(find px4)/build_px4_sitl_default/etc
). For simplicity, it is suggested that the startup file for the model be placed alongside PX4's in PX4-Autopilot/ROMFS/px4fmu_common/init.d-posix/.
其他资源
更多UDP端口配置请参考 Simulation。
更多关于xacro多模型的信息请参考 URDF in Gazebo
更过xacro模型请参考RotorS。
Last updated