CN102426420A - 一种强鲁棒性的运动载体光电稳定平台控制系统 - Google Patents

一种强鲁棒性的运动载体光电稳定平台控制系统 Download PDF

Info

Publication number
CN102426420A
CN102426420A CN2011103828119A CN201110382811A CN102426420A CN 102426420 A CN102426420 A CN 102426420A CN 2011103828119 A CN2011103828119 A CN 2011103828119A CN 201110382811 A CN201110382811 A CN 201110382811A CN 102426420 A CN102426420 A CN 102426420A
Authority
CN
China
Prior art keywords
robust
stable platform
loop
control
disturbance
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
Application number
CN2011103828119A
Other languages
English (en)
Other versions
CN102426420B (zh
Inventor
夏运霞
包启亮
李志俊
于伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Institute of Optics and Electronics of CAS
Original Assignee
Institute of Optics and Electronics of CAS
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Institute of Optics and Electronics of CAS filed Critical Institute of Optics and Electronics of CAS
Priority to CN201110382811.9A priority Critical patent/CN102426420B/zh
Publication of CN102426420A publication Critical patent/CN102426420A/zh
Application granted granted Critical
Publication of CN102426420B publication Critical patent/CN102426420B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Feedback Control In General (AREA)

Abstract

一种强鲁棒性的运动载体光电稳定平台控制系统,系统采用整体稳定方式;设计高带宽的电流环;建立对象数学模型,用动态信号分析仪测试对象频率特性,经拟合得到对象传递函数Gm(s);根据建立的对象模型,采用两步法设计内模控制器Gimc(s),通过调节内模控制器Gimc(s)的参数ε使系统获得高的带宽;在内模控制的基础上添加鲁棒控制回路,设计鲁棒控制器Gc2(s),通过调节鲁棒控制器Gc2(s)的参数λ提高系统的鲁棒性能。本发明不需要额外的传感器,通过控制结构设计对建模误差和载体扰动进行软测量。该方法控制结构简单,参数意义直观明了,便于工程实现,大大提高了光电跟踪稳定平台的稳定精度。

Description

一种强鲁棒性的运动载体光电稳定平台控制系统
技术领域
本发明属于光电跟踪领域,具体的涉及一种强鲁棒性的运动载体上光电跟踪稳定平台控制系统,用于实现提高系统对建模误差和载体扰动的鲁棒性能。
背景技术
针对运动载体上的ATP系统,载体的运动、抖动以及外界环境对载体的干扰等都可以通过轴承摩擦耦合到跟踪平台上造成跟踪瞄准线(LOS)的晃动,引起图像模糊而影响提取目标脱靶量精度,导致跟踪性能下降,因此必须建立稳定分系统,将跟踪传感器的视轴与基座的运动和震动等相隔离,使稳定分系统的负载稳定在固定的惯性空间方向。运动载体上光电稳定平台控制的另一个难点是随着载体的姿态变化,被控对象特性会发生变化,故要求控制系统对模型不确定性有很强的鲁棒性。
如何提高惯性稳定平台的性能,目前大多采用经典的控制技术。一种常用的方法是在系统中添加测速机等能够测量扰动信息的传感器,测量扰动信息并对其进行前馈补偿。该方法能在一定程度上提高系统对扰动的抑制能力,但需要添加额外的传感器且无法改善系统对建模误差的鲁棒性。李嘉全等人在文献《基于速度信号的扰动观测器及在光电稳定平台的应用》(《光学精密工程》,2011,19(5),pp998-1004)中提出了在闭环控制系统中引入基于速度信号的扰动观测器提高系统的扰动抑制能力,但此方法对扰动的提高有限且不能克服对象的不确定性。
进几年,各种现代控制方法在光电跟踪稳定平台系统中的应用也受到了关注。如:变结构控制、神经网络、模糊控制、模型参考自适应控制等。这些方法均在某些方面能改善系统的性能,但因算法复杂或计算量大或实时性不够高等原因不利于工程实现。
发明内容
本发明要解决的技术问题是:克服现有技术不足,在不增加额外传感器的情况下,对建模误差和载体扰动信息进行软测量,并对其进行补偿,使光电跟踪稳定平台系统具有强鲁棒性,从而达到提高稳定平台的稳定精度。
本发明的技术方案:一种强鲁棒性的运动载体光电稳定平台控制系统,提高了系统的鲁棒性。其具体步骤如下:
(1)建立对象模型;
(2)针对高精度转台系统,设计高带宽的电流环反馈回路,以保证电机可以具有足够快的力矩响应;
(3)用动态信号分析仪测试对象频率特性,经matlab拟合得到对象传递函数;
(4)采用低通滤波器对陀螺输出信号进行滤波;
(5)采用两步法设计内模控制器Gimc(s),内模控制器Gimc(s)中的低通滤波器取为1型滤波器;
(6)在内模控制的基础上添加鲁棒回路,采用两步法设计鲁棒控制器Gc2(s)。当有建模误差存在即Gp(s)=Gm(s)+δGp(s)时,其中Gm(s)为建立的对象模型,δGp(s)为模型误差,通过鲁棒回路,将真实对象Gp(s)改造成与建立的内部模型接近的等效对象Gcp(s), G cp ( s ) = G m ( s ) + 1 1 + KG c 2 ( s ) G p ( s ) δ G p ( s ) , 此时模型误差为 1 1 + KG c 2 ( s ) G p ( s ) δ G p ( s ) . 当有扰动时,添加鲁棒回路之后,扰动抑制残余量为内模控制的 1 1 + KG c 2 ( s ) G p ( s ) ; k为鲁棒稳定回路比例因子,在试验中取为1;
所述步骤(5)中,在噪声容许范围内将内模控制器Gimc(s)的参数ε尽量取小而不用过多考虑系统对建模误差和扰动的鲁棒性,这样可以提高系统的带宽。
所述步骤(6)中,在保证鲁棒回路稳定的前提下Gc2(s)的参数λ越小,比例因子K越大,系统对建模误差和载体扰动的鲁棒性越强。
本发明的技术方案所具有的益处是:
1、相对于扰动前馈控制需要测速机等能够测量扰动信息的传感器,本发明采用对扰动信息的软测量,除了速率陀螺不需要额外的传感器就能提高系统对载体扰动的抑制能力。
2、相对于带扰动观测器的控制方法,本发明在系统中引入了内部模型,并通过鲁棒回路将真实对象改造成与内部模型相同的对象,大大提高了系统对建模误差的鲁棒性。
3、相对于神经网络、模糊自适应控制等现代控制方法,本发明技术简单,对微处理器性能要求较低,便于工程应用。
附图说明
图1为本发明的系统结构示意图;
图2为本发明的控制方法结构图;
图3为本发明的系统控制结构图;
图4为实测被控对象频率特性和拟合被控对象频率特性;
图5为采用本发明方法提高系统对建模误差的鲁棒性;
图6为采用PI控制和采用改进内模控制(RIMC)对扰动的抑制性能对比。
具体实施方式
以下结合附图,说明本发明的实施例。但以下的实施例仅限于解释本发明,本发明的保护范围应包括权利要求的全部内容,而且通过以下实施例对该领域的技术人员即可以实现本发明权利要求的全部内容。
下面以如附图1所示的某光电跟踪一维稳定平台为例进行说明。本伺服系统由两台单轴转台构成,位于下面的是扰动台,用于提供扰动角速度,位于上面的是稳定平台,扰动台和稳定平台由各自的力矩电机直接驱动。本系统采用DMM16T采集板+PC104/SPD2C嵌入式系统,采样频率为1000Hz,采用CS-ARS-12速率陀螺。本发明的具体实施步骤如下:
(1)设计电流控制器
Figure BDA0000112928090000031
其中s是laplace变换算子,在式子中,如果s在分母表示极点,在分子表示零点,电流环闭环带宽大于280Hz,在100Hz的相位滞后小于10°。
(2)对伺服系统进行机理分析,将系统近似建立一个二阶模型
Figure BDA0000112928090000032
利用动态信号分析仪测试系统开环频率特性,经matlab拟合得到系统开环传递函数
Figure BDA0000112928090000033
系统开环频率特性实测数据与拟合传递函数如图4所示。
(3)陀螺输出信号经过低通滤波器进行滤波处理,低通滤波器带宽设为150Hz;
(4)设计控制器Gimc(s)。将控制方法中引入的内部模型取为拟合得到的开环传递函数,并对其进行分解Gm(s)=Gp(s)=Gm+(s)*Gm-(s),其中Gm+(s)包含所有时滞和右半平面零点,且Gm+(0)=1,Gm-(s)是具有最小相位特征的传递函数。设计Gimc(s)=Gm- -1(s)*Gf(s),低通滤波器n取为Gm(s)中分子分母阶数之差,ε=0.0015。
(5)设计鲁棒控制回路,K=1,控制器Gc2(s)=Gm- -1(s)*Gf2(s),
Figure BDA0000112928090000041
λ=0.003。步骤(4)和步骤(5)所述的控制算法设计如图2、所示,图3是本发明控制结构图。
(6)用Matlab仿真本发明对系统建模误差的鲁棒性,其效果如图5所示。对扰动台施加扫频正弦信号,分别采用PI控制方法和改进鲁棒性的内模控制方法控制系统,并分别用动态信号分析仪测得这两种控制方法下稳定平台对扰动得抑制比,如图6所示。图4是用动态信号分析仪实测被控对象频率特性和用Matlab拟合得到被控对象频率特性,图中实线代表实测数据,虚线代表拟合得到的对象;图5是用Matlab仿真得到的本发明对建模误差的鲁棒性,图中实线代表建立的对象模型,虚线代表真实的对象,点线代表经改造过的等效被控对象;图6是控制系统闭环且对扰动台施加扫频正弦信号,用动态信号分析仪测得稳定平台对外界扰动的抑制比,图中实线代表PI控制方法系统对扰动的抑制性能,点划线代表改进鲁棒性内模控制系统对扰动的抑制性能。

Claims (4)

1.一种强鲁棒性的运动载体光电稳定平台控制系统,其特征在于:
(1)系统包括一个提供扰动的摇摆台和一个稳定平台,将陀螺安装在稳定平台上;
(2)针对高精度转台系统,设计高带宽的电流反馈回路,将电机改造成一理想力矩源,保证电机可以具有足够快的力矩响应;
(3)建立对象模型,用动态信号分析仪测试对象的频率特性,经拟合得到对象传递函数,将此传递函数设为控制系统内部模型,所述对象为电机和转台负载;
(4)采用内模控制方法将系统设计为1型系统,采用两步法设计内模控制器Gimc(s),调节其参数ε,提高系统的带宽;
(5)在内模控制的基础上添加鲁棒回路,采用与内模控制器相同的设计方法设计鲁棒控制器Gc2(s),调节其参数λ提高系统对建模误差和载体扰动的鲁棒性能,通过添加鲁棒回路之后,将系统对建模误差和对载体扰动的抑制性能提高1+KGc2(s)Gp(s)倍,其中Gc2(s)是鲁棒回路控制器,K是鲁棒回路比例因子,Gp(s)是被控对象传递函数。
2.根据权利要求1所述的一种强鲁棒性的运动载体光电稳定平台控制系统,其特征在于步骤(4)所述的内模控制器Gimc(s)的设计方法不限于两步法。
3.根据权利要求1所述的一种强鲁棒性的运动载体光电稳定平台控制系统,其特征在于步骤(5)中所述的鲁棒控制器Gc2(s)的设计与内模控制器Gimc(s)的设计相互独立,Gc2(s)的设计是满足系统稳定的任意一种设计方法。
4.根据权利要求1所述的一种强鲁棒性的运动载体光电稳定平台控制系统,其特征在于:基本内模控制方法和加上鲁棒控制回路的改进内模控制方法也适用于非运动载体上的光电跟踪稳定平台控制。
CN201110382811.9A 2011-11-27 2011-11-27 一种强鲁棒性的运动载体光电稳定平台控制系统 Active CN102426420B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110382811.9A CN102426420B (zh) 2011-11-27 2011-11-27 一种强鲁棒性的运动载体光电稳定平台控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110382811.9A CN102426420B (zh) 2011-11-27 2011-11-27 一种强鲁棒性的运动载体光电稳定平台控制系统

Publications (2)

Publication Number Publication Date
CN102426420A true CN102426420A (zh) 2012-04-25
CN102426420B CN102426420B (zh) 2014-10-15

Family

ID=45960420

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110382811.9A Active CN102426420B (zh) 2011-11-27 2011-11-27 一种强鲁棒性的运动载体光电稳定平台控制系统

Country Status (1)

Country Link
CN (1) CN102426420B (zh)

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102866636A (zh) * 2012-09-20 2013-01-09 中国科学院光电技术研究所 一种能体现减振系统性能的控制回路设计方法
CN103576677A (zh) * 2013-11-19 2014-02-12 中国科学院光电技术研究所 基于误差模型的光电跟踪控制系统中跟踪误差的估计方法
CN103644915A (zh) * 2013-12-11 2014-03-19 东南大学 一种直驱光纤陀螺稳定平台结构及其控制方法
CN104101364A (zh) * 2014-07-29 2014-10-15 济南飞越机电科技有限公司 一种提高微机械陀螺稳像平台精度的方法
CN104266663A (zh) * 2014-09-28 2015-01-07 中国科学院光电技术研究所 一种运动平台光电跟踪系统二级稳定扰动解耦方法
CN104535081A (zh) * 2014-11-28 2015-04-22 中国科学院西安光学精密机械研究所 用于稳定平台测试的可配置仿真位置姿态测量系统及方法
CN105182756A (zh) * 2015-10-22 2015-12-23 东华大学 一种基于模型参考自适应的新型内模补偿控制系统
CN105607658A (zh) * 2016-03-31 2016-05-25 西北工业大学 一种机载光电平台稳定指向控制方法
CN105629737A (zh) * 2016-03-25 2016-06-01 中车永济电机有限公司 一种内燃机车异步电机内模控制方法
CN106482735A (zh) * 2016-10-14 2017-03-08 中国科学院光电技术研究所 一种提高快反镜稳定平台扰动抑制能力的控制方法
CN109960151A (zh) * 2019-05-10 2019-07-02 中国科学院光电技术研究所 一种基于模型的鲁棒控制器设计方法
CN110109343A (zh) * 2019-04-30 2019-08-09 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
CN110968118A (zh) * 2019-12-18 2020-04-07 中国科学院长春光学精密机械与物理研究所 一种六自由度调整转台的控制方法
CN111506119A (zh) * 2020-04-27 2020-08-07 中国科学院光电技术研究所 一种非正交驱动三自由度内框的光电吊舱装置
CN112540539A (zh) * 2020-12-28 2021-03-23 武汉华中天易星惯科技有限公司 一种面向光电跟踪系统的神经网络控制系统及方法
CN113189873A (zh) * 2021-04-21 2021-07-30 中国科学院光电技术研究所 一种基于对称误差拟合的旋转双棱镜快速高精度解算方法
CN113867155A (zh) * 2021-11-10 2021-12-31 中国科学院光电技术研究所 一种适用于光电跟踪系统的扰动辨识和自适应补偿方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101382805A (zh) * 2008-10-14 2009-03-11 哈尔滨工程大学 速率陀螺稳定平台式天线随动跟踪系统
KR20110066262A (ko) * 2009-12-11 2011-06-17 한국과학기술원 내부 모델을 갖는 시간지연제어를 활용한 비선형 마찰 하에서의 강인 궤적 추종 방법

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101382805A (zh) * 2008-10-14 2009-03-11 哈尔滨工程大学 速率陀螺稳定平台式天线随动跟踪系统
KR20110066262A (ko) * 2009-12-11 2011-06-17 한국과학기술원 내부 모델을 갖는 시간지연제어를 활용한 비선형 마찰 하에서의 강인 궤적 추종 방법

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
李志俊等: "惯性平台稳定回路多闭环串级控制", 《光电工程》, vol. 37, no. 5, 31 May 2010 (2010-05-31), pages 19 - 24 *
王建宏等: "机载稳定跟踪平台速率回路的内模H_∞控制", 《电光与控制》, vol. 18, no. 01, 31 January 2011 (2011-01-31) *
胡浩军等: "稳定平台对基座角速率扰动的抑制能力", 《电机与控制学报》, vol. 11, no. 1, 31 January 2007 (2007-01-31), pages 25 - 28 *

Cited By (31)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102866636A (zh) * 2012-09-20 2013-01-09 中国科学院光电技术研究所 一种能体现减振系统性能的控制回路设计方法
CN102866636B (zh) * 2012-09-20 2014-11-19 中国科学院光电技术研究所 一种能体现减振系统性能的控制回路设计方法
CN103576677B (zh) * 2013-11-19 2015-12-02 中国科学院光电技术研究所 光电跟踪控制系统中跟踪误差的估计方法
CN103576677A (zh) * 2013-11-19 2014-02-12 中国科学院光电技术研究所 基于误差模型的光电跟踪控制系统中跟踪误差的估计方法
CN103644915A (zh) * 2013-12-11 2014-03-19 东南大学 一种直驱光纤陀螺稳定平台结构及其控制方法
CN103644915B (zh) * 2013-12-11 2016-03-23 东南大学 一种直驱光纤陀螺稳定平台结构及其控制方法
CN104101364B (zh) * 2014-07-29 2017-01-11 济南飞越机电科技有限公司 一种提高微机械陀螺稳像平台精度的方法
CN104101364A (zh) * 2014-07-29 2014-10-15 济南飞越机电科技有限公司 一种提高微机械陀螺稳像平台精度的方法
CN104266663A (zh) * 2014-09-28 2015-01-07 中国科学院光电技术研究所 一种运动平台光电跟踪系统二级稳定扰动解耦方法
CN104266663B (zh) * 2014-09-28 2017-02-08 中国科学院光电技术研究所 一种运动平台光电跟踪系统二级稳定扰动解耦方法
CN104535081A (zh) * 2014-11-28 2015-04-22 中国科学院西安光学精密机械研究所 用于稳定平台测试的可配置仿真位置姿态测量系统及方法
CN104535081B (zh) * 2014-11-28 2017-08-25 中国科学院西安光学精密机械研究所 用于稳定平台测试的可配置仿真位置姿态测量系统及方法
CN105182756A (zh) * 2015-10-22 2015-12-23 东华大学 一种基于模型参考自适应的新型内模补偿控制系统
CN105629737A (zh) * 2016-03-25 2016-06-01 中车永济电机有限公司 一种内燃机车异步电机内模控制方法
CN105629737B (zh) * 2016-03-25 2018-02-16 中车永济电机有限公司 一种内燃机车异步电机内模控制方法
CN105607658A (zh) * 2016-03-31 2016-05-25 西北工业大学 一种机载光电平台稳定指向控制方法
CN105607658B (zh) * 2016-03-31 2018-06-05 西北工业大学 一种机载光电平台稳定指向控制方法
CN106482735A (zh) * 2016-10-14 2017-03-08 中国科学院光电技术研究所 一种提高快反镜稳定平台扰动抑制能力的控制方法
CN110109343B (zh) * 2019-04-30 2021-09-10 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
CN110109343A (zh) * 2019-04-30 2019-08-09 东南大学 一种光电跟踪系统视觉测量时滞补偿方法
CN109960151A (zh) * 2019-05-10 2019-07-02 中国科学院光电技术研究所 一种基于模型的鲁棒控制器设计方法
CN109960151B (zh) * 2019-05-10 2022-07-19 中国科学院光电技术研究所 一种基于模型的鲁棒控制器设计方法
CN110968118A (zh) * 2019-12-18 2020-04-07 中国科学院长春光学精密机械与物理研究所 一种六自由度调整转台的控制方法
CN110968118B (zh) * 2019-12-18 2021-01-05 中国科学院长春光学精密机械与物理研究所 一种六自由度调整转台的控制方法
CN111506119A (zh) * 2020-04-27 2020-08-07 中国科学院光电技术研究所 一种非正交驱动三自由度内框的光电吊舱装置
CN112540539A (zh) * 2020-12-28 2021-03-23 武汉华中天易星惯科技有限公司 一种面向光电跟踪系统的神经网络控制系统及方法
CN112540539B (zh) * 2020-12-28 2022-08-09 武汉华中天易星惯科技有限公司 一种面向光电跟踪系统的神经网络控制方法
CN113189873A (zh) * 2021-04-21 2021-07-30 中国科学院光电技术研究所 一种基于对称误差拟合的旋转双棱镜快速高精度解算方法
CN113189873B (zh) * 2021-04-21 2022-08-02 中国科学院光电技术研究所 一种基于对称误差拟合的旋转双棱镜快速高精度解算方法
CN113867155A (zh) * 2021-11-10 2021-12-31 中国科学院光电技术研究所 一种适用于光电跟踪系统的扰动辨识和自适应补偿方法
CN113867155B (zh) * 2021-11-10 2023-05-26 中国科学院光电技术研究所 一种适用于光电跟踪系统的扰动辨识和自适应补偿方法

Also Published As

Publication number Publication date
CN102426420B (zh) 2014-10-15

Similar Documents

Publication Publication Date Title
CN102426420B (zh) 一种强鲁棒性的运动载体光电稳定平台控制系统
CN102621890A (zh) 一种运动载体光电跟踪稳定平台的控制方法
Glück et al. Swing-up control of a triple pendulum on a cart with experimental validation
CN102506860B (zh) 一种基于加速度反馈与前馈的惯性稳定装置及其控制方法
Mao et al. Design and implementation of continuous finite-time sliding mode control for 2-DOF inertially stabilized platform subject to multiple disturbances
CN105651242A (zh) 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法
CN102679979B (zh) 一种航空遥感三轴惯性稳定平台工作模式监控方法
Wang et al. Stabilization control mothed for two-axis inertially stabilized platform based on active disturbance rejection control with noise reduction disturbance observer
CN102243080A (zh) 高精度光纤陀螺带温度补偿的信号检测方法及装置
CN106707766A (zh) 一种基于误差观测器的快反镜前馈控制方法
CN104101361A (zh) 一种惯性平台角度传感器误差标定补偿方法
CN104615153A (zh) 一种基于tmx320f28335浮点dsp的二轴光电跟踪系统
US5274314A (en) Adaptive friction compensator
CN108459497A (zh) 一种基于adrc和nlpid的稳瞄伺服系统的控制方法
CN104266663A (zh) 一种运动平台光电跟踪系统二级稳定扰动解耦方法
CN103713520A (zh) 一种陀螺稳定平台的自适应复合控制方法
CN103529858A (zh) 位置闭环系统最小幅相差跟踪法
CN105955027A (zh) 一种基于多阶运动信息估计的前馈控制方法
CN107390522A (zh) 一种基于视觉跟踪的误差观测前馈控制方法
CN105446140A (zh) 一种稳定平台伺服系统基于有限时间收敛的复合控制方法
CN105486328A (zh) 一种抑制陀螺仪漂移的方法及装置
CN110209122A (zh) 一种多轴运动平台的控制方法、装置、介质及设备
CN109884881A (zh) 一种基于非线性pid控制技术的稳瞄伺服控制器的设计
Shao et al. Data-driven model-free adaptive positioning and anti-swing control for bridge cranes
Kodgirwar et al. Design of control system for quadcopter using Complementary Filter and PID controller

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant