当前位置：首页 > news >正文

APM二次开发实战：手把手教你从添加任务到地面站打印（基于Copter 4.3.1）

news 2026/6/15 14:31:06

APM二次开发实战：从任务添加到地面站通信的完整指南

当你第一次拿到APM飞控板时，可能会被它强大的功能和复杂的代码结构所震撼。作为ArduPilot生态系统的重要组成部分，APM为无人机爱好者提供了广阔的二次开发空间。本文将带你从零开始，逐步实现一个完整的自定义功能开发流程。

1. 开发环境准备与基础概念

在开始APM二次开发前，需要搭建合适的开发环境。推荐使用Ubuntu 20.04 LTS作为开发平台，因为ArduPilot工具链对其支持最为完善。

必备工具安装：

sudo apt-get install git gcc-arm-none-eabi python3-pip pip3 install future pyserial empy

APM固件采用模块化设计，主要代码结构包括：

libraries/：核心功能库
ArduCopter/：多旋翼专用代码
Tools/：编译和调试工具

关键概念理解：

调度器：负责管理所有周期性任务的执行
单例模式：全局唯一实例的访问方式
MAVLink协议：地面站与飞控通信的标准

2. 创建自定义周期性任务

添加新任务是APM二次开发中最基础也最重要的操作。我们将创建一个每秒执行一次的状态报告任务。

首先在Copter.h的Copter类声明中添加：

void status_report();

然后在Copter.cpp的调度器部分添加：

SCHED_TASK(status_report, 1000, 75, 84),

实现任务函数：

void Copter::status_report() { static uint32_t counter = 0; gcs().send_text(MAV_SEVERITY_INFO, "Status #%u", counter++); }

编译并上传固件后，地面站将每秒收到递增的状态消息。

提示：调度器参数中，1000表示1000ms周期，75是最大允许执行时间(ms)，84是优先级(数值越小优先级越高)

3. 硬件接口控制实战

3.1 PWM输出控制

控制PWM输出是飞控的常见需求，下面代码演示如何设置第3通道输出1500μs的PWM信号：

#include <AP_ServoRelayEvents/AP_ServoRelayEvents.h> void set_pwm_output() { AP_ServoRelayEvents *handler = AP::servorelayevents(); if (handler != nullptr) { handler->do_set_servo(3, 1500); } }

3.2 飞行模式切换

通过代码切换飞行模式是自动化控制的关键。以下示例展示如何切换到GUIDED模式：

void set_guided_mode() { if (!copter.set_mode(Mode::Number::GUIDED, ModeReason::GCS_COMMAND)) { gcs().send_text(MAV_SEVERITY_WARNING, "Mode change failed"); } }

常见模式枚举值：

STABILIZE：自稳模式
ALT_HOLD：定高模式
AUTO：自动航线模式
GUIDED：引导模式

4. 系统状态获取与处理

4.1 实时飞行数据读取

获取当前飞行状态是做出控制决策的基础：

void print_flight_status() { // 获取解锁状态 bool is_armed = AP_Notify::flags.armed; // 获取当前飞行模式 uint8_t mode_num = copter.control_mode->mode_number(); // 获取电池电压 float voltage = copter.battery.voltage(); gcs().send_text(MAV_SEVERITY_INFO, "Armed:%d Mode:%d Volt:%.1fV", is_armed, mode_num, voltage); }

4.2 传感器数据获取

GPS数据是许多应用的基础，获取方法如下：

void print_gps_data() { const AP_GPS &gps = AP::gps(); if (gps.status() >= AP_GPS::GPS_OK_FIX_3D) { Location loc = gps.location(); gcs().send_text(MAV_SEVERITY_INFO, "Lat:%.7f Lng:%.7f", loc.lat * 1e-7, loc.lng * 1e-7); } }

5. 高级功能实现

5.1 自定义单例模式实现

对于需要全局访问的数据，单例模式是理想选择：

class TelemetrySingleton { public: static TelemetrySingleton& getInstance() { static TelemetrySingleton instance; return instance; } float home_lat; float home_lng; private: TelemetrySingleton() : home_lat(0), home_lng(0) {} TelemetrySingleton(const TelemetrySingleton&) = delete; void operator=(const TelemetrySingleton&) = delete; };

使用示例：

TelemetrySingleton& telemetry = TelemetrySingleton::getInstance(); telemetry.home_lat = copter.ahrs.get_home().lat * 1e-7;

5.2 地面站通信增强

除了基本文本信息，还可以发送自定义数据包：

void send_custom_telemetry() { uint32_t now = AP_HAL::micros64(); float voltage = copter.battery.voltage(); mavlink_message_t msg; mavlink_msg_custom_telemetry_pack( gcs().sysid_this_mav(), gcs().compid_this_mav(), &msg, now, voltage ); gcs().send_to_ground_station(msg); }

6. 调试技巧与性能优化

6.1 高效日志记录

合理使用日志级别可以平衡信息量和性能：

void debug_output() { // 仅在调试编译时输出 #ifdef DEBUG_BUILD gcs().send_text(MAV_SEVERITY_DEBUG, "Debug info: %f", some_value); #endif // 关键错误始终输出 if (error_condition) { gcs().send_text(MAV_SEVERITY_CRITICAL, "Error occurred!"); } }

6.2 任务执行时间监控

确保自定义任务不会超过分配的时间片：

void time_critical_task() { uint32_t start = AP_HAL::micros(); // 执行操作... uint32_t elapsed = AP_HAL::micros() - start; if (elapsed > 5000) { // 5ms gcs().send_text(MAV_SEVERITY_WARNING, "Task overtime: %uus", elapsed); } }

在实际项目中，我发现将复杂任务拆分为多个小步骤并分散到不同周期执行，可以显著提高系统响应性。例如，将1Hz的数据采集和10Hz的控制逻辑分开处理，既能保证数据完整性又能维持控制精度。

查看全文

http://www.jsqmd.com/news/602099/