介绍

为https://blog.csdn.net/weixin_41469272/article/details/117919845的补充篇

依赖

• Dependencies：
  PX4 Firmware v1.8.0
  地面站：QGC
  视景：gazabo
  通信：mavros

PX4 Firmware：

下载：

git clone https://github.com/PX4/PX4-Autopilot.git --recursive

编译固件：

cd [PX4-Autopilot]
# 编译v1.8.0
#git checkout v1.8.0
#编译对应硬件版本的v1.8。0的固件，以下以v5为例，vx与飞控硬件版本号对应
make px4_fmu-v5_default
#编译sitl仿真程序
DONT_RUN=1 make px4_sitl_default gazebo-classic
或
make px4_sitl gazebo 

烧录v1.8.0固件
1）USB连接飞控ACM口
2）打开QGC，设置->固件
3）重新拔插USB-》弹出固件设置->勾选高级设置-》下拉框选择自定义固件-》弹出文件管理框-》找到编译好的固件px4_fmu-vx_default.px4
固件路径默认在[PX4-Autopilot]/build/nuttx_px4fmu-vx_default下
sitl程序默认在[PX4-Autopilot]/build/posix_sitl_default下

软件在环(SITL)仿真

Gazebo 软件无人机

1. 更新环境变量

source [PX4-Autopilot]/Tools/setup_gazebo.bash [PX4-Autopilot] [PX4-Autopilot]/build/posix_sitl_default

2. launch mavros sitl
   （1）仅启动STIL

cd [PX4-Autopilot]/launch
#仅启动gazebo和仿真无人机
roslaunch posix_sitl.launch

附posix_sitl.launch文件内容

<?xml version="1.0"?>
<launch><!-- Posix SITL environment launch script --><!-- launches PX4 SITL, Gazebo environment, and spawns vehicle --><!-- vehicle pose --><arg name="x" default="0"/><arg name="y" default="0"/><arg name="z" default="0"/><arg name="R" default="0"/><arg name="P" default="0"/><arg name="Y" default="0"/><!-- vehicle model and world --><arg name="est" default="ekf2"/><arg name="vehicle" default="iris"/><arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/empty.world"/><arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/><arg name="rcS" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)"/><!-- gazebo configs --><arg name="gui" default="true"/><arg name="debug" default="false"/><arg name="verbose" default="false"/><arg name="paused" default="false"/><arg name="respawn_gazebo" default="false"/><!-- PX4 configs --><arg name="interactive" default="true"/><!-- PX4 SITL --><arg unless="$(arg interactive)" name="px4_command_arg1" value="-d"/><arg     if="$(arg interactive)" name="px4_command_arg1" value=""/><node name="sitl" pkg="px4" type="px4" output="screen" args="$(find px4) $(arg rcS) $(arg px4_command_arg1)" required="true"/><!-- Gazebo sim --><include file="$(find gazebo_ros)/launch/empty_world.launch"><arg name="gui" value="$(arg gui)"/><arg name="world_name" value="$(arg world)"/><arg name="debug" value="$(arg debug)"/><arg name="verbose" value="$(arg verbose)"/><arg name="paused" value="$(arg paused)"/><arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/></include><!-- gazebo model --><node name="$(anon vehicle_spawn)" pkg="gazebo_ros" type="spawn_model" output="screen" args="-sdf -file $(arg sdf) -model $(arg vehicle) -x $(arg x) -y $(arg y) -z $(arg z) -R $(arg R) -P $(arg P) -Y $(arg Y)"/>
</launch>
~          

此时在终端回车，可以使用pxh命令，即px4的终端指令。
如commander takeoff让飞机起飞
以及一些常用的mavlink命令，如启用飞控硬件串口，修改串口波特率等等。
eg；

mavlink start -d /dev/ttyS2 -b 1000000 -r 1000 -m onboard
mavlink stream -d /dev/ttyS2 -s ATTITUDE -r 1000
mavlink stream -d /dev/ttyS2 -s VISION_POSE_ESTIMATE -r 400 
mavlink stream -d /dev/ttyS2 -s LOCAL_POSITION_NED -r 1000

更多指令见本博客后续的介绍

（2）启动STIL，及mavros 地面站

cd [PX4-Autopilot]/launch
#启动gazebo和仿真无人机，以及mavros
roslaunch mavros_posix_sitl.launch

附mavros_posix_sitl.launch

