CN106707766B - 一种基于误差观测器的快反镜前馈控制方法 - Google Patents

一种基于误差观测器的快反镜前馈控制方法 Download PDF

Info

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
controller
feedforward
fast
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
Application number
CN201710137779.5A
Other languages
English (en)
Other versions
CN106707766A (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 CN201710137779.5A priority Critical patent/CN106707766B/zh
Publication of CN106707766A publication Critical patent/CN106707766A/zh
Application granted granted Critical
Publication of CN106707766B publication Critical patent/CN106707766B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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所传回的跟踪误差量通过模型补偿器
Figure BDA0001241903720000022
又因为此处内环带宽高,外环带宽低,在外环带宽有效范围内,可得Gm(s)=1,也就是CCD误差量在此处可直接使用;然后把当前的内环给定进行延时T1后与CCD误差量相加,如此可得到当前目标位置估计量;
步骤(5):根据CCD延时特性设计前馈控制器Q(s)的滤波带宽,然后把目标位置估计量直接作为前馈控制器的输入,计算得到真实前馈量,最后把该前馈量直接加在CCD环位置控制器C(s)的输出,此时的输出量则是作为内环的给定量输入,如此完成前馈操作,实现误差抑制。
其中,步骤(3)中内环位置控制器Cp(s)和CCD外环控制器C(s)都设计为PI控制器,其模型参考如下:
Figure BDA0001241903720000021
其中,KP为比例增益,KI为积分增益。
其中,步骤(4)中的给定进行延时T1一般通过采样保持延时进行处理,通过确定CCD的延时时间后,T1则与之对应,这样可使数据时间上对齐。
其中,步骤(5)中前馈控制器Q(s)的设计为如下带一阶滤波环节的控制器模型:
Figure BDA0001241903720000031
其中,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控制器,其模型参考如下:
Figure BDA0001241903720000041
其中,KP为比例增益,KI为积分增益。
步骤(4):添加误差观测器,首先把CCD所传回的跟踪误差量通过模型补偿器
Figure BDA0001241903720000044
又因为此处内环带宽高,外环带宽低,在外环带宽有效范围内,可得Gm(s)=1,也就是CCD误差量在此处可直接使用;然后把当前的内环给定进行延时T1后与CCD误差量相加,如此可得到当前目标位置估计量。给定进行延时T1一般通过采样保持延时进行处理,通过确定CCD的延时时间后,T1则与之对应,这样可使数据时间上对齐;
步骤(5):根据CCD延时特性设计前馈控制器Q(s)的滤波带宽,然后把目标位置估计量直接作为前馈控制器的输入,计算得到真实前馈量,最后把该前馈量直接加在CCD环位置控制器C(s)的输出,此时的输出量则是作为内环的给定量输入,如此完成前馈操作,实现误差抑制。前馈控制器Q(s)的设计为如下带一阶滤波环节的控制器模型:
Figure BDA0001241903720000042
其中,Tf为滤波器滤波带宽因子。当前馈补偿器设计为如上模型后,整个前馈控制器呈现一个高通校正特性,从而有力的提高系统的低频误差抑制能力,也就是低频跟踪性能。
下面以一快反镜跟踪平台实验系统为例对本发明的设计过程和效果进行详细说明:
(1)通过频率响应测试仪测出系统的电涡流位置模型为如下G(s),然后可设计内环位置控制器为Cp(s)和外环CCD控制器C(s)实现双环闭环,其中CCD频率为50Hz,延时为3帧(60ms);
Figure BDA0001241903720000043
(2)设计内环给定进行延时T1为60ms,延时3帧,和CCD延时保证一致,然后设计前馈控制器Q(s)为如下,其带宽约为1Hz;
Figure BDA0001241903720000051
(3)如图2是本发明的跟踪误差抑制能力对比图。在相同情况下,可以明确看出在采用基于误差观测器进行前馈控制后,系统的低频的误差抑制能力大大提高,同时也在高频保证系统稳定特性,延续了高频的误差抑制能力。

Claims (4)

1.一种基于误差观测器的快反镜前馈控制方法,其特征在于:该方法步骤如下:
步骤(1):在快反镜跟踪控制系统中安装电涡流位置传感器,用以测量快反镜的偏转角位置量,利用电涡流传感器的采样频率高的特点以实现一个高带宽线性内环,为外环提供一个线性被控对象;
步骤(2):通过频率响应测试仪对平台的电涡流位置频率对象特性进行测试,输入为控制器输出值,输出为电涡流采样值,高采样率可获得较高精度的电涡流对象模型G(s),用于实现高带宽内环;
步骤(3):在获取到被控对象模型G(s)基础上,设计内环位置控制器Cp(s)实现高带宽位置反馈闭环,然后再次通过频率响应测试仪测试位置内环闭环后的对象模型,输入为给定位置,输出为CCD量,此对象模型为外环被控对象模型,称为Gp(s),然后可设计CCD环控制器C(s),这样就构成了传统的双闭环控制;
步骤(4):添加误差观测器,首先把CCD所传回的跟踪误差量通过模型补偿器
Figure FDA0002131115370000012
又因为此处内环带宽高,外环带宽低,在外环带宽有效范围内,可得Gm(s)=1,也就是CCD误差量在此处可直接使用;然后把当前的内环给定进行延时T1后与CCD误差量相加,如此可得到当前目标位置估计量;
步骤(5):根据CCD延时特性设计前馈控制器Q(s)的滤波带宽,然后把目标位置估计量直接作为前馈控制器的输入,计算得到真实前馈量,最后把该前馈量直接加在CCD环位置控制器C(s)的输出,此时的输出量则是作为内环的给定量输入,如此完成前馈操作,实现误差抑制。
2.根据权利要求1所述的一种基于误差观测器的快反镜前馈控制方法,其特征在于:步骤(3)中内环位置控制器Cp(s)和CCD外环控制器C(s)都设计为PI控制器,其模型参考如下:
Figure FDA0002131115370000011
其中,KP为比例增益,KI为积分增益。
3.根据权利要求1所述的一种基于误差观测器的快反镜前馈控制方法,其特征在于:步骤(4)中的给定进行延时T1一般通过采样保持延时进行处理,通过确定CCD的延时时间后,T1则与之对应,这样可使数据时间上对齐。
4.根据权利要求1所述的一种基于误差观测器的快反镜前馈控制方法,其特征在于:步骤(5)中前馈控制器Q(s)的设计为如下带一阶滤波环节的控制器模型:
Figure FDA0002131115370000021
其中,Tf为滤波器滤波带宽因子,当前馈补偿器设计为如上模型后,整个前馈控制器呈现一个高通校正特性,从而有力的提高系统的低频误差抑制能力,也就是低频跟踪性能。
CN201710137779.5A 2017-03-09 2017-03-09 一种基于误差观测器的快反镜前馈控制方法 Active CN106707766B (zh)

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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107390522A (zh) * 2017-07-11 2017-11-24 中国科学院光电技术研究所 一种基于视觉跟踪的误差观测前馈控制方法
CN107367934B (zh) * 2017-07-11 2021-02-19 中国科学院光电技术研究所 一种基于双扰动观测器的快反镜稳定控制方法
CN107272411A (zh) * 2017-07-11 2017-10-20 中国科学院光电技术研究所 一种插件式加速度反馈的快反镜光束稳定控制方法
CN108563246B (zh) * 2018-01-02 2021-04-27 广东铭凯医疗机器人有限公司 显微镜下的旋转定位平台的控制系统和控制方法
CN108469842A (zh) * 2018-03-19 2018-08-31 中国科学院光电技术研究所 一种运动平台复合轴光电跟踪系统精稳定扰动解耦方法
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)

