CN116222304B - 一种基于双光楔的无随动红外位标器光轴控制装置和方法 - Google Patents
一种基于双光楔的无随动红外位标器光轴控制装置和方法 Download PDFInfo
- Publication number
- CN116222304B CN116222304B CN202211583400.0A CN202211583400A CN116222304B CN 116222304 B CN116222304 B CN 116222304B CN 202211583400 A CN202211583400 A CN 202211583400A CN 116222304 B CN116222304 B CN 116222304B
- Authority
- CN
- China
- Prior art keywords
- wedge
- single optical
- angle
- optical wedge
- axis
- 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
- 230000003287 optical effect Effects 0.000 title claims abstract description 327
- 239000003550 marker Substances 0.000 title claims abstract description 49
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000005096 rolling process Methods 0.000 claims abstract description 24
- 230000007246 mechanism Effects 0.000 claims abstract description 12
- 229920001971 elastomer Polymers 0.000 claims description 8
- 239000000806 elastomer Substances 0.000 claims description 8
- 230000009977 dual effect Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 239000000463 material Substances 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000004075 alteration Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000006185 dispersion Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000003331 infrared imaging Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000026683 transduction Effects 0.000 description 1
- 238000010361 transduction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F41—WEAPONS
- F41G—WEAPON SIGHTS; AIMING
- F41G3/00—Aiming or laying means
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F41—WEAPONS
- F41G—WEAPON SIGHTS; AIMING
- F41G7/00—Direction control systems for self-propelled missiles
- F41G7/20—Direction control systems for self-propelled missiles based on continuous observation of target position
- F41G7/22—Homing guidance systems
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明涉及一种基于双光楔的无随动红外位标器光轴控制装置和方法,所述双光楔由两块单光楔组成,两块单光楔沿弹轴方向平行排列,单光楔的中心轴与弹轴重合,靠近位标器的单光楔记为第一单光楔,另一块单光楔记为第二单光楔,所述光轴控制装置包括两组滚转机构和控制器;每组滚转机构均包括镜筒、轴承组、电机和码盘;所述双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态;控制器,获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2,最后采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,实现光轴在空间的任意指向。
Description
技术领域
本发明涉及一种基于双光楔的无随动红外位标器光轴控制装置和方法。属于红外制导技术领域。
背景技术
针对未来空战中强环境适应性、强对抗作战任务对导引头提出的高性能需求,需开展无随动高敏红外导引头技术的研究。利用基于小型光楔扫描技术等,突破小型导引头技术,开展新一代导弹研究,提高我空军作战能力,适应未来空战,满足未来复杂战场环境下的强对抗作战要求。未来作战的主要模式将是四代机对四代机,为保证在四代机有限的弹舱内装备足够多的武器,导弹需采用小型化设计。非近轴双光楔结构的位标器设计,可以大大减小导引头尺寸,且结构简单,控制灵活,偏转角度足够大,可满足小型化设计需求。
目前常用的位标器结构主要有双框架结构、滚仰式结构等,光学系统随框架一起运动。这种结构的位标器重量偏大,很难实现小型化设计。
基于双光楔的无随动红外光轴控制装置设计,可以大大减小导引头尺寸,且结构简单,控制灵活,偏转角度足够大,可满足小型化设计需求。近轴双光楔扫描技术广泛应用于激光扫描工作体制中,技术成熟,控制方法完备,但一般都是小偏角控制(小于10°),而红外成像系统的光轴控制中,一般要求有大的跟踪场,大的偏转角,采用激光双光楔的控制方法并不适用,需要采用新的光轴控制方法。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种基于双光楔的无随动红外光轴控制装置和方法,能够利用简单的结构及经典控制方法实现导引头光轴的精确控制。
本发明解决问题的技术方案是:一种基于双光楔的无随动红外位标器光轴控制装置,所述双光楔由两块单光楔组成,两块单光楔沿弹轴方向平行排列,单光楔的中心轴与弹轴重合,靠近位标器的单光楔记为第一单光楔,另一块单光楔记为第二单光楔,所述光轴控制装置包括两组滚转机构和控制器;每组滚转机构均包括镜筒、轴承组、电机和码盘;单光楔由镜筒支撑,镜筒通过轴承组安装在位标器壳体上,电机用于驱动镜筒带动单光楔绕中心轴旋转,码盘用于实时测量光楔绕中心轴旋转的角度信息反馈给控制器;所述双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态,此时第一单光楔、第二单光楔对应的码盘归为零位;
控制器,获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,位标器光轴从初始状态需要先绕弹体坐标系OZB轴转动的俯仰角θ0、再绕OXB旋转的滚转角γ0,再结合双光楔折射原理,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2;根据实时测量的第一单光楔和第二单光楔光绕中心轴旋转的角度信息、第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2,采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,控制电机旋转,实现光轴在空间的任意指向;
所述弹体坐标系OXBYBZB定义如下:
O为弹体质心,OXB为沿弹体纵轴,指向弹头为正,OYB在弹体对称平面内,垂直OXB轴,向上为正,OZB符合右手定则。
优选地,所述目标相对于弹体坐标系的偏航角α和俯仰角β为:
其中,α0、β0分别为机载雷达确定的目标相对于弹体坐标系的偏航角和俯仰角,Δα、Δβ分别为位标器确定的目标相对于弹体坐标系的偏航失调角和俯仰失调角。
优选地,位标器确定的目标相对于弹体坐标系的偏航失调角Δα和俯仰失调角Δβ直接采用位标器测得目标相对位标器坐标系的偏航失调角εα、俯仰失调角εβ替代。
优选地,为使位标器光轴指向目标,位标器光轴从初始位置需要先绕弹体坐标系OZB轴转动的俯仰角θ0、再绕OXB旋转的滚转角γ0通过如下公式计算得到:
优选地,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2为:
其中,γ″temp1为第一单光楔和第二单光楔同步旋转的角度;|Δγ|为沿弹体坐标系OXB轴看去,第二单光楔相对于第一单光楔逆时针旋转的角度。
优选地,所述沿弹体坐标系OXB轴看去,第二单光楔相对于第一单光楔逆时针旋转的角度|Δγ|为:
其中,n1为第一单光楔的折射率,α1为第一单光楔的楔角,n2为第二单光楔的折射率,α2为第二单光楔的楔角。
优选地,所述第一单光楔和第二单光楔同步旋转的角度γ″temp1为:
γ″temp1=γ0-γ′temp1
其中,(x,y,z)为位标器出射光线矢量的方向余弦。
优选地,PID控制器算法为:
式中:
Y1、Y2分别为第一单光楔、第二单光楔对应的电机控制信号;
Kp1、Kp2分别为第一单光楔、第二单光楔的比例控制器增益;
Ki1、Ki2分别为第一单光楔、第二单光楔的积分控制器系数;
Kdy、Kdz分别为第一单光楔、第二单光楔的微分控制器系数;
U1m、U2m分别为第一单光楔、第二单光楔对应的码盘反馈值。
优选地,所述第一单光楔和第二单光楔折射率相同、折射棱角相等。
本发明的另一个技术方案是:提供了一种无随动红外光轴控制方法,该方法包括如下步骤:
S1、调整双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态,将第一单光楔、第二单光楔对应的码盘归为零位;
S2、获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,位标器光轴从初始状态需要先绕弹体坐标系OZB轴转动的俯仰角θ0、再绕OXB旋转的滚转角γ0;
所述弹体坐标系OXBYBZB定义如下:
O为弹体质心,OXB为沿弹体纵轴,指向弹头为正,OYB在弹体对称平面内,垂直OXB轴,向上为正,OZB符合右手定则;
S3、结合双光楔折射原理,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2;
S4、根据第一单光楔、第二单光楔对应的码盘实时测量的第一单光楔和第二单光楔光绕中心轴旋转的角度信息、第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,控制电机旋转,实现光轴在空间的任意指向。
本发明与现有技术相比的有益效果是:
(1)、无随动红外光轴控制装置具有结构简单稳定、动态响应好、偏转角度大等特点。利用双光楔差动滚转控制实现对光轴控制。
(2)、位标器结构简单,控制规律经典、灵活,偏转角度足够大,满足产品小型化设计需求。
(3)、本发明双光楔机构经典,工艺技术成熟,便于工程实现,为后续型号的研制奠定基础。
(4)、本发明控制方法采用矢量形式的斯涅尔定律,进行出射光轴偏角解算,相比传统的双光楔解算方法,可以精确解算光轴角度。
附图说明
通过构成本申请的一部分附图以及下面的详细描述,可以对本发明有更充分地理解。
图1为本发明实施例控制系统简化图;
图2为本发明实施例坐标变换简图;
图3为本发明实施例双光楔简图;
图4为本发明实施例光楔结构简图;
图5为本发明实施例单光楔示简图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
为达到上述发明目的,基于非近轴大偏角双光楔的双滚转光轴控制方法,具体内容如下:
1、双光楔原理
本发明设计中采用折射率相同、折射棱角相等的两块光楔组成的光楔组作为位标器的光学系统。双光楔组不仅具有单光楔的特性,而且通过控制两个光楔的转动,可实现光轴在空间的不同指向。
单光楔对光线具有折射作用,不同的材料折射角不同。当单光楔绕中心轴以一定的速度旋转一周时,出射光线在空间扫描出一个张角为δ的圆锥面。
如图5所示,顶角为A较小的棱镜称为光楔,当光线从光楔的侧面进入光楔时光线发生折射,入射光线和出射光线之间将形成一定的夹角,设为δ,当δ较小时,满足以下近似关系:
δ=(n-1)A
式中:
δ为单个光楔入射光线与出射光线夹角
n为光楔折射率,A为光楔顶角。
当δ较大时,采用上述方法会存在较大误差,需采用新的方法求解。
如果双光楔中顶角均为A的两个光楔以不同的角度放置在一起,则:当两个光楔平行同向放置时,此时双光楔所产生的偏转角最大为2δ;当其中一个光楔绕中心轴旋转180°时,两块单光楔反向放置时,光线偏转角为0°;当其中一块单光楔绕中心轴旋转0~180°内任意角度时,光线偏转角在0~2δ之间;如果双光楔同时绕中心轴旋转,那么出射光线将在空间扫描出一个张角在0~2δ之间的圆锥面。当两光楔相对位置固定后,两光楔同时同向或反向绕中心轴旋转时,将形成一个固定偏转角的空间光轴角。
2、光轴控制方法
如图3所示,本发明某一具体实施例中,双光楔由两块单光楔组成,两块单光楔沿弹轴方向平行排列,单光楔的中心轴与弹轴重合,靠近位标器的单光楔记为第一单光楔,另一块单光楔记为第二单光楔。
如图1所示,无随动红外光轴控制装置由两组滚转机构和控制器构成,每组滚转机构均包括镜筒、轴承组、电机和码盘;单光楔由镜筒支撑,镜筒通过轴承组安装在位标器壳体上,电机用于驱动镜筒带动单光楔绕中心轴旋转,码盘用于实时测量光楔绕中心轴旋转的角度信息反馈给控制器;所述双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态,此时第一单光楔、第二单光楔对应的码盘归为零位。
控制器,获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,位标器光轴从初始状态需要先绕弹体坐标系OZB轴转动的俯仰角θ0、再绕OXB旋转的滚转角γ0,再结合双光楔折射原理,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2;根据实时测量的第一单光楔和第二单光楔光绕中心轴旋转的角度信息、第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2,采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,控制电机带动光楔绕弹轴旋转,实现光轴在空间的任意指向;每个滚转机构带动一个光楔绕中心轴旋转。通过两个光楔的同向和相对运动,实现光轴在空间的任意指向。
通过双光楔折射原理分析可知,可通过控制两个光楔的相对运动及同向运动,实现出射光线在空间的不同位置,即光轴角的空间指向,等效于位标器光轴的俯仰位置控制及滚转位置控制。因此,为实现光轴角的控制,分以下两个步骤实施:
(a)坐标解算
如图3所示,所述弹体坐标系OXBYBZB定义如下:
O为弹体质心,OXB为沿弹体纵轴,指向弹头为正,OYB在弹体对称平面内,垂直OXB轴,向上为正,OZB符合右手定则。
当两个光楔处于任意夹角时,所产生的出射光线偏转角在0~2δ之间。如果此时双光楔同时绕中心轴旋转,那么出射光线将在空间扫描出一个有张角的圆锥面。
在位标器跟踪目标过程中,可把位标器测得的目标失调角转换为目标位置坐标,控制非近轴双光楔旋转将光轴指向目标。
位标器坐标系OXSYSZS:O为弹体质心,OXS为位标器光轴,OZS位标器俯仰轴,垂直OXS轴,向上,OYS位标器偏航轴。
目标位置分为两部分,一部分是由机载雷达确定的目标相对于弹体坐标系的偏航角α0和俯仰角β0,另一部分是位标器确定的目标相对于弹体坐标系的偏航失调角和俯仰失调角Δα、Δβ。
所述目标相对于弹体坐标系的偏航角α和俯仰角β为:
其中,α0、β0分别为机载雷达确定的目标相对于弹体坐标系的偏航角和俯仰角,Δα、Δβ分别为位标器确定的目标相对于弹体坐标系的偏航失调角和俯仰失调角。
由于位标器测得目标相对位标器坐标系的偏航失调角εα、俯仰失调角εβ相对机载雷达确定的目标相对于弹体坐标系的偏航角α0和俯仰角β0是小量,则位标器确定的目标相对于弹体坐标系的偏航失调角Δα和俯仰失调角Δβ直接采用位标器测得目标相对位标器坐标系的偏航失调角εα、俯仰失调角εβ替代。
即:
(b)光轴控制方法
初始状态光轴与OXB同轴,定义OXB轴方向上单位向量[1 0 0]T,为将光轴指向目标,有两种转换方式:
第一种:将该向量可先绕OZB转动俯仰角β,再绕OYB转偏航角α后,光轴指向目标,则该单位向量在弹体坐标系中的分量为:
第二种将该向量可先绕OZB转动俯仰角θ0,再绕OXB转滚转角γ0后,光轴指向目标,则该单位向量在弹体坐标系中的分量为:
对于同一个目标,在弹体坐标系下坐标是一定的,则:
因此,为使位标器光轴指向目标,位标器光轴从初始位置需要先绕弹体坐标系OZB轴转动的俯仰角θ0、再绕OXB旋转的滚转角γ0通过如下公式计算得到:
将双滚转导引头单光楔镜组等效为楔角α,折射率为n的单个光楔。如图4所示,第一单光楔Π1(靠近探测器)楔角α1,折射率为n1,目标滚转角γ1,第二单光楔Π2楔角α2,折射率为n2,目标滚转角γ2。假设入射光束沿OXB方向入射,其光线矢量表示为单位矢量:
第一单光楔Π1左界面法线矢量可表示为:
n1=(-cosα1 sinα1sinγ1 sinα1cosγ1)T
应用矢量形式的斯涅尔定律可得第一单光楔Π1左界面折射光线矢量:
第一单光楔Π1右界面和第二单光楔Π2左界面相互平行,不改变光束的传播方向。入射到第二单光楔Π2右界面的入射光线矢量为:
第二单光楔Π2右界面法线矢量可表示为:
n2=(-cosα2-sinα2sinγ2-sinα2cosγ2)T
应用矢量形式的斯涅尔定律可得第二单光楔Π2右界面折射光线矢量:
综合式上述公式可得第二单光楔Π2的出射光的方向余弦:
其中:
出射光线矢量的方向即导引头光轴的方向,则光轴的偏转角θ0为:
θ0=arc cos(x)
可得:
由上式可得,对确定的双光楔,光轴的偏转角θ0仅取决两个光楔的滚转夹角|Δγ|=|γ2-γ1|。因此,为得到第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2,可分两步求解,第一是保持其中一个光楔不动,控制电机带动另一个单光楔绕弹轴旋转|Δγ|=|γ1-γ2|,使得光轴的偏航角达到目标值;第二是在保持双光楔夹角不变的条件下控制双光楔同时旋转γ″temp1,使得光轴的方位角达到目标值,实现光轴在空间的任意指向。
因此,首先让第一单光楔Π1旋转第一单光楔的目标滚转角γ1保持0°,正向旋转第二单光楔Π2到|Δγ|。此时,光轴指向一个新的方向,其光轴偏转角达到目标值θ0。此时γ1=0,γ2=|Δγ|,令光轴的方位角为γ′temp1,方位角为γ′temp1取值为-180°~180,则可通过下式计算:
然后同步旋转双光楔,使得光轴到达指定的滚转角γ0,则同步旋转的角度为
γ″temp1=γ0-γ′temp1
第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2为:
其中,γ″temp1为第一单光楔和第二单光楔同步旋转的角度;|Δγ|为沿弹体坐标系OXB轴看去,第二单光楔相对于第一单光楔逆时针旋转的角度。
所述沿弹体坐标系OXB轴看去,第二单光楔相对于第一单光楔逆时针旋转的角度|Δγ|为:
其中,n1为第一单光楔的折射率,α1为第一单光楔的楔角,n2为第二单光楔的折射率,α2为第二单光楔的楔角。
所述第一单光楔和第二单光楔同步旋转的角度γ″temp1为:
γ″temp1=γ0-γ′temp1
其中,(x,y,z)为位标器出射光线矢量的方向余弦。
3、双光楔控制方法
位标器每个光楔滚转机构分别由镜筒、轴承组、电机和一个码盘组成。根据上述步骤解算出的控制指令,由DSP实时解算控制器,输出控制量控制电机带动光楔旋转,由码盘实时测得滚转光楔机构的位置信息进行反馈,形成闭环回路,最终实现光轴的位置控制,算法简单易实现。
本发明某一具体实施例中,控制器采用经典的PID控制算法,PID控制器算法为:
式中:
Y1、Y2分别为第一单光楔、第二单光楔对应的电机控制信号;
Kp1、Kp2分别为第一单光楔、第二单光楔的比例控制器增益;
Ki1、Ki2分别为第一单光楔、第二单光楔的积分控制器系数;
Kdy、Kdz分别为第一单光楔、第二单光楔的微分控制器系数;
U1m、U2m分别为第一单光楔、第二单光楔对应的码盘反馈值。
所述第一单光楔和第二单光楔折射率相同、折射棱角相等。
4、单光楔结构改进
在产品实际应用中,由于红外材料对不同波长光线的折射率不同,为实现轻量化,需寻求折射率大的透红外材料,以最小的楔角满足光路偏折需求;由于不同波长的光线在经过光楔后所产生的偏折角度不同,因此中波红外光线空过楔镜后存在色散现象,需要进行色差补偿,所以采用组合光楔的方式来减小色差对系统的影响。如附图4所示。第一单光楔Π1、第二单光楔Π2分别是由两个光楔组成的光楔对,每个光楔对固连,作为一个单光楔使用。
基于上述装置,本发明还提供了无随动红外光轴控制方法,其特征在于包括如下步骤:
S1、调整双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态,将第一单光楔、第二单光楔对应的码盘归为零位;
S2、获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,位标器光轴从初始状态需要先绕弹体坐标系OZB轴转动的俯仰角θ0、再绕OXB旋转的滚转角γ0;
所述弹体坐标系OXBYBZB定义如下:
O为弹体质心,OXB为沿弹体纵轴,指向弹头为正,OYB在弹体对称平面内,垂直OXB轴,向上为正,OZB符合右手定则;
S3、结合双光楔折射原理,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2;
S4、根据第一单光楔、第二单光楔对应的码盘实时测量的第一单光楔和第二单光楔光绕中心轴旋转的角度信息、第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,控制电机旋转,实现光轴在空间的任意指向。
综上所述,本发明采用一种基于双光楔的无随动装置来实现光轴的指向控制,满足产品小型化设计需求,同时位标器结构简单,控制规律经典、灵活。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (10)
1.一种基于双光楔的无随动红外位标器光轴控制装置,所述双光楔由两块单光楔组成,两块单光楔沿弹轴方向平行排列,单光楔的中心轴与弹轴重合,靠近位标器的单光楔记为第一单光楔,另一块单光楔记为第二单光楔,其特征在于所述光轴控制装置包括两组滚转机构和控制器;每组滚转机构均包括镜筒、轴承组、电机和码盘;单光楔由镜筒支撑,镜筒通过轴承组安装在位标器壳体上,电机用于驱动镜筒带动单光楔绕中心轴旋转,码盘用于实时测量光楔绕中心轴旋转的角度信息反馈给控制器;所述双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态,此时第一单光楔、第二单光楔对应的码盘归为零位;
控制器,获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,位标器光轴从初始状态需要先绕弹体坐标系OZB轴转动的俯仰角再绕OXB旋转的滚转角γ0,再结合双光楔折射原理,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2;根据实时测量的第一单光楔和第二单光楔光绕中心轴旋转的角度信息、第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2,采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,控制电机旋转,实现光轴在空间的任意指向;
所述弹体坐标系OXBYBZB定义如下:
O为弹体质心,OXB为沿弹体纵轴,指向弹头为正,OYB在弹体对称平面内,垂直OXB轴,向上为正,OZB符合右手定则。
2.根据权利要求1所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于所述目标相对于弹体坐标系的偏航角α和俯仰角β为:
其中,α0、β0分别为机载雷达确定的目标相对于弹体坐标系的偏航角和俯仰角,Δα、Δβ分别为位标器确定的目标相对于弹体坐标系的偏航失调角和俯仰失调角。
3.根据权利要求2所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于位标器确定的目标相对于弹体坐标系的偏航失调角Δα和俯仰失调角Δβ直接采用位标器测得目标相对位标器坐标系的偏航失调角εα、俯仰失调角εβ替代。
4.根据权利要求1所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于为使位标器光轴指向目标,位标器光轴从初始位置需要先绕弹体坐标系OZB轴转动的俯仰角再绕OXB旋转的滚转角γ0通过如下公式计算得到:
5.根据权利要求1所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2为:
其中,γt”emp1为第一单光楔和第二单光楔同步旋转的角度;|Δγ|为沿弹体坐标系OXB轴看去,第二单光楔相对于第一单光楔逆时针旋转的角度。
6.根据权利要求5所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于所述沿弹体坐标系OXB轴看去,第二单光楔相对于第一单光楔逆时针旋转的角度|Δγ|为:
其中,n1为第一单光楔的折射率,α1为第一单光楔的楔角,n2为第二单光楔的折射率,α2为第二单光楔的楔角。
7.根据权利要求5所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于所述第一单光楔和第二单光楔同步旋转的角度γ″temp1为:
γ″temp1=γ0-γ′temp1
其中,(x,y,z)为位标器出射光线矢量的方向余弦。
8.根据权利要求1所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于PID控制器算法为:
式中:
Y1、Y2分别为第一单光楔、第二单光楔对应的电机控制信号;
Kp1、Kp2分别为第一单光楔、第二单光楔的比例控制器增益;
Ki1、Ki2分别为第一单光楔、第二单光楔的积分控制器系数;
Kdy、Kdz分别为第一单光楔、第二单光楔的微分控制器系数;
U1m、U2m分别为第一单光楔、第二单光楔对应的码盘反馈值。
9.根据权利要求1所述的一种基于双光楔的无随动红外位标器光轴控制装置,其特征在于所述第一单光楔和第二单光楔折射率相同、折射棱角相等。
10.基于权利要求1~9任一项装置的无随动红外光轴控制方法,其特征在于包括如下步骤:
S1、调整双光楔的初始状态为:两个双光楔相对旋转角为180°,光线偏转角为0°的状态,将第一单光楔、第二单光楔对应的码盘归为零位;
S2、获取目标相对于弹体坐标系的偏航角α和俯仰角β,计算得到为使位标器光轴指向目标,位标器光轴从初始状态需要先绕弹体坐标系OZB轴转动的俯仰角再绕OXB旋转的滚转角γ0;
所述弹体坐标系OXBYBZB定义如下:
O为弹体质心,OXB为沿弹体纵轴,指向弹头为正,OYB在弹体对称平面内,垂直OXB轴,向上为正,OZB符合右手定则;
S3、结合双光楔折射原理,计算得到为使位标器光轴指向目标,第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2;
S4、根据第一单光楔、第二单光楔对应的码盘实时测量的第一单光楔和第二单光楔光绕中心轴旋转的角度信息、第一单光楔的目标滚转角γ1和第二单光楔的目标滚转角γ2采用PID控制算法,解算出的第一单光楔和第二对应单光楔的电机控制指令,控制电机旋转,实现光轴在空间的任意指向。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211583400.0A CN116222304B (zh) | 2022-12-09 | 2022-12-09 | 一种基于双光楔的无随动红外位标器光轴控制装置和方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211583400.0A CN116222304B (zh) | 2022-12-09 | 2022-12-09 | 一种基于双光楔的无随动红外位标器光轴控制装置和方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116222304A CN116222304A (zh) | 2023-06-06 |
| CN116222304B true CN116222304B (zh) | 2024-12-13 |
Family
ID=86572047
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202211583400.0A Active CN116222304B (zh) | 2022-12-09 | 2022-12-09 | 一种基于双光楔的无随动红外位标器光轴控制装置和方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116222304B (zh) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107356236A (zh) * | 2017-07-31 | 2017-11-17 | 天津大学 | 一种动态位姿实时测量装置及方法 |
| CN113673078A (zh) * | 2021-07-14 | 2021-11-19 | 南京航空航天大学 | 一种双光楔激光雷达模拟计算方法 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO1999038045A1 (en) * | 1998-01-21 | 1999-07-29 | Renishaw Plc | Beam deflector |
| EP1455204A1 (en) * | 2003-03-06 | 2004-09-08 | ASML Netherlands B.V. | Device and method for manipulation and routing of a metrology beam |
| IL155860A0 (en) * | 2003-05-12 | 2003-12-23 | Elop Electrooptics Ind Ltd | Rotary wedge scanner |
| CN1256608C (zh) * | 2004-06-08 | 2006-05-17 | 中国科学院上海光学精密机械研究所 | 星间激光通信终端高精度动静态测量装置 |
| JP2009139692A (ja) * | 2007-12-07 | 2009-06-25 | Mitsubishi Electric Corp | レーザービーム走査装置および光アンテナ装置 |
| US9976947B1 (en) * | 2014-11-24 | 2018-05-22 | TVS Holdings, LLC | Position measurement device |
| CN114114673A (zh) * | 2021-12-31 | 2022-03-01 | 华中科技大学 | 一种激光对点传输系统 |
-
2022
- 2022-12-09 CN CN202211583400.0A patent/CN116222304B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107356236A (zh) * | 2017-07-31 | 2017-11-17 | 天津大学 | 一种动态位姿实时测量装置及方法 |
| CN113673078A (zh) * | 2021-07-14 | 2021-11-19 | 南京航空航天大学 | 一种双光楔激光雷达模拟计算方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116222304A (zh) | 2023-06-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111123991B (zh) | 一种基于双光楔红外成像的光轴控制方法 | |
| CN102279093B (zh) | 红外动态三角形目标模拟器 | |
| CN105865272B (zh) | 一种用于半捷联制导导弹的一体化控制方法 | |
| US5946143A (en) | Dynamic aberration correction of conformal/aspheric domes and windows for missile and airborne fire control applications | |
| CN104122900A (zh) | 一种基于旋转双棱镜的复合轴跟踪系统 | |
| CN102830714A (zh) | 一种空地激光通信中的超前瞄准方法 | |
| US20070187546A1 (en) | Binary optics SAL seeker (BOSS) | |
| CN106526832B (zh) | 一种二维指向机构伺服控制方法及系统 | |
| CN104570346A (zh) | 一种基于像方间接稳像的长波红外光学成像系统 | |
| US20150268346A1 (en) | Optical axis directing apparatus | |
| CN109471252B (zh) | 一种复杂光学场景空间运动模拟装置 | |
| CN116222304B (zh) | 一种基于双光楔的无随动红外位标器光轴控制装置和方法 | |
| Li et al. | Rotation matrix error-decoupling methods for Risley prism closed-loop tracking | |
| CN114967767A (zh) | 基于组合转镜的复合轴粗精跟踪装置及方法 | |
| CN103512427A (zh) | 龙虾眼红外成像制导系统 | |
| CN112987557B (zh) | 一种基于双光楔红外成像的跟踪控制方法 | |
| CN108387151B (zh) | 一种测量导弹相对姿态角的偏置跟随激光测量系统 | |
| CN112526747B (zh) | 一种共形光学系统两维运动的像差校正成像透镜组件 | |
| US3337161A (en) | Radio controlled missile with television camera | |
| CN115639812B (zh) | 一种基于偏差角的水下航行器航路跟踪控制方法 | |
| CN114625179A (zh) | 一种旋转双棱镜快速平滑跟踪目标方法 | |
| CN112946879B (zh) | 一种双滚转跟踪去耦控制方法及系统 | |
| Wang et al. | A three dimensional guidance and control method for suicide UAV and the flight test verification | |
| CN110336613A (zh) | 一种基于检流式振镜的轻快型无线光通信系统及控制方法 | |
| Chen et al. | A beam pointing and tracking control method for rotating double-prism system based on virtual axis angular deviation strategy |
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 |