CN108008630A - 一种无人机位置环的补偿器设计方法及装置 - Google Patents
一种无人机位置环的补偿器设计方法及装置 Download PDFInfo
- Publication number
- CN108008630A CN108008630A CN201610938373.2A CN201610938373A CN108008630A CN 108008630 A CN108008630 A CN 108008630A CN 201610938373 A CN201610938373 A CN 201610938373A CN 108008630 A CN108008630 A CN 108008630A
- Authority
- CN
- China
- Prior art keywords
- mtd
- mrow
- mtr
- unmanned plane
- msup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
本发明公开了一种无人机位置环的补偿器设计方法及装置,所述补偿器设计方法包括:建立无人机位置环的闭环状态空间方程;基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。本发明能够有效提高无人机系统的动态性能和抗干扰能力。
Description
技术领域
本发明涉及无人机技术领域,尤其涉及一种无人机位置环的补偿器设计方法及装置。
背景技术
现有的无人机位置环采用串级pid(proportion、integration、differentiation,比例、积分、微分)的控制策略,其性能只能通过在线调pid参数来调节,参数调节比较麻烦,且控制效果往往不够理想,无法达到最优的控制效果。
发明内容
本发明针对现有技术中存在的问题,提供了一种无人机位置环的补偿器设计方法及装置,能够有效提高无人机系统的动态性能和抗干扰能力。
本发明就上述技术问题而提出的技术方案如下:
一方面,本发明提供一种无人机位置环的补偿器设计方法,包括:
建立无人机位置环的闭环状态空间方程;
基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;
根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。
进一步地,所述建立无人机位置环的闭环状态空间方程,具体包括:
基于所述无人机控制环中的速度误差计算公式,推力计算公式和牛顿第二定律,建立所述无人机位置环的闭环状态空间方程;
所述闭环状态空间方程如下:
其中,x(t)为系统的状态向量,e(t)为位置误差,m为无人机的质量,t为时间,A、B为系统矩阵,K为补偿器,p为位置环的比例系数,kp、ki、kd分别为速度环的比例系数、积分系数、微分系数。
进一步地,所述基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型,具体包括:
在所述闭环状态空间方程中加入噪声项,获得系统方程其中,w(t)为噪声项;
选取目标输出方程z(t)=Cx(t);其中,C为参数矩阵;
获取所述无人机系统的H∞性能指标J1和二次型性能指标J2;其中,Q、R为加权矩阵;
基于所述系统方程和所述目标输出方程,对所述H∞性能指标和所述二次型性能指标进行优化,使J1<γ,且J1+J2取最小值,γ>0,构建优化模型;
所述优化模型如下:
[J1+J2]min;
其中,L为正定矩阵,W为适合维数矩阵,I为适合维数单位矩阵。
进一步地,所述根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器,具体包括:
根据所述无人机的质量m、所述位置环的比例系数p和所述速度环的比例系数kp、积分系数ki、微分系数kd,采用所述优化模型,求取正定矩阵L和适合维数矩阵W;
根据所述正定矩阵L和所述适合维数矩阵W,采用补偿器计算公式,获得所述无人机位置环的补偿器;所述补偿器计算公式为:K=WL-1。
另一方面,本发明提供一种无人机位置环的补偿器设计装置,包括:
方程建立模块,用于建立无人机位置环的闭环状态空间方程;
优化模块,用于基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;以及,
补偿器获取模块,用于根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。
进一步地,所述方程建立模块具体用于基于所述无人机控制环中的速度误差计算公式,推力计算公式和牛顿第二定律,建立所述无人机位置环的闭环状态空间方程;
所述闭环状态空间方程如下:
其中,x(t)为系统的状态向量,e(t)为位置误差,m为无人机的质量,t为时间,A、B为系统矩阵,K为补偿器,p为位置环的比例系数,kp、ki、kd分别为速度环的比例系数、积分系数、微分系数。
进一步地,所述优化模块具体包括:
系统方程获取单元,用于在所述闭环状态空间方程中加入噪声项,获得系统方程其中,w(t)为噪声项;
目标方程选取单元,用于选取目标输出方程z(t)=Cx(t);其中,C为参数矩阵;
性能指标获取单元,用于获取所述无人机系统的H∞性能指标J1和二次型性能指标J2;其中,Q、R为加权矩阵;以及,
性能指标优化单元,用于基于所述系统方程和所述目标输出方程,对所述H∞性能指标和所述二次型性能指标进行优化,使J1<γ,且J1+J2取最小值,γ>0,构建优化模型;
所述优化模型如下:
[J1+J2]min;
其中,L为正定矩阵,W为适合维数矩阵,I为适合维数单位矩阵。
进一步地,所述补偿器获取模块具体包括:
矩阵求取单元,用于根据所述无人机的质量m、所述位置环的比例系数p和所述速度环的比例系数kp、积分系数ki、微分系数kd,采用所述优化模型,求取正定矩阵L和适合维数矩阵W;以及,
补偿器获取单元,用于根据所述正定矩阵L和所述适合维数矩阵W,采用补偿器计算公式,获得所述无人机位置环的补偿器;所述补偿器计算公式为:K=WL-1。
本发明实施例提供的技术方案带来的有益效果是:
通过建立的闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建出优化模型,再根据待补偿的无人机的质量、位置环的系数和速度环的系数,采用优化模型,即可设计出该无人机位置环的补偿器,添加补偿器后,有效提升无人机系统的动态性能和抗干扰能力。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例一提供的无人机位置环的补偿器设计方法的流程示意图;
图2是本发明实施例一中无人机系统在阶跃信号下的响应曲线图;
图3是本发明实施例一中无人机系统在正弦信号下的阶跃响应曲线图;
图4是本发明本发明实施例二提供的无人机位置环的补偿器设计装置的结构示意图。
具体实施方式
为了解决现有技术存在的无人机系统动态性能差、抗干扰能力弱等技术问题,本发明旨在提供一种无人机位置环的补偿器设计方法,其核心思想是:基于闭环状态空间方程和选取的目标输出方程,构建无人机系统性能指标的优化模型,并采用该优化模型针对不同无人机设计出相应的补偿器。本发明所提供的补偿器设计方法能够在无人机系统的性能指标优化的基础上,设计无人机位置环的补偿器,有效提高无人机系统的动态性能和抗干扰能力。
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
实施例一
本发明实施例提供了一种无人机位置环的补偿器设计方法,参见图1,该补偿器设计方法包括:
S1、建立无人机位置环的闭环状态空间方程;
S2、基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;
S3、根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。
需要说明的是,本发明实施例采用H∞/LQR鲁棒控制器设计定理来针对无人机位置环pid设计补偿器。在设计过程中,先建立无人机位置环含pid控制器的闭环状态空间方程,再基于闭环状态空间方程和选取的目标输出方程,采用H∞/LQR鲁棒控制器设计定理构建出优化模型,进而,针对不同无人机的质量、位置环的系数和速度环的系数,对构建出的优化模型进行求解,即可设计出无人机位置环的补偿器。采用H∞/LQR鲁棒控制器设计方法添加补偿器,可以有效提升无人机系统的动态性能和抗干扰能力。
进一步地,所述建立无人机位置环的闭环状态空间方程,具体包括:
基于所述无人机控制环中的速度误差计算公式,推力计算公式和牛顿第二定律,建立所述无人机位置环的闭环状态空间方程;
所述闭环状态空间方程如下:
其中,x(t)为系统的状态向量,e(t)为位置误差,m为无人机的质量,t为时间,A、B为系统矩阵,K为补偿器,p为位置环的比例系数,kp、ki、kd分别为速度环的比例系数、积分系数、微分系数。
需要说明的是,先计算无人机系统位置环中的速度期望,速度期望的计算公式为:其中,r(t)为期望位置值,x(t)为实际位置值,kff为位置环的前馈系数。进而,根据速度期望计算速度误差,获取速度误差计算公式:其中,e(t)为位置误差,v(t)为实际速度值。另外,无人机系统位置环中的推力计算公式为:而由牛顿第二定律可知:通过速度误差计算公式、推力计算公式和牛顿第二定律三个公式即可得到:其中,忽略指令输入向量仅讨论无人机系统的内部性能,获得方程: 再在该方程中添加补偿输入项:u(t)=Kx(t),且因此,最终构建无人机位置环的闭环状态空间方程:
进一步地,所述基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型,具体包括:
在所述闭环状态空间方程中加入噪声项,获得系统方程其中,w(t)为噪声项;
选取目标输出方程z(t)=Cx(t);其中,C为参数矩阵;
获取所述无人机系统的H∞性能指标J1和二次型性能指标J2;其中,Q、R为加权矩阵;
基于所述系统方程和所述目标输出方程,对所述H∞性能指标和所述二次型性能指标进行优化,使J1<γ,且J1+J2取最小值,γ>0,构建优化模型;
所述优化模型如下:
[J1+J2]min;
其中,L为正定矩阵,W为适合维数矩阵,I为适合维数单位矩阵。
需要说明的是,在构建无人机位置环的闭环状态空间方程后,考虑噪声,在方程中添加噪声项,获得系统方程:任意选取一个目标输出方程,其可以为:z(t)=Cx(t)。基于系统方程和目标输出方程,通过优化两个性能指标J1和J2以构建出优化模型,其中,J1为H∞性能指标,表征系统的抗干扰能力,J2为二次型性能指标,可以保证系统的动态性能和输入代价有限。
进一步地,所述根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器,具体包括:
根据所述无人机的质量m、所述位置环的比例系数p和所述速度环的比例系数kp、积分系数ki、微分系数kd,采用所述优化模型,求取正定矩阵L和适合维数矩阵W;
根据所述正定矩阵L和所述适合维数矩阵W,采用补偿器计算公式,获得所述无人机位置环的补偿器;所述补偿器计算公式为:K=WL-1。
需要说明的是,采用H∞/LQR鲁棒控制器设计定理来设计补偿器,即对于系统矩阵A、B、C、G,若存在正定矩阵L和适合维数矩阵W,标量γ>0,优化模型成立,则K=WL-1是系统的最优补偿器,从而保证系统的抗干扰能力,一定的动态性能和输入代价有限。以某型四旋翼无人机为例,其质量m=1.25kg,重力加速度为g=9.78kg·m/s2,位置环的比例系数和前馈系数分别为p=1,kff=0.5,速度环的比例系数、积分系数和微分系数分别为kp=0.1,ki=0.02,kd=0.01,加权矩阵取R=1000,由matlab中的lmi求解优化模型中的线性矩阵不等式,进而获得该无人机位置环的补偿器K=[0.0016 0.0117 0.06]。
系统在阶跃信号下的响应曲线如图2所示,系统在噪声影响,即正弦信号下的阶跃响应曲线如图3所示。其中,X1为加入补偿器后的实际位置的响应曲线,X2为不加补偿器后的实际位置的响应曲线。由图2和图3可知,具有本发明实施例所设计的补偿器的系统动态响应更快,超调更小,优于不带补偿器的系统。
本发明实施例通过建立的闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建出优化模型,再根据待补偿的无人机的质量、位置环的系数和速度环的系数,采用优化模型,即可设计出该无人机位置环的补偿器,添加补偿器后,有效提升无人机系统的动态性能和抗干扰能力。
实施例二
相应的,本发明还提供一种无人机位置环的补偿器设计装置,能够实现上述实施例中的无人机位置环的补偿器设计方法的所有流程。
本发明实施例提供了一种无人机位置环的补偿器设计装置,参见图4,包括:
方程建立模块1,用于建立无人机位置环的闭环状态空间方程;
优化模块2,用于基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;以及,
补偿器获取模块3,用于根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。
进一步地,所述方程建立模块具体用于基于所述无人机控制环中的速度误差计算公式,推力计算公式和牛顿第二定律,建立所述无人机位置环的闭环状态空间方程;
所述闭环状态空间方程如下:
其中,x(t)为系统的状态向量,e(t)为位置误差,m为无人机的质量,t为时间,A、B为系统矩阵,K为补偿器,p为位置环的比例系数,kp、ki、kd分别为速度环的比例系数、积分系数、微分系数。
进一步地,所述优化模块具体包括:
系统方程获取单元,用于在所述闭环状态空间方程中加入噪声项,获得系统方程其中,w(t)为噪声项;
目标方程选取单元,用于选取目标输出方程z(t)=Cx(t);其中,C为参数矩阵;
性能指标获取单元,用于获取所述无人机系统的H∞性能指标J1和二次型性能指标J2;其中,Q、R为加权矩阵;以及,
性能指标优化单元,用于基于所述系统方程和所述目标输出方程,对所述H∞性能指标和所述二次型性能指标进行优化,使J1<γ,且J1+J2取最小值,γ>0,构建优化模型;
所述优化模型如下:
[J1+J2]min;
其中,L为正定矩阵,W为适合维数矩阵,I为适合维数单位矩阵。
进一步地,所述补偿器获取模块具体包括:
矩阵求取单元,用于根据所述无人机的质量m、所述位置环的比例系数p和所述速度环的比例系数kp、积分系数ki、微分系数kd,采用所述优化模型,求取正定矩阵L和适合维数矩阵W;以及,
补偿器获取单元,用于根据所述正定矩阵L和所述适合维数矩阵W,采用补偿器计算公式,获得所述无人机位置环的补偿器;所述补偿器计算公式为:K=WL-1。
本发明实施例通过建立的闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建出优化模型,再根据待补偿的无人机的质量、位置环的系数和速度环的系数,采用优化模型,即可设计出该无人机位置环的补偿器,添加补偿器后,有效提升无人机系统的动态性能和抗干扰能力。
综上所述,本发明提出了一种无人机位置环的补偿器设计方法及装置,其具有较好的实用效果:建立的闭环状态空间方程后,带入H∞/LQR鲁棒控制器设计定理,求解线性矩阵不等式,即可设计出该无人机位置环的补偿器,添加补偿器后,有效提升无人机系统的动态性能和抗干扰能力。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种无人机位置环的补偿器设计方法,其特征在于,包括:
建立无人机位置环的闭环状态空间方程;
基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;
根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。
2.如权利要求1所述的无人机位置环的补偿器设计方法,其特征在于,所述建立无人机位置环的闭环状态空间方程,具体包括:
基于所述无人机控制环中的速度误差计算公式,推力计算公式和牛顿第二定律,建立所述无人机位置环的闭环状态空间方程;
所述闭环状态空间方程如下:
u(t)=Kx(t);
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>pk</mi>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>pk</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>pk</mi>
<mi>d</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>B</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mstyle>
<mrow>
<mo>&Integral;</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mstyle>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>e</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
其中,x(t)为系统的状态向量,e(t)为位置误差,m为无人机的质量,t为时间,A、B为系统矩阵,K为补偿器,p为位置环的比例系数,kp、ki、kd分别为速度环的比例系数、积分系数、微分系数。
3.如权利要求2所述的无人机位置环的补偿器设计方法,其特征在于,所述基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型,具体包括:
在所述闭环状态空间方程中加入噪声项,获得系统方程其中,w(t)为噪声项;
选取目标输出方程z(t)=Cx(t);其中,C为参数矩阵;
获取所述无人机系统的H∞性能指标J1和二次型性能指标J2;其中,
Q、R为加权矩阵;
基于所述系统方程和所述目标输出方程,对所述H∞性能指标和所述二次型性能指标进行优化,使J1<γ,且J1+J2取最小值,γ>0,构建优化模型;
所述优化模型如下:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>LA</mi>
<mi>T</mi>
</msup>
<mo>+</mo>
<mi>A</mi>
<mi>L</mi>
<mo>+</mo>
<msup>
<mi>W</mi>
<mi>T</mi>
</msup>
<msup>
<mi>B</mi>
<mi>T</mi>
</msup>
<mo>+</mo>
<mi>B</mi>
<mi>W</mi>
</mrow>
</mtd>
<mtd>
<mi>G</mi>
</mtd>
<mtd>
<mrow>
<msup>
<mi>LC</mi>
<mi>T</mi>
</msup>
</mrow>
</mtd>
<mtd>
<mi>L</mi>
</mtd>
<mtd>
<msup>
<mi>W</mi>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mn>2</mn>
</msup>
<mi>I</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>I</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>Q</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>R</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo><</mo>
<mn>0</mn>
<mo>;</mo>
</mrow>
[J1+J2]min;
其中,L为正定矩阵,W为适合维数矩阵,I为适合维数单位矩阵。
4.如权利要求3所述的无人机位置环的补偿器设计方法,其特征在于,所述根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器,具体包括:
根据所述无人机的质量m、所述位置环的比例系数p和所述速度环的比例系数kp、积分系数ki、微分系数kd,采用所述优化模型,求取正定矩阵L和适合维数矩阵W;
根据所述正定矩阵L和所述适合维数矩阵W,采用补偿器计算公式,获得所述无人机位置环的补偿器;所述补偿器计算公式为:K=WL-1。
5.一种无人机位置环的补偿器设计装置,其特征在于,包括:
方程建立模块,用于建立无人机位置环的闭环状态空间方程;
优化模块,用于基于所述闭环状态空间方程和选取的目标输出方程,对无人机系统的性能指标进行优化,构建优化模型;以及,
补偿器获取模块,用于根据无人机的质量、位置环的系数和速度环的系数,采用所述优化模型,获取所述无人机位置环的补偿器。
6.如权利要求5所述的无人机位置环的补偿器设计装置,其特征在于,所述方程建立模块具体用于基于所述无人机控制环中的速度误差计算公式,推力计算公式和牛顿第二定律,建立所述无人机位置环的闭环状态空间方程;
所述闭环状态空间方程如下:
u(t)=Kx(t);
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>pk</mi>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>pk</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mo>+</mo>
<msub>
<mi>pk</mi>
<mi>d</mi>
</msub>
</mrow>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>B</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mstyle>
<mrow>
<mo>&Integral;</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mstyle>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>e</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
其中,x(t)为系统的状态向量,e(t)为位置误差,m为无人机的质量,t为时间,A、B为系统矩阵,K为补偿器,p为位置环的比例系数,kp、ki、kd分别为速度环的比例系数、积分系数、微分系数。
7.如权利要求6所述的无人机位置环的补偿器设计装置,其特征在于,所述优化模块具体包括:
系统方程获取单元,用于在所述闭环状态空间方程中加入噪声项,获得系统方程其中,w(t)为噪声项;
目标方程选取单元,用于选取目标输出方程z(t)=Cx(t);其中,C为参数矩阵;
性能指标获取单元,用于获取所述无人机系统的H∞性能指标J1和二次型性能指标J2;其中,Q、R为加权矩阵;以及,
性能指标优化单元,用于基于所述系统方程和所述目标输出方程,对所述H∞性能指标和所述二次型性能指标进行优化,使J1<γ,且J1+J2取最小值,γ>0,构建优化模型;
所述优化模型如下:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>LA</mi>
<mi>T</mi>
</msup>
<mo>+</mo>
<mi>A</mi>
<mi>L</mi>
<mo>+</mo>
<msup>
<mi>W</mi>
<mi>T</mi>
</msup>
<msup>
<mi>B</mi>
<mi>T</mi>
</msup>
<mo>+</mo>
<mi>B</mi>
<mi>W</mi>
</mrow>
</mtd>
<mtd>
<mi>G</mi>
</mtd>
<mtd>
<mrow>
<msup>
<mi>LC</mi>
<mi>T</mi>
</msup>
</mrow>
</mtd>
<mtd>
<mi>L</mi>
</mtd>
<mtd>
<msup>
<mi>W</mi>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>&gamma;</mi>
<mn>2</mn>
</msup>
<mi>I</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>I</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>Q</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mo>*</mo>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mi>R</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo><</mo>
<mn>0</mn>
<mo>;</mo>
</mrow>
[J1+J2]min;
其中,L为正定矩阵,W为适合维数矩阵,I为适合维数单位矩阵。
8.如权利要求7所述的无人机位置环的补偿器设计装置,其特征在于,所述补偿器获取模块具体包括:
矩阵求取单元,用于根据所述无人机的质量m、所述位置环的比例系数p和所述速度环的比例系数kp、积分系数ki、微分系数kd,采用所述优化模型,求取正定矩阵L和适合维数矩阵W;以及,
补偿器获取单元,用于根据所述正定矩阵L和所述适合维数矩阵W,采用补偿器计算公式,获得所述无人机位置环的补偿器;所述补偿器计算公式为:K=WL-1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610938373.2A CN108008630B (zh) | 2016-11-01 | 2016-11-01 | 一种无人机位置环的补偿器设计方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610938373.2A CN108008630B (zh) | 2016-11-01 | 2016-11-01 | 一种无人机位置环的补偿器设计方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108008630A true CN108008630A (zh) | 2018-05-08 |
CN108008630B CN108008630B (zh) | 2022-04-19 |
Family
ID=62047244
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610938373.2A Active CN108008630B (zh) | 2016-11-01 | 2016-11-01 | 一种无人机位置环的补偿器设计方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108008630B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101122791A (zh) * | 2007-09-13 | 2008-02-13 | 上海交通大学 | 数控机床定位误差实时补偿装置 |
US20080097658A1 (en) * | 2004-11-08 | 2008-04-24 | Shue Shyhpyng J | Flight Control System Having a Three Control Loop Design |
JP2009070050A (ja) * | 2007-09-12 | 2009-04-02 | Okuma Corp | 位置制御装置 |
CN101571704A (zh) * | 2009-06-18 | 2009-11-04 | 北京航空航天大学 | 一种复合分层抗干扰控制器 |
CN102323754A (zh) * | 2011-07-29 | 2012-01-18 | 北京理工大学 | 一种基于区域极点配置的鲁棒增益调度控制方法 |
US20130124177A1 (en) * | 2009-06-13 | 2013-05-16 | Eric T. Falangas | Method of modeling dynamic characteristics of a flight vehicle |
CN103199546A (zh) * | 2013-03-29 | 2013-07-10 | 中冶南方工程技术有限公司 | 动态无功补偿装置最优二次调节器及其设计方法 |
CN103941583A (zh) * | 2014-05-04 | 2014-07-23 | 福州大学 | 抗扰动复合非线性伺服控制器的参数化设计方法 |
CN104536297A (zh) * | 2015-01-22 | 2015-04-22 | 中国科学院光电技术研究所 | 一种串级自抗扰的多闭环控制方法 |
-
2016
- 2016-11-01 CN CN201610938373.2A patent/CN108008630B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080097658A1 (en) * | 2004-11-08 | 2008-04-24 | Shue Shyhpyng J | Flight Control System Having a Three Control Loop Design |
JP2009070050A (ja) * | 2007-09-12 | 2009-04-02 | Okuma Corp | 位置制御装置 |
CN101122791A (zh) * | 2007-09-13 | 2008-02-13 | 上海交通大学 | 数控机床定位误差实时补偿装置 |
US20130124177A1 (en) * | 2009-06-13 | 2013-05-16 | Eric T. Falangas | Method of modeling dynamic characteristics of a flight vehicle |
CN101571704A (zh) * | 2009-06-18 | 2009-11-04 | 北京航空航天大学 | 一种复合分层抗干扰控制器 |
CN102323754A (zh) * | 2011-07-29 | 2012-01-18 | 北京理工大学 | 一种基于区域极点配置的鲁棒增益调度控制方法 |
CN103199546A (zh) * | 2013-03-29 | 2013-07-10 | 中冶南方工程技术有限公司 | 动态无功补偿装置最优二次调节器及其设计方法 |
CN103941583A (zh) * | 2014-05-04 | 2014-07-23 | 福州大学 | 抗扰动复合非线性伺服控制器的参数化设计方法 |
CN104536297A (zh) * | 2015-01-22 | 2015-04-22 | 中国科学院光电技术研究所 | 一种串级自抗扰的多闭环控制方法 |
Non-Patent Citations (2)
Title |
---|
LGHANI MENHOUR等: "Switched LQR/ H ∞ steering vehicle control to detect critical driving situations", 《SWITCHED LQR/ H ∞ STEERING VEHICLE CONTROL TO DETECT CRITICAL DRIVING SITUATIONS》 * |
高大伟: "航空发动机分布式控制时延系统稳定性及鲁棒控制方法研究", 《中国优秀博硕士学位论文全文数据库(硕士) 工程科技Ⅱ辑》 * |
Also Published As
Publication number | Publication date |
---|---|
CN108008630B (zh) | 2022-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102736518B (zh) | 一种含测量和输入时滞的挠性航天器复合抗干扰控制器 | |
CN108008628A (zh) | 一种不确定欠驱动无人艇系统的预设性能控制方法 | |
CN105182984B (zh) | 飞行器俯仰姿态的线性自抗扰控制器设计与参数整定方法 | |
CN107065902A (zh) | 基于非线性模型的无人机姿态模糊自适应预测控制方法及系统 | |
Sun et al. | Balance control of two-wheeled self-balancing robot based on linear quadratic regulator and neural network | |
CN103728988B (zh) | 基于内模的scara机器人轨迹跟踪控制方法 | |
CN104298109B (zh) | 基于多控制器融合的无尾飞行器协调转弯控制方法 | |
CN110376882A (zh) | 基于有限时间扩张状态观测器的预定性能控制方法 | |
CN107390525B (zh) | 一种应用于混联机构的控制系统参数整定方法 | |
CN105375848B (zh) | 一种永磁同步电机自适应辨识控制方法及其控制系统 | |
CN103433924A (zh) | 串联机器人高精度位置控制方法 | |
CN107132761A (zh) | 一种采用纯模糊与模糊pid复合控制的电动舵机设计方法 | |
CN108170151A (zh) | 一种水下机器人的自适应运动控制装置及其方法 | |
CN107505846A (zh) | 一种空间机械臂系统抗干扰姿态协调验证装置及控制方法 | |
Li et al. | Robust trajectory tracking control for a quadrotor subject to disturbances and model uncertainties | |
CN106647264B (zh) | 一种基于控制约束的扩展鲁棒h∞的无人机控制方法 | |
CN104049536A (zh) | 底盘非线性系统模糊神经网络广义逆控制器的构造方法 | |
CN105227035A (zh) | 一种永磁直线电机控制方法 | |
CN106338918A (zh) | 一种微陀螺自适应动态面双神经网络控制方法 | |
CN106826807A (zh) | 一种三自由度腕部结构的滑模变结构控制方法 | |
Sun et al. | A design for two-wheeled self-balancing robot based on Kalman filter and LQR | |
CN116360470A (zh) | 一种多水下直升机协同编队控制方法 | |
CN106842953B (zh) | 一种无人直升机自适应低阶控制器 | |
CN103901775A (zh) | 一种基于t-s模型带有输入约束的舵减横摇模糊控制器及其控制方法 | |
Dai et al. | Finite-time trajectory tracking for marine vessel by nonsingular backstepping controller with unknown external disturbance |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230103 Address after: 518000 F1.6, 5D-506, Tianfa mansion, Tianan Che Kung Temple Industrial Zone, Shenzhen, Guangdong, 5D-506 Patentee after: SHENZHEN SPROCOMM TECHNOLOGIES Co.,Ltd. Address before: 563000 building B, No.2 scientific research building, Zunyi Software Park, Xinpu Economic Development Zone, Xinpu New District, Zunyi City, Guizhou Province Patentee before: GUIZHOU MARS EXPLORATION TECHNOLOGY Co.,Ltd. |
|
TR01 | Transfer of patent right |