12.1 Mission Planner安装与连接

Mission Planner是ArduPilot生态中常用的Windows地面站软件，可用于固件刷写、参数配置、传感器校准、飞行模式设置、航线规划以及日志下载与分析。第一次连接飞控时，建议先通过USB完成基础配置，再根据户外使用需要配置数传电台或WiFi数传。

12.1.1 软件安装

访问ArduPilot官方Mission Planner页面，下载当前稳定版本的安装程序。

运行安装程序，根据安装向导完成软件与驱动安装。

安装完成后启动Mission Planner。首次启动可能需要等待地图、驱动和组件初始化。

连接飞控前关闭INAV Configurator、Betaflight Configurator、QGroundControl及其他串口工具，避免COM端口被占用。

12.1.2 USB连接

确认使用的是能够传输数据的USB线，而不是仅供充电的电源线。

打开Windows设备管理器，展开“端口（COM和LPT）”，插拔飞控并观察新增或消失的COM口。

在Mission Planner右上角选择对应COM口，波特率选择115200，然后点击“Connect”。

连接成功后会自动读取参数，HUD能够显示飞控姿态，右上角按钮变为“Disconnect”。

12.1.3 数传电台连接

户外飞行时通常不便使用USB线，可使用SiK数传电台或WiFi数传模块实现Mission Planner与飞控之间的MAVLink通信。

（1）SiK数传电台

将地面端数传电台连接至电脑USB口。

将机载端数传电台连接至飞控的TELEM1或TELEM2接口，并确认TX、RX、5V和GND接线正确。

在Mission Planner右上角选择地面端数传对应的COM口。

波特率通常选择57600；如果厂家修改过电台串口速率，应以实际设置为准。

点击Connect，等待参数读取完成。

（2）WiFi数传

电脑连接WiFi数传模块的热点后，在Mission Planner中选择UDP或TCP连接。UDP常用端口为14550，但实际IP地址和端口应以模块说明书为准。

12.2 初始设置向导

进入“初始设置（INITIAL SETUP）”后，应按照机架类型、飞控方向、加速度计、罗盘、遥控器、输出映射、电调、飞行模式和电机测试的顺序完成配置。前一项未验证正确时，不要继续下一项。

12.2.1 机架类型配置

机架类型决定飞控采用哪一种电机混控关系。普通X型四旋翼应选择Quad（四旋翼）和X布局，对应参数通常为FRAME_CLASS=1、FRAME_TYPE=1。

*图12-1 机架类型选择界面*

截图来源：用户实际操作界面

操作步骤

确认无人机实际为四旋翼，且四个机臂呈X型布置。

在上方Frame Class区域选择四旋翼图标。

在下方机架类型区域选择X布局，不要误选Plus、Y6、H、V尾或其他机型。

写入设置后重启飞控，再进入页面确认Class为Quad、Type为X。

12.2.2 加速度计校准与水平校准

加速度计校准用于修正三轴传感器的零偏、比例和安装误差，是ArduCopter的必要校准项目。若飞控箭头未指向机头，应先正确设置AHRS_ORIENTATION，再进行六面校准。

*图12-2 加速度计校准与校准水平界面*

截图来源：用户实际操作界面

（1）完整六面校准

拆除全部螺旋桨，将无人机放在稳定、平整的表面上。

点击“校准加速度计”。

按照屏幕提示依次完成：水平正放、左侧朝下、右侧朝下、机头朝下、机头朝上和倒置。

每个姿态放稳后保持完全静止，再点击确认或按提示继续。

出现“Calibration Successful”后重启飞控。

（2）校准水平

“校准水平”只用于重新设定当前安装状态下的水平基准，不等同于完整六面校准。六面校准已经成功，但HUD在机械水平状态下存在小幅倾斜时，可将整机前后、左右调平后点击“校准水平”。

12.2.3 罗盘校准

罗盘用于提供航向信息。罗盘校准应在加速度计校准完成后进行，并尽量选择室外、远离车辆、钢筋、铁门、手机、电脑、电源和大电流线缆的环境。

确认Mission Planner已检测到内部或外置罗盘。外置GPS罗盘通常距离电机和电调更远，可作为优先罗盘。

点击Onboard Mag Calibration中的Start按钮。

缓慢转动整架无人机，使六个面都朝向不同方向，覆盖完整空间姿态。

所有启用罗盘显示校准成功后，重启飞控。

把无人机水平转动90°，确认Mission Planner中的机头方向同步转动且方向一致。

12.2.4 遥控器校准

图*12-3 遥控器校准界面*

截图来源：用户实际操作界面

遥控器校准用于记录每个通道的最小值、最大值和中位值。校准前应断开动力电池，打开遥控器并确保接收机已经对频。

操作步骤

进入遥控器校准页面，移动摇杆，确认相应通道条能够变化。

点击“校准遥控”，按提示将所有摇杆推到四个角和全部极限位置。

将所有旋钮和辅助开关拨到全部挡位，尤其是飞行模式开关。

点击“完成”，将横滚、俯仰和偏航摇杆回中，油门保持最低。

确认CH1至CH4的中位值约为1500，端点通常接近1100和1900。

如果通道顺序与实际遥控器不一致，可修改RCMAP_ROLL、RCMAP_PITCH、RCMAP_THROTTLE和RCMAP_YAW。修改映射后应重启飞控并重新进行遥控器校准。

12.2.5 Servo Output输出映射

图12-4 Servo Output输出映射界面

截图来源：用户实际操作界面

Servo Output页面用于设置每个物理输出端口对应的功能、最小值、中位值和最大值。图中输出1至输出4分别被映射为Motor2、Motor3、Motor4和Motor1，这是当前ZP_MH743固件与板级输出定义的实际配置示例。

12.2.6 电调校准

传统PWM电调需要校准油门端点，使各电调对最小和最大油门信号的理解一致。DShot和DroneCAN属于数字协议，通常不需要传统PWM油门行程校准。

确认全部螺旋桨已经拆除。

先查明电调支持的协议，并在飞控中设置正确的输出协议。

如果是传统PWM电调，严格按照Mission Planner页面提示和电调说明书完成上电、提示音和断电操作。

如果是DShot电调，跳过传统ESC Calibration，直接进行电机测试和方向检查。

12.2.7 飞行模式配置

图*12-5 飞行模式配置界面*

截图来源：用户实际操作界面

ArduCopter最多可通过一个飞行模式通道选择六个模式。默认飞行模式通道通常是CH5，由FLTMODE_CH参数指定。拨动遥控器开关时，页面中的“当前PWM”应变化，并高亮对应的飞行模式档位。

设置完成后点击“保存模式”，反复拨动开关，确认Mission Planner顶部显示的当前模式与开关挡位一致。RTL应设置在容易触及但不易误触的位置。

12.2.8 电机测试

图12-6 Quad X电机测试界面

截图来源：用户实际操作界面

图中已经识别Class为Quad、Type为X。Mission Planner按A、B、C、D顺序测试电机，X型四旋翼从机头右侧电机开始，随后沿顺时针方向依次测试。

测试步骤

测试持续时间先设置为2秒。

油门百分比先设置为5%，点击Test motor A。

如果电机不转，可逐步提高到10%，必要时短暂测试15%，不要直接提高到较高油门。

依次测试A、B、C和D，记录实际转动位置和方向。

点击Stop all motors停止所有输出。

12.3 完整参数配置与管理

12.3.1 参数管理界面

Mission Planner的“配置/调试（CONFIG/TUNING）”页面提供完整参数表、参数树、文件导入导出和差异比较功能。修改重要参数前，应先保存当前参数文件。

12.3.2 基础参数

12.3.3 PID与初始调参原则

ATC_RAT_RLL_P/I/D、ATC_RAT_PIT_P/I/D和ATC_RAT_YAW_P/I/D分别控制横滚、俯仰和偏航角速度环。不同机架尺寸、桨叶、电机、电池和重量对应的合适增益差异很大，因此不应把网络教程中的固定数值直接写入。

12.3.4 导航与返航参数

常用导航参数包括航点速度、爬升/下降速度、航点加速度、返航高度和降落速度。较新固件中部分高度参数使用“_M”后缀并以米为单位，旧版本则可能使用厘米。修改前必须查看Mission Planner当前参数说明中的单位。

12.4 常用飞行模式详解

12.4.1 Stabilize（自稳模式）

Stabilize模式会自动将横滚和俯仰恢复到水平，但不会自动保持高度或水平位置。飞手需要手动控制油门。该模式适合首飞、基础姿态检查和GPS异常时的人工接管。

12.4.2 AltHold（定高模式）

AltHold使用气压计和惯性传感器保持高度。横滚、俯仰和偏航仍由飞手控制，松开横滚和俯仰摇杆后飞机回平，但不会自动保持水平位置。油门处于中位死区时保持高度，离开死区后控制上升或下降。

12.4.3 Loiter（定点模式）

Loiter会保持高度、航向和水平位置，需要可靠的GPS位置、罗盘和低振动。摇杆控制水平移动和升降，松开摇杆后飞机减速并重新定点。首次测试前必须先确认AltHold稳定。

12.4.4 RTL（自动返航）

RTL会根据返航参数先调整到安全高度，再返回Home或最近的Rally Point，随后悬停或降落。返航高度必须高于返航路径中的障碍物。RTL依赖GPS、罗盘和EKF，不能把传感器异常时的RTL当作万能救援手段。

12.4.5 Auto（自动任务模式）

Auto按照已经上传到飞控的任务航点执行自动飞行。使用前应完成航线回读、障碍物检查、电池余量评估、Loiter和RTL验证，并准备随时切换至人工模式接管。

12.4.6 Guided（引导模式）

Guided由地面站、伴随计算机或MAVLink指令实时发送目标位置。它不要求预先定义完整任务，但依赖可靠的通信链路和位置估计。

12.4.7 Drift（漂移模式）

Drift采用类似车辆的操控方式，适合特定飞行体验，不是初学者首飞必需模式。其工作仍依赖良好的姿态与速度估计。

12.4.8 PosHold（位置保持模式）

PosHold在摇杆居中时保持位置、航向和高度，飞手的横滚和俯仰输入直接控制倾斜角。它同样需要可靠GPS和罗盘。通常优先推荐Loiter，熟悉后再使用PosHold。

12.4.9 新手测试顺序

12.5 地理围栏与安全保护

12.5.1 地理围栏

地理围栏用于限制最大高度、最大半径或多边形区域。设置围栏前必须保证位置估计可靠，否则可能出现“Fence enabled, need position estimate”等预解锁提示。

在飞行计划或围栏页面绘制允许飞行的区域。

设置最大高度和最大半径，并根据任务场景选择围栏触发后的动作。

上传围栏后回读确认，并在低风险条件下验证。

围栏不能替代人工观察、合法空域确认和障碍物避让。

12.5.2 遥控器失控保护

遥控器失控保护在飞控检测到RC信号丢失或油门通道低于失控阈值时触发。可通过Mission Planner故障保护页面设置RTL、Land或SmartRTL等动作。实际动作应根据GPS可靠性、飞行距离和场地环境选择。

12.5.3 电池失控保护

ArduCopter支持低电量和严重低电量两级保护。常见做法是低电量执行RTL，严重低电量执行Land。电压阈值必须根据电池串数、类型、负载压降和实际容量设置，不能照抄其他无人机。

12.5.4 GCS失控保护

GCS失控保护通过MAVLink心跳判断地面站连接是否中断。主要参数包括FS_GCS_ENABLE和FS_GCS_TIMEOUT。只有飞行过程中确实依赖地面站控制或监控时，才应根据任务需求配置相应动作。

12.5.5 EKF与位置估计保护

旧教程中的FS_GPS_ENABLE已经被归档。当前ArduCopter主要通过EKF失控保护监测位置、速度和罗盘估计质量。关键参数包括FS_EKF_ACTION和FS_EKF_THRESH。发生EKF异常时，GPS依赖模式可能自动切换至Land或AltHold等安全模式。

12.6 日志分析与飞行数据回放

12.6.1 日志类型

12.6.2 DataFlash日志下载

飞行后先断桨或确保电机无法意外启动，再连接Mission Planner。

进入DataFlash Logs页面读取日志列表。

选择需要的.bin日志并下载到电脑。

使用Review a Log或Log Browser打开并分析。

12.6.3 关键数据检查

振动分析应优先查看VIBE和Clip计数，而不是只看原始ACC曲线。Vibe大部分时间低于约30 m/s²通常较理想，超过60 m/s²并伴随Clip持续增加时，应优先处理螺旋桨、电机、机架和飞控减震。

12.6.4 飞行数据回放

Mission Planner可以打开.tlog文件进行HUD和地图回放。回放时可调整速度，定位模式切换、失控保护、位置跳变或电池压降发生的时间点，并与.bin日志中的传感器数据进行交叉分析。

12.7 多旋翼与固定翼配置差异

12.7.1 机架类型

12.7.2 飞行模式

12.7.3 传感器与执行机构

多旋翼主要依靠IMU、气压计、罗盘、GPS和电机混控；固定翼通常还需要空速管、副翼、升降舵、方向舵以及相应舵机行程和反向配置。固定翼的舵机反向可以在Servo Output中设置，而多旋翼无刷电机的机械转向通常通过换相线或电调软件修改。

12.7.4 PID参数体系

多旋翼使用ATC_RAT_RLL/PIT/YAW等姿态控制参数；固定翼使用横滚、俯仰、偏航速率控制参数，并涉及L1导航和TECS总能量控制。两套参数体系不能相互照抄。

12.8 解锁、上锁与遥控器快捷开关设置

ArduCopter只有在解锁（ARMED）后才允许电机进入正常工作状态。解锁不是简单的“启动电机”动作：飞控会先检查传感器、遥控器、飞行模式、电池、位置估计和安全开关等条件。第一次操作必须拆除全部螺旋桨，并在Mission Planner中观察PreArm提示。

12.8.1 解锁前必须满足的条件

拆除全部螺旋桨，清理电机周围的工具、线缆和其他物体。

先打开遥控器，再给飞控和电调上电；上电后将无人机放平并保持静止，等待陀螺仪初始化完成。

油门摇杆保持最低，飞行模式优先切换到Stabilize。不要在RTL、Brake、Land、Circle或其他不允许普通地面解锁的模式中反复尝试。

确认遥控器CH1至CH4输入正常，油门最低值通常接近1000～1100，偏航摇杆方向与Mission Planner显示一致。

如飞控带硬件安全开关，长按安全开关，直到安全指示灯进入允许输出的状态。

查看飞行数据页面的HUD和Messages，不得存在阻止解锁的PreArm错误。

若计划使用Loiter、RTL、Auto或Guided，应在室外等待GPS、Home和EKF位置估计正常。

确认电池电压显示与实际电池一致，不能在“Battery low voltage failsafe”等告警状态下强制解锁。

12.8.2 使用摇杆解锁和上锁

ARMING_RUDDER决定是否允许通过偏航摇杆执行解锁和上锁。它只在油门处于最低位置附近时生效。

将ARMING_RUDDER设置为2，点击“Write Params”写入参数；如果界面提示需要重启，则重新上电后再验证。

Mode 2遥控器解锁：油门拉到最低，将左摇杆推到右下角，也就是“油门最低＋偏航最右”，保持约5秒。

Mission Planner显示ARMED后，立即松开偏航摇杆，让其回到中间；不要持续保持右偏航超过15秒，以免进入AutoTrim相关操作。

上锁：确认飞机已经落地、油门最低，将左摇杆推到左下角，也就是“油门最低＋偏航最左”，保持约2秒。

Mission Planner显示DISARMED且电机完全停止后，先断开动力电池，最后关闭遥控器。

12.8.3 使用Mission Planner地面站按钮解锁

在拆桨调试、SITL仿真或地面排故时，也可以使用Mission Planner发送解锁/上锁命令。实机测试时仍须满足所有安全检查。

进入“飞行数据（DATA）”，打开左下方“动作（Actions）”标签。

确认油门最低、模式可解锁、无人机静止且没有关键PreArm告警。

点击Arm/Disarm相关按钮，按照弹窗提示确认操作。

若地面站按钮也无法解锁，应查看Messages中的完整PreArm原因；不要连续点击，也不要关闭ARMING_CHECK。

若地面站按钮可以解锁但摇杆不能解锁，重点检查ARMING_RUDDER、CH3最低值、CH4方向和遥控器校准。

12.8.4 设置遥控器快捷解锁/上锁开关

除摇杆动作外，还可以把一个未被占用的遥控器通道分配为解锁功能。例如将遥控器两挡或三挡开关映射到CH7，再通过RC7_OPTION指定功能。CH7只是示例，也可以使用其他空闲通道，但不能与横滚、俯仰、油门、偏航或飞行模式通道重复。

图12-10 RC7_OPTION参数设置示例（截图中当前值为165）

截图来源：用户提供的ARMING文档

（1）先确认快捷开关使用的接收机通道

在遥控器中选择一个不易误触的开关，将它输出到空闲通道，例如CH7。不要使用默认飞行模式通道CH5。

进入“初始设置 → 必要硬件 → 遥控器校准”，拨动该开关，确认只有对应通道发生变化。

两挡开关应能达到低位小于1200 μs、高位大于1800 μs；三挡开关的中位通常处于1200～1800 μs。

如果高位达不到1800或低位降不到1200，应在遥控器端调整该通道的行程端点，然后重新校准遥控器。

（2）在全部参数表中分配功能

普通快捷解锁/上锁：把RC7_OPTION设置为153。

使用用户截图中的三挡急停逻辑：把RC7_OPTION设置为165，并确认遥控器确实为三挡开关。

点击“Write Params”，重新启动飞控，再回到遥控器校准或Status页面检查通道PWM。

保持拆桨，先测试低位、中位和高位，观察Mission Planner中的ARMED/DISARMED状态以及Messages提示。

确认动作方向完全正确后再决定是否保留该快捷开关；不熟悉时应恢复RC7_OPTION=0并使用标准摇杆解锁。

12.8.5 选项153与165的功能区别

12.8.6 解锁失败的快速排查

12.8.7 推荐的新手配置

12.9 飞行计划与航点任务设置

Mission Planner的“飞行计划（PLAN）”页面用于编辑自动任务。用户可以在地图上添加航点，设置起飞、航点飞行、悬停、改变速度、返航和降落等命令，并将任务写入飞控。飞行计划只负责描述自动任务，不能替代传感器校准、失控保护、空域确认和人工接管准备。

图12-7 Mission Planner飞行计划与航点编辑界面

截图来源：用户实际操作界面

12.9.1 飞行计划界面组成

12.9.2 创建一个基础四旋翼任务

连接飞控后进入“飞行计划”。实机规划前应等待GPS定位正常；仅编辑离线任务时可以不连接飞控，但写入任务前必须建立连接。

将地图移动并放大到实际飞行区域。确认屏幕中的位置不是省级或全国级缩放，避免因误点击产生几十或几百千米外的航点。

在高度基准中选择Relative（相对Home高度）。初学阶段不建议混用绝对海拔和地形跟随高度。

在任务起点加入TAKEOFF命令，并填写安全起飞高度。高度应高于附近地面障碍，同时符合当地法规和场地限制。

在地图上依次点击需要经过的位置，生成WAYPOINT航点。第一次练习建议只设置3至4个近距离航点，形成简单三角形或矩形路线。

如需在某点停留，可把该行命令改为LOITER_TIME，并填写悬停时间；如需改变任务速度，可在适当位置加入DO_CHANGE_SPEED。

任务末尾加入RTL或LAND。第一次实机任务优先使用RTL，并在此前已经单独验证RTL工作正常。

点击“写入航点（Write WPs）”上传任务，随后点击“读取航点（Read WPs）”回读，逐行检查命令、顺序、坐标和高度。

12.9.3 常用任务命令

12.9.4 Home位置与高度基准

飞行计划页面中的Home图标用于任务规划和距离计算。实机飞行时，飞控通常在获得可靠位置并完成解锁时建立实际Home点。因此，不能仅在地图上拖动Home图标，就假定实机返航点已经被安全修改。起飞前必须在飞行数据页面确认Home已建立，且飞机当前位置、地图位置和航向一致。

• Relative：相对Home高度。适合大多数初学者任务，但必须确认Home位置和起飞点地面高度。
• Absolute：相对海平面的绝对高度。需要准确理解当地海拔和任务数据来源。
• Terrain：相对地形高度。依赖地形数据和相关功能配置，不建议在首次任务中直接使用。

12.9.5 航线保存、写入与回读

点击“保存航点文件”，将任务保存到电脑，文件名中写明地点、日期和版本。

点击“写入航点”将任务发送至飞控，等待状态栏提示写入完成。

立即点击“读取航点”，从飞控回读任务。不要省略这一步。

对比回读后的任务列表，重点检查第一个命令、最后一个命令、所有高度、速度改变命令和返航/降落位置。

修改任务后重新保存为新版本，不要覆盖唯一的正确任务文件。

12.9.6 自动任务执行顺序

完成首飞、AltHold、Loiter和RTL单项测试，确认飞行器在人工和位置模式下均可稳定飞行。

在地面完成电池、GPS、EKF、罗盘、Home、任务距离和预计飞行时间检查。

起飞后先在Loiter中悬停，确认位置稳定，再切换到Auto执行任务。

任务执行时持续观察电池、GPS、EKF、当前航点、距离和飞行模式。

出现航向异常、位置漂移、低电量或任务路线不正确时，立即切换回Loiter或Stabilize人工接管。

12.10 参数修改、调参与飞行数据显示

Mission Planner将“参数修改”和“飞行数据显示”分为两个主要界面：“配置/调试（CONFIG/TUNING）”用于修改飞控参数，“飞行数据（DATA）”用于观察HUD、地图、告警、实时状态和遥测数据。参数修改改变的是飞控控制行为，飞行数据和日志则用于判断修改是否有效，二者应配合使用。

图12-8 Mission Planner飞行数据、HUD、地图和状态显示界面

截图来源：用户实际操作界面

12.10.1 飞行数据页面的主要区域

12.10.2 HUD与地图的正确读取方法

• 姿态：飞机向右倾斜时，人工地平线会以飞行仪表的方式相反倾斜；判断时应同时观察Roll和Pitch数值。
• 模式：确认HUD右下角显示的Stabilize、AltHold、Loiter或Auto与遥控器开关一致。
• 解锁状态：ARMED表示电机输出已允许，DISARMED表示上锁。任何告警状态下均不应强行解锁。
• 电池：同时查看电压、电流和剩余容量。百分比只在容量和电流计配置正确时才有参考价值。
• GPS：未定位时地图位置和Home可能不可靠，不能测试Loiter、RTL、Auto和Guided。
• EKF与VIBE：EKF异常或振动过大可能导致定高、定点和导航失效。

12.10.3 参数修改的标准流程

进入“配置/调试 → 全部参数表（Full Parameter List）”。

点击“Save to File”保存当前完整参数，文件名注明日期和修改前状态。

使用搜索框查找目标参数，先阅读当前固件版本显示的参数说明、单位、范围和重启要求。

记录原值，只修改一个参数或一组明确关联的参数；不要一次批量修改多个不相关项目。

输入新值后点击“Write Params”。需要重启的参数应断开并重新上电，再点击“Refresh Params”确认写入值。

进行低风险地面测试或短时间悬停，下载日志并比较修改前后的表现。

若效果变差，立即恢复保存的原值；不要继续在错误方向上叠加修改。

12.10.4 新手调参顺序

12.10.5 建议固定显示的实时数据

12.10.6 Quick、Messages和Status的使用

在Quick页面双击空白或数据项，根据界面提示添加需要的大字体遥测字段。

进入Messages页面查看完整告警。HUD通常只显示最重要或最近的信息，排故时应读取全部消息。

进入Status页面搜索roll、pitch、yaw、battery、gps、ekf、vibe、rcin等字段，确认原始数据与实物动作一致。

飞行过程中不建议频繁切换复杂页面。应提前固定最需要的字段，并由地面人员协助观察。

12.10.7 飞行后验证参数效果

下载DataFlash .bin日志，重点查看ATT、PIDR、PIDP、PIDY、VIBE、BAT、GPS和XKF/NKF数据。

比较目标姿态与实际姿态曲线，判断是否存在明显滞后、超调或持续振荡。

对比参数修改前后的相同动作或相同任务，不要用完全不同的风况和载荷直接下结论。

确认改动确实改善后，再进行下一项小幅修改，并保存新的参数版本。

12.11 Mission Planner模拟飞行（SITL）

Mission Planner的“模拟（SIMULATION）”页面可以启动SITL（Software in the Loop，软件在环）飞行器。SITL在电脑中运行ArduPilot固件和飞行动力学模型，可用于练习地面站操作、验证航点任务、熟悉模式切换和测试参数逻辑，而不会让真实电机和螺旋桨转动。

图12-9 Mission Planner模拟飞行（SITL）启动界面

截图来源：用户实际操作界面

12.11.1 模拟界面主要选项

12.11.2 启动单架四旋翼SITL

先与真实飞控断开连接。不要在真实飞控保持连接时启动仿真，以免混淆真实参数和模拟参数。

点击顶部“模拟”，在地图上拖动Home位置到准备练习的区域。

将Sim Speed设置为1，将固件分支选择为Stable。

在Model下拉框中选择与四旋翼对应的模型，再点击下方多旋翼/Copter图标启动。模型和车辆类型必须匹配。

等待Mission Planner下载或加载SITL文件。启动完成后软件会自动连接模拟飞行器并读取参数。

切换到“飞行数据”，确认地图上出现模拟飞机，GPS、姿态和Home数据正常。

12.11.3 模拟器中的基础飞行练习

在飞行数据页面确认当前模式为Stabilize或Loiter，并检查没有关键PreArm告警。

可连接游戏杆/遥控器进行手动操控，也可以使用Actions或Guided命令进行解锁、起飞和位置控制。

先练习解锁、上锁、起飞、悬停、模式切换和RTL。

观察HUD中的高度、速度、航向、模式和电池模拟数据，熟悉真实飞行时需要关注的位置。

练习遇到异常时切换回Loiter或Stabilize，并执行RTL或Land。

12.11.4 在SITL中验证航点任务

进入“飞行计划”，在模拟Home附近创建一个短距离任务：TAKEOFF → 3个WAYPOINT → RTL。

使用相对高度，起飞高度和航点高度保持保守，航点间距先控制在较小范围。

点击“写入航点”，再点击“读取航点”回读检查。

返回“飞行数据”，解锁并切换到Auto，观察飞机是否按顺序执行任务。

监控当前航点、航点距离、高度、速度和模式；发现路线不正确时立即切换人工模式。

任务结束后查看地图航迹和.tlog回放，确认实际轨迹与规划路线一致。

12.11.5 仿真Home与航点设置要求

仿真Home决定虚拟飞机的初始位置、相对高度基准和RTL返航位置。航点决定实际任务路线。设置错误会造成飞机出现在远处、地图出现超长连线或RTL返回错误区域。

Home设置：启动SITL前，把“Home Location - Drag Me”拖到空旷练习区域，并将地图放大到街区或场地级别。

航点范围：所有航点放在Home附近，首次仿真控制在20～50 m范围内，不要一开始规划几千米任务。

高度基准：选择Relative；TAKEOFF和WAYPOINT可先设为10～15 m。实机必须根据障碍物、场地和法规重新评估。

基础任务：Home不作为普通WP添加，使用“TAKEOFF → WAYPOINT → WAYPOINT → RTL”。

写入验证：点击Read WPs回读，确认命令顺序、坐标、高度和任务终点正确后再执行Auto。

12.11.6 在SITL中验证航点任务

推荐执行顺序：Guided解锁并起飞至安全高度 → Loiter确认悬停稳定 → 写入并回读任务 → 切换Auto执行 → 异常时切回Loiter或Stabilize接管。

进入“飞行计划”，在模拟Home附近创建一个短距离任务：TAKEOFF → 3个WAYPOINT → RTL。

使用相对高度，起飞高度和航点高度保持保守，航点间距先控制在较小范围。

点击“写入航点”，再点击“读取航点”回读检查。

返回“飞行数据”，解锁并切换到Auto，观察飞机是否按顺序执行任务。

监控当前航点、航点距离、高度、速度和模式；发现路线不正确时立即切换人工模式。

任务结束后查看地图航迹和.tlog回放，确认实际轨迹与规划路线一致。

12.11.7 参数与故障逻辑测试

SITL连接后可以像连接真实飞控一样进入“配置/调试”修改参数。模拟器还会显示SIM_开头的仿真参数，可用于设置风、传感器、位置或其他模拟条件。具体参数名称会随固件版本变化，应以当前参数说明为准。

测试返航高度和航点速度修改后，任务轨迹是否符合预期。

测试模式开关、地理围栏和任务结束行为。

测试通信中断、位置异常或电池保护逻辑时，先在SITL中确认预期动作。

修改参数前保存模拟参数文件；需要恢复干净环境时重新启动并使用Wipe。

12.11.8 常见启动问题

12.11.9 常见启动问题

12.11.10 SITL的局限性

SITL能够验证任务逻辑和软件参数，但不能完全复现真实机架的螺旋桨不平衡、电机振动、电磁干扰、GPS多路径、载荷偏心、动力不足和结构松动。因此，仿真成功只说明软件流程基本可行，不能替代拆桨测试、低空首飞和逐级实机验证。

INAV（INertial AVigation）是一款专为多旋翼和固定翼飞行器设计的开源飞控固件，在导航、自主飞行和传感器融合方面具有显著优势。INAV Configurator 是其配套的地面站配置软件，提供了直观的用户界面，允许用户对飞行控制器的各项参数进行全面配置。本章将基于 ZP-MH743 飞控板（STM32H743 处理器），讲解 INAV Configurator 配置流程。

13.1 校准加速度计

加速度计用于检测飞行器的重力方向和运动加速度，为横滚角、俯仰角以及水平姿态估计提供参考。由于传感器本身存在零点和比例误差，因此在首次安装飞控、更换飞控安装方式或姿态显示明显异常时，需要重新进行加速度计校准。 首先选择配置哪种类型的飞行器：

接收机配置向导选择CRSF。

“重置 Z 轴”：把当前无人机朝向设为三维模型的显示参考方向，让屏幕中的模型机头与你桌面上的实物机头看起来一致。

进入INAV Configurator的“校准（Calibration）”页面，选择“加速度计校准（Accelerometer Calibration）”。校准过程中，应按照界面提示依次将飞行器或飞控板放置在六个方向：水平正放；倒置； 左侧朝下； 右侧朝下； 机头朝下； 机尾朝下。最后保存并重启。

13.2 校准罗盘

校准界面对罗盘进行校准

朝向预设 (align_mag),相对于FC方向选择CW 180° fip。

13.3检查并设置电机编号、输出通道和旋转方向

启用电机输出测试后，分别轻微提高M1、M2、M3、M4的测试滑块，每次只测试一个电机，并记录实际转动的电机位置。将实际位置与INAV Mixer页面中的电机编号图进行比较，确认：M1滑块控制实际M1电机；M2滑块控制实际M2电机；M3滑块控制实际M3电机；M4滑块控制实际M4电机。

如果编号不一致，在混控界面，混控使用向导中按照实际转动的电机位置进行修改。

完成编号检查后，再检查各电机旋转方向是否符合INAV机架示意图。若某个无刷电机转向相反，可采用以下方法处理：在支持方向设置的电调配置的软件中修改电机方向https://am32.ca/configurator。

13.4 设置飞行模式

在“模式”页面中，通过遥控器辅助通道设置解锁和飞行模式。图中将 ARM解锁分配至 CH7，通道值在 1700～2100 时进入解锁状态；将 ANGLE自稳模式分配至 CH6，通道值在 900～1300 时启用；将 NAV ALTHOLD高度保持模式分配至 CH8，通道值在 1700～2100 时启用。蓝色区域表示模式的有效范围，拨动遥控器开关时应确认通道指示点进入对应区域。PREARM、HORIZON和 HEADING HOLD目前未设置。配置完成后点击右下角“保存”。

对各模式作简短说明:

13.5 完成解锁前检查，准备起飞

QGroundControl（QGC）是开源无人机地面站软件，由 Dronecode 基金会维护，是 PX4 和 ArduPilot 生态系统的核心组件。QGC 提供了完整的飞行规划、实时监控、传感器校准和数据分析功能，支持桌面端（Windows/macOS/Linux）和移动端（Android/iOS）。本章将基于 ZP-MH743 飞控板配合 PX4 固件，全面讲解 QGroundControl 的配置与使用。

14.1 QGroundControl 安装与连接

14.1.1 软件获取与安装

QGroundControl 可从官方网站（https://qgroundcontrol.com/downloads）下载最新版本。

安装步骤（Windows）：

1. 下载 Windows 版本的 .exe安装程序。

2. 双击安装程序，按照向导完成安装。

3. 安装完成后从桌面快捷方式或开始菜单启动 QGC。

4. 首次启动时，QGC 会要求选择界面语言——建议选择中文（简体）以获得最佳体验。

移动端安装：

• Android：从 Google Play 商店搜索"QGroundControl"下载安装。

• iOS：从 App Store 搜索"QGroundControl"下载安装。

• 移动端功能与桌面端基本一致，但界面布局针对触屏进行了优化。

14.1.2 连接飞控板

QGroundControl 支持多种连接方式：

USB 直连步骤：

1. 使用 USB Type-C 线缆将 ZP-MH743 飞控板连接至计算机。

2. 系统自动识别并安装驱动（如第 13 章所述 STM32 VCP 驱动）。

3. 启动 QGroundControl，软件会自动检测并连接飞控板。

4. 连接成功后，QGC 主界面左上角将显示载具图标和固件版本信息。

5. 界面顶部状态栏显示"Connected"状态和 MAVLink 心跳信号指示。

数传电台连接：

1. 将地面端数传电台通过 USB 连接至计算机。

2. 将机载端数传电台连接至飞控板的遥测 UART 端口。

3. QGC 会自动检测串口并建立 MAVLink 连接。

4. 默认波特率为 57600 bps（MAVLink 标准遥测速率）。

14.2 载具设置（Vehicle Setup）

载具设置是 QGC 的核心配置模块，位于主界面的齿轮图标"Vehicle Setup"区域。

14.2.1 Summary 概览页

进入 Vehicle Setup 后首先看到的是 Summary 概览页，以卡片形式展示飞控系统的整体健康状态：

• 固件信息：显示当前固件版本（如 PX4 v1.14.0）、Git 哈希值和编译日期。

• 传感器状态：各传感器（加速度计、陀螺仪、磁力计、气压计、GPS）的校准状态，绿色对勾表示已校准，红色叉号表示需要校准。

• 电池状态：电池电压和容量信息。

• 遥控器状态：遥控器连接状态和通道映射信息。

• 飞行时间：累计飞行时间和飞行次数统计。

14.2.2 Airframe 机架类型选择

在"Airframe"设置页面中，选择与飞行器匹配的机架类型：

选择正确的机架类型后，PX4 固件会自动加载对应的默认参数集（混控器、PID 初始值、安全限制等），大幅简化后续配置。

14.2.3 Actuator 输出配置

在"Actuators"设置页面中配置电机和舵机的输出映射：

1. 电机通道映射：确认每个电机对应正确的 PWM/DShot 输出通道。

2. 电机方向测试：点击每个电机的"Test"按钮，确认旋转方向正确（根据机架类型，部分电机正转，部分反转）。

3. DShot 配置（如使用 DShot ESC）：

• 在"Actuator Output"中选择 DShot 协议。

• 可选 DShot150 / DShot300 / DShot600 / DShot1200。

• ZP-MH743 推荐使用 DShot600，兼顾速度和稳定性。

1. PWM 频率配置（如使用 PWM ESC）：

• 标准 PWM：400Hz（适用于大多数电调）。

• OneShot125：适用于支持 OneShot 的电调。

14.3 传感器校准

传感器校准是确保飞行安全和导航精度的关键步骤。QGC 提供了图形化的校准引导流程。

14.3.1 加速度计校准

加速度计校准需要用户在 QGC 引导下将飞行器置于 6 个标准姿态：

1. 点击"Accelerometer"校准按钮。

2. QGC 显示当前加速度计校准状态，点击"Start"开始校准。

3. 按照屏幕上的 3D 模型指示，依次将飞行器放置于以下 6 个姿态：

**• Level（水平）：飞行器正常放置，水平朝上。

**• Left Side（左侧朝下）：飞行器向左侧翻转 90°。

**• Right Side（右侧朝下）：飞行器向右侧翻转 90°。

**• Nose Down（机头朝下）：飞行器向前翻转 90°。

**• Nose Up（机头朝上）：飞行器向后翻转 90°。

**• Back（背部朝下）：飞行器翻转 180°，底部朝上。

1. 每个姿态放置稳定后，点击"Next"确认。QGC 会采集当前姿态的加速度数据。

2. 6 个姿态全部完成后，QGC 计算校准参数并写入飞控板。

3. 校准完成后，Summary 页面的加速度计状态变为绿色。

【提示】提示：校准时确保飞行器放置稳固，每个姿态之间切换时避免剧烈晃动。ZP-MH743 搭载的 ICM-42688-P 加速度计具有出色的温度稳定性，校准后在正常工作温度范围内（-10°C ~ 50°C）不需要重新校准。

14.3.2 陀螺仪校准

陀螺仪校准相对简单：

1. 点击"Gyroscope"校准按钮。

2. 将飞行器放置在水平且稳定的平面上，确保没有任何振动源。

3. 点击"Start"开始校准。

4. 校准过程中飞行器必须保持完全静止（约 5-10 秒）。

5. QGC 自动采集陀螺仪零偏数据并计算校准参数。

6. 校准完成后显示成功提示。

【提示】注意：陀螺仪零偏会随温度变化，PX4 固件内置了温度补偿机制。建议在飞行环境温度下重新校准陀螺仪以获得最佳性能。

14.3.3 磁力计（罗盘）校准

磁力计校准需要在三维空间中旋转飞行器以采集地磁数据：

1. 点击"Compass"校准按钮。

2. 点击"Start"开始校准。

3. QGC 显示一个进度条和三维旋转引导动画。

4. 按照引导在三维空间中缓慢旋转飞行器，确保覆盖所有方向：

• 水平旋转（偏航方向）360°。

• 俯仰方向旋转 360°。

• 横滚方向旋转 360°。

1. 旋转过程中 QGC 实时显示数据采集进度，覆盖的区域以绿色显示在球面上。

2. 当进度达到 100% 时校准自动完成。

3. 校准结果会显示"Fit Quality"（拟合质量）评分，建议达到"Good"或"Excellent"。

【提示】重要：校准时远离大型金属物体、电磁设备和钢筋混凝土建筑。ZP-MH743 建议同时安装外部磁力计（如 Matek M10Q-5883 集成的 QMC5883L），远离电机和电调的电磁干扰。

14.3.4 电机校准

⚠️安全前提：拆下螺旋桨，防止意外转动伤人

1. 确认机架构型：当前为四轴 X 构型（CCW），电机编号、转向与实物保持一致。
2. 电调协议统一：MAIN1~4 选择 DSHOT300，不要混用 PWM/DSHOT 协议。
3. 转向校验：使用Set Spin Direction按钮，对照示意图确认旋转方向，反向电机勾选对应反转复选框。
4. 单独测试：拖动 Actuator Testing 滑块，逐个验证每个电机正常响应，无卡顿、异响。
5. 禁止带电触碰电机转轴，测试完成后关闭执行器滑块，再安装桨叶。
6. 若电调首次使用，需提前完成电调油门行程校准。

14.4 遥控器校准与飞行模式映射

14.4.1 遥控器校准流程

1. 在 QGC 的"Radio"设置页面点击"Start"开始校准。

2. 按照引导依次操作遥控器各通道：

**• 右摇杆（副翼/横滚）：左推到底 → 居中 → 右推到底。

**• 右摇杆（升降/俯仰）：上推到底 → 居中 → 下拉到底。

**• 左摇杆（油门）：推至最高 → 拉至最低。

**• 左摇杆（方向/偏航）：左推到底 → 居中 → 右推到底。

1. QGC 自动检测各通道的最小值、中位值和最大值。

2. 校准完成后显示各通道的校准数据，确认数值合理（中位值接近 1500μs，行程范围约 1000-2000μs）。

14.4.2 飞行模式映射

PX4 使用遥控器通道映射飞行模式，与 INAV 的方式有所不同：

1. 在"Flight Modes"设置页面，选择用于模式切换的遥控器通道（通常为 AUX1/CH5 或 AUX2/CH6）。

2. PX4 支持将通道行程划分为最多 6 个档位，每个档位对应一个飞行模式：

1. 拨动遥控器开关，确认 QGC 中显示的当前模式与预期一致。

2. 可设置额外的开关用于以下辅助功能：

**• Kill Switch（紧急停机）：映射到独立开关，一旦触发立即关闭所有电机。

**• Return Switch（返航开关）：映射一个专用开关用于触发 RTL。

**• Loiter Switch（悬停开关）：快速切换到 Position Hold 模式。

14.5 安全设置（Failsafe / Return-to-Launch / GeoFence）

安全设置是飞行操作中最重要的配置环节，直接关系到飞行器、人员和财产的安全。

14.5.1 Failsafe（失控保护）配置

PX4 的 Failsafe 系统覆盖了多种异常场景：

低电量阈值设置：

**• Level 1（警告级）：COM_LOW_BAT_ACT = 1（RTL），阈值建议设为电池容量的 30%。

**• Level 2（紧急级）：COM_LOW_BAT_ACT = 2（Land），阈值建议设为电池容量的 15%。

**• Critical（危险级）：COM_LOW_BAT_ACT = 3（Terminate），阈值建议设为电池容量的 5%。

14.5.2 Return-to-Launch（RTL 返航）配置

PX4 的 RTL 系统与 INAV 的 RTH 类似，但参数命名和策略有所不同：

RTL 流程（多旋翼）：

1. 触发 RTL 后，飞行器记录当前位置和航向。

2. 爬升至 RTL_RETURN_ALT高度（如果当前高度更高则保持）。

3. 沿直线飞向 Home 点（或指定 RTL 着陆点）。

4. 到达后下降至 RTL_DESCEND_ALT高度悬停。

5. 等待 RTL_LAND_DELAY秒后执行自动降落。

14.6 日志下载与分析

14.6.1 飞行日志管理

PX4 固件将每次飞行的完整数据记录在飞控板的 SD 卡或内部 Flash 中，格式为 .ulg（ULog 格式）。

日志下载步骤：

1. 在 QGC 中点击"Analyze"→"Log Download"。

2. QGC 列出飞控板中存储的所有日志文件，显示文件名、日期、大小和飞行时长。

3. 选择需要下载的日志文件，点击"Download"。

4. 下载完成后日志文件保存在本地指定目录。

14.6.2 日志分析工具

QGC 内置了基础的日志分析功能：

• Log Browser：在"Analyze"→"Log Browser"中加载 .ulg日志文件，以图表形式显示各通道的飞行数据。

• 可调取的数据通道：加速度、角速度、姿态角、GPS 位置、气压高度、电机输出、PID 误差、电池电压/电流、遥控输入等。

专业分析工具推荐：

14.6.3 振动分析

日志分析的一个重要应用是振动诊断：

1. 下载包含 IMU 原始数据的飞行日志。

2. 在 Flight Review 中查看"Vibration"分析图表。

3. 关注以下指标：

• 加速度计振动：正常值 1.0 m/s² RMS，超过 2.0 m/s² 需要检查机架结构。

• 陀螺仪振动：正常值 0.05 rad/s RMS。

• 频谱分析：如果特定频率出现明显峰值，可能指示电机不平衡或螺旋桨损坏。

14.7 QGC 特色功能专项

14.7.1 MAVLink 实时数据流监控与自定义仪表盘

MAVLink 协议概述：

MAVLink 是 PX4/ArduPilot 与地面站之间的标准通信协议。QGC 通过 MAVLink 接收飞行器的全部遥测数据。MAVLink 2.0 支持加密和身份验证，提升了通信安全性。

MAVLink Inspector（数据流监控器）：

QGC 提供了内置的 MAVLink Inspector 工具，用于实时监控 MAVLink 消息流：

1. 在"Analyze"菜单中选择"MAVLink Inspector"。

2. 界面左侧显示所有活跃的 MAVLink 消息类型及其接收频率。

3. 点击任意消息类型，右侧显示该消息的所有字段及其当前值。

4. 常见 MAVLink 消息类型：

自定义仪表盘（Custom Telemetry Widgets）：

QGC 允许用户自定义 Fly View 中的遥测数据显示：

1. 在 Fly View 中右键点击遥测数据区域，选择"Edit"。

2. 进入仪表盘编辑模式，可添加以下类型的 Widget：

• Value Widget：显示单个数值（如电压、速度）。

• Gauge Widget：以仪表形式显示数值（带刻度和指针）。

• Bar Widget：以条形图形式显示百分比或范围值。

• Compass Widget：罗盘方位显示。

• Plot Widget：实时曲线图，显示数值的历史变化。

1. 每个 Widget 可选择绑定的 MAVLink 数据源。

2. 调整 Widget 大小和位置后保存布局。

QGC 内置了完整的视频流接收和显示功能，支持多种流媒体协议。

14.7.2 离线地图与任务预规划

离线地图功能：

QGC 支持预下载地图瓦片以供离线使用，适用于无网络连接的野外作业环境：

1. 在 QGC 设置中选择"Offline Maps"。

2. 点击"Create New Set"创建新的离线地图集。

3. 在地图上框选需要下载的区域。

4. 选择缩放级别范围（建议 Level 1-18 覆盖从全局到细节）。

5. QGC 估算需要下载的瓦片数量和磁盘空间。

6. 确认下载，等待完成。

7. 离线地图自动保存在本地缓存中，离线环境下自动加载。

支持的地图源：

任务预规划工作流：

在离线环境下进行任务预规划的完整流程：

1. 在有网络的环境下，下载目标区域的离线地图。

2. 在 Plan View 中基于离线地图规划航线。

3. 设置地形跟随（Terrain Follow）模式时，需预先下载 DEM 高程数据。

4. 将任务保存为 .plan文件。

5. 到达作业现场后，连接飞控板，上传 .plan文件执行任务。

14.7.3 QGC 与 PX4 固件的深度配合（参数树 / MAVLink Shell）

参数树（Parameter Tree）管理：

PX4 固件包含数百个可调参数，QGC 提供了完整的参数管理界面：

1. 在 Vehicle Setup 中选择"Parameters"进入参数管理页面。

2. 参数按功能分组显示：

1. 每个参数提供：

• 名称和描述。

• 当前值和默认值。

• 允许值范围和单位。

• 是否需要重启才能生效的提示。

1. 参数修改后点击"Save"写入飞控板，部分参数需要重启飞控板后生效。

参数批量管理：

• 导出参数文件：将所有参数导出为 .params文件，用于备份或在同型号飞行器间复制配置。

• 导入参数文件：从 .params文件批量加载参数，节省逐项配置时间。

• 参数对比：将当前参数与默认值对比，快速识别已修改的参数。

• 参数搜索：通过搜索框快速定位目标参数。

MAVLink Shell（命令行控制台）：

QGC 内置了 MAVLink Shell 功能，允许操作者直接与 PX4 固件的 NSH（NuttX Shell）或系统命令行交互：

1. 在"Analyze"菜单中选择"MAVLink Console"。

2. Shell 终端连接到飞控板的命令行接口。

3. 常用 NSH 命令：

uORB 话题监听：

PX4 使用 uORB（micro Object Request Broker）作为内部进程间通信机制。通过 MAVLink Shell 可以实时监听各模块的数据交换：

# 监听传感器融合输出

listener estimator_status

# 监听 GPS 数据

listener vehicle_gps_position

# 监听电池状态

listener battery_status

# 监听遥控器输入

listener manual_control_input

14.7.4 Joystick 虚拟摇杆控制与 SITL 仿真对接

Joystick 虚拟摇杆控制：

QGC 支持通过 USB 游戏手柄或专业遥控器作为虚拟摇杆直接控制飞行器，适用于以下场景：

• 在没有物理遥控器的情况下进行测试飞行。

• 使用计算机上的飞行模拟设备进行训练。

• 通过自定义控制器实现特殊操控需求。

配置步骤：

1. 将 USB 游戏手柄（如 Xbox 手柄、PS 手柄）连接至计算机。

2. 在 QGC 设置中选择"Joystick"。

3. QGC 自动检测已连接的手柄设备。

4. 按照引导完成轴映射校准：

• 移动左摇杆的横滚轴，QGC 自动检测对应轴号。

• 移动左摇杆的俯仰轴，QGC 自动检测对应轴号。

• 移动右摇杆的油门轴，QGC 自动检测对应轴号。

