邵霖文,廖 芳,丁黎明,舒 薇,何志谦
(怀化学院电气与信息工程学院,湖南 怀化 418000)
四旋翼无人机在较好的环境中飞行具有较好的稳定性,但是对于较为复杂的飞行环境,往往难以达到用户的需求,特别是在农业植保无人机方面。因此,对四旋翼无人机的控制研究具有重要的意义和应用前景。
四旋翼无人机核心设计包括无人机的姿态控制器设计,姿态控制器将决定无人机的运行稳定性和灵敏性,本文将阐述一种通过四旋翼无人机的姿态数据解算与融合滤波算法而设计的双闭环级联PID控制器,并利用MATLAB开展软件的仿真实验,从而验证无人机控制器的稳定性。
在无人机控制系统中,主要采用捷联惯性导航的基本思想,结合其他定位方式对其在捷联惯性导航中的误差进行修正[1]。处理器读取每个传感器的原始测量数据,使用四元数方法更新姿态,然后将四元数转化为欧拉角,通过互补滤波器执行姿态校正,最后将校正后的欧拉角转换为四元数并对其进行归一化后执行下一个姿势更新,以便获得实际角度值[2]。
四元数的定义式如下:
i2=j2=k2=ijk=-1.
(1)
式中i、j、k分别为空间直角坐标系中x、y、z轴正方向上的单位向量。
变化公式如下:
Q=
T.
(2)
|Q|2=w2+x2+y2+z2=1.
(3)
使用旋转轴和围绕旋转轴的旋转角度来构建四元数:
(4)
式中w为四元数的标量部分的系数;xyz表示四元数的矢量部分的系数[3];α是绕旋转轴旋转的角度;cos(βx)、cos(βy)、cos(βz)分别为旋转轴在x、y、z方向上的分量。
根据四元数的定义,可以得到欧拉角对四元数的算法:……p>