OpenEdv-开源电子网

 找回密码
 立即注册
正点原子全套STM32/Linux/FPGA开发资料,上千讲STM32视频教程免费下载...
查看: 2274|回复: 0

四轴飞行器PID控制D项加入后电机一侧减速一侧加速,怎么调整成只减速不加速?

[复制链接]

4

主题

7

帖子

0

精华

新手上路

积分
20
金钱
20
注册时间
2022-3-16
在线时间
7 小时
发表于 2022-5-14 16:44:56 | 显示全部楼层 |阅读模式
7金钱
这是我的程序,我引用的是MPU6050直接输出的角加速作为D项里的角度积分,按理说D项一个是抵消运动过快的一侧,但出现的问题是一侧减速的同时另一侧加速,导致四轴飞行器还是不稳定,D的参数越大,反机越快。
//外环D项
        PID_OUT_PITCH_D = -OUT_KD * Current_Pitch_AS_Angle;
        PID_OUT_ROLL_D = -OUT_KD * Current_Roll_AS_Angle;
        PID_OUT_YAW_D = -OUT_KD * Current_Yaw_AS_Angle;

//外环PID输出
        PID_OUT_Pitch_OUT = PID_OUT_PITCH_P + PID_OUT_PITCH_I + PID_OUT_PITCH_D;
        PID_OUT_Roll_OUT = PID_OUT_ROLL_P + PID_OUT_ROLL_I + PID_OUT_ROLL_D;
        PID_OUT_Yaw_OUT = PID_OUT_YAW_P + PID_OUT_YAW_I + PID_OUT_YAW_D;

正点原子逻辑分析仪DL16劲爆上市
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则



关闭

原子哥极力推荐上一条 /2 下一条

正点原子公众号

QQ|手机版|OpenEdv-开源电子网 ( 粤ICP备12000418号-1 )

GMT+8, 2024-11-22 16:19

Powered by OpenEdv-开源电子网

© 2001-2030 OpenEdv-开源电子网

快速回复 返回顶部 返回列表