PX4-Autopilot中外部执行器控制问题的分析与解决方案

问题背景

在PX4自动驾驶仪的实际应用中，开发者经常需要通过外部控制来实现对附加执行器（如额外电机或伺服机构）的精确控制。本文针对一个典型场景进行分析：在PX4飞控上，开发者尝试通过Offboard模式下的fmu/in/actuator_motors主题来控制6个外部电机，但发现PWM输出没有变化。

问题分析

1. 执行器配置问题

PX4系统对执行器的控制需要明确的配置映射关系。当开发者将电机设置为"main 1 -> peripheral via actuator set 1"时，实际上采用了外围执行器集的配置方式，这与直接通过actuator_motors主题控制的方式不兼容。

2. 控制模式选择

在Offboard模式下，PX4提供了多种控制方式：

• 通过actuator_motors主题直接控制（需要正确配置执行器映射）
• 通过MAVLink命令控制（如VEHICLE_CMD_DO_SET_ACTUATOR）
• 通过执行器测试命令控制（VEHICLE_CMD_ACTUATOR_TEST）

3. 仿真与实机差异

值得注意的是，该问题在Gazebo仿真环境中可以正常工作，但在实际硬件上失效。这是因为仿真环境通常直接监听actuator_motors主题，而实际硬件需要严格的执行器映射配置。

解决方案

方案一：正确配置执行器映射

1. 在QGroundControl的"执行器"配置页面中，将需要控制的电机明确配置为"Motor 1"、"Motor 2"等标准电机输出
2. 确保Offboard控制模式消息中设置了direct_actuator = true
3. 通过fmu/in/actuator_motors主题发送控制指令

方案二：使用MAVLink命令控制

1. 发送VEHICLE_CMD_DO_SET_ACTUATOR命令（MAVLink命令号187）
2. 在命令参数中指定各执行器的输出值
3. 这种方式适用于将执行器配置为"Peripheral with actuator set z"的情况

方案三：执行器测试命令（推荐）

经过验证，使用VEHICLE_CMD_ACTUATOR_TEST命令是最直接有效的解决方案：

vehicleCommandMsg msg{};
msg.param1 = 执行器编号;  // 指定要控制的执行器
msg.param2 = 1.0f;      // 设置为1表示激活测试
msg.param5 = 1300.0f + 期望PWM值;  // 设置PWM输出值
msg.command = vehicleCommandMsg::VEHICLE_CMD_ACTUATOR_TEST;
msg.target_system = 1;
msg.target_component = 1;
msg.source_system = 255;
msg.source_component = 1;
msg.from_external = true;
msg.timestamp = 当前时间戳;
pub.vehicle_command->publish(msg);

实施建议

1. 对于简单的附加执行器控制，推荐使用VEHICLE_CMD_ACTUATOR_TEST方法，它简单直接且不受主飞行控制模式影响
2. 如果需要与飞行控制系统更深度集成，应采用标准电机映射配置方式
3. 注意执行器编号与实际硬件连接的对应关系，可通过QGroundControl的输出测试功能进行验证
4. 对于关键应用，建议在代码中添加执行器状态反馈监控

总结

PX4系统提供了多种执行器控制方式，开发者需要根据具体应用场景选择合适的方法。对于附加执行器控制，VEHICLE_CMD_ACTUATOR_TEST命令提供了简单可靠的解决方案，而标准电机映射方式则更适合与飞行控制系统深度集成的场景。理解这些控制方式的差异和适用条件，将帮助开发者更高效地实现复杂的执行器控制需求。