<?xml version="1.0"?>
<launch><!-- MAVROS posix SITL environment launch script --><!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle --><!-- vehicle pose --><arg name="x" default="0"/><arg name="y" default="0"/><arg name="z" default="0"/><arg name="R" default="0"/><arg name="P" default="0"/><arg name="Y" default="0"/><!-- vehicle model and world --><arg name="est" default="ekf2"/><arg name="vehicle" default="iris"/><arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/empty.world"/><arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/><arg name="rcS" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)"/><!-- gazebo configs --><arg name="gui" default="true"/><arg name="debug" default="false"/><arg name="verbose" default="false"/><arg name="paused" default="false"/><arg name="respawn_gazebo" default="false"/><!-- MAVROS configs --><arg name="fcu_url" default="udp://:14540@localhost:14557"/><arg name="respawn_mavros" default="false"/><!-- PX4 configs --><arg name="interactive" default="true"/><!-- PX4 SITL and Gazebo --><include file="$(find px4)/launch/posix_sitl.launch"><arg name="x" value="$(arg x)"/><arg name="y" value="$(arg y)"/><arg name="z" value="$(arg z)"/><arg name="R" value="$(arg R)"/><arg name="P" value="$(arg P)"/><arg name="Y" value="$(arg Y)"/><arg name="world" value="$(arg world)"/><arg name="vehicle" value="$(arg vehicle)"/><arg name="sdf" value="$(arg sdf)"/><arg name="rcS" value="$(arg rcS)"/><arg name="gui" value="$(arg gui)"/><arg name="interactive" value="$(arg interactive)"/><arg name="debug" value="$(arg debug)"/><arg name="verbose" value="$(arg verbose)"/><arg name="paused" value="$(arg paused)"/><arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/></include><!-- MAVROS --><include file="$(find mavros)/launch/px4.launch"><!-- GCS link is provided by SITL --><arg name="gcs_url" value=""/><arg name="fcu_url" value="$(arg fcu_url)"/><arg name="respawn_mavros" value="$(arg respawn_mavros)"/></include>
</launch>

3. 连接地面站

打开地面站，(确保地面站设置->常规->自动连接到下列设备->UDP被勾选)，则会自动连接到模型飞机

而后使用QGC可以对飞机进行一些操作。

4. 其他

此外，在单独launch了posix_sitl.launch，也可以通过下述命令单独启动mavros，连接仿真无人机及地面站:

roslaunch mavros px4.launch fcu_url:="udp://:14540@127.0.0.1:14557"

默认自动开启gcs_url，也通过如下命令，设置远程地面站(要求地面站与仿真电脑同一局域网)

roslaunch mavros px4.launch fcu_url:=udp://:14540@127.0.0.1:14557 gcs_url:=udp://@192.168.xxx.xxx

通过以下命令可以查看mavros的连接状态

rostopic echo /mavros/state

STIL连接简要示意

GCS《-可远程连接(端口:IP)-》mavros:udp:14540 《-》px4:udp:14557 的连接，以下是连接示意图。

可以使用netstat -tunlp |grep px4 或netstat -tunlp |grep 14557来查看端口占用状态。

SITL SLAM仿真

本实验是基于D435i仿真模型是按的RGBD SLAM仿真。

1. 模型创建

建立安装D435i的无人机仿真模型。详细参考：https://blog.csdn.net/weixin_41469272/article/details/117919845
模型下载地址: https://gitee.com/nie_xun/realsense_ros_gazebo.git

根据上述链接，我们可以得到D435i，无人机，以及搭建D435i的无人机的模型，将其模型对应的文件夹放到[PX4-Autopilot]/Tools/sitl_gazebo/models下。

注意v1.8.0的UAV模型通过rcS(默认路径/posix-configs/SITL/init/$(arg est)/$(arg vehicle))下修改位置源(EKF2_AID_MASK)。附示例rcS文件。

uorb start
param load
dataman start
param set BAT_N_CELLS 3
param set CAL_ACC0_ID 1376264
param set CAL_ACC0_XOFF 0.01
param set CAL_ACC0_XSCALE 1.01
param set CAL_ACC0_YOFF -0.01
param set CAL_ACC0_YSCALE 1.01
param set CAL_ACC0_ZOFF 0.01
param set CAL_ACC0_ZSCALE 1.01
param set CAL_ACC1_ID 1310728
param set CAL_ACC1_XOFF 0.01
param set CAL_GYRO0_ID 2293768
param set CAL_GYRO0_XOFF 0.01
param set CAL_MAG0_ID 196616
param set CAL_MAG0_XOFF 0.01
param set COM_DISARM_LAND 3
param set COM_OBL_ACT 2
param set COM_OBL_RC_ACT 0
param set COM_OF_LOSS_T 5
param set COM_RC_IN_MODE 1
param set EKF2_AID_MASK 24
param set EKF2_ANGERR_INIT 0.01
param set EKF2_GBIAS_INIT 0.01
param set EKF2_HGT_MODE 3
param set EKF2_MAG_TYPE 1
param set MAV_TYPE 2
param set MC_PITCH_P 6
param set MC_PITCHRATE_P 0.2 
param set MC_ROLL_P 6
param set MC_ROLLRATE_P 0.2 
param set MIS_TAKEOFF_ALT 2.5 
param set MPC_HOLD_MAX_Z 2.0 
param set MPC_Z_VEL_I 0.15
param set MPC_Z_VEL_P 0.6 
param set NAV_ACC_RAD 2.0 
param set NAV_DLL_ACT 2
param set RTL_DESCEND_ALT 5.0 
param set RTL_LAND_DELAY 5
param set RTL_RETURN_ALT 30.0
param set SDLOG_DIRS_MAX 7
param set SENS_BOARD_ROT 0
param set SENS_BOARD_X_OFF 0.000001
param set SYS_AUTOSTART 4010
param set SYS_MC_EST_GROUP 2
param set SYS_RESTART_TYPE 2
replay tryapplyparams
simulator start -s
tone_alarm start
gyrosim start
accelsim start
barosim start
gpssim start
pwm_out_sim start
sensors start
commander start
land_detector start multicopter
navigator start
ekf2 start
mc_pos_control start
mc_att_control start
mixer load /dev/pwm_output0 ROMFS/px4fmu_common/mixers/quad_w.main.mix
mavlink start -x -u 14556 -r 4000000
mavlink start -x -u 14557 -r 4000000 -m onboard -o 14540
mavlink stream -r 50 -s POSITION_TARGET_LOCAL_NED -u 14556
mavlink stream -r 50 -s LOCAL_POSITION_NED -u 14556
mavlink stream -r 50 -s GLOBAL_POSITION_INT -u 14556
mavlink stream -r 50 -s ATTITUDE -u 14556
mavlink stream -r 50 -s ATTITUDE_QUATERNION -u 14556
mavlink stream -r 50 -s ATTITUDE_TARGET -u 14556
mavlink stream -r 50 -s SERVO_OUTPUT_RAW_0 -u 14556
mavlink stream -r 20 -s RC_CHANNELS -u 14556
mavlink stream -r 250 -s HIGHRES_IMU -u 14556
mavlink stream -r 10 -s OPTICAL_FLOW_RAD -u 14556
logger start -e -t
mavlink boot_complete
replay trystart

将编译得到的librealsense_gazebo_plugin.so存放到[PX4-Autopilot]//build/posix_sitl_default/build_gazebo下或者export到LD_LIBRARY_PATH下。

2. px4 mavros gazebo launch
   创建launch文件，同时启动gazebo models mavros以及PX4，以下为示例launch文件
   iris_realsense_camera_px4_mavros_vo.launch

<?xml version="1.0"?>
<launch><!-- MAVROS posix SITL environment launch script --><!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle --><!-- vehicle pose --><arg name="x" default="0"/><arg name="y" default="0"/><arg name="z" default="0"/><arg name="R" default="0"/><arg name="P" default="0"/><arg name="Y" default="0"/><!-- vehicle model and world --><arg name="est" default="ekf2"/><arg name="vehicle" default="iris"/><!--arg name="world" default="$(find gazebo_ros)/worlds/[your world].world"/--><arg name="world" default="$(find px4)/Tools/sitl_gazebo/worlds/vio_simple4.world"/><!--arg name="sdf" default="$(find px4)/Tools/sitl_gazebo/models/[your model]/[your model].sdf"/--><arg name="sdf" default="$(find px4)/Tools/sitl_gazebo/models/iris_realsense_camera/iris_realsense_camera.sdf"/><arg name="rcS" default="$(find px4)/posix-configs/SITL/init/$(arg est)/$(arg vehicle)_vo"/><!-- gazebo configs --><arg name="gui" default="true"/><arg name="debug" default="false"/><arg name="verbose" default="false"/><arg name="paused" default="false"/><arg name="respawn_gazebo" default="false"/><!-- MAVROS configs --><arg name="fcu_url" default="udp://:14540@localhost:14557"/><arg name="respawn_mavros" default="false"/><!-- PX4 configs --><arg name="interactive" default="true"/><!-- PX4 SITL and Gazebo --><include file="$(find px4)/launch/posix_sitl.launch"><arg name="x" value="$(arg x)"/><arg name="y" value="$(arg y)"/><arg name="z" value="$(arg z)"/><arg name="R" value="$(arg R)"/><arg name="P" value="$(arg P)"/><arg name="Y" value="$(arg Y)"/><arg name="world" value="$(arg world)"/><arg name="vehicle" value="$(arg vehicle)"/><arg name="sdf" value="$(arg sdf)"/><arg name="rcS" value="$(arg rcS)"/><arg name="gui" value="$(arg gui)"/><arg name="interactive" value="$(arg interactive)"/><arg name="debug" value="$(arg debug)"/><arg name="verbose" value="$(arg verbose)"/><arg name="paused" value="$(arg paused)"/><arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/></include><!-- MAVROS --><include file="$(find mavros)/launch/px4.launch"><arg name="gcs_url" value=""/><arg name="fcu_url" value="$(arg fcu_url)"/><arg name="respawn_mavros" value="$(arg respawn_mavros)"/></include>
</launch>

其中的posix_sitl.launch(可见上文)以及px4.launch可以用px4自带文件。

3. slam launch
   重点remap gazebo模型输出的相机topic到slam，此外remap SLAM输出的定位信息remap到/mavros/vision_pose/pose，从而，mavros自动解析local position到飞控。

以下为launch topic remap 示例：

1. IMU topic
<!--remap from="/your slam/imu topic" to="/camera/imu" /-->
eg:
<remap from="/imu/data_raw" to="/camera/imu" />
2. rgb image topic
<!--remap from="/your image topic" to="/camera/color/image_raw" /-->
eg:
<remap from="/camera/rgb/image_rect" to="/camera/color/image_raw" />
3. depth image topic
<!--remap from="/your depth image topic" to="/camera/depth/image_raw" /-->
eg:
<remap from="/camera/depth_registered/image" to="/camera/depth/image_raw" />4. odometry topic
<remap from="your odomtry topic" to="/mavros/vision_pose/pose" />

4. Offboard launch
   编写任务机目标程序。

方形目标文件：offboard_square.cpp

#include <string>
#include <iostream>
#include <ros/ros.h>
#include <geometry_msgs/PoseStamped.h>
#include <mavros_msgs/CommandBool.h>
#include <mavros_msgs/SetMode.h>
#include <mavros_msgs/State.h>
#include <nav_msgs/Odometry.h>
#include <vector>using namespace std;ros::Subscriber state_sub, local_pos_sub;
ros::Publisher pose_target_pub;mavros_msgs::State current_state;
int pos_state = 0;
std::vector<geometry_msgs::PoseStamped> pose_commands;vector<double> initPose;
float takeoff_height;
float side_length;void state_cb(const mavros_msgs::State::ConstPtr& msg){current_state = *msg;
}void local_pos_cb(const geometry_msgs::PoseStamped::ConstPtr& msg){if( current_state.mode != "OFFBOARD" )return;geometry_msgs::Point p_now = msg->pose.position;geometry_msgs::Point p_target = pose_commands[pos_state].pose.position;double delta_p = sqrt((p_target.x + initPose[0] - p_now.x)*(p_target.x + initPose[0] - p_now.x) + (p_target.y + initPose[1] - p_now.y)*(p_target.y + initPose[1] - p_now.y) + (p_target.z + initPose[2] - p_now.z)*(p_target.z + initPose[2] - p_now.z));std::cout << "delta_p:" <<  delta_p << std::endl;if(delta_p < 0.3 && pos_state + 1 < pose_commands.size()){pos_state++;std::cout << "pos_state: " << pos_state << std::endl;}   
}int main(int argc, char **argv)
{ros::init(argc, argv, "offb_node");ros::NodeHandle nh; if(!nh.getParam("initPose", initPose)) {ROS_ERROR_STREAM("Read param error initPose:");for (const auto &i: initPose) {ROS_ERROR_STREAM(i);}}nh.param<float>("takeoff_height", takeoff_height, 1);nh.param<float>("side_length", side_length, 1);state_sub = nh.subscribe<mavros_msgs::State>("mavros/state", 10, state_cb);local_pos_sub = nh.subscribe<geometry_msgs::PoseStamped>("/mavros/local_position/pose", 10, local_pos_cb);pose_target_pub = nh.advertise<geometry_msgs::PoseStamped>("mavros/setpoint_position/local", 10);//the setpoint publishing rate MUST be faster than 2Hzros::Rate rate(20.0);geometry_msgs::PoseStamped pose;pose.pose.position.x = 0;pose.pose.position.y = 0;pose.pose.position.z = takeoff_height;pose.pose.orientation.w = 1;pose.pose.orientation.x = 0;pose.pose.orientation.y = 0;pose.pose.orientation.z = 0;pose_commands.push_back(pose);pose.pose.position.y = -side_length;pose_commands.push_back(pose);pose.pose.position.x = side_length;pose_commands.push_back(pose);pose.pose.position.y = 0;pose_commands.push_back(pose);pose.pose.position.x = 0;pose_commands.push_back(pose);//send a few setpoints before startingfor(int i = 100; ros::ok() && i > 0; --i){pose_target_pub.publish(pose);ros::spinOnce();rate.sleep();}int count = 0;while(ros::ok()){if( current_state.mode != "OFFBOARD" && count%20 == 0){//local_pos_pub.publish(pose);std::cout << current_state.mode << std::endl;}pose_target_pub.publish(pose_commands[pos_state]);ros::spinOnce();rate.sleep();count++;}return 0;
}

方形节点启动launch Offboard_square.launch

<?xml version='1.0'?>
<launch><rosparam>initPose: [0, 0, 0]side_length: 2takeoff_height: 2</rosparam><node pkg="offboard" type="offboard_square_node" name="offboard_square_node" output="screen"></node>
</launch>

5. 坐标系变换
   当SLAM坐标系与mavros使用的坐标系(ENU，FLU)不相同时，在remap 定位消息之前，需要先进行坐标系对齐。
   两种情况，当两个坐标系是同手系坐标系(同为左手坐标系或右手坐标系)，则可以手动对齐yaw角(旋转相机安装方式)，就可以直接remap消息。
   当两个坐标系，一个是左手坐标系一个是右手坐标系时，则需要进行坐标变换。https://blog.csdn.net/weixin_41469272/article/details/117919845 nav_msg_to_mavros.cpp举了一个只需要变换坐标轴定义的例子。

启动offboard方形以及转换坐标系，及remap topic的例子Offboard_square_vision_pose_simulation.launch

<?xml version='1.0'?>
<launch><rosparam>initPose: [0, 0, 0]side_length: 2takeoff_height: 2</rosparam><node pkg="offboard" type="offboard_square_node" name="offboard_square_node" output="screen"/><param name="use_sim_time" type="bool" value="True"/><node pkg="offboard" type="offboard_nav_msg_to_mavros_node" name="offboard_nav_msg_to_mavros_node" output="screen"><!-- 0: gazebo_gt(NWU); 1: camera_vo(WUN)--><param name="data_source" value="1" /><remap from="/camera/odometry" to="/cam_to_init" /><!--remap from="/camera/odometry" to="/ground_truth/iris" /--></node>
</launch>

总结示例

3个窗口一个启动一个，自用

1. px4 mavros eg
#cd in ~/workspace/uav_ws/src/Firmware/launch
#source [PX4-Autopilot]/Tools/setup_gazebo.bash [PX4-Autopilot] [PX4-Autopilot]/build/posix_sitl_defaultroscd px4/launch
#launch uav & world
roslaunch iris_realsense_camera_px4_mavros_vo.launch2. slam eg
cd ~/workspace/demo_tmp/src/demo_rgbd/launch
#launch slam
#source ~/workspace/demo_tmp/devel/setup.sh
roslauch roslaunch realsense_simulation.launch3. offboard eg
cd ~/workspace/uav_ws/src/Offboard_simulation/src/offboard/launch
#launch offboard localization & mission
#source ~/workspace/uav_ws/src/Offboard_simulation/devel/setup.sh
roslaunch Offboard_square_vision_pose_simulation.launch

HITL 仿真

与SITL不同的是，硬件在环的飞控及offboard任务机连接实际硬件。地面站可远程或直接部署在任务机上(因为是仿真，世纪飞行，地面站需要远程)。
连接示意图如下：

推荐：如果只是想测试slam，而不是为飞行作准备，可以将任务机、视景计算机、地面站放在一个电脑，但是单链接经过测试，是卡顿的，仍旧按下方示意图，两路连接可行。，如官方连接所示：

1. 飞控设置
   QGC通过ACM链接飞控（注意，QGC常规设置->自动连接到下列设备pixhawk需要选中）
   

设置机架, 选择HIL Quadcopter X，此时会提示"HITL被启用"一类的警告。同时设置->安全->最后一项硬件在环仿>
真自动被启用"HITL enabled"。

如果不连接遥控器RC，则需要设置以下参数

• COM_RC_IN_MODE to “Joystick/No RC Checks”. 这允许操纵杆输入并禁用 RC 输入检查。
• NAV_RCL_ACT to “Disabled”. 这可确保在没有无线遥控的情况下运行 HITL 时 RC 失控保护不会介入。

2. 硬件在环模型文件
   与SITL模型文件不同的是，HITL需要修改无人机模型文件：如[PX4-Autopilot]/Tools/simulation/gazebo-classic/sitl_gazebo-classic/models/iris_hitl/iris_hitl.sdf
   将模型文件对应的 mavlink_interface plugin部分的 serialEnabled 和 hil_mode改为 true。
   并对应修改模型的串口serialDevice为使用的连接端口。可以通过拔插飞控，并使用dmesg | grep "tty"或ls /dev/tty*查看多出来的设备号。

<plugin name='mavlink_interface' filename='libgazebo_mavlink_interface.so'><robotNamespace/><imuSubTopic>/imu</imuSubTopic><gpsSubTopic>/gps</gpsSubTopic><mavlink_addr>INADDR_ANY</mavlink_addr><mavlink_udp_port>14560</mavlink_udp_port>**<serialEnabled>true</serialEnabled>****<serialDevice>/dev/ttyACM0</serialDevice>**<baudRate>921600</baudRate><qgc_addr>INADDR_ANY</qgc_addr><qgc_udp_port>14550</qgc_udp_port>**<hil_mode>true</hil_mode>**<hil_state_level>0</hil_state_level>

3. 任务机部署

1）将offboard 方形轨迹、坐标变换、mavros部署在任务机上。

示例：Offboard_square_vision_pose.launch

<?xml version='1.0'?>
<launch><node pkg="mavros" type="mavros_node" name="mavros" output="screen"><param name="fcu_url" value="/dev/ttyS0:115200" /><!--param name="gcs_url" value="udp://@192.168.xxx.xxx<-your GCS IP " /--><param name="gcs_url" value="udp://@192.168.1.250" /><param name="gcs_url" value="" /><param name="target_system_id" value="1" /><param name="target_component_id" value="1" /><rosparam command="load" file="$(find offboard)/config/mavros_config/px4_pluginlists.yaml" /><rosparam command="load" file="$(find offboard)/config/mavros_config/px4_config.yaml" /></node><rosparam>initPose: [0, 0, 0]side_length: 2takeoff_height: 2</rosparam><node pkg="offboard" type="offboard_square_node" name="offboard_square_node" output="screen"/><node pkg="offboard" type="offboard_nav_msg_to_mavros_node" name="offboard_nav_msg_to_mavros_node" output="screen"><!-- 0: gazebo_gt(NWU); 1: camera_vo(WUN)--><param name="data_source" value="1" /><remap from="/camera/odometry" to="/cam2_to_init" /><!--remap from="/camera/odometry" to="/ground_truth/iris" /--></node>
</launch>

注意：与SITL 不同的是如果任务机与视景软件分离，任务机上启动mavros，视景软件上不要起mavros了，即iris_realsense_camera_px4_mavros_vo.launch去掉mavros node。

如果任务机与视景集成，则直接用iris_realsense_camera_px4_mavros_vo.launch和Offboard_square_vision_pose_simulation.launch

2）SLAM算法部署
ROS多机通讯部署，需要视景计算机与任务机处于同一局域网，具体连接方法见https://blog.csdn.net/weixin_41469272/article/details/105289174

将slam算法部署到任务机，并remap topic，同SITL。

