基于PID控制器和L1自适应控制器的姿态控制方法技术

本发明专利技术公开了一种基于PID控制器和L1自适应控制器的姿态控制方法，通过PID控制器对期望情况下飞行器姿态系统的稳定控制，再利用L1自适应控制器实时估计姿态系统中的扰动误差，并对估计出的扰动误差进行快速补偿；本发明专利技术基于PID控制器和L1自适应控制器的姿态控制方法利用PID控制器和L1自适应控制器补偿由于建模误差引入的内部扰动及飞行环境对飞行器产生的外界扰动，可以在无法获得飞行器准确数学模型，存在外界扰动的情况下，实现对飞行器姿态的稳定控制，具有较强鲁棒性。

【技术实现步骤摘要】

本专利技术涉及飞行器姿态控制技术，尤其涉及一种基于PID控制器和L1自适应控制器的姿态控制方法。
技术介绍
无人机主要是指无人驾驶的飞行器。目前无人机已经在军事和民用方面得到了广泛应用，例如，军事侦查，空中巡逻与搜救，紧急物质的运输与投放，城市规划，气象观测，森林防火，农业植保，电力线路与石油管道的巡检，影视航拍，娱乐等。由于无人机上不需要驾驶员可以完全避免执行任务过程中的人员伤亡，操作人员可以在地面控制中心查看无人机实时传送回来的图像及状态信息，检测无人机任务执行的进度及完成效果。随着无人机的飞速发展，各大高校及科研机构也都纷纷展开对无人机控制及应用的研究。无人机的姿态控制问题是关乎其能否稳定可靠的应用在实际生活中的根本问题，由于无人机的数学模型具有强非线性，并且在实际上我们无法获得它的准确参数，而且还存在一部分无法建模的系统模型。在无法获得准确数学模型的情况下传统非线性控制器在实际应用中，特别是当存在外界扰动的情况下很难达到理想的控制效果。
技术实现思路
本专利技术的目的就在于为了解决上述在无法获得准确完整的数学模型及存在外部扰动时的姿态控制的问题而提供在利用自适应策略实时在线的补偿系统的模型偏差及外界扰动的同时实现对飞行器姿态系统的稳定控制的基于PID控制器和L1自适应控制器的姿态控制方法。本专利技术通过以下技术方案来实现上述目的：1、一种基于PID控制器和L1自适应控制器的姿态控制方法，通过PID控制器对期望情况下飞行器姿态系统的稳定控制，再利用L1自适应控制器实时估计姿态系统中的扰动误差，并对估计出的扰动误差进行快速补偿，包括以下步骤，(1)获得期望欧拉角和某一时刻iTs的实际姿态角，并计算PID控制器的输入误差向量，获得PID控制器的控制输出信号，其计算公式为：τPID=Kpηe+Kddηedt+∫Kiηe·dt]]>其中，输入误差向量的计算公式为：ηe＝ηd-η；式中：ηd为第iTs时刻期望的欧拉角，η为第iTs时刻飞行器的姿态向量；Kp＝diag(Kp1,Kp2,Kp3)，Ki＝diag(Ki1,Ki2,Ki3)，Kd＝diag(Kd1,Kd2,Kd3)，分别为PID控制反馈系数矩阵且均为正定阵；(2)根据上一时刻(i-1)Ts的控制输出，更新iTs时刻的L1自适应控制器的状态估计器的状态值，其计算公式为：ω^·=-J-1(ω×Jω)+J-1(τ+σ)+Ap(ω^-ω)]]>式中：J＝diag(Jx,Jy,Jz)为飞行器的转动惯量矩阵；为第iTs时刻L1自适应控制器的状态估计器的状态向量；ω为第(i-1)Ts时刻姿态系统的角速度向量；τ为第(i-1)Ts时刻飞行器的总控制输入向量；σ为第(i-1)Ts时刻L1自适应控制器所计算的扰动向量；Ap为一个用来定义估计误差收敛特性的Hurwitz矩阵；(3)通过第iTs时刻状态估计器的状态值和姿态系统的角速度值，计算第iTs时刻扰动误差，其计算公式为：σ(t)=JAp(I-exp(ApTs))-1exp(ApTs)ωe(iTs),∀t∈[iTs,(i+1)Ts]]]>其中：估计误差向量的计算公式为：式中：为第iTs时刻状态估计器的状态向量；ω为第iTs时刻姿态系统的角速度向量；Ts为控制算法运行的时间间隔；(4)通过低通滤波器对L1自适应控制器的扰动误差进行平滑输出，其计算公式为：式中：为低通滤波器的带宽；σ(t)为低通滤波器的输入信号，即在第iTs时刻扰动误差；τL1为低通滤波器的输出信号；(5)计算第iTs时刻PID控制器和L1自适应控制器的总输出信号，并将总输出信号输入至飞行器的姿态系统控制飞行器的姿态，其计算公式为：τ(iTs)＝τPID-τL1本专利技术的有益效果在于：本专利技术基于PID控制器和L1自适应控制器的姿态控制方法利用PID控制器和L1自适应控制器补偿由于建模误差引入的内部扰动及飞行环境对飞行器产生的外界扰动，可以在无法获得飞行器准确数学模型，存在外界扰动的情况下，实现对飞行器姿态的稳定控制，具有较强鲁棒性。附图说明图1是本专利技术所述基于PID控制器和L1自适应控制器的姿态控制方法的整体控制框图；图2是具体实施方式中四旋翼飞行器的结构示意图；图3是具体实施方式中四旋翼飞行器系统运行框图；图4是具体实施方式中四旋翼飞行器受到的外界扰动；图5是具体实施方式中四旋翼飞行器存在外界扰动时，单PID控制器滚转角控制效果；图6是具体实施方式中四旋翼飞行器存在外界扰动时，单PID控制器俯仰角控制效果；图7是具体实施方式中四旋翼飞行器存在外界扰动时，L1自适应控制补偿的扰动信号；图8具体实施方式中四旋翼飞行器存在外界扰动时，PID控制器和L1自适应控制器控制滚转角控制效果；图9是具体实施方式中四旋翼飞行器存在外界扰动时，PID控制器和L1自适应控制器控制俯仰角控制效果；具体实施方式下面结合附图对本专利技术作进一步说明：如图1所示，各个物理量分别指，系统的期望参考输入向量为ηd＝(ψd,θd,φd)T，ψd为期望的偏航角，θd为期望的俯仰角，φd为期望的滚转角；η为飞行器的实际欧拉角向量；τPID为PID控制器控制输出向量；τL1为L1自适应控制器经过低滤波之后的控制输出向量；τ＝τPID+τL1为姿态系统的总控制输入；ω为姿态系统的实际角速度值；ωp为L1自适应控制器的状态估计器的状态。将期望的姿态角ηd与当时姿态系统的检测到的实际姿态角η做差，并送入到PID控制器得到PID控制器的输出τPID；然后，根据上一时刻的控制输出，角速度和估计的扰动，更新L1自适应控制器的状态估计器的状态值得到ωp；接着利用状态估计器的状态值ωp与姿态系统的角速度值ω计算估计扰动；然后通过低通滤波器对估计的扰动滤波得到τL1；最后计算PID+L1自适应控制器输出τ＝τPID-τL1，将其输入至姿态系统中进行飞行器的姿态控制。在自适应反馈回路中引入了低通滤波器，通过调节补偿回路中低通滤波器的带宽可以很容易地调节系统的鲁棒性与动态特性，提高低通滤波器的带宽可以提高系统的响应速度但是同时也会降低系统的鲁棒性，而减小低通滤波器的带宽虽然可以提高系统的稳定性但是同时也会减小系统对扰动的抑制能力。通过调节合适的低通滤波器带宽既可以在保证系统稳定性避免产生高频震荡的同时提高系统对外界扰动的抑制能力。以图2所示的“十字结构”四旋翼无人机为例，该无人机包括四个电机，且1号电机在前方，3号电机在后方，2号和4号电机分别位于飞机的左边和右边。1号和3号电机以正时钟方向转动，2号和4号电机以逆时钟方向转动。四个电机转动时都会产生向上的升力，1号与3号电机存在升力差时会使飞机做俯仰运动，2号与4号电机存在升力差时会使飞机做滚转运动，当1号和3号电机转动时会对飞机产生一个逆向的扭力，而2号和4号电机转动时会对飞机产生一个正向的扭力，当这两个扭力不相等时飞机会做偏航运动。如图3所示，四旋翼无人控制系统主要包括几个部分：遥控接收机，传感器及姿态融合模块，本文档来自技高网...

