3、顶层架构解析：主循环（AP_Mainloop）、调度器（Scheduler）、任务（Task）的运作机制
大家好，我是你们的嵌入式讲师。今天我们来聊聊ArduPilot最核心的骨架——主循环、调度器和任务。说白了，这三兄弟决定了飞控“什么时候该干什么事”。
很多初学者拿到ArduPilot源码，第一反应就是“这么大一坨代码，从哪里看起？”我个人习惯，先看主循环。因为它是整个飞控的心脏，一跳一停之间，所有模块都在有条不紊地工作。
3.1 主循环（AP_Mainloop）——飞控的心脏
ArduPilot的主循环，其实就是一个超级大的while(1)。它位于ArduCopter.cpp（或者ArduPlane.cpp）的loop()函数里。嗯，这里要注意，不同载板的主循环入口略有不同，但核心逻辑是一样的。
主循环的伪代码大致长这样：
void loop()
{
// 1. 等待调度器通知
scheduler.wait_for_trigger();
// 2. 执行所有就绪的任务
scheduler.run();
// 3. 更新输出（比如PWM、串口）
outputs.update();
}你可能会问：“就这么简单？”其实不然。真正的复杂度在于调度器如何决定“什么时候该触发”。
核心要点：主循环本身不直接调用任何模块代码。它只负责两件事：等待触发信号，然后让调度器去干活。这种设计让主循环非常轻量，也方便移植到不同硬件平台。
我在项目中遇到过一个问题：某次把主循环里加了一个延时函数，结果整个飞控卡死了。后来才意识到，主循环里绝对不能阻塞！所有耗时操作都必须拆成小任务，交给调度器去分时执行。
3.2 调度器（Scheduler）——时间管理者
调度器是ArduPilot里最聪明的家伙。它不直接干活，但它知道每个任务该什么时候干、干多久。
调度器的核心数据结构是一个任务列表。每个任务都包含：
- 函数指针：要执行的代码
- 运行周期：比如10ms、20ms、100ms
- 最大运行时间：超过这个时间会被强制打断
- 优先级：紧急任务优先执行
调度器的运行逻辑，我画了一张图，你一看就明白：
这张图展示了调度器的核心逻辑：每次主循环触发，调度器就遍历任务列表，检查每个任务是否到了该运行的时间。如果到了，就执行；没到，就跳过。全部检查完后，等待下一次触发。
避坑指南：我曾经在调试一个自定义传感器驱动时，把任务周期设成了1ms。结果飞控直接卡死，因为调度器根本来不及处理这么多任务。后来我把周期改成10ms，一切正常。记住：任务周期不是越短越好，够用就行。
3.3 任务（Task）——模块的最小执行单元
任务，就是调度器要执行的“小函数”。每个模块（比如GPS、姿态估计、遥控器处理）都会注册一个或多个任务到调度器里。
任务的注册方式，我直接给你看代码：
// 在模块的初始化函数中
void AP_GPS::init()
{
// 注册一个10ms执行一次的任务
scheduler.register_task(
FUNCTOR_BIND_MEMBER(&AP_GPS::update, void),
10, // 周期：10ms
500 // 最大执行时间：500微秒
);
}你看，注册一个任务只需要三样东西：要执行的函数、运行周期、最大耗时。调度器会根据这些信息，自动安排执行顺序。
任务的设计有几个关键原则：
- 短小精悍：每个任务执行时间不能太长，一般控制在1ms以内
- 无阻塞：任务里不能有while(1)等待，也不能有sleep
- 可重入：同一个任务可能被多次调用，要保证数据一致性
重要提醒：千万不要在任务里调用delay()或hal.scheduler->delay()！这会导致整个调度器卡住，其他任务全部无法执行。如果你需要延时，请使用hal.scheduler->register_timer_process()或者状态机的方式。
3.4 三者的协作关系
主循环、调度器、任务，这三者是怎么配合的？我打个比方你就明白了：
- 主循环 = 工厂的流水线传送带，一直转不停
- 调度器 = 车间主任，知道每个工位该什么时候干活
- 任务 = 工人，只负责自己那一亩三分地
流水线（主循环）每转一圈，车间主任（调度器）就看看手表，然后喊：“GPS模块，该你干活了！”GPS模块（任务）就赶紧干完自己的活，然后继续等待下一次被叫到。
这种设计的好处是：
- 解耦：每个模块只关心自己的任务，不用管别人
- 可扩展：加一个新功能，只需要注册一个新任务
- 可预测：每个任务的执行时间可控，不会出现某个模块霸占CPU的情况
我记得有一次，团队里新来的同事想加一个“日志记录”功能，直接把文件写入操作放在了主循环里。结果飞控一飞就炸，因为写入SD卡太耗时了。后来我让他改成任务方式，每100ms写一次，问题就解决了。
3.5 实际项目中的经验总结
最后，我分享几个在实际项目中积累的经验：
| 场景 | 建议 | 原因 |
|---|---|---|
| 传感器读取 | 周期设为10-20ms | 太快了数据噪声大，太慢了控制延迟高 |
| 姿态解算 | 周期设为2-5ms | 飞控的核心，需要高频率更新 |
| 日志写入 | 周期设为100-200ms | 写入操作耗时，频率太高会拖慢系统 |
| 遥控器信号处理 | 周期设为10ms | 人手的操作频率有限，10ms足够 |
嗯，说到这里，你应该对ArduPilot的顶层架构有了清晰的认识。主循环是骨架，调度器是大脑，任务是肌肉。三者配合，才能让飞控稳定运行。
下次你打开ArduPilot源码，不妨先从loop()函数看起，然后找到调度器的注册代码，看看每个模块都注册了哪些任务。相信我，这样看代码，比从头读到尾效率高得多。