• 移动右摇杆的偏航轴，QGC 自动检测对应轴号。

1. 配置按钮映射：将手柄按钮映射到 Arm、Disarm、RTL、Mode Switch 等功能。

2. 设置死区和指数曲线，使操控手感更自然。

【提示】安全提醒：虚拟摇杆控制依赖计算机与飞控板之间的数据链路。如果链路中断，飞行器将执行 Failsafe 动作。建议仅在受控环境中使用虚拟摇杆。

SITL（*Software In The Loop*）仿真对接：

QGC 可以无缝对接 PX4 的 SITL 仿真环境，无需真实硬件即可进行飞控算法验证和任务测试。

SITL 环境搭建：

1. 安装 PX4 开发环境（参考 PX4 官方文档）。

2. 在终端中启动 SITL 仿真：

# 启动四旋翼 SITL 仿真（使用 Gazebo 模拟器）

make px4_sitl gazebo-classic_iris

# 启动固定翼 SITL 仿真

make px4_sitl gazebo-classic_plane

# 仅启动 SITL（不启动 3D 可视化）

make px4_sitl none_iris

1. SITL 仿真器启动后，在本地 UDP 端口 14540 上提供 MAVLink 接口。

QGC 连接 SITL：

1. QGC 默认监听 UDP 14550 端口，SITL 默认连接 UDP 14540/14550。

2. 启动 SITL 后，QGC 会自动检测到仿真飞行器并建立连接。

3. 在 QGC 中看到的界面与连接真实飞控板完全一致。

4. 可以在 SITL 环境中进行：

• 完整的传感器校准流程（仿真数据）。

• 任务规划和执行测试。

• PID 调参验证。

• Failsafe 场景模拟。

• 飞行模式切换测试。

SITL 仿真中的故障注入：

通过 MAVLink Shell 可以在仿真中注入各种故障，测试系统的容错能力：

# 模拟 GPS 信号丢失

param set EKF2_GPS_CTRL 0

# 模拟电机故障

failure inject --type motor --id 1 --state off

# 模拟风速突变

wind set 10 5 2 # 设置风速 10m/s 北向 5m/s 东向 2m/s 上升

# 模拟电池电压下降

param set SIM_BAT_MIN 10.0

14.7.5 QGC 移动端（Android / iOS）使用指南

QGroundControl 移动端应用提供了与桌面端几乎一致的功能，是外场飞行的便携解决方案。

移动端功能对比：

移动端连接方式：

1. USB OTG 连接：使用 USB OTG 转接线将飞控板直接连接到手机/平板的 USB 端口。Android 设备会自动识别串口设备。iOS 设备需要 Apple Camera Adapter。

2. WiFi 连接：如果飞控板通过 WiFi 模块（如 ESP8266/ESP32 WiFi 桥接）提供网络连接，手机连接同一 WiFi 后 QGC 自动发现飞行器。

3. 蓝牙连接：部分蓝牙数传模块（如 Holybro Telemetry Radio）支持与移动端蓝牙连接。

移动端界面优化：

• 移动端 QGC 针对触屏操作进行了界面优化：

• 按钮和控件更大，便于手指操作。

• 支持双指缩放地图。

• 支持长按地图弹出上下文菜单。

• 侧边栏菜单通过滑动手势展开/收起。

• 横屏模式下显示更多飞行数据。

移动端任务规划技巧：

1. 在 WiFi 环境或离线环境下，使用手指在地图上点触设置航点。

2. 双指缩放查看航线细节和地形。

3. 利用离线地图功能在无网络的野外环境预规划任务。

4. 保存的任务文件可通过手机存储或云存储备份。

移动端外场飞行建议：

• 使用平板电脑（如 iPad Pro 12.9"）代替手机，更大的屏幕提供更好的地图和数据显示。

• 搭配遮阳罩使用，避免强光下屏幕反光导致看不清数据。

• 确保移动设备电量充足，建议配备充电宝。

• 开启飞行模式以节省电量并避免来电/通知干扰。

• 预先下载离线地图，避免现场网络不稳定影响使用。

• 移动端作为辅助操控工具使用，建议同时配备物理遥控器作为主操控设备。

本章小结

本章详细讲解了 QGroundControl 地面站的安装连接、载具设置、传感器校准、任务规划、飞行监控、日志分析等核心功能，并深入探讨了 MAVLink 数据流监控、视频流集成、多载具管理、QML 界面扩展、离线地图、PX4 参数管理、Joystick 控制和 SITL 仿真等特色功能。QGC 作为 PX4/ArduPilot 生态的核心地面站工具，其强大的功能和灵活的扩展性为 ZP-MH743 飞控板的调试和飞行操作提供了全面支持。掌握 QGC 的使用，是进行专业无人机飞行操作的必要技能。

【提示】警告： 试飞前检查是保障人身安全和设备安全的最重要环节。任何一项检查未通过，严禁进入试飞阶段。据统计，超过70%的首飞事故可追溯到试飞前检查不充分。请务必逐项完成所有检查项目，并建议由第二人进行复核。

15.1 硬件检查清单（螺丝、接线、焊点）

硬件检查是试飞前检查的第一道关卡。ZP-MH743 飞控板基于 STM32H743 高性能处理器，集成了大量外设接口，其硬件连接的可靠性直接决定了飞行安全。在组装完成后、通电之前，必须对整机硬件进行系统化的检查。

机架与结构检查： 首先检查机架的所有螺丝是否拧紧。碳纤维机架上使用的 M3 螺丝应使用合适的六角扳手逐一确认，力矩建议控制在 0.5~0.8 N·m 之间。特别注意电机安装座上的螺丝——电机在高速旋转时产生的振动会通过松动的螺丝传导至飞控板，导致 IMU 数据异常。检查机臂是否牢固固定在机架上，折叠机臂的锁定机构是否完全到位。对于四轴飞行器，确认四根机臂的几何角度呈标准 X 型或 H 型布局，相邻机臂夹角偏差不得超过 2°。

飞控板安装检查： ZP-MH743 飞控板应使用减震垫（如硅胶减震柱或泡沫垫）固定在机架中心板上，避免刚性连接导致的振动直接传导至 IMU 芯片。检查飞控板安装方向是否正确——板载丝印的箭头标记（FRONT）必须指向机头方向。固定螺丝不要过紧，以免减震垫被压扁失去减震效果。检查飞控板下方的焊接面是否有锡珠残留或短路风险，使用放大镜检查所有排针焊点的焊接质量。

电气连接检查： 逐项检查所有接线端子的连接情况。重点检查以下连接：

焊点质量复查： 对飞控板上所有手工焊接的焊点进行质量复查。合格的焊点应呈现光滑的圆锥形，表面有光泽，无毛刺、无虚焊（冷焊）。虚焊的典型特征是焊点表面灰暗、粗糙，用手轻拨导线时焊点有松动感。对于 STM32H743 芯片周围的 LQFP176 封装引脚，建议使用放大镜或显微镜检查是否有桥接短路现象。所有焊接完成后，建议使用洗板水清洁残留的助焊剂，防止助焊剂腐蚀焊盘。

15.2 软件配置检查清单

在确认硬件连接无误后，进行软件配置检查。将 ZP-MH743 飞控板通过 USB-C 接口连接至电脑，打开地面站软件（如 INAV、Betaflight Configurator 或 ArduPilot Mission Planner，取决于所选固件），逐一核实以下配置项。

固件版本与基本参数确认： 首先确认已烧录的固件版本与飞控板硬件版本匹配。ZP-MH743 使用 STM32H743VIT6 处理器，对应固件中应正确识别芯片型号。在地面站的"状态"页面确认以下基本信息：CPU 型号显示为 STM32H743、陀螺仪和加速度计型号正确（如 ICM-42688-P 或 MPU6000，视具体硬件方案而定）、气压计型号正确（如 BMP388 或 MS5611）。检查固件编译日期，确认烧录的是最新稳定版本而非开发版。

关键配置参数核对： 在地面站中逐一核对以下关键参数，确保与实际硬件配置一致：

传感器校准状态确认： 检查加速度计是否已完成水平校准——将飞行器放置在绝对水平的台面上，在地面站中确认 Pitch 和 Roll 的角度读数接近 0°（允许 ±0.5° 偏差）。检查陀螺仪校准状态，确认在飞行器静止时陀螺仪的三轴角速度读数均为零或接近零。如果更换了固件或修改了飞控板安装位置，加速度计必须重新校准。

功能开关与模式配置： 确认遥控器通道映射正确（详见 15.3 节），飞行模式开关已分配到指定通道，各飞行模式（如自稳模式 STABILIZE、定高模式 ALT HOLD、GPS 定点模式 POSHOLD、返航模式 RTH）均已正确配置并可通过遥控器切换。确认解锁（Arm）和上锁（Disarm）操作已配置到指定的辅助通道或摇杆组合。

15.3 遥控器检查（通道映射、开关功能、舵量/行程）

遥控器是飞手与飞行器之间的唯一通信纽带，其配置正确性直接关系到飞行安全。在首次试飞前，必须完成遥控器的全面检查。

通道映射验证： 打开地面站的"接收机"页面，逐一拨动遥控器的两个摇杆，确认地面站显示的通道响应与实际物理操作一致。标准映射如下（以美国手 Mode 2 为例）：

如果通道映射不正确，在遥控器端修改通道映射（如支持），或在飞控固件中通过 CHANNEL_MAP参数重新映射。严禁在通道映射未确认正确的情况下尝试解锁电机。

开关功能验证： 为每个拨杆开关分配功能后，逐一拨动开关，在地面站中确认功能切换正确。重点验证以下开关功能：

• 飞行模式开关（通常为三档开关）：在不同档位间切换，确认地面站显示的模式名称与预期一致。例如，三档开关分别对应自稳模式（STABILIZE）、定高模式（ALT HOLD）和 GPS 定点模式（POSHOLD）。

• *解锁/上锁开关*：拨动到解锁位置，确认地面站的"ARM"状态指示变化；拨回上锁位置，确认状态恢复。

• 蜂鸣器开关（如配备）：拨动后应听到蜂鸣器响起。

舵量与行程校准： 在地面站的接收机页面，检查各主通道（CH1\~CH4）的中位值和满行程值。将摇杆置于中位时，各通道读数应接近 1500μs（PPM/SBUS 标准）；将摇杆推至极限位置时，读数应接近 1000μs 和 2000μs。如果中位偏差超过±10μs，需在遥控器端进行子微调（Sub-trim）。如果满行程不足（如仅达到 1100\~1900μs），需在遥控器端调整行程量（End Point/Travel Adjust）。油门通道的低油门位置尤其重要——确保油门摇杆拉到最低时，地面站显示的油门值确实为最低值，这关系到解锁和上锁操作的可靠性。

15.4 电机转向与顺序验证

电机转向和旋转顺序是多旋翼飞行器正常飞行的基础条件。ZP-MH743 飞控支持的混控器配置中，标准四轴 X 型的电机布局和转向有明确规定，任何错误都将导致飞行器无法正常起飞甚至剧烈翻滚。

电机编号与位置确认： 标准四轴 X 型布局的电机位置编号如下（从上方俯视）：左前方为电机1（Motor 1），右前方为电机2（Motor 2），右后方为电机3（Motor 3），左后方为电机4（Motor 4）。在地面站的"电机测试"页面中，依次点击每个电机的测试按钮（注意：测试时务必拆除桨叶！），观察实际转动的电机是否与屏幕显示的编号对应。如果某个电机不转，检查电调信号线连接和电调供电；如果转动的电机与预期不符，检查信号线与飞控对应输出的连接。

转向验证： 在确认电机编号正确后，验证每个电机的旋转方向。四轴 X 型布局中，对角线上的两个电机旋转方向相同：电机1和电机3逆时针旋转（CCW），电机2和电机4顺时针旋转（CW）。在地面站电机测试页面，观察每个电机的旋转方向是否符合要求。如果转向错误，有两种修正方法：一是交换电调到电机的三相线中的任意两根（物理方法），二是在飞控固件中通过参数设置反转对应电机的转向（软件方法，DShot 协议支持）。推荐使用物理方法，因为软件反转在某些固件版本中可能存在兼容性问题。

【提示】安全警告： 在进行电机转向测试时，必须拆除所有螺旋桨！裸露的电机轴在旋转时虽然危险性较低，但一旦安装了螺旋桨，高速旋转的桨叶具有极高的杀伤力。即使是最小尺寸的5寸桨叶，在满油门时也能造成严重的割伤。任何涉及电机转动的测试，拆除桨叶是铁律，不可违反。

电机响应一致性检查： 在地面站中缓慢增加电机测试油门，观察四个电机是否大致同时开始旋转（启动一致性），以及在不同油门开度下四个电机的转速是否基本一致。如果某个电机明显延迟启动或转速偏低，可能的原因包括：电调配置不一致、电调固件版本不同、电机内部绕组问题、或电机轴承磨损。

15.5 GPS 搜星与罗盘校准验证

GPS 和罗盘（磁力计）是实现 GPS 定点飞行、自动航线和返航功能的核心传感器。在试飞前必须确认这两个传感器工作正常。

GPS 搜星测试： 将飞行器放置在室外开阔地带（远离高大建筑物和密集树冠），通电后等待 GPS 模块完成搜星。ZP-MH743 通常搭配 M8N 或 M10 系列 GPS 模块，在开阔环境下首次搜星（冷启动）通常需要 30~90 秒。在地面站中观察以下指标：

• 卫星数量： 锁定卫星数≥8 颗为合格，≥12 颗为良好。如果卫星数长期低于 6 颗，检查 GPS 天线是否被遮挡、GPS 模块安装位置是否合理（应安装在机架顶部、远离金属遮挡物）。

**• HDOP（水平精度因子）： 该值越小越好，＜1.5 为优秀，1.5~2.5 为良好，＞3.0 时定位精度较差，不建议执行 GPS 依赖型任务。

• 3D Fix 状态： 地面站应显示"3D Fix"或"GPS Fix: 3D"，表示已获得三维定位。如果仅显示"2D Fix"或"No Fix"，需要继续等待或改善接收条件。

• GPS 更新速率： ZP-MH743 的串口应配置为 10Hz 更新速率（即每秒更新10次位置数据），在地面站的 GPS 信息页面确认更新频率。

罗盘（磁力计）校准： 罗盘校准是 GPS 定点飞行和返航功能的前提。校准不准确的罗盘会导致飞行器在 GPS 模式下缓慢旋转（"马桶效应"）或在返航时飞向错误方向。校准步骤如下：

1. 在地面站中进入罗盘校准页面。

2. 点击"开始校准"按钮。

3. 手持飞行器（或整机），在三维空间中缓慢旋转——前后左右各旋转360°，同时上下倾斜翻转，确保罗盘芯片感应到各个方向的磁场。整个校准过程通常持续 30~60 秒。

4. 校准完成后，地面站会显示校准结果和磁场强度。检查校准后的偏移值（Offset）是否在合理范围内——偏移量不应超过原始磁场强度的 30%。

罗盘干扰检查： 校准完成后，在地面站中观察罗盘的航向角（Heading）。将飞行器指向正北方向，航向角应接近 0°（或 360°）；指向正东时应接近 90°；指向正南时应接近 180°；指向正西时应接近 270°。允许误差为 ±5°。如果偏差较大，检查罗盘安装位置是否靠近电流导线、电机或其他磁性物体。外置罗盘（如 HMC5883L 或 QMC5883L 模块）应安装在尽可能远离干扰源的位置，通常建议安装在机架顶部的 GPS 桅杆上。

15.6 电池检查与安全规范

锂电池（LiPo）是多旋翼飞行器的动力来源，同时也是最大的安全隐患之一。试飞前对电池的严格检查不容忽视。

电池外观与物理状态检查： 取出飞行用锂电池，进行以下外观检查：

电压检查与一致性： 使用万用表或专用电池检测仪（如 ISDT BG7）测量电池各单体（Cell）电压。对于 4S 锂电池（标称 14.8V），各单体电压应在 3.7~4.2V 之间，且各单体之间的电压差不超过 0.05V。如果某个单体电压明显偏低（差值＞0.1V），说明电池组的一致性已下降，不宜用于飞行测试。满电的锂电池单体电压应为 4.20V±0.02V。

放电能力与C数验证： 确认电池的最大持续放电电流满足飞行器需求。例如，如果飞行器满油门时四个电机总电流约为 80A，则 4S 5000mAh 20C 的电池理论最大持续放电电流为 5A × 20C = 100A，满足要求。如果使用C数过低的电池（如 10C），在大电流放电时电池会严重发热、鼓包甚至起火。

【提示】锂电池安全规范（必读）： 1. 充电安全： 锂电池充电时必须有人看管，使用具有平衡充电功能的专用充电器，充电倍率不超过 1C（即 5000mAh 电池充电电流不超过 5A）。充电器应放置在防火袋或防爆箱中。 2. 存放安全： 长期存放时电池电压应保持在存储电压（约 3.85V/cell），存放在防爆箱或防火袋中，远离易燃物。 3. 运输安全： 运输过程中电池应做好绝缘保护，避免正负极短路。航空运输需遵守 IATA 危险品规定。 4. 使用安全： 飞行时设置低电压报警（建议 3.5V/cell）和低电压保护（建议 3.3V/cell）。电池温度超过 60°C 时立即停止使用。 5. 报废处理： 鼓包、漏液、严重过放的电池应按当地规定进行安全报废处理，不得随意丢弃。将电池放电至 0V 后送至指定的电池回收点。

【提示】本章目标： 指导飞手安全地完成 ZP-MH743 飞行器的首次试飞。首飞的目标不是追求飞行性能，而是验证飞行器的基本功能正常、飞控参数合理、操控响应正确。整个过程应保持保守、有序进行。

16.1 试飞场地选择

试飞场地的选择对首飞安全至关重要。理想的试飞场地应满足以下条件：

开阔性要求： 场地应至少为 30m × 30m 的开阔空间，周围 50m 内无高大建筑物（＞10m）、无密集树冠、无高压电线。开阔场地不仅能减少 GPS 信号遮挡和多径效应，还能在飞行器失控时提供足够的缓冲空间。公园草地、学校操场（非使用时段）、空旷的农田等都是理想选择。避免在居民区、停车场、道路旁等人口密集区域试飞。

地面条件： 优先选择平整的草地或土地作为起降点。水泥地面虽然平整，但飞行器起降时螺旋桨可能弹起小石子，且水泥地面对坠机时缺少缓冲。如果使用水泥地面，建议铺设一块专用的起降垫（Landing Pad）。避免在沙地、碎石地或积水地面起降——这些地面条件会损坏螺旋桨和电机。

环境条件： 首飞应在风速较低的环境下进行，地面风速不超过 5m/s（约3级风）。使用手持风速仪或观察旗帜、树枝的摆动来估计风速。避免在雨天、雾天或极端温度下试飞——湿气可能损坏电子设备，极端低温会降低锂电池性能。最佳的试飞时间是上午 9:00~11:00 或下午 15:00~17:00，此时大气较为稳定、光线充足。

空域合规性： 根据中国民用航空局（CAAC）的规定，确认试飞场地不在机场净空保护区、军事禁区或其他限制飞行区域范围内。可通过"UOM"（无人驾驶航空器一体化综合监管服务平台）查询当地空域限制。对于 250g 以上的无人机，需确保已完成实名登记并在机身粘贴登记标识。

16.2 解锁与起飞操作流程

解锁（Arm）和起飞是首飞中最关键的环节，必须严格按照标准化流程操作。

起飞前最后检查： 在解锁之前，完成以下最后检查清单：

1. 所有人员退至起飞点 5m 以外的安全区域。

2. 螺旋桨已正确安装——正向桨（CCW）安装在逆时针电机上，反向桨（CW）安装在顺时针电机上，桨叶螺母已拧紧。

3. 电池已牢固固定在机架上，电源已连接，电池固定带扣紧。

4. 遥控器已开机，信号连接正常（地面站显示 RSSI 信号强度正常）。

5. GPS 已锁定足够的卫星（≥8颗，3D Fix）。

6. 飞行模式已切换至自稳模式（STABILIZE / ANGLE），这是首飞推荐的模式。

7. 油门摇杆已拉至最低位置。

解锁操作： 执行解锁操作（通常是将偏航摇杆推至最左并保持 1~2 秒，或通过辅助通道开关触发）。解锁成功后，飞控板上的 LED 指示灯会由闪烁变为常亮（或按特定模式闪烁），电机可能会发出轻微的怠速旋转声。解锁后，保持双手握住遥控器，随时准备操控。

起飞操作： 缓慢推高油门摇杆，直到飞行器刚好离地。在离地约 0.5m 的高度保持悬停，此时重点观察以下现象：

• 飞行器是否有明显的水平漂移（前后左右缓慢移动）？轻微的漂移是正常的，但如果飞行器快速向某个方向持续漂移，需要立即降落检查加速度计校准。

• 飞行器是否有持续的偏航旋转（机头缓慢左转或右转）？如有此现象，需降落检查罗盘校准。

• 飞行器的姿态响应是否正确？轻推右摇杆前后左右，确认飞行器的前后左右倾斜方向与摇杆操作一致。

• 飞行器是否出现异常振动或异响？如有，立即降落检查。

如果上述观察一切正常，缓慢将飞行器升高到 2~3m 的高度，开始下一阶段的悬停测试。

【提示】安全提示： 如果在解锁瞬间电机出现异常行为（如某个电机突然高速旋转、电机不转、或飞行器剧烈抖动），立即执行上锁操作（偏航摇杆推至最右并保持）或切断电源。不要在异常状态下尝试"飞起来看看"。

16.3 悬停测试与基本操控

在确认飞行器能够正常起飞和保持悬停后，进行基本操控测试。这一阶段的目的是验证飞行器的操控响应正确、姿态保持稳定。

定点悬停测试： 在 GPS 定点模式（POSHOLD / LOITER）下，将飞行器悬停在约 3m 高度、距飞手 5~10m 的位置。松开所有摇杆（回到中位），观察飞行器的悬停稳定性。在 GPS 定点模式下，飞行器应能在无风条件下保持在约 ±1m 的范围内。如果飞行器持续向某个方向漂移，可能是 GPS 定位精度不足、罗盘校准偏差或加速度计水平校准有误。

基本操控响应测试： 依次测试以下操控动作，每个动作完成后回到悬停状态：

• 俯仰（Pitch）： 轻推右摇杆向前，飞行器应向前飞行并低头；拉回摇杆，飞行器向后飞行并抬头。观察操控灵敏度——如果飞行器反应过激（前倾角度过大），可能需要降低 PID 的 P 值；如果反应迟钝，可能需要增加 P 值。

• 横滚（Roll）： 轻推右摇杆向左/右，飞行器应向对应方向侧飞。观察操控响应是否与俯仰方向一致。

• 偏航（Yaw）： 轻推左摇杆向左/右，飞行器应原地左旋/右旋。观察旋转是否平稳、是否有过冲（overshoot）。

• 油门（Throttle）： 在定高模式下，推高油门飞行器上升，拉低油门飞行器下降。观察高度保持是否稳定——在定高模式下松开油门后，飞行器应保持高度不变。

自稳模式与手动模式对比： 在完成自稳模式（ANGLE / STABILIZE）下的基本操控测试后，如果飞手具备足够的操控经验，可以切换至半自稳模式（HORIZON / ACRO）进行简单的操控体验。注意，在半自稳模式下松开摇杆后飞行器不会自动回平，需要飞手手动控制姿态。首飞阶段不建议长时间使用此模式。

16.4 各飞行模式切换测试

ZP-MH743 支持多种飞行模式，每种模式对应不同的飞控逻辑和传感器使用策略。在首飞中应逐一测试各模式的切换和基本功能。

自稳模式（STABILIZE / ANGLE）： 这是最基本的飞行模式，飞控使用加速度计和陀螺仪保持飞行器的姿态稳定。松开摇杆后，飞行器自动回平（Roll 和 Pitch 回到水平），但不会保持位置或高度。这是手动操控的基础模式，也是失控时的保底模式。在此模式下测试：摇杆中位回平速度是否正常（约 0.5~1 秒回到水平），最大倾斜角度是否符合设置（通常默认 35°~45°）。

定高模式（ALT HOLD）： 在自稳模式基础上增加气压计高度保持功能。松开油门摇杆后，飞行器应保持当前高度。测试要点：油门中位死区是否合理（通常为 ±25~50μs），高度保持精度如何（在平静大气中应保持在 ±0.5m 以内）。如果飞行器在定高模式下持续上升或下降，检查气压计是否受到阳光直射或气流干扰。

GPS 定点模式（POSHOLD / LOITER）： 在定高模式基础上增加 GPS 位置保持功能。松开所有摇杆后，飞行器应保持当前位置和高度。测试要点：位置保持精度（理想条件下 ±1~2m），进入和退出此模式时是否有明显的抖动或跳动。如果进入 GPS 定点模式时飞行器突然向某个方向快速移动，说明 GPS 定位与罗盘航向之间存在偏差，需要降落重新检查罗盘校准。

模式切换测试： 在各模式之间反复切换，观察切换过程是否平滑。特别注意：从 GPS 定点模式切换到自稳模式时，飞行器可能会因为惯性而继续移动，飞手需要立即进行操控修正。从自稳模式切换到 GPS 定点模式时，飞行器应在 2~3 秒内稳定位置。如果切换过程中出现剧烈振荡，立即切回自稳模式并降落。

16.5 降落与上锁操作

降落是飞行的最后环节，同样需要规范操作。

降落流程：

1. 将飞行器飞至飞手正前方约 3m 处，降低高度至 1m 左右。

2. 切换至自稳模式（STABILIZE），以获得最直接的操控响应。

3. 缓慢拉低油门，控制飞行器以约 0.5~1m/s 的速度匀速下降。

4. 当飞行器接近地面时（约 0.3m），保持油门不变，让飞行器自然着陆。避免在触地瞬间突然收油——这可能导致飞行器在触地后弹跳。

5. 确认飞行器完全着陆且稳定后，将油门拉至最低。

6. 执行上锁操作（通常是偏航摇杆推至最右并保持 1~2 秒）。

7. 电机完全停止旋转后，断开电池电源。

【提示】注意事项： 在 GPS 定点模式或定高模式下降落时，飞控会尝试保持高度，导致飞行器在接近地面时"不肯下降"。建议在距地面 1m 以内时切换到自稳模式进行手动降落，或者使用飞控自带的降落模式（LAND）——如果固件支持的话。

上锁后的检查： 上锁后、断开电源前，在地面站中快速检查以下信息：

• 飞行日志是否已正确记录（检查日志文件大小或条目数）。

• 飞行过程中是否有任何警告或错误信息。

• 电池剩余电压是否在安全范围内（如 4S 电池着陆电压不低于 14.0V / 3.5V per cell）。

断开电源后，用手触摸电机和电调，检查是否有异常发热。电机温度不超过 60°C 为正常（手感温热但不烫手），如果某个电机明显比其他电机更热，可能说明该电机存在机械阻力或电调配置问题。

16.6 首飞后数据分析

首飞结束后，应对飞行数据进行分析，以确认飞行器状态良好并为首飞后的调参提供依据。

飞行日志下载： 将飞控板通过 USB 连接至电脑，从地面站下载飞行日志（黑匣子日志）。ZP-MH743 的 STM32H743 处理器通常配备板载 Flash 存储（如 W25Q128 / 128Mbit），可存储大量飞行数据。在地面站中点击"下载日志"按钮，将日志文件保存到电脑。

关键数据分析： 使用日志分析工具（如 Blackbox Explorer、INAV Blackbox Tools 或 UAV Log Viewer）打开日志文件，重点分析以下数据：

• 陀螺仪原始数据： 查看悬停状态下的陀螺仪数据，确认振动水平是否在可接受范围内。如果陀螺仪数据中出现明显的高频振荡，说明存在机械振动问题，需要检查电机平衡、螺旋桨平衡和减震措施。

• PID 控制器输出： 查看 PID 控制器的 P、I、D 各项输出，评估当前 PID 参数的合理性。如果在悬停时 PID 输出持续振荡（周期性的大幅度波动），说明 P 值可能偏高；如果 PID 输出响应迟钝（大幅操控后需要很长时间恢复），说明 P 值可能偏低。

• 电池电压曲线： 查看整个飞行过程中的电池电压变化曲线。正常的电压曲线应在起飞后缓慢下降，在大油门机动时出现短暂下降后恢复。如果电压出现骤降（瞬间下降超过 1V），说明电池内阻过大或连接处存在接触不良。

• GPS 轨迹： 如果飞行中使用了 GPS 定点模式，查看 GPS 记录的飞行轨迹，评估定位精度和航向准确性。

• 电机输出一致性： 查看四个电机的 PWM 输出值，在悬停状态下四个电机的输出应基本一致（差异不超过 5%）。如果某个电机的输出明显偏高或偏低，可能说明电机效率不一致或机架重心偏移。

数据驱动的调参建议： 基于首飞数据分析结果，制定下一步的调参计划。典型的调参优先级为：首先解决振动问题（机械调整），然后优化 PID 参数（软件调整），最后测试 GPS 和自动飞行功能。详细调参方法参见第17章。

【提示】本章目标： 在首飞验证基本功能正常后，通过进阶飞行测试进一步优化飞行器性能，验证自动飞行功能和失效保护机制，确保飞行器在各种工况下的安全性和可靠性。

17.1 PID 调参实战（自稳/角速度环）

PID 控制器是飞控系统的核心算法，其参数直接决定了飞行器的操控手感和稳定性。ZP-MH743 的 STM32H743 处理器提供了强大的计算能力，支持高频率的 PID 运算（通常运行在 8kHz 的陀螺仪采样率和 4~8kHz 的 PID 循环频率），为精确调参提供了硬件基础。

PID 参数基础知识： PID 控制器由三个部分组成：

**• P（比例项 / Proportional）： 决定了飞行器对偏差的即时响应强度。P 值越高，飞行器回正越快、操控越"硬"，但过高会导致振荡（表现为飞行时的高频抖动）。P 值过低，飞行器反应迟钝、操控"软"。

**• I（积分项 / Integral）： 用于消除持续性的稳态偏差（如风力造成的持续偏移）。I 值越高，飞行器抵抗持续外力的能力越强，但过高会导致"积分饱和"——飞行器在快速操控后出现延迟性的反向修正（表现为操控后的摆动）。

**• D（微分项 / Derivative）： 用于抑制 P 项引起的振荡，起阻尼作用。D 值越高，对振荡的抑制越强，但过高会引入高频噪声（表现为电机发热和高频啸叫）。

调参流程（推荐方法）：

调参应在自稳模式（ANGLE）和角速度模式（ACRO / RATE）下分别进行。推荐以下步骤：

步骤一：从默认参数出发。 大多数固件（INAV、Betaflight、ArduPilot）都为常见的机架类型提供了合理的默认 PID 参数。首飞时先使用默认参数，通过首飞日志分析确定需要调整的方向。

步骤二：逐步调整 P 值。选择一个轴（通常从 Roll 轴开始），每次将 P 值增加 10%\~20%，然后进行飞行测试。执行快速横滚操控后松杆，观察飞行器的恢复过程：如果飞行器快速回正且不振荡，P 值合适；如果回正后出现 2\~3 次振荡才稳定，P 值偏高，回调 10%；如果回正缓慢且有"漂移感"，P 值偏低，继续增加。对 Pitch 轴重复同样的操作。

步骤三：调整 D 值。 D 值用于消除 P 值带来的振荡。如果 P 值调好后仍有轻微振荡，逐步增加 D 值（每次增加 5~10 个单位），直到振荡消失。注意 D 值不宜过高——过高的 D 值会导致电机发热和高频噪声，可以通过日志中的电机输出频谱分析来判断。

步骤四：调整 I 值。 在有风环境中飞行，观察飞行器抵抗风力的能力。如果飞行器被风吹偏后恢复缓慢，增加 I 值；如果飞行器在快速操控后出现"甩尾"（过冲后反向修正），降低 I 值。

步骤五：Yaw 轴单独调整。 偏航轴的 PID 通常与 Roll/Pitch 轴差异较大，需要单独调整。偏航轴的 P 值通常较低（避免偏航振荡），D 值通常为零或很小。

【提示】调参安全提示： 每次只修改一个参数，每次修改后立即飞行测试。如果测试中出现严重振荡无法控制，立即切回自稳模式降落，将参数回调到上一个稳定值。调参过程中建议在 GPS 定点模式和自稳模式之间切换——如果某个 PID 参数导致 GPS 模式下不稳定，说明参数过于激进。

17.2 自动航线飞行测试

自动航线飞行是 ZP-MH743 的高级功能之一，通过地面站预设航点（Waypoint），飞行器按照预设的路线自动飞行。这一功能广泛用于航拍、测绘、巡检等应用场景。

航线规划： 在地面站（如INAV Mission Control 或 QGroundControl）中规划一条简单的测试航线。首条航线建议包含3\~5 个航点，航线形状为简单的矩形或三角形，航点间距 20\~50m，飞行高度统一设置为 10\~20m（确保高于周围障碍物）。每个航点设置合理的飞行速度（建议 3\~5m/s），避免在首个测试航线中使用高速飞行。

航线上传与验证： 将规划好的航线上传至飞控板，然后在地面站中重新下载航线进行比对，确认上传的航线与规划的一致。特别检查：航点的高度值、飞行速度、在每个航点的动作（如拍照、悬停等待等）。

自动航线执行： 起飞后切换至航线飞行模式（MISSION / WP），飞行器将自动飞向第一个航点。在执行过程中，飞手应始终保持对飞行器的目视观察，手指放在模式切换开关上，随时准备切回手动模式接管。重点观察以下内容：

• 飞行器是否准确地飞越每个航点？航点偏差是否在可接受范围内（通常 ±2~3m）？

• 在航点间的转弯是否平滑？转弯半径是否合理？

• 到达最后一个航点后，飞行器是否按预期执行结束动作（如悬停等待、自动返航或降落）？

• 飞行速度是否稳定？是否出现忽快忽慢的现象？

航线精度优化： 如果航线执行精度不理想，可以从以下方面优化：增加 GPS 采样率（确认 ZP-MH743 的 GPS 串口配置为 10Hz）、优化 PID 参数（特别是位置环的 P 值）、检查航点间的距离是否过短（过短的间距会导致飞行器频繁加减速）、确认风速是否在合理范围内（强风会显著降低航线精度）。

17.3 返航（RTH/RTL）功能测试

返航功能是飞行器的安全保障机制之一，在飞手失去对飞行器的控制或主动触发时，飞行器自动返回起飞点并降落。ZP-MH743 通过 GPS 和罗盘的协同工作实现返航功能。

返航参数设置： 在地面站中配置返航相关参数，关键参数包括：

• 返航高度（RTH Altitude）： 飞行器在返航过程中爬升到的安全高度，应高于飞行区域内所有障碍物。例如，如果周围最高的建筑物为 30m，返航高度应设置为 40~50m。

• 返航速度（RTH Speed）： 返航过程中的水平飞行速度，建议设置为 5~8m/s。

• 降落速度（Landing Speed）： 到达起飞点后的下降速度，建议设置为 0.5~1m/s，避免着陆冲击过大。

• 返航触发条件： 配置哪些情况下自动触发返航——遥控器失联（Failsafe）、GPS 信号丢失、低电压等。

手动返航测试： 在 GPS 定点模式下，将飞行器飞到距起飞点 50100m 的位置，高度 10~20m。然后通过遥控器开关触发手动返航（RTH 模式）。观察飞行器的返航过程：

1. 飞行器是否首先爬升至设定的返航高度？（如果当前高度已高于返航高度，应直接水平飞行。）

2. 飞行方向是否直接指向起飞点？如果飞行器偏离了起飞点方向飞行，说明罗盘校准存在偏差。

3. 到达起飞点上方后，飞行器是否稳定悬停片刻后开始缓慢下降？

4. 着陆过程是否平稳？着陆后是否自动上锁？

偏差分析： 返航精度受多种因素影响。GPS 定位精度（HDOP）直接影响起飞点的记录精度——如果首飞时 GPS 搜星不充分就记录了 Home 点，后续返航的精度会大幅下降。建议在每次起飞后、开始飞行任务前，等待 GPS 锁定足够多的卫星（≥10颗）后再记录 Home 点。如果返航落地点偏差超过 5m，检查 GPS 天线安装和罗盘校准。

17.4 失效保护测试（遥控器失联、GPS 丢失、低电压）

失效保护（Failsafe）是飞行器在出现异常情况时的最后一道安全防线。在受控环境下验证失效保护功能的正确性，是进阶测试的重要内容。

【提示】安全警告： 失效保护测试存在一定风险，必须在开阔、无人的场地进行，且飞手应随时准备通过重新建立信号连接来中止测试。建议有助手在场协助观察。

遥控器失联保护测试： 在 GPS 定点模式下，将飞行器悬停在 10m 高度、30m 远处。关闭遥控器电源（模拟遥控器失联），观察飞行器的行为。根据预设的失效保护策略，飞行器应执行以下操作之一：

• 自动返航（RTH）： 飞行器爬升至返航高度后飞回起飞点——这是最推荐的失联保护策略。

• 原地降落（LAND）： 飞行器在当前位置缓慢下降并着陆——适用于飞行区域较小、返航路线可能有障碍物的场景。

• 悬停等待（HOVER）： 飞行器在当前位置悬停等待信号恢复——适用于信号可能短暂中断的场景。

在关闭遥控器后，等待 5~10 秒（这是典型的失效保护触发延迟时间），确认飞行器开始执行预设的保护动作。然后重新打开遥控器，确认信号恢复后能够重新获得控制权。

GPS 信号丢失保护测试： 在 GPS 定点模式下飞行时，用铝箔纸包裹 GPS 天线（模拟 GPS 信号被遮挡），观察飞控的行为。当 GPS 信号丢失时，飞控应自动切换到不依赖 GPS 的飞行模式（如自稳模式或定高模式），并触发警告（如蜂鸣器响起、OSD 显示警告信息）。飞手应能在手动模式下安全接管飞行器。测试完成后，移除铝箔纸，确认 GPS 信号恢复正常。

低电压保护测试： 在地面站中设置低电压警告阈值（如 3.5V/cell）和低电压保护触发阈值（如 3.3V/cell）。在飞行过程中，当电池电压降至警告阈值时，飞控应通过 OSD 显示警告信息或蜂鸣器报警。当电压继续降低至保护阈值时，飞控应自动触发返航或降落。注意：此测试会对电池造成较大压力，建议使用状态良好的电池并在电压降至保护阈值后立即着陆。

低电压保护参数设置建议：

17.5 大机动飞行与极限测试（按需）

大机动飞行和极限测试用于验证飞行器在高负载工况下的性能和可靠性。此类测试具有一定的风险性，仅建议在完成前述所有测试且对飞行器状态有充分信心后进行。

快速机动测试： 在 GPS 定点模式下，执行快速的前飞、后飞、侧飞和旋转操作，观察飞行器的响应和恢复能力。重点检查：快速操控后飞行器是否能迅速稳定（不超过 2~3 次振荡）、电机和电调是否出现过热保护、PID 控制器是否出现积分饱和。

最大速度测试（按需）： 在自稳模式下，满油门前飞测试飞行器的最大水平速度。注意：高速飞行时螺旋桨效率降低、电机负载增加，需密切监控电池电压和电机温度。建议在 GPS 定点模式下设置最大速度限制（如 15m/s），防止飞行器飞出可视范围。

抗风能力测试（按需）： 在有风条件下（5~8m/s）飞行，评估飞行器在风力干扰下的姿态保持能力和航向稳定性。如果飞行器在大风中出现严重的姿态偏移或无法维持航向，可能需要增加 PID 的 I 值或降低最大倾斜角度限制。

极限载荷测试（按需）： 如果飞行器设计用于携带载荷（如相机、传感器等），在安装载荷后进行飞行测试，验证飞行器在满载条件下的悬停稳定性和操控响应。注意：载荷会改变飞行器的重心位置和总质量，可能需要重新进行加速度计校准和 PID 调参。

【提示】极限测试安全提醒： 极限测试时务必保持足够的安全距离（人员距离飞行器 10m 以上），确保电池有充足的电量余量（测试结束时电池电量不低于 30%），并制定应急预案（如预设紧急降落点、准备灭火器）。如果测试中出现任何异常（电机过热、结构异响、操控响应异常），立即中止测试并降落检查。

【提示】本章目标： 系统性地介绍 ZP-MH743 飞行器在试飞过程中可能遇到的常见问题及其诊断排除方法。掌握这些排故技能，能够显著提高试飞效率，减少因问题排查不当导致的安全事故。

18.1 振动异常分析与处理

振动是多旋翼飞行器最常见也最容易被忽视的问题之一。ZP-MH743 飞控板上搭载的 IMU（惯性测量单元）对振动非常敏感——过大的振动会导致陀螺仪和加速度计数据失真，进而引发姿态估计错误、PID 控制不稳定甚至飞行失控。

振动的识别方法：

振动问题通常有以下表现：飞行器悬停时出现肉眼可见的高频抖动（桨叶模糊）；地面站中的陀螺仪数据出现大幅度的高频噪声；PID 输出中的 D 项异常偏高；电机发出异常的高频啸叫声；飞行日志中的加速度计数据显示 Z 轴振动幅值超过 2~3 m/s²（正常值应低于 1 m/s²）。

振动的来源分类：

诊断步骤：

1. 日志分析定位： 下载飞行日志，使用 FFT（快速傅里叶变换）分析工具查看陀螺仪数据的频率谱。正常飞行器的频谱应相对平滑，主频（对应螺旋桨转速）处有一个峰值但不超过阈值。如果频谱中出现异常的尖峰，根据频率可以初步判断振动来源。例如，如果主频为 80Hz（对应电机转速约 4800RPM）处的峰值特别突出，说明是螺旋桨或电机的转速同频振动。

2. 逐一排查法： 分别更换每个螺旋桨（使用已知平衡良好的桨叶），测试振动是否改善。如果更换某个桨叶后振动明显降低，说明该桨叶存在不平衡问题。如果更换所有桨叶后振动仍无改善，问题可能在电机或机架上。

3. 电机排查： 拆下螺旋桨，用手转动每个电机，感受是否有卡涩、异响或不均匀的阻力。如果某个电机转动不顺畅，可能轴承已损坏。使用电机测试功能，逐一让每个电机在不同转速下运行，观察振动变化。

处理措施：

• 螺旋桨平衡： 使用螺旋桨平衡器（Prop Balancer）对桨叶进行平衡校正。在较轻的一侧粘贴透明胶带增加重量，直到桨叶在平衡器上可以静止在任意角度。

• 电机更换： 如果确认电机轴承磨损或轴弯曲，更换电机。安装新电机后重新进行振动测试。

• 减震改善： 检查飞控板的减震垫是否被压扁或老化，必要时更换更软的减震垫。对于严重振动的机架，可以考虑在飞控板下方使用双层减震（如硅胶垫 + 泡沫垫）。

• 软件滤波： 在飞控固件中配置陀螺仪低通滤波器（Gyro Low-Pass Filter），滤除高频振动噪声。ZP-MH743 的 STM32H743 处理器具有充足的计算资源支持多级滤波，但过度滤波会引入相位延迟，需要在滤波效果和操控响应之间取得平衡。推荐的滤波器截止频率为振动主频的 1.5~2 倍。

18.2 漂移/偏航问题分析

飞行器在悬停时出现缓慢的水平漂移或持续的偏航旋转，是试飞中常见的问题。漂移可能由多种原因引起，需要系统性地逐一排查。

水平漂移分析：

水平漂移（飞行器在 GPS 定点模式下缓慢向某个方向移动）的可能原因及处理方法：

原因一：加速度计水平校准偏差。 这是最常见的原因。如果飞控板安装不完全水平，或加速度计校准时的台面不够水平，飞控会将倾斜角度误判为"水平"，导致飞行器向一个方向持续漂移。处理方法：将飞行器放置在绝对水平的台面上（使用水平仪确认），重新执行加速度计校准。校准后在地面站中确认 Roll 和 Pitch 角度读数接近 0°。

原因二：GPS 定位漂移。 GPS 定位本身存在随机误差，在卫星信号较弱（如建筑物遮挡、多云天气）时误差会增大。如果漂移方向随机变化且速度较慢（＜0.5m/s），可能是正常的 GPS 定位波动。处理方法：等待 GPS 搜星条件改善后再飞行，确保 HDOP 值＜2.0。

原因三：风力影响。 即使是微风（2~3m/s）也会导致飞行器在自稳模式下持续漂移。在 GPS 定点模式下，飞控会自动抵抗风力保持位置，但如果风力持续增强超出飞控的修正能力，仍可能出现漂移。处理方法：降低飞行高度（地面附近风力较小），或增加 PID 的 I 值以提高抗风能力。

原因四：重心偏移。 如果电池安装位置偏离机架中心，飞行器的重心不在几何中心，飞控需要持续输出不平衡的电机力来维持姿态，这在长时间飞行中可能导致漂移。处理方法：调整电池安装位置，使整机重心尽可能位于机架几何中心。

偏航漂移分析：

偏航漂移（飞行器在悬停时缓慢旋转，俗称"马桶效应"）通常由罗盘问题引起：

原因一：罗盘校准不准确。 这是"马桶效应"的最常见原因。处理方法：在远离金属物体和电子设备的环境下重新执行罗盘校准，确保校准时进行了充分的三维旋转。

原因二：罗盘安装方向错误。 如果外置罗盘的安装方向与飞控固件中设置的方向不一致，会导致航向信息完全错误。处理方法：确认罗盘模块上的方向标记（箭头）朝向机头方向，并在地面站中正确设置罗盘安装方向参数（如 CW0、CW90、CW180、CW270）。

原因三：磁场干扰。 大电流导线（电调到电机的三相线）在通电时会产生磁场，干扰附近的罗盘传感器。处理方法：确保罗盘安装位置远离大电流线路（距离 ≥5cm），如果条件允许，使用外置罗盘并将其安装在 GPS 桅杆顶部。

18.3 电机/电调故障排查

电机和电调是飞行器的动力执行机构，其故障直接影响飞行安全。以下是常见的电机/电调问题及排查方法。

电机不转或启动困难：

可能的原因及排查步骤：

1. 电调信号问题： 在地面站的电机测试页面点击测试按钮，使用示波器或逻辑分析仪测量飞控到电调的信号线，确认是否有正确的 PWM 或 DShot 信号输出。如果无信号，检查飞控的定时器配置和引脚分配。

2. 电调供电问题： 测量电调的电源输入端电压，确认电池供电正常到达电调。如果电压为零，检查 PDB 板上的焊接和保险丝。

3. 电调配置问题： 某些电调需要在使用前进行油门行程校准（Throttle Range Calibration）。如果油门行程未校准，电调可能无法正确识别飞控发出的油门信号。按照电调说明书执行校准流程。

4. 电机内部故障： 用万用表测量电机三相绕组之间的电阻值，三相电阻应基本一致（差异＜10%）。如果某相电阻明显偏大或为无穷大，说明绕组断路。如果某相电阻为零，说明绕组短路。

电机过热：

电机温度超过 80°C 为过热。常见原因：PID 的 D 值过高（导致高频振荡消耗大量能量）、螺旋桨尺寸过大导致电机过载、电机轴承磨损增加摩擦阻力、电调时序（Timing）设置不当。处理方法：首先检查 PID 参数是否合理（降低 D 值测试），然后检查螺旋桨与电机的匹配关系，最后检查电机轴承状态。

电调故障：

电调的常见故障表现：某个电机完全不响应（电调损坏）、电机间歇性停转（电调过温保护或 BEC 供电不足）、所有电机同时失去动力（主 BEC 故障或电源模块故障）。排查方法：将疑似故障的电调与正常工作的电调交换信号线和电机，如果故障跟随电调移动，则确认电调损坏；如果故障留在原位，则问题在信号端。

电调固件更新： 对于支持 BLHeli_32 或 AM32 固件的电调，建议定期检查并更新固件。新版本的固件通常包含改进的启动特性、更精确的时序控制和更好的 DShot 协议兼容性。使用 BLHeli Configurator 或 AM32 Configurator 通过飞控直通（Passthrough）功能更新电调固件，更新后重新进行油门行程校准。

18.4 GPS 定位精度问题

GPS 定位精度直接影响 GPS 定点飞行、自动航线和返航功能的可靠性。以下是常见的 GPS 精度问题及其解决方法。

搜星困难/卫星数不足：

如果 GPS 模块在开阔环境下长时间（超过 5 分钟）仍无法锁定足够的卫星（＜6颗），可能的原因包括：

1. GPS 天线遮挡： 检查 GPS 模块安装位置，确保天线上方无金属遮挡物。碳纤维材料对 GPS 信号有一定衰减（约 3~6dB），如果 GPS 安装在碳纤维板下方，建议将 GPS 移至机架顶部。

2. GPS 模块故障： 将 GPS 模块连接至电脑（通过 USB-TTL 转接板），使用 u-blox 的 u-center 软件查看原始卫星信号强度。如果所有卫星的信号强度（C/N0）均低于 25dB-Hz，可能是 GPS 天线损坏或模块故障。

3. 星历过期： 如果 GPS 模块长时间未使用（超过数周），星历数据可能已过期，导致冷启动时间显著增加。解决方法：在开阔环境下保持 GPS 通电 15~30 分钟，让其重新下载星历。

定位漂移/跳动：

GPS 定位点在短时间内大幅度跳动（跳动幅度＞5m），可能的原因：

1. 多径效应： GPS 信号被周围的建筑物、金属表面反射后到达天线，导致定位计算错误。典型场景：在建筑物附近飞行、在金属屋顶上方飞行。解决方法：远离反射面，选择开阔场地飞行。

2. 电磁干扰： 图传（VTX）的大功率射频信号可能干扰 GPS 接收。特别是当图传天线距离 GPS 天线过近时（＜10cm），干扰尤为严重。解决方法：增加图传天线与 GPS 天线的距离，或使用 GPS 模块自带的陶瓷滤波器和 SAW 滤波器。

3. GPS 模块质量问题： 低质量的 GPS 模块（如未使用 SAW 滤波器和 LNA 低噪声放大器的模块）在复杂环境下性能急剧下降。建议使用带 SAW 滤波器和 LNA 的 M8N 或 M10 系列 GPS 模块。

返航落点偏差大：

返航落点偏离起飞点超过 5m，可能的原因：

1. Home 点记录不准确： 如果在 GPS 搜星不充分时（卫星数＜8）就记录了 Home 点，该点坐标本身就有较大误差。解决方法：每次起飞后等待 GPS 锁定≥10颗卫星、HDOP＜1.5 后再记录 Home 点。

2. 罗盘偏差导致航向错误： 返航方向依赖罗盘提供的航向信息，罗盘偏差会直接导致返航路径偏离。解决方法：重新进行罗盘校准，并验证航向准确性。

3. 风的影响： 返航过程中遇到侧风，飞行器需要时间修正风偏。在大风条件下，返航精度会自然降低。解决方法：适当增加返航速度以提高抗风能力，或在风力较小时进行返航测试。

18.5 日志分析方法（黑匣子/Flash 日志解读）

飞行日志（黑匣子数据）是诊断飞行问题的最有价值的工具。ZP-MH743 的 STM32H743 处理器配备了高速 SPI 接口，可以以高数据速率将飞行数据实时写入板载 Flash 芯片（如 W25Q128），记录包括陀螺仪原始数据、加速度计数据、PID 输出、电机输出、GPS 数据、电池数据等在内的完整飞行信息。

日志下载与管理：

将飞控通过 USB 连接电脑，在地面站中进入"黑匣子"/"Flash 日志"页面，可以查看存储的日志列表。每次飞行（从上锁到下次解锁之间）生成一条独立的日志记录。点击"下载"按钮将日志文件保存到电脑。建议按日期和飞行目的对日志文件进行归档管理，便于后续回溯分析。

日志分析工具选择：

• *Blackbox Explorer（INAV/Betaflight 官方工具）：* 支持图形化显示所有飞行参数，内置 FFT 分析功能，是分析 PID 性能和振动问题的首选工具。

**• UAV Log Viewer（在线工具）： 无需安装软件，直接在浏览器中查看日志，适合快速浏览和分享。

**• Python + pandas（自定义分析）： 对于需要深度定制的分析需求（如统计特定条件下的数据分布），可以使用 Python 脚本读取 CSV 格式的日志数据进行处理。

关键日志字段解读：

振动分析的 FFT 方法：

在 Blackbox Explorer 中，选择悬停阶段的陀螺仪数据，点击"FFT"按钮生成频率谱图。正常的频率谱图应呈现以下特征：

• 在电机旋转频率处（通常 50~120Hz，取决于螺旋桨尺寸和电机转速）有一个清晰的主峰。

• 主峰之外无明显的异常峰值。

• 高频段（＞200Hz）的能量较低，说明机械滤波和软件滤波效果良好。

如果频谱图中出现以下异常，需要针对性处理：

• 低频段（＜50Hz）出现大幅峰值：可能是机架刚性不足或机臂松动。

• 中频段（50~200Hz）出现多个尖锐峰值：可能是电机轴承问题或螺旋桨严重不平衡。

• 高频段（＞200Hz）能量异常偏高：可能是 PID 参数过于激进（D 值过高）或电调 PWM 频率与结构共振。

基于日志的 PID 调参分析：

分析快速操控动作（如快速横滚后松杆）时的 PID 输出波形，可以指导 PID 参数调整：

• 如果松杆后 P 项输出呈衰减振荡（振幅逐渐减小），且衰减时间超过 0.5 秒，说明 P 值偏高或 D 值偏低。

• 如果松杆后 P 项输出呈过阻尼响应（缓慢回到零，无振荡），说明 P 值偏低。

• 如果 I 项输出在快速操控后持续偏大且缓慢恢复，说明存在积分饱和，应降低 I 值或增加积分限幅（I-term Limit）。

故障复盘案例：

案例一：飞行器在 GPS 定点模式下突然快速向右侧漂移。通过分析日志发现，在漂移发生时刻 GPS_numSat 从 12 骤降至 4，HDOP 从 1.2 升至 5.8，说明 GPS 信号突然恶化（可能是卫星经过遮挡区域）。飞控在卫星数不足时无法维持位置锁定，导致漂移。解决方案：避免在该区域的同一时间段进行 GPS 依赖型飞行。

案例二：飞行器在悬停时出现持续的偏航振荡（约 2Hz 频率的左右摆动）。日志分析显示 Yaw 轴的 axisP 和 axisD 输出同步振荡，FFT 分析在 2Hz 处有明显的峰值。降低 Yaw P 值后振荡消失，但响应变慢。最终通过将 Yaw P 值降低 30% 并适当增加 Yaw I 值来平衡响应速度和稳定性。

【提示】日志分析的黄金法则： 每次飞行后都下载并保存日志，即使飞行看起来一切正常。当问题发生时，对比正常飞行和异常飞行的日志数据，往往能快速定位问题根源。养成"飞行必记、有疑必查"的习惯，是成为成熟飞手和调试工程师的关键。

【提示】本篇小结： 试飞与调试是将理论设计和实际飞行连接起来的桥梁。从严格的试飞前检查，到谨慎的首飞验证，再到系统的进阶测试和问题诊断，每一个环节都需要耐心、细致和科学的方法。ZP-MH743 飞控基于 STM32H743 的强大性能为精确控制提供了硬件保障，但最终的飞行品质取决于调试者对系统的理解和对细节的把控。牢记安全第一，循序渐进，不断积累经验，你的飞行器将越飞越好。

19.1 ROS2 概述

ROS2（Robot Operating System 2）是当前机器人与无人机上层应用开发中广泛使用的开源中间件平台。相比 ROS1，ROS2 在实时性、跨平台支持、通信机制和工程部署能力等方面都有明显提升。对于无人机系统而言，ROS2 主要承担高层任务规划、状态感知、数据记录、仿真验证以及与飞控之间的数据通信等功能。

本章主要完成以下内容：

• 搭建 ROS2 Jazzy 开发环境；
• 验证 ROS2 基本通信功能；
• 安装开发工具 colcon 与 rosdep；
• 创建 ROS2 工作空间；
• 创建 Python 功能包 drone_tools；
• 编写并运行 hello_drone 节点；
• 测试节点的话题发布与订阅功能。

19.2 ROS2 开发环境安装与验证

19.2.1 使用小鱼 ROS 一键安装

为提高安装效率，本实验采用小鱼 ROS 一键安装方式完成 ROS2 环境部署。通过下载安装脚本并运行，可自动完成 ROS2 软件安装及常用环境配置。

wget http://fishros.com/install -O fishros  . fishros

图19-1 小鱼 ROS 一键安装脚本页面

19.2.2 ROS2 环境检查

ROS2 安装完成后，首先需要检查系统中 ROS2 是否可正常调用。通过加载 Jazzy 环境变量，并运行 ros2 --help 命令，可以查看 ROS2 命令行工具是否可用。

source /opt/ros/jazzy/setup.bash
ros2 --help

当终端能够正确显示 topic、node、service、run、launch 等 ROS2 常用命令时，说明 ROS2 基础环境安装成功。

图19-2 ROS2 命令帮助界面

19.2.3 使用 talker 与 listener 验证通信

为了进一步验证 ROS2 的发布/订阅通信功能，本实验分别运行官方示例节点 talker 和 listener。

终端1：运行发布者 talker

source /opt/ros/jazzy/setup.bash
ros2 run demo_nodes_cpp talker

该节点会持续向外发布字符串消息“Hello World”。

图19-3 talker 节点运行结果

终端2：运行订阅者 listener

source /opt/ros/jazzy/setup.bash
ros2 run demo_nodes_py listener

该节点会接收 talker 节点发送的消息，并在终端中显示“I heard: [Hello World: x]”。

图19-4 listener 节点运行结果

如果 talker 能持续发布消息，listener 能同步接收消息，则说明 ROS2 的基本通信机制工作正常。

19.2.4 开发工具检查

ROS2 开发过程中常用的两个工具分别为 colcon 和 rosdep。colcon 用于编译 ROS2 工作空间，rosdep 用于自动安装功能包依赖。

colcon --help
rosdep --version

若终端能够正确显示 colcon 的帮助信息，并输出 rosdep 版本号，则说明相关开发工具环境正常。

图19-5 colcon 与 rosdep 工具检查结果

19.3 ROS2 工作空间创建与功能包配置

19.3.1 创建 ROS2 工作空间

在 ROS2 中，用户自定义程序通常放置在工作空间中进行统一管理。实验中创建的工作空间名称为 ros2_ws。

mkdir -p ~/ros2_ws/src
cd ~/ros2_ws
colcon build

完成后，工作空间中会自动生成 build、install、log 和 src 等目录，这说明工作空间已创建成功。

图19-6 工作空间创建与初始编译结果

19.3.2 创建 Python 功能包 drone_tools

进入工作空间源码目录后，创建 Python 类型的 ROS2 功能包 drone_tools：

cd ~/ros2_ws/src
ros2 pkg create --build-type ament_python drone_tools --dependencies rclpy std_msgs geometry_msgs

创建完成后，可通过 tree 命令查看其目录结构：

tree ~/ros2_ws/src/drone_tools

功能包中包含 package.xml、setup.py、setup.cfg、resource、drone_tools 和 test 等标准目录与文件，说明 Python 功能包创建成功。

图19-7 drone_tools 功能包目录结构

19.3.3 编写 hello_drone.py 节点程序

在 drone_tools/drone_tools 目录下创建 hello_drone.py 文件，用于编写第一个 ROS2 无人机示例节点。

该节点主要实现以下功能：

• 发布无人机状态话题 /drone/status；
• 发布模拟位姿话题 /drone/pose；
• 订阅控制指令话题 /drone/command；
• 根据接收到的文字指令输出相应提示信息。

图19-8 hello_drone.py 节点代码编写界面

程序编写完成后，需要赋予执行权限：

chmod +x hello_drone.py

19.3.4 配置 setup.py 入口文件

为了能够通过 ros2 run 直接运行 Python 节点，需要在功能包的 setup.py 中注册入口函数。在 entry_points 中加入：

'hello_drone = drone_tools.hello_drone:main',

该配置表示在终端执行 ros2 run drone_tools hello_drone 时，将自动调用 hello_drone.py 中的 main() 函数。

图19-9 setup.py 入口配置界面

19.3.5 安装依赖并编译功能包

在工作空间根目录中执行以下命令安装依赖：

cd ~/ros2_ws
rosdep install -i --from-paths src --rosdistro jazzy -y

当终端输出“All required rosdeps installed successfully”时，说明功能包依赖安装成功。

图19-10 rosdep 依赖安装成功界面

随后对功能包进行编译：

colcon build --packages-select drone_tools --symlink-install

编译成功后，终端会显示 Starting drone_tools、Finished drone_tools 和 Summary: 1 package finished。

图19-11 drone_tools 功能包编译成功界面

19.3.6 加载工作空间环境

功能包编译完成后，需要重新加载 ROS2 环境以及当前工作空间环境：

source /opt/ros/jazzy/setup.bash
source ~/ros2_ws/install/setup.bash

随后使用以下命令检查功能包是否已被 ROS2 正确识别：

ros2 pkg list | grep drone_tools

若终端输出 drone_tools，则说明该功能包已成功注册到当前 ROS2 环境中。

图19-12 工作空间环境加载与功能包识别结果

19.4 Hello Drone 节点运行与通信测试

19.4.1 运行 hello_drone 节点

在终端中输入：

source /opt/ros/jazzy/setup.bash
source ~/ros2_ws/install/setup.bash
ros2 run drone_tools hello_drone

运行后，节点会周期性输出 Hello Drone 节点已启动、飞控型号 ZP-MH743（模拟状态）以及发布状态等信息，说明节点已开始正常工作，并持续发布无人机状态信息。

图19-13 hello_drone 节点运行结果

19.4.2 查看 /drone/pose 话题数据

在另一个终端中输入：

source /opt/ros/jazzy/setup.bash
source ~/ros2_ws/install/setup.bash
ros2 topic echo /drone/pose

终端中会持续输出位姿消息，包括坐标位置 x、y、z 和姿态四元数 x、y、z、w。当前节点持续发布的位姿信息为固定模拟值：位置为 (0.0, 0.0, 0.0)，姿态为 (0.0, 0.0, 0.0, 1.0)，说明 /drone/pose 话题发布功能正常。

图19-14 /drone/pose 话题查看结果

19.4.3 发送 /drone/command 指令测试

为了验证节点的订阅功能，在终端中分别向 /drone/command 话题发布三条测试命令：

ros2 topic pub --once /drone/command std_msgs/msg/String {data: 'ARM'}
ros2 topic pub --once /drone/command std_msgs/msg/String {data: 'TAKEOFF'}
ros2 topic pub --once /drone/command std_msgs/msg/String {data: 'LAND'}

实验结果表明，发送 ARM、TAKEOFF 和 LAND 后，hello_drone 节点能够分别接收指令，并输出模拟执行解锁、起飞和降落的提示信息，说明节点已经能够正常订阅并处理控制指令。

图19-15 /drone/command 指令发布与接收测试结果

19.4.4 查看节点与话题信息

为进一步验证节点的通信关系，可使用以下命令查看节点和话题信息：

ros2 node info /hello_drone_node
ros2 topic list | grep drone
ros2 topic type /drone/status

实验结果显示，节点 /hello_drone_node 已正常注册；话题列表中成功出现 /drone/command、/drone/pose 和 /drone/status；/drone/status 的消息类型为 std_msgs/msg/String。由此可见，该节点的发布、订阅以及 ROS2 注册信息均正常。

图19-16 节点与话题信息查看结果

19.5 本章小结

本章完成了 ROS2 Jazzy 基础开发环境的搭建与验证，并通过 hello_drone 节点实现了 ROS2 基本通信流程的实践。主要完成内容如下：

• 采用小鱼 ROS 一键安装方式完成 ROS2 Jazzy 环境部署；
• 使用 ros2 --help 验证 ROS2 命令行工具可正常使用；
• 使用 talker 与 listener 示例验证 ROS2 发布/订阅通信功能；
• 检查 colcon 与 rosdep 工具工作正常；
• 成功创建 ROS2 工作空间 ros2_ws；
• 成功创建 Python 功能包 drone_tools；
• 编写并运行 hello_drone 节点；
• 实现 /drone/status 和 /drone/pose 的发布；
• 实现 /drone/command 的订阅与处理；
• 完成节点信息与话题类型的检查验证。

通过本章实验，已经掌握了 ROS2 的基础开发流程，包括环境搭建、工作空间创建、功能包管理、节点编写以及话题通信测试等内容，为后续 MAVROS2、PX4 桥接和无人机上层控制节点开发打下基础。

MAVLink（Micro Air Vehicle Link）是一种轻量级无人机通信协议，主要用于飞控、地面站、机载计算机和外围设备之间的数据交换。本章采用 Ubuntu 24.04、PX4 SITL、Gazebo Sim、Python 3 和 Pymavlink 完成 MAVLink 通信实验。

Gazebo X500 → PX4 SITL → MAVLink/UDP → Pymavlink Python程序

20.1 MAVLink 协议概述

MAVLink 不是飞控算法，也不是地面站软件，而是一套通信规则。它规定消息如何封装、系统和组件如何编号、数据如何校验，以及控制命令和状态数据如何传输。

20.2 软件安装与环境准备

20.2.1 创建虚拟环境并安装 Pymavlink

mkdir -p ~/mavlink_lab
cd ~/mavlink_lab
python3 -m venv venv
source venv/bin/activate
python -m pip install --upgrade pip
pip install pymavlink

终端前出现 (venv) 表示虚拟环境已激活。截图中 Pymavlink、lxml 和 fastcrc 均已成功安装。

图20-1 Pymavlink 安装完成

20.2.2 安装基础开发工具

sudo apt update
sudo apt install -y git wget curl gedit python3 python3-pip python3-venv build-essential cmake ninja-build

截图中各软件均显示已安装或已经是最新版本。

图20-2 基础开发工具安装与检查

20.2.3 下载或检查 PX4-Autopilot 源码

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

# 若目录已存在
cd ~/PX4-Autopilot
git submodule update --init --recursive
ls

出现 boards、src、Tools、Makefile 和 CMakeLists.txt 等内容，说明源码目录存在。

图20-3 PX4-Autopilot 源码与目录检查

20.2.4 安装 PX4 开发环境与 Gazebo

cd ~/PX4-Autopilot
bash ./Tools/setup/ubuntu.sh
sudo reboot

安装脚本会配置 PX4 编译依赖和 Gazebo 仿真环境。截图中 Gazebo Harmonic、OpenCV 和相关开发库均已安装。

图20-4 PX4 开发环境与 Gazebo 安装完成

20.2.5 启动 PX4 SITL 与 Gazebo X500

cd ~/PX4-Autopilot
make px4_sitl gz_x500

成功时，Gazebo 中出现 X500 四旋翼，实体树中出现 x500_0，PX4 终端启动 MAVLink、日志和仿真模块。

图20-5 PX4 SITL 与 Gazebo X500 仿真启动

20.2.6 验证 Pymavlink 与 MAVLink v2 消息库

cd ~/mavlink_lab
source venv/bin/activate
python -c from pymavlink import mavutil; print('Pymavlink安装成功')
python -c from pymavlink.dialects.v20 import common; print('MAVLink v2消息库加载成功')
pip show pymavlink

实验中 Pymavlink 版本为 2.4.49，MAVLink v2 方言能够正常加载。

图20-6 Pymavlink 与 MAVLink v2 消息库验证

20.3 PX4 MAVLink 通信链路

在 PX4 的 pxh 终端中输入以下命令：

mavlink status

该命令用于查看 MAVLink 实例、模式、协议版本、UDP 端口、发送速率和丢包率。截图中可以看到 MAVLink version 2、UDP、Onboard 和 Gimbal 等链路信息。

图20-7 PX4 MAVLink 通信链路状态

20.4 HEARTBEAT 心跳消息实验

HEARTBEAT 的消息 ID 为 0，用于表明系统或组件在线，同时携带飞行器类型、自动驾驶仪类型、模式和系统状态。

cd ~/mavlink_lab
source venv/bin/activate
python heartbeat_monitor.py

实验结果显示系统ID为1、组件ID为1、飞行器类型为四旋翼、自动驾驶仪为 PX4，并能够持续接收心跳。

图20-8 Pymavlink 接收 PX4 HEARTBEAT 心跳消息

20.5 常用 MAVLink 消息接收

cd ~/mavlink_lab
source venv/bin/activate
python message_monitor.py

实验成功接收到本地位置、速度、姿态、电池和系统状态。截图中电池电压为16.20 V，剩余电量为100%。

图20-9 常用 MAVLink 消息接收结果

20.6 MAVLink v2 帧结构与 CRC 校验

cd ~/mavlink_lab
source venv/bin/activate
python frame_parser.py

解析结果显示 STX 为0xFD、消息ID为0、帧内CRC与计算CRC均为0xFA7E，CRC一致为True。

图20-10 MAVLink v2 数据帧与 CRC 解析结果

20.7 常用消息 ID 与 MAV_CMD

MAVLink 使用消息ID区分 HEARTBEAT、姿态、位置、电池和任务消息；使用 MAV_CMD 区分航点、返航、起飞、降落和解锁等命令。

cd ~/mavlink_lab
source venv/bin/activate
python message_dictionary.py

图20-11 常用 MAVLink 消息、任务消息和 MAV_CMD 编号

20.8 心跳连接与断连检测

程序记录最近一次收到 HEARTBEAT 的时间。超过设定阈值仍未收到新心跳时，将链路判定为断开。本实验超时阈值设置为5秒。

cd ~/mavlink_lab
source venv/bin/activate
python connection_manager.py

程序首先显示 PX4 上线；停止 PX4 后，等待5秒显示心跳断连。

图20-12 MAVLink 心跳连接与断连检测

20.9 MAVLink v2 消息签名

cd ~/mavlink_lab
source venv/bin/activate
python signing_demo.py

实验生成了总长度34字节的签名帧，不兼容标志为0x01，签名标志为True，并成功解析13字节签名区域。

图20-13 MAVLink v2 签名数据帧测试

20.10 本章小结

1. 完成基础工具、PX4、Gazebo 和 Pymavlink 环境检查；
2. 成功启动 PX4 SITL 与 Gazebo X500；
3. 查看了 PX4 内部 MAVLink v2 UDP 链路；
4. 成功接收 HEARTBEAT、姿态、位置、GPS 和电池消息；
5. 完成 MAVLink v2 原始帧解析与 CRC 校验；
6. 输出常用消息 ID、任务消息 ID 和 MAV_CMD；
7. 完成心跳连接与断连检测；
8. 生成并解析带13字节签名区域的 MAVLink v2 数据帧。

说明：本章仅完成协议理解和仿真通信实验，没有向真实无人机发送解锁、起飞或任务控制指令。

21.1 MAVROS2 概述与安装

# 安装

sudo apt install -y ros-humble-mavros ros-humble-mavros-extras

sudo /opt/ros/humble/lib/mavros/install_geographiclib_datasets.sh

# 从源码安装

cd ~/ros2_ws/src

git clone https://github.com/mavlink/mavros.git -b ros2

cd ~/ros2_ws

rosdep install --from-paths src --ignore-src -r -y

colcon build --packages-select mavros mavros_msgs mavros_extras

# 启动（SITL）

ros2 launch mavros px4.launch fcu_url:=udp://:14540@14557

# 启动（实际飞控串口）

ros2 launch mavros px4.launch fcu_url:=serial:///dev/ttyUSB0:57600

21.2 MAVROS2 话题与服务映射

核心话题映射表

核心服务映射表

21.3 通过 MAVROS2 获取飞控状态

#!/usr/bin/env python3

"""drone_state_monitor.py - 无人机状态监控节点"""

import rclpy

from rclpy.node import Node

from sensor_msgs.msg import Imu, NavSatFix, BatteryState

from geometry_msgs.msg import PoseStamped, TwistStamped

from mavros_msgs.msg import State, VFR_HUD

import math

class DroneStateMonitor(Node):

def init(self):

super().init('drone_state_monitor')

self.state = State()

self.pose = PoseStamped()

self.velocity = TwistStamped()

self.gps = NavSatFix()

self.battery = BatteryState()

self.hud = VFR_HUD()

self.create_subscription(State, '/mavros/state',

lambda m: setattr(self, 'state', m), 10)

self.create_subscription(PoseStamped, '/mavros/local_position/pose',

lambda m: setattr(self, 'pose', m), 10)

self.create_subscription(TwistStamped, '/mavros/local_position/velocity_local',

lambda m: setattr(self, 'velocity', m), 10)

self.create_subscription(NavSatFix, '/mavros/global_position/global',

lambda m: setattr(self, 'gps', m), 10)

self.create_subscription(BatteryState, '/mavros/battery',

lambda m: setattr(self, 'battery', m), 10)

self.create_subscription(VFR_HUD, '/mavros/vfr_hud',

lambda m: setattr(self, 'hud', m), 10)

self.create_timer(1.0, self.print_summary)

self.get_logger().info('飞控状态监控节点已启动')

def quat_to_euler(self, x, y, z, w):

roll = math.degrees(math.atan2(2(wx+yz), 1-2(xx+yy)))

pitch = math.degrees(math.asin(max(-1, min(1, 2(wy-z*x)))))

yaw = math.degrees(math.atan2(2(wz+xy), 1-2(yy+zz)))

return roll, pitch, yaw

def print_summary(self):

q = self.pose.pose.orientation

r, p, y = self.quat_to_euler(q.x, q.y, q.z, q.w)

pos = self.pose.pose.position

vel = self.velocity.twist.linear

self.get_logger().info(

f'\n--- ZP-MH743 状态 ---'

f'\n 连接:{self.state.connected} 模式:{self.state.mode} 解锁:{self.state.armed}'

f'\n 位置: ({pos.x:.2f}, {pos.y:.2f}, {pos.z:.2f}) m'

f'\n 姿态: ({r:.1f}, {p:.1f}, {y:.1f}) deg'

f'\n 速度: ({vel.x:.2f}, {vel.y:.2f}, {vel.z:.2f}) m/s'

f'\n GPS: {self.gps.latitude:.7f}, {self.gps.longitude:.7f}, {self.gps.altitude:.1f}m'

f'\n 电池: {self.battery.voltage:.1f}V {self.battery.percentage*100:.0f}%')

def main(args=None):

rclpy.init(args=args)

node = DroneStateMonitor()

try:

rclpy.spin(node)

except KeyboardInterrupt:

pass

finally:

node.destroy_node()

rclpy.shutdown()

if name == 'main':

main()

21.4 通过 MAVROS2 发送控制指令

#!/usr/bin/env python3

"""drone_commander.py - 无人机指令控制器"""

import rclpy

from rclpy.node import Node

from mavros_msgs.srv import CommandBool, CommandTOL, SetMode, WaypointPush

from mavros_msgs.msg import State, Waypoint

from geometry_msgs.msg import PoseStamped

import time

class DroneCommander(Node):

def init(self):

super().init('drone_commander')

self.current_state = State()

self.create_subscription(State, '/mavros/state',

lambda m: setattr(self, 'current_state', m), 10)

self.setpoint_pub = self.create_publisher(

PoseStamped, '/mavros/setpoint_position/local', 10)

self.arm_client = self.create_client(CommandBool, '/mavros/cmd/arming')

self.takeoff_client = self.create_client(CommandTOL, '/mavros/cmd/takeoff')

self.land_client = self.create_client(CommandTOL, '/mavros/cmd/land')

self.mode_client = self.create_client(SetMode, '/mavros/set_mode')

self.mission_client = self.create_client(WaypointPush, '/mavros/mission/push')

self.get_logger().info('指令控制器已启动')

def wait_for_connection(self, timeout=10.0):

start = time.time()

while not self.current_state.connected:

if time.time() - start timeout:

return False

rclpy.spin_once(self, timeout_sec=0.5)

return True

def set_mode(self, mode):

req = SetMode.Request()

req.custom_mode = mode

future = self.mode_client.call_async(req)

rclpy.spin_until_future_complete(self, future)

ok = future.result() and future.result().mode_sent

self.get_logger().info(f'模式切换 {"成功" if ok else "失败"}: {mode}')

return ok

def arm(self):

req = CommandBool.Request()

req.value = True

future = self.arm_client.call_async(req)

rclpy.spin_until_future_complete(self, future)

ok = future.result() and future.result().success

self.get_logger().info(f'{"解锁" if ok else "解锁失败"}')

return ok

def takeoff(self, altitude):

req = CommandTOL.Request()

req.altitude = altitude

future = self.takeoff_client.call_async(req)

rclpy.spin_until_future_complete(self, future)

ok = future.result() and future.result().success

self.get_logger().info(f'起飞 {"成功" if ok else "失败"} - {altitude}m')

return ok

def land(self):

req = CommandTOL.Request()

future = self.land_client.call_async(req)

rclpy.spin_until_future_complete(self, future)

ok = future.result() and future.result().success

self.get_logger().info(f'降落指令 {"已发送" if ok else "失败"}')

return ok

def upload_mission(self, waypoints):

"""上传航点任务, waypoints: [{'lat':..,'lon':..,'alt':..,'command':16}, ...]"""

req = WaypointPush.Request()

for i, wp in enumerate(waypoints):

w = Waypoint()

w.frame = wp.get('frame', 3) # GLOBAL_REL_ALT

w.command = wp.get('command', 16)

w.is_current = (i == 0)

w.autocontinue = True

w.param1 = wp.get('param1', 0.0)

w.param4 = wp.get('param4', 0.0)

w.x_lat = wp['lat']

w.y_long = wp['lon']

w.z_alt = wp['alt']

req.waypoints.append(w)

future = self.mission_client.call_async(req)

rclpy.spin_until_future_complete(self, future)

result = future.result()

if result and result.success:

self.get_logger().info(f'任务上传成功: {result.wp_transferred} 个航点')

return True

self.get_logger().error('任务上传失败')

return False

21.5 PX4 原生 DDS 方案——MicroXRCE-DDS Agent 桥接

PX4 v1.14+ 提供基于 DDS 的原生通信方案，通过 MicroXRCE-DDS Agent 将飞控内部 uORB 消息直接映射到 ROS2 DDS 域，绕过 MAVLink 层。

机载计算机: ROS2 节点 --DDS-- MicroXRCE-DDS Agent

|

UDP/Serial

|

飞控 STM32H743: PX4 模块 --uORB-- XRCE Client

# 安装 MicroXRCE-DDS Agent

git clone https://github.com/eProsima/Micro-XRCE-DDS-Agent.git

cd Micro-XRCE-DDS-Agent mkdir build cd build

cmake .. make sudo make install sudo ldconfig

# 启动 Agent（UDP 模式）

MicroXRCEAgent udp4 -p 8888

# 串口模式

MicroXRCEAgent serial --serial /dev/ttyUSB0 --baud 921600

21.6 MicroXRCE-DDS 配置与 uORB 话题直连

uORB 话题与 ROS2 映射

# 安装 PX4 消息包

cd ~/ros2_ws/src

git clone https://github.com/PX4/px4_msgs.git

git clone https://github.com/PX4/px4_ros_com.git

cd ~/ros2_ws colcon build --packages-select px4_msgs px4_ros_com

#!/usr/bin/env python3

"""xrce_drone_monitor.py - 通过 XRCE-DDS 获取飞控数据"""

import rclpy

from rclpy.node import Node

from px4_msgs.msg import VehicleAttitude, VehicleLocalPosition, VehicleStatus

class XRCEDroneMonitor(Node):

def init(self):

super().init('xrce_drone_monitor')

self.attitude = None

self.position = None

self.create_subscription(VehicleAttitude, '/fmu/out/vehicle_attitude',

lambda m: setattr(self, 'attitude', m), 10)

self.create_subscription(VehicleLocalPosition, '/fmu/out/vehicle_local_position',

lambda m: setattr(self, 'position', m), 10)

self.create_timer(1.0, self.print_status)

self.get_logger().info('XRCE-DDS 监控节点已启动')

def print_status(self):

if self.attitude and self.position:

q = self.attitude.q

self.get_logger().info(

f'\n--- XRCE-DDS 状态 ---'

f'\n 四元数: [{q[0]:.4f}, {q[1]:.4f}, {q[2]:.4f}, {q[3]:.4f}]'

f'\n 位置: ({self.position.x:.2f}, {self.position.y:.2f}, {self.position.z:.2f})'

f'\n 高度有效: {self.position.z_valid}')

def main(args=None):

rclpy.init(args=args)

rclpy.spin(XRCEDroneMonitor())

rclpy.shutdown()

if name == 'main':

main()

21.7 MAVROS2 vs MicroXRCE-DDS 方案对比

选型建议：生产稳定环境选 MAVROS2；追求最低延迟且使用 PX4 v1.14+ 选 XRCE-DDS；需要两者优势可混合方案（MAVROS2 远程 + XRCE 本地高频数据）。