CN114721442B - 一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法 - Google Patents
一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法 Download PDFInfo
- Publication number
- CN114721442B CN114721442B CN202210373025.0A CN202210373025A CN114721442B CN 114721442 B CN114721442 B CN 114721442B CN 202210373025 A CN202210373025 A CN 202210373025A CN 114721442 B CN114721442 B CN 114721442B
- Authority
- CN
- China
- Prior art keywords
- prism
- motor
- encoder
- image sensor
- controller
- 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
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
-
- G—PHYSICS
- G02—OPTICS
- G02B—OPTICAL ELEMENTS, SYSTEMS OR APPARATUS
- G02B7/00—Mountings, adjusting means, or light-tight connections, for optical elements
- G02B7/18—Mountings, adjusting means, or light-tight connections, for optical elements for prisms; for mirrors
- G02B7/1805—Mountings, adjusting means, or light-tight connections, for optical elements for prisms; for mirrors for prisms
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
- Studio Devices (AREA)
Abstract
本发明公开了一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法。旋转三棱镜光电跟踪装置可有效缓解双棱镜系统带来的视野盲区、控制奇异等问题。本方法根据图像传感器反馈的视轴偏差,利用解耦算法输出三块棱镜的调整量,实现闭环跟踪。该方法解决了图像传感器的视轴偏差与棱镜旋转量之间的强耦合关系。具体涉及到的装置包括三块独立的棱镜、伺服控制系统、图像传感器、平台。该方法具有执行简单、解耦充分、闭环精度高、工程易于实现等优点。
Description
技术领域
本发明属于光电跟踪领域,具体涉及一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法。
背景技术
传统的光电跟踪主要是由万向架和快反镜构成粗精跟踪系统执行。这种系统一般体积大、造价成本高、转动惯量大。基于光束折射的旋转双棱镜光电跟踪系统具有体积小、成本低、转动惯量小等优点,越来越多的用在空间光通信、目标跟踪、激光雷达等领域。但旋转双棱镜系统存在视场盲区、控制奇异等问题。旋转三棱镜装置可有效解决这类问题。因此对旋转三棱镜装置的闭环跟踪方法进行研究,具有重要的意义。相比于旋转双棱镜装置,旋转三棱镜装置的视轴偏移与三块棱镜的旋转具有更强的耦合关系。
在现有技术中,Michael Sánchez等人(SáNCHEZ M,GUTOW D.Control laws for athree-element Risley prism optical beam pointer[J].International Society forOptics and Photonics,2006,6304:630403.)和Li Anhu等人(Li A,Sun W.Forward andinverse solutions for three-element Risley prism beam scanners[J].OpticsExpress,2017,25(7):7677.)针对旋转三棱镜装置进行了反解技术研究。这两项技术并未涉及三棱镜装置的跟踪方法。李锦英等在专利CN106802672A提出了一种基于旋转双棱镜装置的实时闭环跟踪方法,解决了双棱镜系统跟踪误差与棱镜旋转之间的强耦合关系。
发明内容
本发明要解决的技术问题为克服现有技术的不足,针对旋转三棱镜装置的跟踪问题,提出一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法。本方法根据图像传感器反馈的视轴偏差,利用解耦算法输出三块棱镜的调整量,实现闭环跟踪。该方法解决了旋转三棱镜装置中图像传感器的视轴偏差与棱镜旋转量之间的强耦合关系。
本发明提出的技术方案如下:
一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法,其中,所述装置由第一棱镜1、第二棱镜2、第三棱镜3、第一电机4、第二电机5、第三电机6、第一编码器7、第二编码器8、第三编码器9、图像传感器10和控制器11组成;所述第一电机4、第二电机5和第三电机6分别与第一棱镜1、第二棱镜2和第三棱镜3相连;所述第一编码器7、第二编码器8和第三编码器9用于分别将第一棱镜1、第二棱镜2和第三棱镜3绕旋转轴旋转后的角度返回给控制器11,所述图像传感器10用于反馈目标成像点的位置给控制器11;所述控制器11基于图像传感器10反馈的视轴偏移量,结合解耦闭环跟踪方法,驱动第一电机4、第二电机5和第三电机6直至系统闭环;所述旋转三棱镜装置闭环跟踪方法包括以下步骤:
步骤1):通过目标的引导信息(方位角Θ0和俯仰角Φ0),引导目标的成像点进入图像传感器10的视场内;若无法获取目标的引导信息,利用扫描的方式捕获目标,使目标的成像点在图像传感器10的视场内。此时图像传感器10反馈的视轴偏差的方位角误差为ΔΘ、俯仰角误差为ΔΦ。
步骤2):在控制器11中,对误差信号进行解耦。误差解耦算法的如公式(1)所示:
(1)式中分别为第一棱镜1,第二棱镜2,第三棱镜3下一时刻所需调整的角度值:θ1,θ2,θ3分别为第一棱镜1,第二棱镜2,第三棱镜3当前时刻由第一编码器7、第二编码器8、第三编码器9反馈的角度值。f(ΔΘ)为方位角误差对应的旋转量,g(ΔΦ)为俯仰角误差对应的旋转量,如公式(2)所示:
G1(s)和G2(s)表示设计的控制算法。
步骤3):根据控制器11解耦出的第一棱镜1,第二棱镜2,第三棱镜3下一时刻的所需调整角度值,驱动第一电机4、第二电机5、第三电机6旋转,使第一棱镜1,第二棱镜2,第三棱镜3转动到对应的位置。
步骤4):重复步骤2)、步骤3)运动目标的成像点便可一直稳定在探测器的视场中心。
进一步地,所述旋转三棱镜装置中,所述第一棱镜1、第二棱镜2、第三棱镜3和第一电机4、第二电机5、第三电机6为同轴安装,且第一棱镜1、第二棱镜2、第三棱镜3具有相同的折射率和顶角。
本发明与现有技术相比优点在于:
旋转三棱镜装置对目标进行跟踪,可克服旋转双棱镜跟踪设备中的视场盲区、奇异控制等问题。本发明填补了旋转三棱镜装置对目标闭环跟踪技术的空白。通过对视轴偏移进行充分解耦,旋转三棱镜装置可对目标进行高精度的跟踪。本发明具有跟踪精度高,实现简单等优点。
附图说明
图1为本发明一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法利用的基于旋转三棱镜光电跟踪装置示意图,其中,1为第一棱镜,2为第二棱镜,3为第三棱镜,4为第一电机,5为第二电机,6为第三电机,7为第一编码器,8为第二编码器,9为第三编码器,10为图像传感器,11为控制器;
图2为闭环跟踪过程中方位误差曲线;
图3为闭环跟踪过程中俯仰误差曲线;
图4为第一棱镜所处角度值曲线;
图5为第二棱镜所处角度值曲线;
图6为第三棱镜所处角度值曲线。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本发明进一步详细说明。
图1所示为本发明所使用的旋转三棱镜装置的示意图,该装置由第一棱镜1、第二棱镜2、第三棱镜3、第一电机4、第二电机5、第三电机6、第一编码器7、第二编码器8、第三编码器9、图像传感器10和控制器11组成;其中第一棱镜1、第二棱镜2、第三棱镜3、第一电机4、第二电机5、第三电机6为同轴安装;其中第一棱镜1、第二棱镜2、第三棱镜3具有相同的折射率1.517和顶角10°;第一电机4、第二电机5、第三电机6分别与第一棱镜1、第二棱镜2、第三棱镜3相连;第一编码器7、第二编码器8、第三编码器9可分别返回第一棱镜1、第二棱镜2、第三棱镜3绕旋转轴旋转后的角度θ1,θ2,θ3,并将θ1,θ2,θ3返回给控制器11;图像传感器10返回目标的视轴偏差给控制器11。视轴偏差由两部分组成,一部分为方位误差,另一部分为俯仰误差。
本发明所采用的一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法,该方法执行过程如下:
1)通过扫描或给定的引导信息,将目标的成像点引入图像传感器的视场内;假定通过扫描的方式,图像传感器捕获到目标。此时第一棱镜所处位置值为92.02°,第二棱镜所处位置值为-71.90°,第三棱镜所处位置值为41.24°。方位角误差ΔΘ=206.2角秒,俯仰角误差ΔΦ=103.1角秒。
2)在控制器11中,对误差信号进行解耦。误差解耦算法的如公式(1)所示:
(1)式中分别为第一棱镜1,第二棱镜2,第三棱镜3下一时刻所需调整的角度值:θ1,θ2,θ3分别为第一棱镜1,第二棱镜2,第三棱镜3当前时刻由第一编码器7、第二编码器8、第三编码器9反馈的角度值。f(ΔΘ)为方位角误差对应的旋转量,g(ΔΦ)为俯仰角误差对应的旋转量,如公式(2)所示:
3)根据控制器11解耦出的第一棱镜1、第二棱镜2、第三棱镜3下一时刻的所需调整角度值,驱动第一电机4、第二电机5、第三电机6旋转,使第一棱镜1、第二棱镜2、第三棱镜3转动到对应的位置。
4)重复迭代上述过程2)、3),直到闭环精度达到。
上述闭环过程可通过图2-6反映:图2为闭环跟踪过程中方位误差曲线,方位跟踪误差从210角秒快速减小到0角秒附近;图3为闭环跟踪过程中俯仰误差曲线,俯仰跟踪误差从150角秒快速减小到0角秒附近;图2和图3表明本发明方法能够有效地减少跟踪误差。图4为第一棱镜所处角度值曲线;图5为第二棱镜所处角度值曲线;图6为第三棱镜所处角度值曲线,第一棱镜,第二棱镜和第三棱镜在闭环过程中,棱镜最大调整量均小于1度,表明了该方法对误差解耦较为充分;
以上所述,仅为本发明中的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉该技术的人在本发明所揭示的技术范围内,可理解想到的变换或替换,都应涵盖在本发明的包含范围之内。
Claims (2)
1.一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法,其中,所述装置由第一棱镜(1)、第二棱镜(2)、第三棱镜(3)、第一电机(4)、第二电机(5)、第三电机(6)、第一编码器(7)、第二编码器(8)、第三编码器(9)、图像传感器(10)和控制器(11)组成;所述第一电机(4)、第二电机(5)和第三电机(6)分别与第一棱镜(1)、第二棱镜(2)和第三棱镜(3)相连;所述第一编码器(7)、第二编码器(8)和第三编码器(9)用于分别将第一棱镜(1)、第二棱镜(2)和第三棱镜(3)绕旋转轴旋转后的角度返回给控制器(11),所述图像传感器(10)用于反馈目标成像点的位置给控制器(11);所述控制器(11)基于图像传感器(10)反馈的视轴偏移量,结合解耦闭环跟踪方法,驱动第一电机(4)、第二电机(5)和第三电机(6)直至系统闭环;其特征在于,所述闭环跟踪方法包括以下步骤:
步骤1):通过目标的包括方位角Θ0和俯仰角Φ0的引导信息,引导目标的成像点进入图像传感器(10)的视场内;若无法获取目标的引导信息,利用扫描的方式捕获目标,使目标的成像点在图像传感器(10)的视场内,此时图像传感器(10)反馈的视轴偏差的方位角误差为ΔΘ、俯仰角误差为ΔΦ;
步骤2):在控制器(11)中,对误差信号进行解耦,误差解耦算法的如公式(1)所示:
(1)式中分别为第一棱镜(1),第二棱镜(2),第三棱镜(3)下一时刻所需调整的角度值:θ1,θ2,θ3分别为第一棱镜(1),第二棱镜(2),第三棱镜(3)当前时刻由第一编码器(7)、第二编码器(8)、第三编码器(9)反馈的角度值,f(ΔΘ)为方位角误差对应的旋转量,g(ΔΦ)为俯仰角误差对应的旋转量,如公式(2)所示:
G1(s)和G2(s)表示设计的控制算法;
步骤3):根据控制器(11)解耦出的第一棱镜(1),第二棱镜(2),第三棱镜(3)下一时刻的所需调整角度值,驱动第一电机(4)、第二电机(5)、第三电机(6)旋转,使第一棱镜(1),第二棱镜(2),第三棱镜(3)转动到对应的位置;
步骤4):重复步骤2)、步骤3)运动目标的成像点便可一直稳定在探测器的视场中心。
2.根据权利要求1所述的一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法,其特征在于:所述基于旋转三棱镜光电跟踪装置中,所述第一棱镜(1)、第二棱镜(2)、第三棱镜(3)和第一电机(4)、第二电机(5)、第三电机(6)为同轴安装,且第一棱镜(1)、第二棱镜(2)、第三棱镜(3)具有相同的折射率和顶角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210373025.0A CN114721442B (zh) | 2022-04-11 | 2022-04-11 | 一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210373025.0A CN114721442B (zh) | 2022-04-11 | 2022-04-11 | 一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114721442A CN114721442A (zh) | 2022-07-08 |
CN114721442B true CN114721442B (zh) | 2023-05-30 |
Family
ID=82241852
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210373025.0A Active CN114721442B (zh) | 2022-04-11 | 2022-04-11 | 一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114721442B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4154219A (en) * | 1977-03-11 | 1979-05-15 | E-Systems, Inc. | Prismatic solar reflector apparatus and method of solar tracking |
GB8602434D0 (en) * | 1986-01-31 | 1988-05-25 | Ferranti Plc | Apparatus for controlling direction of beam of optical radiation |
US5521843A (en) * | 1992-01-30 | 1996-05-28 | Fujitsu Limited | System for and method of recognizing and tracking target mark |
CN1563889A (zh) * | 2004-03-26 | 2005-01-12 | 清华大学 | 激光跟踪惯性组合测量系统及其测量方法 |
CN1608212A (zh) * | 2001-08-22 | 2005-04-20 | 精密自动化股份有限公司 | 六维激光跟踪系统及方法 |
CN102353359A (zh) * | 2003-12-16 | 2012-02-15 | 特里伯耶拿有限公司 | 探测仪器的校准 |
CN102445949A (zh) * | 2011-10-20 | 2012-05-09 | 浙江中控太阳能技术有限公司 | 一种定日镜定位系统与方法 |
CN105571833A (zh) * | 2015-12-23 | 2016-05-11 | 中国科学院长春光学精密机械与物理研究所 | 大口径光电探测系统不同仰角下波像差室内检测方法 |
CN106249405A (zh) * | 2016-10-10 | 2016-12-21 | 同济大学 | 旋转三棱镜光束扫描装置 |
CN106802672A (zh) * | 2017-01-13 | 2017-06-06 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的实时闭环跟踪方法 |
-
2022
- 2022-04-11 CN CN202210373025.0A patent/CN114721442B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4154219A (en) * | 1977-03-11 | 1979-05-15 | E-Systems, Inc. | Prismatic solar reflector apparatus and method of solar tracking |
GB8602434D0 (en) * | 1986-01-31 | 1988-05-25 | Ferranti Plc | Apparatus for controlling direction of beam of optical radiation |
US5521843A (en) * | 1992-01-30 | 1996-05-28 | Fujitsu Limited | System for and method of recognizing and tracking target mark |
CN1608212A (zh) * | 2001-08-22 | 2005-04-20 | 精密自动化股份有限公司 | 六维激光跟踪系统及方法 |
CN102353359A (zh) * | 2003-12-16 | 2012-02-15 | 特里伯耶拿有限公司 | 探测仪器的校准 |
CN1563889A (zh) * | 2004-03-26 | 2005-01-12 | 清华大学 | 激光跟踪惯性组合测量系统及其测量方法 |
CN102445949A (zh) * | 2011-10-20 | 2012-05-09 | 浙江中控太阳能技术有限公司 | 一种定日镜定位系统与方法 |
CN105571833A (zh) * | 2015-12-23 | 2016-05-11 | 中国科学院长春光学精密机械与物理研究所 | 大口径光电探测系统不同仰角下波像差室内检测方法 |
CN106249405A (zh) * | 2016-10-10 | 2016-12-21 | 同济大学 | 旋转三棱镜光束扫描装置 |
CN106802672A (zh) * | 2017-01-13 | 2017-06-06 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的实时闭环跟踪方法 |
Non-Patent Citations (1)
Title |
---|
范大鹏 等.旋转双棱镜光束指向控制技术综述.中国光学.2013,第6卷(第2期),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN114721442A (zh) | 2022-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102941410B (zh) | 一种点扫描三维测量系统振镜标定方法 | |
CN101972928B (zh) | 一种用于微小型结构件的自动对位装配系统 | |
CN102324962B (zh) | 一种卫星光通信捕获跟踪处理方法 | |
CN110989695B (zh) | 一种移动平台上的太阳自动跟踪装置及方法 | |
US11703322B2 (en) | Method for measuring blade cross-section profile based on line structured-light sensor at high precision | |
CN1777064A (zh) | 卫星激光通信端机 | |
CN110233664A (zh) | 一种无线光通信的跟瞄控制系统及跟瞄控制方法 | |
CN104122900A (zh) | 一种基于旋转双棱镜的复合轴跟踪系统 | |
CN107272015A (zh) | 高精度视觉导引激光跟踪方法 | |
CN106802672B (zh) | 一种基于旋转双棱镜的实时闭环跟踪方法 | |
CN111487998B (zh) | 一种两轴四框架光电跟踪设备自动目标捕获方法和装置 | |
CN114721442B (zh) | 一种基于旋转三棱镜光电跟踪装置的闭环跟踪方法 | |
US10919111B2 (en) | Laser engraver mirror adjustment system | |
CN106918447A (zh) | 靶标自动调向式光轴平行性检测方法及装置 | |
JP2003114105A (ja) | 大型構造物の建造方法 | |
CN113237439B (zh) | 一种潜望式激光通信终端的解耦跟踪方法 | |
CN114211140B (zh) | 一种激光双摆轴的光束指向调节方法 | |
CN113359871B (zh) | 一种基于双棱镜旋转装置的定点闭环方法 | |
CN105157617A (zh) | 应用于球面光学元件表面缺陷检测的球面自动定中方法 | |
CN116700363A (zh) | 一种基于闭环跟踪的旋转双棱镜系统误差辨识方法 | |
CN116817872B (zh) | 一种无人值守全自动高精度归心测量方法 | |
CN216595732U (zh) | 一种激光动态跟踪扫描系统 | |
CN112435302B (zh) | 一种基于高精度转台和平行光管的远距离大视场鱼眼相机标定方法 | |
CN117055208B (zh) | 一种外闭环光束指向校准装置、方法及快反镜系统 | |
CN117589083B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |