【SIGMA开发小组】四轴飞行器之控制篇

zszghzszgh-3712 · 发表于 2013-8-22 17:11:37

之前一直苦于四轴飞行器怎么控制的问题，方法当然有PID的控制，但是究竟无线遥控器输出控制量怎么加在四轴的四个无刷电机上面，一直是我最头疼的问题，下面是我的解决方案，与各位网友分享！！！
首先了解到无线遥控器采用PPM的编码方式，一般还会配对一个接收机，用来解码。一般是将设定姿态和当前姿态做一个差，设定姿态就是遥控器指令了，当前姿态就是IMU检测出来的姿态，然后计算出对应YAW,PICH和ROLL的PID控制量，将各自的PID量加到四个电机上面，代码如下：
MOTOR1=MOTORLimit(Motor_Thr+pid_pitch-pid_yaw);
MOTOR2=MOTORLimit(Motor_Thr-pid_pitch-pid_yaw);
MOTOR3=MOTORLimit(Motor_Thr -pid_roll+pid_yaw);
MOTOR4=MOTORLimit(Motor_Thr +pid_roll+pid_yaw);
这样就能够实现油门（上下），前后，左右，和旋转的动作了，快来试一试吧！！！加入四轴吧！！！

a20084666 · 发表于 2013-8-22 18:29:59

表示呵呵呵呵呵

油炸冰激凌 · 发表于 2013-8-22 19:35:46

a20084666 发表于 2013-8-22 18:29
表示呵呵呵呵呵

同理呵呵呵呵

Hayasaky · 发表于 2013-8-22 19:44:47

呵呵……楼下保持阵型

zszghzszgh-3712 · 发表于 2013-8-23 09:22:19

楼上呵呵代表什么意思？求正解

xiand_ni · 发表于 2013-9-26 19:59:10

能再详细点吗？？

【SIGMA开发小组】四轴飞行器之控制篇

站长推荐 /3