* Cited by examiner, † Cited by third party
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 中国科学院光电技术研究所 一种提高快反镜稳定平台扰动抑制能力的控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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) 一种基于误差观测器的快反镜前馈控制方法
CN106896720B (zh) 一种改进的基于捷联式加速度测量的快反镜惯性稳定控制方法
CN108897230B (zh) 一种基于跟踪和扰动前馈的快反镜控制方法
CN106647257B (zh) 一种基于正交最小二乘的前馈控制方法
CN106482735A (zh) 一种提高快反镜稳定平台扰动抑制能力的控制方法
CN107390522A (zh) 一种基于视觉跟踪的误差观测前馈控制方法
CN109358501A (zh) 自抗扰控制方法、控制器及精跟踪控制系统
CN107272421B (zh) 一种自抗扰控制系统及方法
CN110109343B (zh) 一种光电跟踪系统视觉测量时滞补偿方法
CN109164709A (zh) 一种基于改进型Smith预估器的光电跟踪系统控制方法
CN106814624A (zh) 一种改进的基于多闭环的快反镜扰动观测补偿控制方法
CN107505845B (zh) 一种提高倾斜镜控制系统扰动抑制能力的控制方法
CN107272411A (zh) 一种插件式加速度反馈的快反镜光束稳定控制方法
CN104483977A (zh) 一种舵机云台的无速度反馈动态面控制方法
CN106597838A (zh) 一种控制舵机的装置及方法
CN109634123A (zh) 用于pH中和过程的自抗扰控制参数整定方法
CN106054603A (zh) 一种提高快反镜控制带宽的滞后预估方法
CN117192726B (zh) 一种基于改进自抗扰控制的快速反射镜控制方法及设备
CN108023531B (zh) 一种用于闭环位置伺服的可测量速度扰动的补偿方法
CN107168047B (zh) 提高重复补偿pid控制系统的控制性能的方法
CN116400603A (zh) 基于伪前馈改进的Smith预估器的激光跟踪控制方法
CN115951586A (zh) 一种快速反射镜的建模与控制方法
CN107524660B (zh) 一种大型结构件起竖调直的控制方法及控制系统
CN110635710A (zh) 一种压电驱动器高精度周期跟踪的自抗扰重复控制方法
CN102385312A (zh) 一种快速倾斜镜控制系统中串联型pi-pi的控制器

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