多旋翼无人机复合姿态稳定控制方法及系统
本发明属于多旋翼无人机飞行控制,特别是涉及一种多旋翼无人机复合姿态稳定控制方法及系统。
背景技术:
1、多旋翼无人机具有垂直起降、悬停、低速飞行、结构简单等特点,已被应用于航拍、测绘、巡检、物流、农业植保等场景。姿态稳定控制是多旋翼无人机完成上述作业的基础,其控制品质与飞行安全、作业精度相关。多旋翼无人机是一个非线性、强耦合、多输入多输出系统,在飞行过程中会受到大气紊流、阵风等外部扰动的影响,同时机载传感器噪声、模型参数不确定性等因素也会增加姿态控制的难度。目前,多旋翼无人机姿态控制中较为通用的方案是传统线性pid控制方法,但是其固定线性增益难以适配无人机强非线性与强耦合特性,在飞行状态变化时容易造成姿态跟踪精度下降和动态响应变慢。
技术实现思路
1、针对上述现有技术的不足,本发明所要解决的技术问题是:提供一种多旋翼无人机复合姿态稳定控制方法及系统。
2、为解决上述技术问题,本发明提供如下技术方案:
3、一种多旋翼无人机复合姿态稳定控制方法,包括以下步骤:
4、s1、实时采集多旋翼无人机的姿态角信号,并对采集到的原始信号进行预处理,得到连续的姿态信号;
5、s2、建立多旋翼机载姿态动力学迭代模型,根据预处理后的姿态信号和上一时刻的控制量更新当前时刻姿态角,并根据目标姿态角和所述当前时刻姿态角计算当前时刻姿态偏差;
6、s3、配置离散扰动观测器,根据当前时刻姿态偏差和上一时刻控制量输出,在线估计所述多旋翼无人机飞行过程中的复合未知扰动,输出实时扰动估计值;
7、s4、构建nl-pid控制器,通过所述nl-pid控制器根据当前时刻姿态偏差计算比例控制量、积分控制量和微分控制量;所述nl-pid控制器包括非线性变增益比例控制单元、抗饱和积分控制单元和低通滤波微分控制单元,所述非线性变增益比例控制单元用于生成所述比例控制量,所述抗饱和积分控制单元用于生成所述积分控制量,所述低通滤波微分控制单元用于生成所述微分控制量;
8、s5、将所述比例控制量、所述积分控制量和所述微分控制量相加,并减去干扰补偿增益与所述扰动估计值的乘积,得到复合控制量,对所述复合控制量进行双向限幅,输出最终旋翼驱动控制量;
9、s6、根据所述最终旋翼驱动控制量驱动旋翼执行机构,更新所述多旋翼无人机的姿态,并循环执行s1至s5步骤,实现姿态闭环稳定控制。
10、进一步的,所述姿态角包括滚转角、俯仰角和偏航角,所述姿态角信号包括滚转角信号、俯仰角信号和偏航角信号;在所述s1步骤中,以预设采样频率实时采集所述多旋翼无人机的姿态角信号,并通过线性插值法补充各姿态角信号的缺失数据,得到预处理后的姿态信号。
11、进一步的,在所述s2步骤中,所述多旋翼机载姿态动力学迭代模型的姿态角更新公式如下:
12、
13、其中,表示当前采样时刻;表示当前时刻的姿态角;表示上一采样时刻;表示上一采样时刻的姿态角;表示当前采样时刻的控制量输出;表示采样周期;表示姿态响应系数。
14、进一步的,在所述s3步骤中,所述离散扰动观测器的离散化公式为:
15、
16、其中,表示当前采样时刻的干扰估计值;为遗忘因子,;表示上一采样时刻的干扰估计值;表示当前采样时刻的姿态偏差;表示上一采样时刻的控制量输出;表示输入增益系数。
17、进一步的,在所述s4步骤中,所述非线性变增益比例控制单元的离散化公式为:
18、
19、其中,表示当前采样时刻的非线性比例增益;表示基础比例系数;表示增益调节系数;表示极小正常数。
20、进一步的,在所述s4步骤中,所述抗饱和积分控制单元的离散化公式为:
21、
22、其中,表示当前采样时刻的抗饱和积分项;表示双向限幅函数,用于将输出值限制在范围内,表示积分限幅值;表示采样时间间隔。
23、进一步的,在所述s4步骤中,所述低通滤波微分控制单元的离散化公式为:
24、
25、其中,表示当前采样时刻的低通滤波微分项;表示上一采样时刻的低通滤波微分项;表示滤波系数,。
26、进一步的,在所述s5步骤中,所述最终旋翼驱动控制量的计算公式为:
27、
28、其中,表示双向限幅函数,用于将输出值限制在范围内,为最终旋翼驱动控制量的限幅上限;表示积分系数;表示微分系数;表示干扰补偿增益,用于调节干扰补偿的强度。
29、进一步的,在所述s6步骤循环执行s1至s5的过程中,依据当前姿态偏差的绝对值大小自适应调整所述nl-pid控制器的非线性比例增益和所述离散扰动观测器的遗忘因子:
30、当所述姿态偏差的绝对值较大时,增大所述nl-pid控制器的非线性比例增益,同时减小所述离散扰动观测器的遗忘因子;
31、当所述姿态偏差的绝对值减小时,降低所述nl-pid控制器的非线性比例增益,同时增大所述离散扰动观测器的遗忘因子。
32、一种多旋翼无人机复合姿态稳定控制系统,包括:
33、姿态信号采集与预处理模块,用于实时采集多旋翼无人机的姿态角信号,并对采集到的原始信号通过线性插值法补充缺失数据,得到预处理后的姿态信号;
34、姿态动力学模型模块,用于建立多旋翼机载姿态动力学迭代模型,根据所述预处理后的姿态信号和上一采样时刻的控制量更新当前时刻姿态角,并根据目标姿态角和所述当前时刻姿态角计算当前时刻姿态偏差;
35、离散扰动观测器模块,用于根据当前时刻姿态偏差和上一采样时刻控制量输出,在线估计所述多旋翼无人机飞行过程中的复合未知扰动,输出实时扰动估计值;
36、nl-pid控制器模块,用于根据当前时刻姿态偏差计算比例控制量、积分控制量和微分控制量;所述nl-pid控制器模块包括非线性变增益比例控制单元、抗饱和积分控制单元和低通滤波微分控制单元;
37、复合控制律计算模块,用于将所述比例控制量、所述积分控制量和所述微分控制量相加,并减去干扰补偿增益与所述扰动估计值的乘积,得到复合控制量,对所述复合控制量进行双向限幅,输出最终旋翼驱动控制量;
38、闭环反馈模块,用于根据所述最终旋翼驱动控制量驱动旋翼执行机构,更新所述多旋翼无人机的姿态,并循环执行姿态稳定控制。
39、本发明中,通过非线性pid与离散扰动观测器复合姿态稳定控制方法的设计,针对现有多旋翼无人机姿态控制中抗干扰能力弱、非线性适配差、稳定精度不足、响应速度慢、积分饱和等问题提供了相应解决方式。在复杂干扰条件下,本发明的复合控制方法相较离散化pid,姿态稳定精度有所提高,姿态稳态偏差有所降低;通过离散扰动观测器实时扰动估计与前馈补偿,复合干扰的影响得到抑制,姿态波动减小,系统鲁棒性优于传统pid与离散化pid;采用非线性变增益比例项实现偏差自适应调节,抗饱和积分抑制积分累积过大,低通滤波微分削弱噪声敏感,使得系统响应更平稳、超调更小、动态收敛更快;本发明的算法基于离散化设计,适配数字飞控系统,参数适应性强,可在不同工况下保持稳定控制效果,具备工程应用价值。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com