CN111796515B - 一种适用于未知输入跟踪系统的改进型双口内模控制方法 - Google Patents
一种适用于未知输入跟踪系统的改进型双口内模控制方法 Download PDFInfo
- Publication number
- CN111796515B CN111796515B CN202010749225.2A CN202010749225A CN111796515B CN 111796515 B CN111796515 B CN 111796515B CN 202010749225 A CN202010749225 A CN 202010749225A CN 111796515 B CN111796515 B CN 111796515B
- Authority
- CN
- China
- Prior art keywords
- internal model
- tracking
- controller
- port internal
- control method
- 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.)
- Active
Links
Images
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/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
- G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种适用于未知输入跟踪系统的改进型双口内模控制方法,用于提升未知输入跟踪系统的跟踪能力和扰动抑制能力,以满足更高精度的跟踪控制需求。标准的双口内模方法要求已知系统的输入信号,因此无法在未知输入跟踪系统中使用。本发明提出一种改进的双口内模控制方法,可以在输入未知的情况下,依然实现双口内模的控制效果,同时提升系统的跟踪能力和扰动抑制能力。本发明突破了标准双口内模控制方法的局限,在输入未知的情况下使用内模控制的思想,有效提升系统的跟踪能力和扰动抑制能力,使未知输入跟踪系统获得更高的跟踪精度。
Description
技术领域
本发明属于跟踪控制领域,具体涉及一种适用于未知输入跟踪系统的改进型双口内模控制方法,主要用于在输入信号未知的情况下,有效提升未知输入跟踪系统的跟踪能力和扰动抑制能力,提升系统的跟踪精度。
背景技术
在现实世界中,有许多跟踪系统是无法获知系统输入的,如雷达跟踪系统,光电跟踪系统等。如文献《近程多基地雷达探测系统中快速跟踪方法研究》(徐洪奎.[D].中国科学院大学.2007)、《面向光电跟踪系统的先进运动控制》(任彦.[M].科学出版社.2017)中所述,这类系统无法获得输入信号,只能通过传感器获得输入信号与输出信号的跟踪误差信号。对于未知输入跟踪系统而言,系统性能指标主要体现在跟踪能力和扰动抑制能力。跟踪能力受到传感器采样频率和跟踪带宽的影响,扰动抑制能力受到外界扰动和系统机械结构的影响。地基未知输入跟踪系统的跟踪精度容易因地面振动和空气流动而降低;安装在运动平台上的未知输入跟踪系统,如在飞机,车辆,轮船,卫星等运动平台上时,会受到安装载体的不规则运动而导致的大量扰动。文献《运动平台中惯性稳定控制技术研究》(夏运霞.[D].中国科学院大学.2013)中提到的标准双口内模控制方法,是一种针对已知输入的一般系统,在闭环负反馈回路的基础上添加内模回路,得到等效的输入前馈和扰动前馈效果,构成等效复合控制的方法。在标准双口内模控制方法中,需要直接将系统输入作为内模控制器的输入信号之一,才能提升系统的跟踪能力。但是在未知输入跟踪系统中,跟踪目标的轨迹往往是不可预测的,只能获得跟踪误差。标准双口内模控制方法提供了一种重要思路,在前馈扰动的同时前馈输入,从而提升系统的扰动抑制能力和跟踪能力。但是受限于未知输入跟踪系统的特殊性,标准双口内模控制方法无法发挥效果,因此亟需一种改进型的双口内模控制方法。
发明内容
为了突破标准内模控制方法在未知输入跟踪系统中的局限性,实现高性能的跟踪和稳定,进一步提升未知输入跟踪系统的跟踪能力和扰动抑制能力,本发明提出了一种适用于未知输入跟踪系统的改进型双口内模控制方法。
标准的双口内模方法如图2所示,其将系统输入信号给到内模控制器GIMC(s),可见内模控制器GIMC(s)的输入信号为f=r-d,其中r是输入信号,r是扰动信号,进而达到同时提升系统的跟踪能力和扰动抑制能力的效果。但是在未知输入跟踪系统中,如雷达跟踪系统和光电跟踪系统等,是无法直接获知系统的输入信号的,只能获得输入信号与输出信号的误差信号。因此,在未知输入跟踪系统中不能直接使用标准的双口内模方法。
为了实现本发明的目的,本发明采用的技术方案为:一种适用于未知输入跟踪系统的改进型双口内模控制方法,其具体实施步骤如下:
步骤(1):通过传感器,直接获得未知输入跟踪系统的跟踪误差信号;
步骤(2):对未知输入跟踪系统进行初级位置闭环,将闭环后的初级位置环作为新控制器C(s)的被控对象Gp(s);
步骤(3):根据位置被控对象Gp(s),设计新的位置控制器C(s),并再次进行位置闭环;
步骤(5):根据改进型双口内模控制结构,分析内模控制器GIMC(s)的输入信号,并与标准的双口内模进行对比;
步骤(6):进行内模控制器GIMC(s)的稳定性分析,将得到的约束条件用于其参数设计;
步骤(7):进行内模控制器GIMC(s)的跟踪性能和扰动抑制性能分析,将得到的约束条件用于其参数设计;
步骤(8):根据约束条件,设计内模控制器GIMC(s),并搭建改进型双口内模控制结构,实现系统跟踪性能的提升和对外界扰动的有效抑制。
进一步地,步骤(2)中进行了初级位置闭环,初级闭环后系统特性表现为低通滤波器,滤波器截止频率就是初级位置闭环的跟踪带宽;初级位置闭环后,将其作为新位置控制器C(s)的被控对象Gp(s);在初级位置闭环的跟踪带宽内,有Gp(s)=1,因此被控对象Gp(s)可以表示为:
其中T1,…,Tn是一阶惯性环节的参数,被控对象Gp(s)可以有n个阶次。
进一步地,步骤(3)中新的位置控制器C(s),其设计可以采用经典的PID控制器方法。
进一步地,步骤(5)中内模控制器GIMC(s)的输入信号f,根据改进型双口内模控制方法的结构,输入信号f可以表示为:
其中r是系统输入信号,y是系统输出信号,e=r-y是跟踪误差信号,u是被控对象的输入信号,d是扰动信号;根据的设计,且在初级位置闭环的带宽内有Gp(s)=1,因此在初级位置闭环的带宽内有而f=r-d正是在输入已知的情况下,标准双口内模方法中内模控制器的输入;因此,该方法可以在输入未知的情况下,依然实现标准双口内模方法的控制效果。
进一步地,步骤(6)中内模控制器GIMC(s)的稳定性约束表示如下:
进一步地,步骤(7)中,在初级位置闭环的带宽内,有Gp(s)=1,且改进型双口内模控制方法的跟踪传递函数为:
其中y(s)是输出信号,r(s)是输入信号,GIMC(s)是内模控制器,C(s)是PID控制器;
其扰动传递函数为:
其中y(s)是输出信号,d(s)是扰动信号,GIMC(s)是内模控制器,C(s)是PID控制器。
进一步地,步骤(8)中,内模控制器GIMC(s)的设计方法如下:
其中T0为正的常数,且内模控制器GIMC(s)的截止频率高于初级位置闭环的带宽。
进一步地,使用改进型双口内模控制方法,可以在输入未知的情况下,通过误差信号,实现标准双口内模方法在输入已知的情况下才能实现的效果,从而提升未知输入跟踪系统的跟踪能力和扰动抑制能力,使系统获得更高的跟踪精度。
本发明原理在于:本发明先对未知输入跟踪系统进行初级位置闭环,初级闭环后系统特性表现为低通滤波器,滤波器截止频率就是初级位置闭环的跟踪带宽;将闭环后的初级位置环作为新控制器C(s)的被控对象Gp(s),在初级位置闭环的跟踪带宽内,有Gp(s)=1,因此被控对象Gp(s)可以表示为:
其中T1,…,Tn是一阶惯性环节的参数,被控对象Gp(s)可以有n个阶次;
根据如图1所示的改进型双口内模控制方法的结构,本发明中内模控制器GIMC(s)的输入信号f可以表示为:
根据的设计,且在初级位置闭环的带宽内有Gp(s)=1,因此在初级位置闭环的带宽内有而f=r-d正是在输入已知的情况下,标准双口内模方法中内模控制器的输入;因此本发明可以在输入未知的情况下,依然实现标准双口内模方法的控制效果。
对本发明的内模控制器GIMC(s)进行稳定性分析,根据小增益定理,其稳定性约束表示如下:
在位置闭环中引入本发明的改进型内模控制方法后,在初级位置闭环的带宽内有Gp(s)=1,系统的跟踪传递函数为:
其中y(s)是输出信号,r(s)是输入信号,GIMC(s)是内模控制器,C(s)是PID控制器;
其扰动传递函数为:
其中y(s)是输出信号,d(s)是扰动信号,GIMC(s)是内模控制器,C(s)是PID控制器。
因此,本发明中的内模控制器GIMC(s)可以设计如下:
其中T0为正的常数,且内模控制器GIMC(s)的截止频率高于初级位置闭环的带宽。搭建改进型双口内模控制结构,在输入未知的情况下,通过误差信号,实现标准双口内模方法在输入已知的情况下才能实现的效果,从而提升未知输入跟踪系统的跟踪能力和扰动抑制能力,使系统获得更高的跟踪精度。
本发明与现有技术相比具有如下优点:
(1)相比于标准双口内模控制方法,本发明没有系统输入信号必须已知的局限性,可以应用于未知输入跟踪系统,拓宽了双口内模方法的适用范围,可以有效提升系统的跟踪能力和扰动抑制能力;
(2)相比于传统PID等控制方法,针对未知输入跟踪系统,本发明可以有效提升扰动抑制能力的同时,进一步提升系统的跟踪能力;
(3)相比于标准双口内模控制方法,本发明的内模控制器设计简单,实用性好,易于实现,效果明显;
(4)本发明提出了一种新的双口内模控制方法结构简单,设计直观,可用于大时滞系统,对于扰动抑制和鲁棒性的改善效果显著。
附图说明
图1是本发明的一种适用于未知输入跟踪系统的改进型双口内模控制方法的控制框图。
图2是标准双口内模控制方法的控制框图。
图3是普通闭环与普通闭环加改进型双口内模方法的跟踪效果对比图,其中,图3(a)为普通闭环与普通闭环加改进型双口内模方法的输出对比图,图3(b)为普通闭环与普通闭环加改进型双口内模方法的误差对比图。
图4是普通闭环与普通闭环加改进型双口内模方法的跟踪叠加扰动的效果对比图,其中,图4(a)为普通闭环与普通闭环加改进型双口内模方法的跟踪叠加扰动的输出对比图,图4(b)为普通闭环与普通闭环加改进型双口内模方法的跟踪叠加扰动的误差对比图。
具体实施方式
以下结合附图对本发明的具体实施方式做详细说明。
如图1所示是一种适用于未知输入跟踪系统的改进型双口内模控制方法的控制框图,其中包括输入和扰动估计回路,内模控制器GIMC(s),和普通位置控制器C(s)。
为实现本发明的目的,本发明提供一种适用于未知输入跟踪系统的改进型双口内模控制方法,其方法步骤如下:
步骤(1):通过传感器,直接获得未知输入跟踪系统的跟踪误差信号;
步骤(2):对未知输入跟踪系统进行初级位置闭环,初级闭环后系统特性表现为低通滤波器,滤波器截止频率就是初级位置闭环的跟踪带宽;将闭环后的初级位置环作为新控制器C(s)的被控对象Gp(s),在初级位置闭环的跟踪带宽内,有Gp(s)=1,因此被控对象Gp(s)可以表示为:
其中T1,…,Tn是一阶惯性环节的参数,被控对象Gp(s)可以有n个阶次;
步骤(3):根据位置被控对象Gp(s),设计新的位置控制器C(s),并再次进行位置闭环,位置控制器C(s)的设计可以采用经典的PID控制器方法等方法;
步骤(5):根据改进型双口内模控制方法的结构,内模控制器GIMC(s)的输入信号f可以表示为:
其中r是系统输入信号,y是系统输出信号,e=r-y是跟踪误差信号,u是被控对象的输入信号,d是扰动信号;根据的设计,且在初级位置闭环的带宽内有Gp(s)=1,因此在初级位置闭环的带宽内有而f=r-d正是在输入已知的情况下,标准双口内模方法中内模控制器的输入;因此,该方法可以在输入未知的情况下,依然实现标准双口内模方法的控制效果;
步骤(6):进行内模控制器GIMC(s)的稳定性分析,约束条件用于其参数设计,其稳定性约束表示如下:
步骤(7):进行内模控制器GIMC(s)的跟踪性能和扰动抑制分析,约束条件用于其参数设计,在初级位置闭环的带宽内,改进型双口内模控制方法的跟踪传递函数为:
其中y(s)是输出信号,r(s)是输入信号,GIMC(s)是内模控制器,C(s)是PID控制器;
其扰动传递函数为:
其中y(s)是输出信号,d(s)是扰动信号,GIMC(s)是内模控制器,C(s)是PID控制器。
步骤(8):根据约束条件,设计内模控制器GIMC(s)如下:
其中T0为正的常数,且内模控制器GIMC(s)的截止频率高于初级位置闭环的带宽;搭建改进型双口内模控制结构,在输入未知的情况下,通过误差信号,实现标准双口内模方法在输入已知的情况下才能实现的效果,从而提升未知输入跟踪系统的跟踪能力和扰动抑制能力,使系统获得更高的跟踪精度。
下面以光电跟踪领域的吊舱跟踪系统为例,对本发明的设计过程和效果进行详细说明:
(1):使用图1所示的控制框图搭建系统控制结构,获得吊舱跟踪系统的误差信号;
(2):对吊舱跟踪系统进行初级位置闭环,将闭环后的初级位置环作为新控制器C(s)的被控对象Gp(s):
(3):根据位置被控对象Gp(s),设计新的位置控制器C(s),采用普通PID方法设计为:
(5):根据约束条件,设计内模控制器GIMC(s)如下:
搭建改进型双口内模控制结构,在输入未知的情况下,通过误差信号,实现标准双口内模方法在输入已知的情况下才能实现的效果。
(6):如图3是普通闭环与普通闭环加入改进型双口内模方法后的跟踪效果对比图。与普通闭环相比,加入了本发明后,控制系统可以有效减小系统的跟踪误差,并明显提升系统的跟踪精度和跟踪能力。
(7):如图4是普通闭环与普通闭环加入改进型双口内模方法后的跟踪叠加扰动的效果对比图。与普通闭环相比,加入了本发明后,系统的扰动信号可以得到更好的抑制,在保证跟踪效果的同时,可以有效减小系统跟踪误差,提升系统的扰动抑制能力,有力地证明了本发明在未知输入跟踪系统中的适用性和有效性。
Claims (8)
1.一种适用于未知输入跟踪系统的改进型双口内模控制方法,其特征在于:其具体实施步骤如下:
步骤(1):通过传感器,直接获得未知输入跟踪系统的跟踪误差信号;
步骤(2):对未知输入跟踪系统进行初级位置闭环,将闭环后的初级位置环作为新位置控制器C(s)的位置被控对象Gp(s);
步骤(3):根据位置被控对象Gp(s),设计新的位置控制器C(s),并再次进行位置闭环;
步骤(5):根据改进型双口内模控制结构,分析内模控制器GIMC(s)的输入信号,并与标准的双口内模进行对比;
步骤(6):进行内模控制器GIMC(s)的稳定性分析,将得到的约束条件用于其参数设计;
步骤(7):进行内模控制器GIMC(s)的跟踪性能和扰动抑制性能分析,将得到的约束条件用于其参数设计;
步骤(8):根据约束条件,设计内模控制器GIMC(s),并搭建改进型双口内模控制结构,实现系统跟踪性能的提升和对外界扰动的有效抑制。
3.根据权利要求1所述的一种适用于未知输入跟踪系统的改进型双口内模控制方法,其特征在于:步骤(3)中新的位置控制器C(s),其设计可以采用经典的PID控制器方法。
8.根据权利要求1-7任一项所述的一种适用于未知输入跟踪系统的改进型双口内模控制方法,其特征在于:使用改进型双口内模控制方法,可以在输入未知的情况下,通过误差信号,实现标准双口内模方法在输入已知的情况下才能实现的效果,从而提升未知输入跟踪系统的跟踪能力和扰动抑制能力,使系统获得更高的跟踪精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010749225.2A CN111796515B (zh) | 2020-07-30 | 2020-07-30 | 一种适用于未知输入跟踪系统的改进型双口内模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010749225.2A CN111796515B (zh) | 2020-07-30 | 2020-07-30 | 一种适用于未知输入跟踪系统的改进型双口内模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111796515A CN111796515A (zh) | 2020-10-20 |
CN111796515B true CN111796515B (zh) | 2022-04-19 |
Family
ID=72828297
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010749225.2A Active CN111796515B (zh) | 2020-07-30 | 2020-07-30 | 一种适用于未知输入跟踪系统的改进型双口内模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111796515B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5367646A (en) * | 1991-07-15 | 1994-11-22 | Bull S.A. | Universal device for coupling a computer bus to a controller of a group of peripherals |
CN105487385A (zh) * | 2016-02-01 | 2016-04-13 | 金陵科技学院 | 基于无模型自适应内模控制方法 |
CN107065529A (zh) * | 2017-02-20 | 2017-08-18 | 海南大学 | 双输入双输出网络解耦控制系统未知时延二自由度imc方法 |
CN107168043A (zh) * | 2017-06-07 | 2017-09-15 | 海南大学 | 一种二输入二输出ndcs未知时延补偿与imc方法 |
CN108897230A (zh) * | 2018-09-28 | 2018-11-27 | 中国科学院光电技术研究所 | 一种基于跟踪和扰动前馈的快反镜控制方法 |
CN109901388A (zh) * | 2019-02-19 | 2019-06-18 | 江苏经贸职业技术学院 | 一种基于高阶内模的新型学习控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6930150B2 (ja) * | 2017-03-14 | 2021-09-01 | オムロン株式会社 | 制御装置、制御プログラムおよび制御システム |
-
2020
- 2020-07-30 CN CN202010749225.2A patent/CN111796515B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5367646A (en) * | 1991-07-15 | 1994-11-22 | Bull S.A. | Universal device for coupling a computer bus to a controller of a group of peripherals |
CN105487385A (zh) * | 2016-02-01 | 2016-04-13 | 金陵科技学院 | 基于无模型自适应内模控制方法 |
CN107065529A (zh) * | 2017-02-20 | 2017-08-18 | 海南大学 | 双输入双输出网络解耦控制系统未知时延二自由度imc方法 |
CN107168043A (zh) * | 2017-06-07 | 2017-09-15 | 海南大学 | 一种二输入二输出ndcs未知时延补偿与imc方法 |
CN108897230A (zh) * | 2018-09-28 | 2018-11-27 | 中国科学院光电技术研究所 | 一种基于跟踪和扰动前馈的快反镜控制方法 |
CN109901388A (zh) * | 2019-02-19 | 2019-06-18 | 江苏经贸职业技术学院 | 一种基于高阶内模的新型学习控制方法 |
Non-Patent Citations (1)
Title |
---|
"伺服系统的离散时间双口内模控制器设计";孔祥宣 等;《火炮发射与控制学报》;20070331(第1期);第31-34页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111796515A (zh) | 2020-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108802707B (zh) | 改进的用于目标跟踪的卡尔曼滤波方法 | |
Yang et al. | Kalman filtering with nonlinear state constraints | |
CN109669479B (zh) | 一种基于事件触发的移动机器人轨迹跟踪控制方法 | |
CN110580713A (zh) | 基于全卷积孪生网络和轨迹预测的卫星视频目标跟踪方法 | |
CN110377043A (zh) | 一种基于h∞回路成形算法的小型固定翼无人机姿态控制方法 | |
CN110209180B (zh) | 一种基于HuberM-Cubature卡尔曼滤波的无人水下航行器目标跟踪方法 | |
Eubank et al. | Fault detection and fail-safe operation with a multiple-redundancy air-data system | |
Liu et al. | Unscented Kalman filtering in the additive noise case | |
CN111796515B (zh) | 一种适用于未知输入跟踪系统的改进型双口内模控制方法 | |
Jia et al. | Accurate high-maneuvering trajectory tracking for quadrotors: A drag utilization method | |
Mickle et al. | Bank-to-turn roll-yaw-pitch autopilot design using dynamic nonlinear inversion and PD-eigenvalue assignment | |
Ma et al. | A UKF algorithm based on the singular value decomposition of state covariance | |
CN115129072A (zh) | 固定翼无人机位置跟踪偏差约束下终端滑模控制方法 | |
CN112748748B (zh) | 基于控制杆数据的光电跟瞄半自动复合控制系统及方法 | |
Han et al. | Maneuvering target tracking with unknown acceleration using retrospective-cost-based adaptive input and state estimation | |
CN109085571B (zh) | 基于三重贝叶斯准则的高超声速目标跟踪方法 | |
Ra et al. | Time-varying line-of-sight rate estimator with a single modified tracking index for RF homing guidance | |
CN206820938U (zh) | 一种车载指向拾音器装置及其汽车 | |
CN114637211B (zh) | 一种基于直接自适应律的固定时间反步控制方法 | |
Li et al. | Real-time image stabilization method based on low altitude fixed wing UAV | |
Luo et al. | The design of uav control system based on dsp | |
Chen et al. | Sliding-mode-control based robust guidance algorithm using only line-of-sight rate measurement | |
Wang et al. | Study on homing guidance systems based on different source errors | |
Zhang et al. | Estimation of aerodynamic parameter for maneuvering reentry vehicle tracking | |
Li et al. | NDOB-based three-dimensional guidance law with fast and finite-time convergence |
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 |