CN106707766B - 一种基于误差观测器的快反镜前馈控制方法 - Google Patents
一种基于误差观测器的快反镜前馈控制方法 Download PDFInfo
- Publication number
- CN106707766B CN106707766B CN201710137779.5A CN201710137779A CN106707766B CN 106707766 B CN106707766 B CN 106707766B CN 201710137779 A CN201710137779 A CN 201710137779A CN 106707766 B CN106707766 B CN 106707766B
- Authority
- CN
- China
- Prior art keywords
- ccd
- error
- feedforward
- controller
- loop
- 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
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000005070 sampling Methods 0.000 claims abstract description 17
- 230000001629 suppression Effects 0.000 claims abstract description 12
- 238000012360 testing method Methods 0.000 claims description 6
- 238000012937 correction Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 abstract description 4
- 230000007812 deficiency Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005693 optoelectronics Effects 0.000 description 1
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/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
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
本发明涉及一种基于误差观测器的快反镜前馈控制方法,针对当前快反镜前馈控制存在的不足,利用CCD提供的视轴误差量和位置环控制器的输出量融合实现一个高增益的观测器,用以实现对目标位置的观测和估计,然后实现对目标位置的前馈控制,减少其CCD跟踪误差。由于此方法是基于CCD传感器的数据融合前馈,因此本发明不仅针对目标跟踪有效,同时也对基于CCD的快反镜扰动抑制有效,使用范围较广。该方法是依靠位置控制器的输出,而不是外环的输出,因此不再受外环传感器的采样率限制,而仅仅是依靠CCD所传回的误差量,这样可简化系统控制流程。同时,该控制结构在实际工程实现中较为简单,计算量更小,控制复杂度更低,也更为直观易懂。
Description
技术领域
本发明属于光电系统跟踪控制领域,具体的涉及一种基于误差观测器的快反镜前馈控制方法,用于减少跟踪误差,进一步提高快反镜在针对机动目标的跟踪性能。
背景技术
光电跟踪控制系统在实现运动目标跟踪时,主要依靠基于视觉误差的反馈跟踪方式。CCD作为视觉跟踪误差传感器被广泛应用于光电系统中的机架控制回路和快反镜控制回路。快反镜控制回路用于实现目标的高精度锁定和跟踪,其跟踪精度决定着系统的最终整体性能。传统的快反镜跟踪控制主要依靠电涡流位置传感器和CCD视觉误差传感器实现双闭环跟踪控制。但是由于CCD一般为50Hz采样、2~3帧延时,具有采样率低、时间延时大,从而很大程度上限制了外位置环带宽,进而阻碍控制系统跟踪性能。针对此问题,理论和实验证明,前馈控制是最有效的方法之一。当前的前馈控制主要是依靠机架编码器和CCD的数据融合得到目标运动速度,然后进行基于目标速度的前馈。该方法结构较为复杂,需要依靠外部传感器实现;并且在实现目标速度预测时也使用了CCD数据,其中的延时也会导致对目标速度预测误差较大,从而导致使用效果不佳。
发明内容
针对当前快反镜前馈控制存在的不足,本发明的目的是提供一种基于误差观测器的快反镜前馈控制方法,主要是用于提升系统的低频跟踪性能。本方法的核心思想是利用CCD提供的视轴误差量和位置环控制器的输出量融合实现一个高增益的观测器,用以实现对目标位置的观测和估计,然后实现对目标位置的前馈控制,减少其CCD跟踪误差。由于此方法是基于CCD传感器的数据融合前馈,因此本发明不仅针对目标跟踪有效,同时也对基于CCD的快反镜扰动抑制有效,使用范围较广。在针对CCD的采样延时问题上,本方法不再关注如何进行预测估计来减少延时的问题,而是直接采用延时时间对齐,得到一个带同样延时的目标位置信息,然后利用低通滤波器对之进行滤波处理进行前馈,这样的处理方式虽然牺牲了系统在高频的误差抑制能力,但是保证了系统在低频的跟踪性能,以此本方法主要是用于提升系统的低频跟踪能力。在另一方面,本方法是依靠位置控制器的输出,而不是外环的输出,因此本方法不再受外环传感器的采样率限制,而仅仅是依靠CCD所传回的误差量,这样可简化系统控制流程。
为实现本发明的目的,本发明提供一种基于误差观测器的快反镜前馈控制方法,其步骤如下:
步骤(1):在快反镜跟踪控制系统中安装电涡流位置传感器,用以测量快反镜的偏转角位置量,电涡流传感器的采样频率一般较高,主要是用以实现一个高带宽线性内环,为外环提供一个线性被控对象;
步骤(2):通过频率响应测试仪对平台的电涡流位置频率对象特性进行测试,输入为控制器输出值,输出为电涡流采样值。高采样率可获得较高精度的电涡流对象模型G(s),用于实现高带宽内环;
步骤(3):在获取到被控对象模型G(s)基础上,设计内环位置控制器Cp(s)实现高带宽位置反馈闭环,然后再次通过频率响应测试仪测试位置内环闭环后的对象模型,输入为给定位置,输出为CCD量,此对象模型为外环被控对象模型,称为Gp(s),然后可设计CCD环控制器C(s),这样就构成了传统的双闭环控制;
步骤(4):添加误差观测器,首先把CCD所传回的跟踪误差量通过模型补偿器又因为此处内环带宽高,外环带宽低,在外环带宽有效范围内,可得Gm(s)=1,也就是CCD误差量在此处可直接使用;然后把当前的内环给定进行延时T1后与CCD误差量相加,如此可得到当前目标位置估计量;
步骤(5):根据CCD延时特性设计前馈控制器Q(s)的滤波带宽,然后把目标位置估计量直接作为前馈控制器的输入,计算得到真实前馈量,最后把该前馈量直接加在CCD环位置控制器C(s)的输出,此时的输出量则是作为内环的给定量输入,如此完成前馈操作,实现误差抑制。
其中,步骤(3)中内环位置控制器Cp(s)和CCD外环控制器C(s)都设计为PI控制器,其模型参考如下:
其中,KP为比例增益,KI为积分增益。
其中,步骤(4)中的给定进行延时T1一般通过采样保持延时进行处理,通过确定CCD的延时时间后,T1则与之对应,这样可使数据时间上对齐。
其中,步骤(5)中前馈控制器Q(s)的设计为如下带一阶滤波环节的控制器模型:
其中,Tf为滤波器滤波带宽因子,当前馈补偿器设计为如上模型后,整个前馈控制器呈现一个高通校正特性,从而有力的提高系统的低频误差抑制能力,也就是低频跟踪性能。
本发明与现有技术相比具有如下优点:
(1)相对传统的基于目标速度的前馈控制方法,本发明采用基于误差观测器的位置前馈方式,不再需要外部机架传感器来对目标速度进行估计,而仅仅是依靠CCD所传回的误差量,再加上位置控制器的输出,因此本方法不再受外环传感器的采样率限制,这样可简化系统控制流程;
(2)本方法可有效提高系统的低频跟踪性能,减少跟踪误差,而同时保证高频误差不发散,满足实际工程对跟踪的精度需求;
(3)本方法是基于CCD传感器的数据融合前馈,因此此发明不仅针对目标跟踪有效,同时也对基于CCD的快反镜扰动抑制有效,使用范围较广;同时,该控制结构在实际工程实现中较为简单,计算量更小,控制复杂度更低,也更为直观易懂。
附图说明
图1是本发明的一种基于误差观测器的快反镜前馈控制方法的控制框图。
图2是本发明的一种基于误差观测器的快反镜前馈控制方法的误差抑制对比图。
具体实施方式
以下结合附图对本发明的具体实施方式做详细说明。
如附图1所示是一种基于误差观测器的快反镜前馈控制方法的控制框图,其中包括一个高带宽电涡流内环、一个CCD位置外环和一个误差观测器。本方法的核心思想是利用CCD提供的视轴误差量和位置环控制器的输出量融合实现一个高增益的观测器,用以实现对目标位置的观测和估计,然后实现对目标位置的前馈控制,减少其CCD跟踪误差。采用所述装置实现前馈控制方法的具体实施步骤如下:
步骤(1):在快反镜跟踪控制系统中安装电涡流位置传感器,用以测量快反镜的偏转角位置量。电涡流传感器的采样频率一般较高,主要是用以实现一个高带宽线性内环,为外环提供一个线性被控对象;
步骤(2):通过频率响应测试仪对平台的电涡流位置频率对象特性进行测试,输入为控制器输出值,输出为电涡流采样值。高采样率可获得较高精度的电涡流对象模型G(s),用于实现高带宽内环;
步骤(3):在获取到被控对象模型G(s)基础上,设计内环位置控制器Cp(s)实现高带宽位置反馈闭环,然后再次通过频率响应测试仪测试位置内环闭环后的对象模型,输入为给定位置,输出为CCD量,此对象模型为外环被控对象模型,称为Gp(s),然后可设计CCD环控制器C(s),这样就构成了传统的双闭环控制;其中内环位置控制器Cp(s)和CCD外环控制器C(s)都设计为PI控制器,其模型参考如下:
其中,KP为比例增益,KI为积分增益。
步骤(4):添加误差观测器,首先把CCD所传回的跟踪误差量通过模型补偿器又因为此处内环带宽高,外环带宽低,在外环带宽有效范围内,可得Gm(s)=1,也就是CCD误差量在此处可直接使用;然后把当前的内环给定进行延时T1后与CCD误差量相加,如此可得到当前目标位置估计量。给定进行延时T1一般通过采样保持延时进行处理,通过确定CCD的延时时间后,T1则与之对应,这样可使数据时间上对齐;
步骤(5):根据CCD延时特性设计前馈控制器Q(s)的滤波带宽,然后把目标位置估计量直接作为前馈控制器的输入,计算得到真实前馈量,最后把该前馈量直接加在CCD环位置控制器C(s)的输出,此时的输出量则是作为内环的给定量输入,如此完成前馈操作,实现误差抑制。前馈控制器Q(s)的设计为如下带一阶滤波环节的控制器模型:
其中,Tf为滤波器滤波带宽因子。当前馈补偿器设计为如上模型后,整个前馈控制器呈现一个高通校正特性,从而有力的提高系统的低频误差抑制能力,也就是低频跟踪性能。
下面以一快反镜跟踪平台实验系统为例对本发明的设计过程和效果进行详细说明:
(1)通过频率响应测试仪测出系统的电涡流位置模型为如下G(s),然后可设计内环位置控制器为Cp(s)和外环CCD控制器C(s)实现双环闭环,其中CCD频率为50Hz,延时为3帧(60ms);
(2)设计内环给定进行延时T1为60ms,延时3帧,和CCD延时保证一致,然后设计前馈控制器Q(s)为如下,其带宽约为1Hz;
(3)如图2是本发明的跟踪误差抑制能力对比图。在相同情况下,可以明确看出在采用基于误差观测器进行前馈控制后,系统的低频的误差抑制能力大大提高,同时也在高频保证系统稳定特性,延续了高频的误差抑制能力。
Claims (4)
1.一种基于误差观测器的快反镜前馈控制方法,其特征在于:该方法步骤如下:
步骤(1):在快反镜跟踪控制系统中安装电涡流位置传感器,用以测量快反镜的偏转角位置量,利用电涡流传感器的采样频率高的特点以实现一个高带宽线性内环,为外环提供一个线性被控对象;
步骤(2):通过频率响应测试仪对平台的电涡流位置频率对象特性进行测试,输入为控制器输出值,输出为电涡流采样值,高采样率可获得较高精度的电涡流对象模型G(s),用于实现高带宽内环;
步骤(3):在获取到被控对象模型G(s)基础上,设计内环位置控制器Cp(s)实现高带宽位置反馈闭环,然后再次通过频率响应测试仪测试位置内环闭环后的对象模型,输入为给定位置,输出为CCD量,此对象模型为外环被控对象模型,称为Gp(s),然后可设计CCD环控制器C(s),这样就构成了传统的双闭环控制;
步骤(4):添加误差观测器,首先把CCD所传回的跟踪误差量通过模型补偿器又因为此处内环带宽高,外环带宽低,在外环带宽有效范围内,可得Gm(s)=1,也就是CCD误差量在此处可直接使用;然后把当前的内环给定进行延时T1后与CCD误差量相加,如此可得到当前目标位置估计量;
步骤(5):根据CCD延时特性设计前馈控制器Q(s)的滤波带宽,然后把目标位置估计量直接作为前馈控制器的输入,计算得到真实前馈量,最后把该前馈量直接加在CCD环位置控制器C(s)的输出,此时的输出量则是作为内环的给定量输入,如此完成前馈操作,实现误差抑制。
3.根据权利要求1所述的一种基于误差观测器的快反镜前馈控制方法,其特征在于:步骤(4)中的给定进行延时T1一般通过采样保持延时进行处理,通过确定CCD的延时时间后,T1则与之对应,这样可使数据时间上对齐。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710137779.5A CN106707766B (zh) | 2017-03-09 | 2017-03-09 | 一种基于误差观测器的快反镜前馈控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710137779.5A CN106707766B (zh) | 2017-03-09 | 2017-03-09 | 一种基于误差观测器的快反镜前馈控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106707766A CN106707766A (zh) | 2017-05-24 |
CN106707766B true CN106707766B (zh) | 2020-05-01 |
Family
ID=58918124
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710137779.5A Active CN106707766B (zh) | 2017-03-09 | 2017-03-09 | 一种基于误差观测器的快反镜前馈控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106707766B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272411A (zh) * | 2017-07-11 | 2017-10-20 | 中国科学院光电技术研究所 | 一种插件式加速度反馈的快反镜光束稳定控制方法 |
CN107367934B (zh) * | 2017-07-11 | 2021-02-19 | 中国科学院光电技术研究所 | 一种基于双扰动观测器的快反镜稳定控制方法 |
CN107390522A (zh) * | 2017-07-11 | 2017-11-24 | 中国科学院光电技术研究所 | 一种基于视觉跟踪的误差观测前馈控制方法 |
CN108563246B (zh) * | 2018-01-02 | 2021-04-27 | 广东铭凯医疗机器人有限公司 | 显微镜下的旋转定位平台的控制系统和控制方法 |
CN108469842B (zh) * | 2018-03-19 | 2024-10-18 | 中国科学院光电技术研究所 | 一种运动平台复合轴光电跟踪系统精稳定扰动解耦方法 |
CN108646568B (zh) * | 2018-07-05 | 2021-06-18 | 中国科学院光电技术研究所 | 一种基于改进的扰动观测器的倾斜镜振动抑制方法 |
CN108897230B (zh) * | 2018-09-28 | 2021-09-07 | 中国科学院光电技术研究所 | 一种基于跟踪和扰动前馈的快反镜控制方法 |
CN109541945B (zh) * | 2019-01-10 | 2021-11-02 | 中国科学院光电技术研究所 | 一种基于复合型扰动观测器的扰动抑制方法 |
CN109884882A (zh) * | 2019-02-25 | 2019-06-14 | 中国科学院光电技术研究所 | 一种基于微分跟踪器的光电跟踪系统控制方法 |
CN112051726B (zh) * | 2020-07-27 | 2023-08-11 | 北京控制工程研究所 | 一种基于线性跟踪微分器的位置前馈控制方法 |
CN113075881B (zh) * | 2021-03-29 | 2022-11-01 | 三一重机有限公司 | 一种pid控制器的参数调节方法、装置及电子设备 |
CN113687598A (zh) * | 2021-10-25 | 2021-11-23 | 南京信息工程大学 | 基于内模的预测前馈跟踪控制方法、设备及其存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102385312A (zh) * | 2011-10-26 | 2012-03-21 | 中国科学院光电技术研究所 | 一种快速倾斜镜控制系统中串联型pi-pi的控制器 |
CN202815313U (zh) * | 2012-08-28 | 2013-03-20 | 中国工程物理研究院应用电子学研究所 | 多束光轴闭环控制装置 |
CN105045141A (zh) * | 2015-05-27 | 2015-11-11 | 中国科学院光电技术研究所 | 一种提高快速反射镜控制带宽的模拟控制电路 |
CN105717788A (zh) * | 2016-04-13 | 2016-06-29 | 中国科学院光电技术研究所 | 一种基于模糊pid的快速反射镜自抗扰控制系统 |
CN105911869A (zh) * | 2016-06-30 | 2016-08-31 | 中国科学院光电技术研究所 | 一种基于干扰观测的快速反射镜扰动抑制方法 |
CN106054603A (zh) * | 2016-05-30 | 2016-10-26 | 中国科学院光电技术研究所 | 一种提高快反镜控制带宽的滞后预估方法 |
CN106482735A (zh) * | 2016-10-14 | 2017-03-08 | 中国科学院光电技术研究所 | 一种提高快反镜稳定平台扰动抑制能力的控制方法 |
-
2017
- 2017-03-09 CN CN201710137779.5A patent/CN106707766B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102385312A (zh) * | 2011-10-26 | 2012-03-21 | 中国科学院光电技术研究所 | 一种快速倾斜镜控制系统中串联型pi-pi的控制器 |
CN202815313U (zh) * | 2012-08-28 | 2013-03-20 | 中国工程物理研究院应用电子学研究所 | 多束光轴闭环控制装置 |
CN105045141A (zh) * | 2015-05-27 | 2015-11-11 | 中国科学院光电技术研究所 | 一种提高快速反射镜控制带宽的模拟控制电路 |
CN105717788A (zh) * | 2016-04-13 | 2016-06-29 | 中国科学院光电技术研究所 | 一种基于模糊pid的快速反射镜自抗扰控制系统 |
CN106054603A (zh) * | 2016-05-30 | 2016-10-26 | 中国科学院光电技术研究所 | 一种提高快反镜控制带宽的滞后预估方法 |
CN105911869A (zh) * | 2016-06-30 | 2016-08-31 | 中国科学院光电技术研究所 | 一种基于干扰观测的快速反射镜扰动抑制方法 |
CN106482735A (zh) * | 2016-10-14 | 2017-03-08 | 中国科学院光电技术研究所 | 一种提高快反镜稳定平台扰动抑制能力的控制方法 |
Non-Patent Citations (5)
Title |
---|
《Comparing 2DOF PI and predictive disturbance observer basedfiltered PI control》;M. Hubaa;《Journal of Process Control》;20131231;第1379-1400页 * |
《MEMS Inertial Sensors-Based Multi-Loop Control Enhanced by Disturbance Observation and Compensation for Fast Steering Mirror System》;Chao Deng.et;《sensors》;20161215;第1-12页 * |
《基于DOB和ZPETC的PWM驱动快速反射镜控制方法研究》;王福超等;《机电工程》;20150731;第32卷(第7期);第903-908页 * |
《基于快速反射镜的高精度、宽频带扫描像移补偿技术研究》;孙崇尚;《中国博士学位论文全文数据库(电子期刊)》;20160815(第8期);第I138-38页 * |
《抑制光束抖动的快速反射镜复合控制》;丁科等;《光学精密工程》;20110930;第19卷(第9期);第1991-1998页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106707766A (zh) | 2017-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106707766B (zh) | 一种基于误差观测器的快反镜前馈控制方法 | |
CN107390522A (zh) | 一种基于视觉跟踪的误差观测前馈控制方法 | |
CN104122531B (zh) | 自适应处理雷达天线位置振荡的方法 | |
CN108897230A (zh) | 一种基于跟踪和扰动前馈的快反镜控制方法 | |
CN106647257B (zh) | 一种基于正交最小二乘的前馈控制方法 | |
CN107505845B (zh) | 一种提高倾斜镜控制系统扰动抑制能力的控制方法 | |
CN106482735A (zh) | 一种提高快反镜稳定平台扰动抑制能力的控制方法 | |
CN110086400A (zh) | 一种机电伺服系统非线性变增益控制方法和系统 | |
CN108469842B (zh) | 一种运动平台复合轴光电跟踪系统精稳定扰动解耦方法 | |
CN109164709A (zh) | 一种基于改进型Smith预估器的光电跟踪系统控制方法 | |
CN112051726B (zh) | 一种基于线性跟踪微分器的位置前馈控制方法 | |
CN106896720A (zh) | 一种改进的基于捷联式加速度测量的快反镜惯性稳定控制方法 | |
CN105911869A (zh) | 一种基于干扰观测的快速反射镜扰动抑制方法 | |
CN108931916A (zh) | 电磁式快反镜的跟踪控制系统及带宽提高和相位滞后补偿方法 | |
CN102540877B (zh) | 一种基于快速倾斜镜校正的振动控制装置的控制方法 | |
CN108681242B (zh) | 一种光电系统中快速反射镜的分数阶控制方法 | |
CN107272411A (zh) | 一种插件式加速度反馈的快反镜光束稳定控制方法 | |
CN113687598A (zh) | 基于内模的预测前馈跟踪控制方法、设备及其存储介质 | |
CN113359872A (zh) | 一种舰载光电跟踪平台控制方法 | |
CN110609475A (zh) | 一种基于改进型扩张状态观测器的虚拟双闭环控制方法 | |
CN117192726B (zh) | 一种基于改进自抗扰控制的快速反射镜控制方法及设备 | |
CN109856964B (zh) | 基于脱靶量处理的运动目标控制方法和系统 | |
CN109976146A (zh) | 一种无人机视轴稳定的复合控制方法 | |
CN116442223A (zh) | 一种机械手系统轨迹跟踪的非线性动态控制器设计方法 | |
CN108762085A (zh) | 一种鲁棒快速点对点运动控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |