CN110032220A - 一种基于传感器与模型融合的加速度前馈方法 - Google Patents
一种基于传感器与模型融合的加速度前馈方法 Download PDFInfo
- Publication number
- CN110032220A CN110032220A CN201910274320.9A CN201910274320A CN110032220A CN 110032220 A CN110032220 A CN 110032220A CN 201910274320 A CN201910274320 A CN 201910274320A CN 110032220 A CN110032220 A CN 110032220A
- Authority
- CN
- China
- Prior art keywords
- acceleration
- information
- sensor
- accelerometer
- platform
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
- G05D13/62—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover characterised by the use of electric means, e.g. use of a tachometric dynamo, use of a transducer converting an electric value into a displacement
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明提供一种基于传感器与模型融合的加速度前馈方法。针对光电跟踪系统的跟踪能力受到目标脱靶量滞后的制约,且无法直接提供目标的实时准确的位置、速度、加速度等信息这一问题,本发明将安装在系统上的线加速度的传感器信息和系统探测到的目标脱靶量信息进行融合和预测滤波,得到的目标相对平台的加速度信息,最后将此信息馈入到系统的加速度闭环以构成加速度前馈。本发明通过对系统馈入实时的目标加速度估计信息能够有助于提高系统中低频的跟踪能力。
Description
技术领域
本发明属于光电系统的跟踪控制领域,具体涉及一种基于传感器与模型融合的加速度前馈方法,主要用于当系统传感器受限时,对系统具有一定跟踪性能要求的光电跟踪系统所实现的加速度前馈控制。
背景技术
光电跟踪系统广泛应用于量子通信、自适应光学、天文观测、目标跟踪等科学领域,对于目标的跟踪技术而言,目前研究最多的并且有效的控制算法仍然是经典控制理论中的前馈控制和高型的多闭环反馈控制。在多闭环的反馈控制中,内回路主要是用来抑制内部的扰动,提高系统的线性度,针对目标跟踪性能主要还是靠外回路基于图像传感器的反馈控制,由于光电跟踪系统中图像传感器的低采样率和时间滞后的影响,系统很难通过提高系统增益来提高系统的跟踪能力,系统也很难去达到一个比较宽的跟踪带宽。反馈所能依靠的目标信息只有图像传感器提供的位置偏差信号,而前馈需要对目标的高阶信息,包括速度、加速度信息进行预测估计,然后作为前馈量输入到控制系统中,因此前馈比反馈采用了更多的目标信息量,相当于给系统预判了目标的运动。从而理论上跟踪效果要比单纯的反馈效果好。但是如基于电视传感器的光电跟踪系统只能提供目标的位置偏差即脱靶量信息,系统只能够用脱靶量信息和平台本身的位置信息进行合成目标对于平台的轨迹信息,因此由此构成的复合控制能够提高系统的跟踪性能也是有限的,不过对于机动性较弱速度慢的目标已经能够满足跟踪要求。
此外,随着光电跟踪系统的广泛应用,在尽量保证系统性能前提下,降低系统的复杂度、成本成为一个不可逃避的问题。系统的传感器性能决定着系统的跟踪能力的上限。而降低成本就意味着传感器的数量或者质量的降低。所以如何在传感器有限制的情况下提高系统的跟踪能力成为一个不可避免的问题。近年来,随着微机电系统工业的迅速发展,其惯性传感器的性能有了很大的提升,比如MEMS加速度计,MEMS陀螺,它们体积小,重量轻,价格便宜,功耗低。特别是MEMS加速度计,它们的带宽可以达到1Kz。在此背景下,MEMS加速度计就给系统的小型化和轻量化提供了巨大的可能性。
发明内容
本发明要解决的技术问题是:如何提高一个仅有图像传感器和加速度计的光电跟踪系统的跟踪精度,并且图像传感器存在低采样率和时间滞后,而加速度存在低频漂移和噪声。
本发明解决上述技术问题采用的技术方案为:一种基于传感器与模型融合的加速度前馈实现方法,其具体步骤为:
步骤(1)、系统利用MEMS加速度计来完成一个加速度闭环
其中,所述步骤(1)中,MEMS加速度计是一种线加速度计,此加速度闭环主要的作用是抗扰以及提高系统的线性度,加速度环控制器的设计不采用零极点对消的方式,控制器由一个比例环节、一个积分环节、一个低通滤波器、一个一阶微分环节组成,此控制器避免零极点对消方式产生的积分饱和,消除加速度计的噪声;
步骤(2)、在加速度闭环的基础上利用图像传感器传递的目标位置偏差完成位置外环
其中,所述步骤(2)中,此闭环的控制器称为位置环控制器,此控制器由一个比例环节,一个二阶微分环节,一个积分环节,一个低通滤波器位置环控制器,二阶微分环节主要是为了尽量去抵消系统的一阶谐振,积分环节提高系统的无静差度,低通滤波器滤除高频噪声;
步骤(3)、利用加速度计测得的平台加速度信息进行二次积分得到平台的位置信息,利用平台的位置信息和脱靶量信息进行合成得到目标对于平台的位置信息,然后利用合成得到的目标位置信息作为卡尔曼滤波器的测量值对目标的加速度信息进行预测滤波,最后将预测得到的目标加速度信息前馈到系统的加速度环,最终构成等效复合控制系统;
其中,所述步骤(3)中,由于加速度计低频存在漂移和噪声,平台的加速度信息并不是直接通过系统的加速度计测来的,首先是对系统加速度特性进行物理建模,然后通过实测的加速度开环特性,由于加速度计在中高频是比较精确的,因此利用建好的加速度模型,调整其具体的参数来拟合实测的加速度开环特性。然后将视系统的驱动信号和加速度模型为一个虚拟的加速度计,取虚拟加速度计的低频信号和实际加速度计的中高频信号来进行频域融合,融合后的加速度可以有效的消除低频的漂移和噪声,最后利用融合后的加速度来进行二次微分获得平台的位置。由于脱靶量的滞后,平台位置和脱靶量合成的时候需手动滞后平台的位置信息使之在时间轴上脱靶量对齐,然后再利用卡尔曼滤波器对其进行滤波和预测。
利用以上三个步骤,即完成一种基于传感器与模型融合的加速度前馈实现方法。
本发明与现有技术相比的优点为:
1、为光电跟踪系统的小型化和轻量化提供了的可能性。
2、采用了一种先进的传感器优化技术来获得全频段都较好的加速度信号。
3、在传感器受限的条件下提升系统的跟踪性能。
4、相比传统的加速度度前馈实现方法,本发明的跟踪性能更好。
附图说明
图1为模拟光电跟踪系统的惯性稳定平台示意图;
图2为本发明方法的控制框图;
图3为系统加速度特性测量与模型拟合;
图4为实验结果对比图;
图5为光电跟踪系统的示意图。
具体实施方式
以下结合附图说明本发明的实施例。但以下的实施例仅限于解释本发明,本发明的保护范围应包括权利要求书限定的全部内容;而且通过以下实施例对本领域的技术人员即可以实现本发明权利要求书的全部内容。
本发明实施例的研究对象为图1所示的模拟光电跟踪系统的惯性稳定平台,该系统的传感器有图像探测器和加速度计,由音圈电机驱动。本系统的控制框图如图2所示,系统的加速度特性由一个比例环节,一个二次微分环节,二阶谐振环节和一个电气惯性环节组成,其传递特性可描述为:
式中,K表示系统加速度特性的比例系数,ωn和ξ分别表示二阶震荡环节的自然频率和阻尼系数,Te是电气常数。
首先,根据系统的加速度开环特性,设计一个加速度环控制器,其传递函数形式的描述为:
其中,kCa为加速度控制器的增益,Ta为加速度控制器的低通滤波器的系数。
然后,根据加速度环闭环后的位置特性,设计位置环的控制,其传递函数形式的描述为:
其中,kCp位置控制器的增益,ω'n和ξ'分别表示在加速度闭环后系统新的一阶谐振的自然频率和阻尼系数,Tp位置控制器的低通滤波器的系数;
接着,根据实测和拟合得到的系统的加速度模型,如图3所示,之后利用加速度模型的低频和实际加速度计的中高频进行频域融合得到低频和中高频都比较好的融合加速度,融合的频域描述为:
其中,drive_out表示驱动信号,表示系统加速度模型,ACCsensor表示加速度计的测量值,T表示融合是的滤波器的系数,根据加速度的频域特性来决定。
最后,将融合加速度进行二次积分得到平台位置信息,然后手动滞后后于目标的位置偏差信号合成一个滞后的目标对于平台的轨迹信息,最后通卡尔曼对其滤波和预测得到目标的加速度预测信将其前馈到系统中,构成等效的复合控制系统,以提高系统的跟踪能力。
利用以上四个步骤,即完成光电跟踪系统的加速度前馈方法的实现。在传感器受限的情况下,提高系统的跟踪精度,实验结果对比如图4所示。
本发明未详细阐述的部分属于本领域公知技术。
Claims (3)
1.一种基于传感器与模型融合的加速度前馈方法,其特征在于:具体步骤如下:
步骤(1)、系统利用MEMS加速度计来完成一个加速度闭环
其中,所述步骤(1)中,MEMS加速度计是一种线加速度计,此加速度闭环主要的作用是抗扰以及提高系统的线性度,加速度环控制器的设计不采用零极点对消的方式,控制器由一个比例环节、一个积分环节、一个低通滤波器、一个一阶微分环节组成,此控制器避免零极点对消方式产生的积分饱和,消除加速度计的噪声;
步骤(2)、在加速度闭环的基础上利用图像传感器传递的目标位置偏差完成位置外环
其中,所述步骤(2)中,此闭环的控制器称为位置环控制器,此控制器由一个比例环节,一个二阶微分环节,一个积分环节,一个低通滤波器位置环控制器,二阶微分环节主要是为了尽量去抵消系统的一阶谐振,积分环节提高系统的无静差度,低通滤波器滤除高频噪声;
步骤(3)、利用加速度计测得的平台加速度信息进行二次积分得到平台的位置信息,利用平台的位置信息和脱靶量信息进行合成得到目标对于平台的位置信息,然后利用合成得到的目标位置信息作为卡尔曼滤波器的测量值对目标的加速度信息进行预测滤波,最后将预测得到的目标加速度信息前馈到系统的加速度环,最终构成等效复合控制系统。
2.根据权利要求1所述的一种基于传感器与模型融合的加速度前馈方法,其特征在于:所述步骤(3)中,由于加速度计低频存在漂移和噪声,平台的加速度信息并不是直接通过系统的加速度计测来的,首先是对系统加速度特性进行物理建模,然后通过实测的加速度开环特性,由于加速度计在中高频是比较精确的,因此利用建好的加速度模型,调整其具体的参数来拟合实测的加速度开环特性;然后将视系统的驱动信号和加速度模型为一个虚拟的加速度计,取虚拟加速度计的低频信号和实际加速度计的中高频信号来进行频域融合,融合后的加速度可以有效的消除低频的漂移和噪声,最后利用融合后的加速度来进行二次微分获得平台的位置;由于脱靶量的滞后,平台位置和脱靶量合成的时候需手动滞后平台的位置信息使之在时间轴上脱靶量对齐,然后再利用卡尔曼滤波器对其进行滤波和预测。
3.根据权利要求1所述的一种基于传感器与模型融合的加速度前馈方法,其特征在于:利用以上三个步骤,即可完成基于传感器与模型融合的光电跟踪系统的加速度前馈的实现,在传感器受限的条件下提升系统的跟踪性能,并且为光电跟踪系统的小型化和轻量化提供了可能性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910274320.9A CN110032220A (zh) | 2019-04-08 | 2019-04-08 | 一种基于传感器与模型融合的加速度前馈方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910274320.9A CN110032220A (zh) | 2019-04-08 | 2019-04-08 | 一种基于传感器与模型融合的加速度前馈方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110032220A true CN110032220A (zh) | 2019-07-19 |
Family
ID=67237616
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910274320.9A Pending CN110032220A (zh) | 2019-04-08 | 2019-04-08 | 一种基于传感器与模型融合的加速度前馈方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110032220A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110543123A (zh) * | 2019-09-09 | 2019-12-06 | 中国科学院光电技术研究所 | 一种基于虚拟多闭环的扰动测量前馈抑制方法 |
CN112444374A (zh) * | 2020-09-18 | 2021-03-05 | 中国人民解放军战略支援部队航天工程大学士官学校 | 一种基于光学跟踪测量设备伺服系统的跟踪评估方法 |
CN112684817A (zh) * | 2020-12-17 | 2021-04-20 | 中国工程物理研究院应用电子学研究所 | 一种提高光电跟踪系统跟踪精度的方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105955027A (zh) * | 2016-05-30 | 2016-09-21 | 中国科学院光电技术研究所 | 一种基于多阶运动信息估计的前馈控制方法 |
CN106896720A (zh) * | 2017-03-09 | 2017-06-27 | 中国科学院光电技术研究所 | 一种改进的基于捷联式加速度测量的快反镜惯性稳定控制方法 |
CN108897230A (zh) * | 2018-09-28 | 2018-11-27 | 中国科学院光电技术研究所 | 一种基于跟踪和扰动前馈的快反镜控制方法 |
CN108931916A (zh) * | 2018-07-17 | 2018-12-04 | 西安交通大学 | 电磁式快反镜的跟踪控制系统及带宽提高和相位滞后补偿方法 |
CN109062060A (zh) * | 2018-09-28 | 2018-12-21 | 中国科学院光电技术研究所 | 一种基于加速度计和ccd融合的快反镜稳定方法 |
-
2019
- 2019-04-08 CN CN201910274320.9A patent/CN110032220A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105955027A (zh) * | 2016-05-30 | 2016-09-21 | 中国科学院光电技术研究所 | 一种基于多阶运动信息估计的前馈控制方法 |
CN106896720A (zh) * | 2017-03-09 | 2017-06-27 | 中国科学院光电技术研究所 | 一种改进的基于捷联式加速度测量的快反镜惯性稳定控制方法 |
CN108931916A (zh) * | 2018-07-17 | 2018-12-04 | 西安交通大学 | 电磁式快反镜的跟踪控制系统及带宽提高和相位滞后补偿方法 |
CN108897230A (zh) * | 2018-09-28 | 2018-11-27 | 中国科学院光电技术研究所 | 一种基于跟踪和扰动前馈的快反镜控制方法 |
CN109062060A (zh) * | 2018-09-28 | 2018-12-21 | 中国科学院光电技术研究所 | 一种基于加速度计和ccd融合的快反镜稳定方法 |
Non-Patent Citations (1)
Title |
---|
QIUNONG HE等: "An acceleration feed-forward control method based on fusion of ofmodel output and sensor data", 《SENSORS AND ACTUATORS A: PHYSICAL》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110543123A (zh) * | 2019-09-09 | 2019-12-06 | 中国科学院光电技术研究所 | 一种基于虚拟多闭环的扰动测量前馈抑制方法 |
CN110543123B (zh) * | 2019-09-09 | 2022-04-19 | 中国科学院光电技术研究所 | 一种基于虚拟多闭环的扰动测量前馈抑制方法 |
CN112444374A (zh) * | 2020-09-18 | 2021-03-05 | 中国人民解放军战略支援部队航天工程大学士官学校 | 一种基于光学跟踪测量设备伺服系统的跟踪评估方法 |
CN112444374B (zh) * | 2020-09-18 | 2022-10-11 | 中国人民解放军战略支援部队航天工程大学士官学校 | 一种基于光学跟踪测量设备伺服系统的跟踪评估方法 |
CN112684817A (zh) * | 2020-12-17 | 2021-04-20 | 中国工程物理研究院应用电子学研究所 | 一种提高光电跟踪系统跟踪精度的方法 |
CN112684817B (zh) * | 2020-12-17 | 2023-01-03 | 中国工程物理研究院应用电子学研究所 | 一种提高光电跟踪系统跟踪精度的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110032220A (zh) | 一种基于传感器与模型融合的加速度前馈方法 | |
CN106681344B (zh) | 一种用于飞行器的高度控制方法及控制系统 | |
CN108897230B (zh) | 一种基于跟踪和扰动前馈的快反镜控制方法 | |
CN106482735A (zh) | 一种提高快反镜稳定平台扰动抑制能力的控制方法 | |
CN103439977B (zh) | 适用于光电跟踪仪的高速目标跟踪控制方法 | |
CN110543123B (zh) | 一种基于虚拟多闭环的扰动测量前馈抑制方法 | |
CN102999048B (zh) | 一种车载动基座光电搜索跟踪转台的伺服控制方法 | |
CN106896720B (zh) | 一种改进的基于捷联式加速度测量的快反镜惯性稳定控制方法 | |
CN109358501A (zh) | 自抗扰控制方法、控制器及精跟踪控制系统 | |
CN106814624A (zh) | 一种改进的基于多闭环的快反镜扰动观测补偿控制方法 | |
CN101382805B (zh) | 速率陀螺稳定平台式天线随动跟踪系统 | |
CN106647257B (zh) | 一种基于正交最小二乘的前馈控制方法 | |
CN108333938A (zh) | 一种多闭环复合陀螺稳定控制方法 | |
CN106154837A (zh) | 一种运动平台光电系统高精度视轴稳定控制方法 | |
CN107272411A (zh) | 一种插件式加速度反馈的快反镜光束稳定控制方法 | |
CN108205259A (zh) | 基于线性扩张状态观测器的复合控制系统及其设计方法 | |
CN110083062A (zh) | 一种基于速度扰动观测器和Fuzzy-PID的视轴稳定复合控制方法 | |
CN103488081B (zh) | 惯性稳定平台控制方法 | |
CN105955027B (zh) | 一种基于多阶运动信息估计的前馈控制方法 | |
CN107367934A (zh) | 一种基于双扰动观测器的快反镜稳定控制方法 | |
CN105446140B (zh) | 一种稳定平台伺服系统基于有限时间收敛的复合控制方法 | |
CN110879618A (zh) | 一种基于加速度和位置扰动信息的多扰动观测器三闭环稳定跟踪方法 | |
CN115128958A (zh) | 一种前馈改进Smith预估器的光电跟踪控制方法 | |
CN103226327A (zh) | 光电稳瞄系统瞄准线静态漂移的自动补偿方法 | |
CN108469842A (zh) | 一种运动平台复合轴光电跟踪系统精稳定扰动解耦方法 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20190719 |