4. 任务优先级设计：优先级分配原则、优先级反转问题、优先级继承协议
大家好，我是你们的飞控系统讲师。今天我们来聊聊任务优先级设计。说实话，这部分内容在教科书上可能就几页纸，但在实际飞控开发中，它往往是决定系统稳定性的关键。我见过太多因为优先级没设计好，导致无人机在空中「抽风」的案例了。
4.1 优先级分配原则：别拍脑袋定优先级
优先级怎么分？很多人上来就把控制任务设为最高，日志任务设为最低。嗯，这没错，但太粗糙了。我个人的习惯是，先画一张任务依赖图。
核心原则就三条：
- 实时性要求越高的任务，优先级越高 —— 比如姿态控制环，它决定了飞行器的生死
- 执行时间短的任务，优先级可以适当提高 —— 短任务容易被长任务阻塞，你想想看
- 关键安全任务，必须独占最高优先级 —— 比如看门狗喂狗、紧急降落
我在一个四轴项目中遇到过一个问题：GPS数据处理任务优先级设得比姿态解算还高。结果GPS数据偶尔延迟，姿态解算就被堵住了，飞机直接翻了个跟头。后来我把姿态解算提到最高，GPS任务降了一级，问题就解决了。
4.2 优先级反转问题：一个经典的坑
优先级反转，说白了就是低优先级任务把高优先级任务给「卡住」了。为什么会这样？因为共享资源。
我画个场景：
- 任务A（高优先级）和任务C（低优先级）共享一个互斥锁
- 任务B（中优先级）不共享这个锁
- 某时刻，任务C拿到了锁，然后被任务B抢占
- 任务A来了，想拿锁，发现锁被C拿着，只能等
- 任务B一直跑，任务C一直得不到CPU，锁就释放不了
- 任务A就这么被任务B「反转」了
你看，最高优先级的任务A，反而被中等优先级的任务B给耽误了。这在飞控里是致命的。我早期做飞控时，就因为这个现象导致过电机响应延迟，飞机差点炸了。
4.3 优先级继承协议：FreeRTOS的解决方案
FreeRTOS怎么解决优先级反转？它用了优先级继承协议。说白了就是：当高优先级任务被低优先级任务阻塞时，低优先级任务会临时「继承」高优先级的优先级。
还是刚才那个例子：
- 任务C拿着锁，任务A来了要等
- FreeRTOS发现任务A在等任务C，就把任务C的优先级临时提升到和任务A一样高
- 任务C现在不会被任务B抢占了，它赶紧执行完，释放锁
- 任务C的优先级恢复原样，任务A拿到锁继续跑
嗯，这个机制很巧妙。但要注意，FreeRTOS的互斥量默认就支持优先级继承。你只要用 xSemaphoreCreateMutex() 创建互斥量，系统会自动处理。
// 创建支持优先级继承的互斥量
SemaphoreHandle_t xMutex = xSemaphoreCreateMutex();
// 任务中获取锁
if (xSemaphoreTake(xMutex, portMAX_DELAY) == pdTRUE) {
// 访问共享资源
// ...
xSemaphoreGive(xMutex);
}4.4 优先级设计的实战经验
最后分享一些我在实际项目中总结的经验：
| 任务类型 | 推荐优先级 | 说明 |
|---|---|---|
| 姿态控制（400Hz） | 最高（如5） | 生死攸关，不能被打断 |
| 位置控制（100Hz） | 高（如4） | 次关键，但可以容忍少量延迟 |
| 传感器数据采集 | 较高（如3） | 数据新鲜度很重要 |
| 遥控器信号解析 | 中（如2） | 人操作没那么快 |
| 日志记录 | 低（如1） | 可以等，别抢CPU |
| 空闲任务 | 最低（0） | 系统自带，别动它 |
我曾经在一个项目中，把所有任务优先级都设成一样，想着「公平调度」。结果呢？关键任务经常被非关键任务打断，飞控响应一塌糊涂。后来我按照上面这个表格重新分配，系统就稳了。
记住一句话：优先级不是用来「公平」的，是用来「保命」的。
- 优先级分配：实时性优先，短任务优先，安全任务独占
- 优先级反转：低优先级卡高优先级，用互斥量避免
- 优先级继承：FreeRTOS互斥量自带，临时提升低任务优先级
好了，优先级设计这块就讲到这里。记住，飞控系统里，优先级不是用来「排座次」的，而是用来「保命」的。下次调试时，多想想你的任务到底有多急，别让低优先级的任务把高优先级的给「坑」了。