【技术保护点】
一种基于PID控制器和L1自适应控制器的姿态控制方法，其特征在于：通过PID控制器对期望情况下飞行器姿态系统的稳定控制，再利用L1自适应控制器实时估计姿态系统中的扰动误差，并对估计出的扰动误差进行快速补偿，包括以下步骤，(1)获得期望欧拉角和某一时刻iTs的实际姿态角，并计算PID控制器的输入误差向量，获得PID控制器的控制输出信号，其计算公式为：τPID=Kpηe+Kddηedt+∫Kiηe·dt]]>其中，输入误差向量的计算公式为：ηe＝ηd‑η；式中：ηd为第iTs时刻期望的欧拉角，η为第iTs时刻飞行器的姿态向量；Kp＝diag(Kp1,Kp2,Kp3)，Ki＝diag(Ki1,Ki2,Ki3)，Kd＝diag(Kd1,Kd2,Kd3)，分别为PID控制反馈系数矩阵且均为正定阵；(2)根据上一时刻(i‑1)Ts的控制输出，更新iTs时刻的L1自适应控制器的状态估计器的状态值，其计算公式为：ω^·=-J-1(ω×Jω)+J-1(τ+σ)+Ap(ω^-ω)]]>式中：J＝diag(Jx,Jy,Jz)为飞行器的转动惯量矩阵；为第iTs时刻L1自适应控制器的状态估计器的状态向量；ω为第(i‑1)Ts时刻姿态系统的角速度向量；τ为第(i‑1)Ts时刻飞行器的总控制输入向量；σ为第(i‑1)Ts时刻L1自适应控制器所计算的扰动向量；Ap为一个用来定义估计误差收敛特性的Hurwitz矩阵；(3)通过第iTs时刻状态估计器的状态值和姿态系统的角速度值，计算第iTs时刻扰动误差，其计算公式为：σ(t)=JAp(I-exp(ApTs))-1exp(ApTs)ωe(iTs),∀t∈[iTs,(i+1)Ts]]]>其中：估计误差向量的计算公式为：式中：为第iTs时刻状态估计器的状态向量；ω为第iTs时刻姿态系统的角速度向量；Ts为控制算法运行的时间间隔；(4)通过低通滤波器对L1自适应控制器的扰动误差进行平滑输出，其计算公式为：式中：为低通滤波器的带宽；σ(t)为低通滤波器的输入信号，即在第iTs时刻扰动误差；τL1为低通滤波器的输出信号；(5)计算第iTs时刻PID控制器和L1自适应控制器的总输出信号，并将总输出信号输入至飞行器的姿态系统控制飞行器的姿态，其计算公式为：τ(iTs)＝τPID‑τL1...

【技术特征摘要】
1.一种基于PID控制器和L1自适应控制器的姿态控制方法，其特征在于：通过PID控制器对期望情况下飞行器姿态系统的稳定控制，再利用L1自适应控制器实时估计姿态系统中的扰动误差，并对估计出的扰动误差进行快速补偿，包括以下步骤，(1)获得期望欧拉角和某一时刻iTs的实际姿态角，并计算PID控制器的输入误差向量，获得PID控制器的控制输出信号，其计算公式为：τPID=Kpηe+Kddηedt+∫Kiηe·dt]]>其中，输入误差向量的计算公式为：ηe＝ηd-η；式中：ηd为第iTs时刻期望的欧拉角，η为第iTs时刻飞行器的姿态向量；Kp＝diag(Kp1,Kp2,Kp3)，Ki＝diag(Ki1,Ki2,Ki3)，Kd＝diag(Kd1,Kd2,Kd3)，分别为PID控制反馈系数矩阵且均为正定阵；(2)根据上一时刻(i-1)Ts的控制输出，更新iTs时刻的L1自适应控制器的状态估计器的状态值，其计算公式为：ω^·=-J-1(ω×Jω)+J-1(τ+σ)+Ap(ω^-ω)]]>式中：J＝diag(Jx...

【专利技术属性】
技术研发人员：张洪斌，
申请(专利权)人：成都市优艾维机器人科技有限公司，
类型：发明
国别省市：四川;51