crazyflie-firmware之姿态解算和PID控制

最新推荐文章于 2025-08-08 12:00:00 发布

技术在路上

最新推荐文章于 2025-08-08 12:00:00 发布

阅读量5.1k

点赞数 2

CC 4.0 BY-SA版权

分类专栏： crazyflie2.0

本文链接：https://blog.youkuaiyun.com/xingqingly/article/details/50367044

crazyflie2.0 专栏收录该内容

42 篇文章 ¥19.90 ¥99.00

订阅专栏

超级会员免费看

本文主要探讨crazyflie-firmware中的stabilizerTask任务，该任务在FreeRTOS中具有高优先级。通过分析代码，讲解了如何从四元数转换为欧拉角，然后利用PID控制实现角度到速率的转换。当通信中断时，飞行器会停止目标值以确保安全。内容包括姿态偏差计算、速率控制量的求取以及姿态与推力的融合过程。对于四元数与欧拉角转换及PID的深入研究，文章也做了简要提及。

<span style="font-family: Arial, Helvetica, sans-serif; background-color: rgb(255, 255, 255);">	</span><span style="font-family: Arial, Helvetica, sans-serif; background-color: rgb(255, 255, 255);">今天抽晚上时间看了下crazyflie-firmware程序中姿态解算和PID控制部分代码，看的是crazyflie2.0版本的相关代码。</span>

这部分代码应该算是在FreeRTOS优先级很高的任务了，在stabilizer.c文件中可以找到stabilizerTask任务，再寻找下优先级可以看到如下代码：

<span style="font-size:14px;">//Task priorities. Higher number higher priority
#define SYSTEM_TASK_PRI         2
#define CRTP_RXTX_TASK_PRI      2
#define

了解本专栏