4. 地面站部署
   地面站可以使用网络，通过mavros实现远程连接，也可以直接部署在任务机上，通过本地端口进行连接。
   见文件Offboard_square_vision_pose.launch

  <node pkg="mavros" type="mavros_node" name="mavros" output="screen"><param name="fcu_url" value="/dev/ttyS0:115200" /><!--param name="gcs_url" value="udp://@192.168.xxx.xxx<-your GCS IP " /--><!--Rmote: --><param name="gcs_url" value="udp://@192.168.1.250" /><!--local: -->或：<param name="gcs_url" value="" /></node>

执行步骤同SITL，先飞控gazebo、slam、offboard，而后地面站。可以通过遥控来实现控制无人机飞行，观察定位输出。自用

1. px4 mavros eg
   #cd in ~/workspace/uav_ws/src/Firmware/launch
   #source [PX4-Autopilot]/Tools/setup_gazebo.bash [PX4-Autopilot] [PX4-Autopilot]/build/posix_sitl_default

roscd px4/launch
#launch uav & world
roslaunch iris_realsense_camera_px4_mavros_vo.launch

2. slam eg
   cd ~/workspace/demo_tmp/src/demo_rgbd/launch
   #launch slam
   #source ~/workspace/demo_tmp/devel/setup.sh
   roslauch roslaunch realsense_simulation.launch

3. offboard eg
   cd ~/workspace/uav_ws/src/Offboard_simulation/src/offboard/launch
   #launch offboard localization & mission
   #source ~/workspace/uav_ws/src/Offboard_simulation/devel/setup.sh
   roslaunch Offboard_square_vision_pose_simulation.launch

pxh常用命令

在 PX4 固件 v1.8.0 中，使用 PXH 终端发送指令时，你可以使用以下常见命令和 MAVLink 指令来控制飞行器：

1. 起飞:

   commander takeoff
   

   这个命令将让飞行器执行起飞操作。

2. 着陆:

   commander land
   

   这个命令会让飞行器执行着陆操作。

3. 停止飞行:

   commander stop
   

   停止当前任务并让飞行器悬停。

4. 设置飞行模式:

   set_mode <mode>
   

   例如，set_mode OFFBOARD 可以将飞行器模式设置为 Offboard。

5. 改变高度:

   param set MAV_NAV_ALTITUDE <value>
   

   设置目标高度，<value> 是你希望的高度值（单位为米）。

MAVLink 指令

1. 起飞指令 (MAV_CMD_NAV_TAKEOFF):

   mavlink_command long 11 0 0 0 0 0 0 0 0
   

   11 是 MAV_CMD_NAV_TAKEOFF 的命令码，后面跟随的 0 是参数，可以根据需要调整。

2. 着陆指令 (MAV_CMD_NAV_LAND):

   mavlink_command long 21 0 0 0 0 0 0 0 0
   

   21 是 MAV_CMD_NAV_LAND 的命令码。

3. 更改飞行模式 (MAV_CMD_DO_SET_MODE):

   mavlink_command long 176 0 0 0 0 0 0 <mode> 0
   

   其中 176 是 MAV_CMD_DO_SET_MODE 的命令码，<mode> 是要设置的飞行模式。

4. 设置目标位置 (MAV_CMD_NAV_WAYPOINT):

   mavlink_command long 16 <latitude> <longitude> <altitude> 0 0 0 0 0
   

   16 是 MAV_CMD_NAV_WAYPOINT 的命令码，后续参数是目标位置的经度、纬度和高度。

5. 悬停 (MAV_CMD_NAV_LOITER_TIME):

   mavlink_command long 17 0 0 0 0 0 0 <time> 0
   

   17 是 MAV_CMD_NAV_LOITER_TIME 的命令码，<time> 是悬停的时间（秒）。

使用这些命令时的注意事项

• 确保你的飞行器处于合适的模式，以接收和执行这些命令（例如，Offboard 模式通常用于手动控制）。
• 使用命令前，请确认已正确配置 MAVLink 通道。
• 实际命令可能会有额外参数，建议查看官方文档或相关参考资料以获取详细说明。

更多问题或者需要进一步的信息，请查阅PX4 的官方文档或社区资源。

参考链接

https://docs.px4.io/main/zh/simulation/hitl.html
https://bbs.amovlab.com/forum.php?mod=viewthread&tid=486&extra=page%3D1
https://docs.px4.io/main/zh/sim_gazebo_gz/