CN105955281B - 一种应用于机载红外辅助导航的Risley棱镜系统控制方法 - Google Patents
一种应用于机载红外辅助导航的Risley棱镜系统控制方法 Download PDFInfo
- Publication number
- CN105955281B CN105955281B CN201610268635.9A CN201610268635A CN105955281B CN 105955281 B CN105955281 B CN 105955281B CN 201610268635 A CN201610268635 A CN 201610268635A CN 105955281 B CN105955281 B CN 105955281B
- Authority
- CN
- China
- Prior art keywords
- prism
- sight line
- prisms
- rotation angle
- risley
- 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 50
- 239000013598 vector Substances 0.000 claims abstract description 68
- 238000004422 calculation algorithm Methods 0.000 abstract description 16
- 230000008569 process Effects 0.000 abstract description 8
- 238000004458 analytical method Methods 0.000 abstract description 7
- 230000000694 effects Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 8
- 229910003460 diamond Inorganic materials 0.000 description 7
- 239000010432 diamond Substances 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 5
- 238000004088 simulation Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 244000145845 chattering Species 0.000 description 2
- 230000036632 reaction speed Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000011521 glass Substances 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000002045 lasting effect Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000004297 night vision Effects 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G02—OPTICS
- G02B—OPTICAL ELEMENTS, SYSTEMS OR APPARATUS
- G02B26/00—Optical devices or arrangements for the control of light using movable or deformable optical elements
- G02B26/08—Optical devices or arrangements for the control of light using movable or deformable optical elements for controlling the direction of light
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Optics & Photonics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Mechanical Light Control Or Optical Switches (AREA)
- Mechanical Optical Scanning Systems (AREA)
Abstract
本发明提出一种应用于机载红外辅助导航的Risley棱镜系统控制方法,该方法以瞄准线指向矢量命令为输入量,利用基于非近轴矢量光线追迹法的反向精确解析算法,计算出能够准确实现瞄准线指向要求的棱镜各自旋转角度并作为控制模型输出量。该方法能够有效解决实际应用中瞄准线扫描轨迹连续,离散的各瞄准线指向矢量相应的棱镜旋转角度计算过程相互独立,从而造成的棱镜不断大幅度旋转的问题,提高了棱镜旋转的平稳性和效率。仿真及实施结果表明使用本发明中控制方法能够达到发明目的,具有瞄准线指向控制精确,棱镜旋转运动控制效果好等优点,同时作为软件控制算法,使用成本低,适用范围广。
Description
技术领域
本发明属于机载红外辅助导航设备中瞄准线指向的伺服控制领域,主要涉及一种Risley棱镜系统的精确控制模型,具体为一种应用于机载红外辅助导航的Risley棱镜系统控制方法,保证棱镜连续、平滑、高效旋转。
背景技术
机载红外辅助导航设备用于飞机在夜间或复杂气象条件下对飞行航线前方区域进行扫描观察,实时形成清晰的地理图像供飞行员观察,能够提高飞行员对空地态势的感知能力,提高飞机的夜视作战能力。
目前许多机载红外辅助导航设备由传统的悬挂光电吊舱形式转变为与武器挂架整体外形一体化形式,设备允许的体积空间极其有限,同时还要实现大范围扫描以及严格的重量限制。传统瞄准线运动方案如整体稳定万向架式方案和双反射镜方案很难满足载动静态性能、稳定性、体积、重量等设计指标的要求。
Risley棱镜又称为旋转双棱镜,由两块共轴相邻独立旋转的楔形折射棱镜组成。根据棱镜对入射光束的折射作用原理,通过控制两个棱镜的各自旋转角度,使得出射光束的方位角度、俯仰角度连续变化,实现出射光束在以入射光束为轴的锥形范围内任意方向变化,引导出射光束到达指定的位置,就可以实现瞄准线的扫描运动。旋转Risley棱镜方案具有控制灵活、机械运动平稳、振动噪声小、扫描效率高,结构紧凑等优点,已被广泛应用于性能先进的机载光电产品中。
寻求两个棱镜的旋转角度与出射光束指向位置之间的内在联系是Risley棱镜光束指向系统实际应用面临的基本问题。由出射光束的指向计算两个棱镜各自的旋转角度,是Risley棱镜瞄准线运动方案应用研究的基础前提。传统方法采用一级近轴近似矢量中心算法结合逆向推算求解该问题:将棱镜看作楔角很小的光楔,入射光束在棱镜主截面内偏转角度恒定,仅取决于楔角和折射率的大小。Risley棱镜对光束总的偏转角度就是两个棱镜偏转角度的矢量和。该方法是近轴条件下的薄棱镜近似,仅适用于偏转角较小的Risley棱镜系统,且求解精度不够。对于机载红外辅助导航设备中大角度范围光束转向的需求,需要精确的Risley棱镜运动控制方法。采用非近轴矢量光线追迹法结合两步法可以求得该问题的精确解析解。首先基于光线追迹法推导光束指向随Risley棱镜角度位置变化的解析关系式;然后采用两步法:第一步保持一个棱镜不动,转动另一棱镜直至出射光束的偏转角到达目标值,第二步保持两个棱镜的相对夹角不变,同时转动两个棱镜直至到达出射光束要求指向。该算法为双棱镜系统的大角度偏转应用提供了理论基础和方法导引。
中国专利《采用双光楔实现的机载红外扫描观察装置》公开了一种采用双光楔实现瞄准线扫描的机载红外扫描观察装置,该发明通过旋转双光楔使机载红外导航装置实现了瞄准线扫描观察。该发明公开的双光楔控制方法中有两方面尚待改进:第一,该发明未建立双棱镜旋转控制模型,采用一级近轴近似算法求解双光楔各自的旋转角度,求解精度不够;第二,该发明棱镜运动过程中存在大角度旋转问题,影响瞄准线反应速度及双棱镜系统的平稳性。
发明内容
本发明针对现有技术中存在的双棱镜旋转控制模型不明晰、Risley棱镜光束指向控制算法不精确等问题,利用基于非近轴矢量光线追迹法的反向精确解析算法,提出了能够准确实现瞄准线指向控制的Risley棱镜系统旋转控制模型;针对实际应用中的棱镜不断大幅度旋转问题,提供一种将离散的各瞄准线指向矢量命令的棱镜旋转角度计算过程由相互独立转化为相互关联的控制方法,从而保证棱镜连续、平滑、高效旋转。
本发明的技术方案为:
所述一种应用于机载红外辅助导航的Risley棱镜系统控制方法,其特征在于:包括以下步骤:
步骤1:将机载红外辅助导航设备工作过程中的扫描轨迹指令离散化为若干瞄准线指向矢量(δi,βi),i=1,2,3...,其中δi,βi分别表示瞄准线指向的方位角度和俯仰角度,-π/2<δi<π/2,-π/2<βi<π/2;并按照下面公式对瞄准线指向矢量(δi,βi),i=1,2,3...进行矢量变换,得到转换后的瞄准线指向矢量(Φi,Θi),i=1,2,3...:
步骤2:对于步骤1中得到的每一个转换后的瞄准线指向矢量,通过以下步骤得到对应的Risley棱镜对中两个棱镜的旋转角度;其中对应于第i个转换后的瞄准线指向矢量(Φi,Θi),得到的Risley棱镜对中入射棱镜和出射棱镜的旋转角度依次为θ1,i,θ2,i:
步骤2.1:根据第i个转换后的瞄准线指向矢量(Φi,Θi),利用公式
θ12,i=θ11,i+|Δθ|i
计算得到满足瞄准线指向要求的棱镜旋转角度集合:{θ1,i}={θ11,i+2Zπ},{θ2,i}={θ12,i+2Zπ},其中Z为整数集,n1和n2依次为Risley棱镜对中入射棱镜和出射棱镜的折射系数,α1和α2依次为Risley棱镜对中入射棱镜和出射棱镜的顶角;
步骤2.2:在步骤2.1中得到的满足瞄准线指向要求的棱镜旋转角度集合中,按照两个棱镜的实时状态θpre1,θpre2,以棱镜所需转动幅度ξ1,i和ξ2,i最小为要求,得到最终两个棱镜的旋转角度为:
其中
以最终得到的两个棱镜的旋转角度作为控制量,驱动相应驱动装置带动两个棱镜旋转,实现瞄准线正确指向。
所述一种应用于机载红外辅助导航的Risley棱镜系统控制方法,其特征在于:包括以下步骤:
步骤1:将机载红外辅助导航设备工作过程中的扫描轨迹指令离散化为若干瞄准线指向矢量(δi,βi),i=1,2,3...,其中δi,βi分别表示瞄准线指向的方位角度和俯仰角度,-π/2<δi<π/2,-π/2<βi<π/2;并按照下面公式对瞄准线指向矢量(δi,βi),i=1,2,3...进行矢量变换,得到转换后的瞄准线指向矢量(Φi,Θi),i=1,2,3...:
步骤2:对于步骤1中得到的每一个转换后的瞄准线指向矢量,通过以下步骤得到对应的Risley棱镜对中两个棱镜的旋转角度;其中对应于第i个转换后的瞄准线指向矢量(Φi,Θi),得到的Risley棱镜对中入射棱镜和出射棱镜的旋转角度依次为θ1,i,θ2,i:
步骤2.1:根据第i个转换后的瞄准线指向矢量(Φi,Θi),利用公式
θ21,i=θ22,i+|Δθ|i
计算得到满足瞄准线指向要求的棱镜旋转角度集合:{θ1,i}={θ21,i+2Zπ},{θ2,i}={θ22,i+2Zπ},其中Z为整数集,n1和n2依次为Risley棱镜对中入射棱镜和出射棱镜的折射系数,α1和α2依次为Risley棱镜对中入射棱镜和出射棱镜的顶角;
步骤2.2:在步骤2.1中得到的满足瞄准线指向要求的棱镜旋转角度集合中,按照两个棱镜的实时状态θpre1,θpre2,以棱镜所需转动幅度ξ1,i和ξ2,i最小为要求,得到最终两个棱镜的旋转角度为:
其中
以最终得到的两个棱镜的旋转角度作为控制量,驱动相应驱动装置带动两个棱镜旋转,实现瞄准线正确指向。
有益效果
本发明的有益效果体现在以下几个方面:
(一)本发明建立了双棱镜旋转控制模型,该模型以机载红外辅助导航设备瞄准线指向矢量为输入量,以双棱镜各自旋转角度为输出量,利用基于非近轴矢量光线追迹法的反向解析算法精确解析瞄准线控制问题,解决了现有基于双棱镜系统的机载红外辅助导航装置中由于采用近似算法导致瞄准线指向误差较大的问题。
(二)本发明提出了双棱镜连续平滑旋转控制方法,将独立的棱镜旋转角度计算过程联系起来,扩大棱镜旋转角度取值范围,参考当前棱镜旋转角度,以两棱镜所需运动幅度最小为标准对多组棱镜旋转角计算结果取值,因此该控制方法能够有效消除传统控制算法导致的棱镜大幅度运动现象,最大程度上保证了双棱镜运动控制的平稳性及精确性。
附图说明
图1是瞄准线指向空间矢量转换示意图。
图2是双棱镜系统示意图。
图3是双棱镜控制模型步骤图。
图4是瞄准线菱形扫描轨迹示意图。
图5是实现菱形扫描轨迹双棱镜旋转角度变化示意图。
图6是两棱镜旋转角度变化示意图1(应用双棱镜平滑旋转控制方法前)。
图7是两棱镜旋转角度变化示意图2(应用双棱镜平滑旋转控制方法后)。
具体实施方式
下面结合瞄准线指向扫描仿真实例及相应附图对本发明作进一步的详述。
首先叙述本发明的基本原理:
一、Risley棱镜系统反向精确解析算法
Risley棱镜系统对入射光线产生偏折从而改变光的传播方向,机载红外辅助导航设备利用双棱镜的相对旋转,引导出射光束到达预先设定的指向,通过反向精确解析计算实现瞄准线指向所需的双棱镜旋转角度,实现瞄准线的扫描运动。
1)瞄准线指向矢量变换
在机载红外辅助导航设备工作过程中,瞄准线指向不断移动形成连续的扫描轨迹。离散化该扫描轨迹为一系列瞄准线指向矢量(δi,βi),i=1,2,3...,作为本发明中Risley棱镜系统旋转控制模型的输入量,其中δi(-π/2<δi<π/2),βi(-π/2<βi<π/2)分别表示瞄准线指向的方位角度和俯仰角度。
建立如图1所示的瞄准线指向空间坐标系,为瞄准线指向矢量,为便于利用非近轴光线追迹法中的Snell定理计算,将瞄准线指向矢量转换表示为其中偏转角Φ(0<Φ<π/2)为瞄准线与Z轴逆方向夹角,旋转角Θ(0≤Θ<2π)为瞄准线指向矢量在Z轴垂直面上的投影逆时针旋转的角度。
当瞄准线指向第一象限即δ>0且β>0时:
Θ=arctan(tanβ/tanδ)
Φ=arctan{tanβ/sin[arctan(tanβ/tanδ)]}
将瞄准线指向矢量转换推广到整个平面有:
2)基于非近轴光线追迹法的Risley棱镜系统反向精确解析算法
建立如图2所示的双棱镜坐标系,棱镜Π1和棱镜Π2的折射系数分别为n1和n2,棱镜顶角分别为α1和α2。θ1,θ2分别表示棱镜Π1和棱镜Π2的旋转角度,入射光束沿Z轴逆方向入射,则棱镜Π1的左界面法线矢量可表示为:
对棱镜Π1应用空间矢量形式的Snell定理,入射光线在棱镜左界面发生折射,折射光线矢量为:
由于两个棱镜之间的空气层左右界面平行,入射光束在棱镜Π1中与Π2中的传播方向不变,因此可忽略其中的两次折射过程。从棱镜Π2右界面入射的光线矢量可以看作:
棱镜Π2右界面的法线矢量可表示为:
再次应用Snell定理进行折射计算,得到棱镜Π2右界面的折射光线矢量为:
将表达式代入表达式可得出射光束的方向余弦向量(K,L,M),其中:
且:
其中由于双棱镜旋转角度θ1和θ2,折射系数n1和n2,顶角α1和α2均已知,可推出偏转角Φ与旋转角Θ分别为:
Φ=arccos(-M)
由上式知,偏转角Φ一旦确定,双棱镜旋转角度之差|Δθ|也随之确定,且:
本发明中,瞄准线指向矢量(Φ,Θ)为已知量,根据偏转角Φ求出|Δθ|,进而采用两步法求解两棱镜旋转角度θ1和θ2:第一步,保持一个棱镜不动,旋转另一棱镜直至两个棱镜旋转角度之差为|Δθ|,此时瞄准线指向矢量由(0,0)变为(Φ,Θ'),Θ'可由正向算法计算得出。第二步,保持|Δθ|不变,将两棱镜同时旋转ρ=Θ-Θ',使瞄准线指向达到目标指向。
对于同一瞄准线指向,该方法可求得两套解:
对应|Δθ|=θ2-θ1,即在第一步中保持棱镜Π1不动;
或:
对应|Δθ|=θ1-θ2,即在第一步中保持棱镜Π2不动。
二、Risley棱镜平滑旋转控制方法及旋转控制模型
在上述双棱镜反向解析计算过程中,瞄准线指向矢量的旋转角Θ的值域为[0,2π),双棱镜旋转角度θ的值域为(-2π,2π)。在机载红外辅助导航设备工作时,通常会接收连续的扫描轨迹指令(如对战场进行连续逆时针螺旋轨迹扫描),从而旋转角Θ会在X正半轴即2π处发生跳跃现象。同时,当切换观察多个特定区域时,瞄准线指向要求突变,也会造成旋转角Θ跳跃。
由于双棱镜反向解析计算过程相互独立,上述的两种跳跃现象会导致双棱镜旋转角度θ作为计算结果也会发生跳跃,这种现象会导致双棱镜在执行旋转命令时大幅度运动,降低导航设备的稳定精度和跟踪精度,降低瞄准线反应速度。
为解决上述问题,保证双棱镜能够平滑、连续、高效地旋转,本发明设计了双棱镜平滑旋转控制方法,下面对于两套解均做描述:
(1)将瞄准线指向矢量的旋转角Θ及双棱镜旋转角度θ的值域均扩大到(-∞,∞),这样每个瞄准线指向(δ,β)均对应多组满足条件的棱镜旋转角度,即
或其中Z表示整数集;
(2)参考上一瞄准线指向对应的双棱镜旋转角度θpre1和θpre2,以当前棱镜所需转动幅度ξ1=|θ1-θpre1|和ξ2=|θ2-θpre2|最小为标准,对旋转角度进行取值作为最终计算结果。
上述方法将扫描轨迹离散化后的各瞄准线指向相应的独立计算过程相互关联起来,形成具有“累积效应”的旋转角度取值过程。结合该方法,联立双棱镜反向解析算法各等式,本发明建立Risley棱镜系统旋转控制模型,如图3所示:
步骤1:将机载红外辅助导航设备工作过程中的扫描轨迹指令离散化为若干瞄准线指向矢量(δi,βi),i=1,2,3...作为输入量,其中δi(-π/2<δi<π/2),βi(-π/2<βi<π/2)分别表示瞄准线指向的方位角度和俯仰角度;并按照下面公式对瞄准线指向矢量(δi,βi),i=1,2,3...进行矢量变换,得到转换后的瞄准线指向矢量(Φi,Θi),i=1,2,3...:
步骤2:对于步骤1中得到的每一个转换后的瞄准线指向矢量,通过以下步骤得到对应的Risley棱镜对中两个棱镜的旋转角度;其中对应于第i个转换后的瞄准线指向矢量(Φi,Θi),得到的Risley棱镜对中入射棱镜和出射棱镜的旋转角度依次为θ1,i,θ2,i:
采用第一套解:
步骤2.1:根据第i个转换后的瞄准线指向矢量(Φi,Θi),利用公式
θ12,i=θ11,i+|Δθ|i
计算得到满足瞄准线指向要求的棱镜旋转角度集合:{θ1,i}={θ11,i+2Zπ},{θ2,i}={θ12,i+2Zπ},其中Z为整数集,n1和n2依次为Risley棱镜对中入射棱镜和出射棱镜的折射系数,α1和α2依次为Risley棱镜对中入射棱镜和出射棱镜的顶角;
步骤2.2:在步骤2.1中得到的满足瞄准线指向要求的棱镜旋转角度集合中,按照两个棱镜的实时状态θpre1,θpre2,以棱镜所需转动幅度ξ1,i和ξ2,i最小为要求,得到最终两个棱镜的旋转角度为:
其中
以最终得到的两个棱镜的旋转角度作为控制量,驱动相应驱动装置带动两个棱镜旋转,实现瞄准线正确指向。
采用第二套解:
步骤2.1:根据第i个转换后的瞄准线指向矢量(Φi,Θi),利用公式
θ21,i=θ22,i+|Δθ|i
计算得到满足瞄准线指向要求的棱镜旋转角度集合:{θ1,i}={θ21,i+2Zπ},{θ2,i}={θ22,i+2Zπ},其中Z为整数集,n1和n2依次为Risley棱镜对中入射棱镜和出射棱镜的折射系数,α1和α2依次为Risley棱镜对中入射棱镜和出射棱镜的顶角;
步骤2.2:在步骤2.1中得到的满足瞄准线指向要求的棱镜旋转角度集合中,按照两个棱镜的实时状态θpre1,θpre2,以棱镜所需转动幅度ξ1,i和ξ2,i最小为要求,得到最终两个棱镜的旋转角度为:
其中
以最终得到的两个棱镜的旋转角度作为控制量,驱动相应驱动装置带动两个棱镜旋转,实现瞄准线正确指向。
本仿真实例中取棱镜折射率为n1=n2=4,棱镜顶角为α1=α2=3.1°=0.0541rad。
1)设计合理的扫描轨迹
为设计合理的扫描轨迹,需要求解Risley棱镜系统的最大扫描范围,并将瞄准线扫描轨迹约束在该扫描范围内。显然,光束经双棱镜折射后的偏转范围是以棱镜旋转轴为对称轴,以2Φmax为顶角的圆锥,其中Φmax为Risley棱镜系统的最大偏转角。令两棱镜旋转角度θ1=0,θ2=0,此时光束偏转程度最大。入射光束逆Z轴方向入射,经两棱镜折射后,其方向余弦向量为(K,L,M),则有:
于是求得光束最大偏转角:
Φ=arccos(-M)=arccos(0.9448)=0.3337rad
因此设计本次仿真实例中扫描轨迹为图4中的菱形扫描轨迹,起点为(δ=-0.33,β=0),扫描方向为顺时针,其方程形式为:
2)方法实施流程
下面结合图3说明算法实施步骤:
第一步:将菱形扫描轨迹均匀地离散化为N=400个瞄准线指向矢量(δi,βi),i=1,2,...,N。为描述算法实施细节,本发明取第202个瞄准线指向矢量为例进行计算演示。此时满足第201个瞄准线指向矢量(δ201=0.33,β201=0)的两棱镜当前旋转角度为θpre1=-3.2881,θpre2=-2.9977。对进行矢量转换:
第二步:经过双棱镜反向解析算法计算得出两棱镜旋转角度并扩大取值范围:θ1=θ11+2Zπ,θ2=θ12+2Zπ
其中:
作为棱镜系统固有参数,a1=-0.1623,a2=-3.9967保持不变
此时:
θ12=|Δθ|+θ11=0.3992+2.9305=3.3297
第三步:当前棱镜满足瞄准线方向要求的最小旋转幅度为:
min(ξ1)=min{|θ11+2Zπ-θpre1|}=|θ11+2Z1π-θpre1|=0.0614
min(ξ2)=min{|θ12+2Zπ-θpre2|}=|θ12+2Z2π-θpre2|=0.0474
此时Z1=-1,Z2=-1,得出:
类似地,其它离散的各扫描轨迹点也可求得相应的双棱镜旋转角,控制模型输出旋转角度控制相应电机运动,带动两棱镜旋转以实现瞄准线指向正确移动,进而实现本仿真算例中的菱形扫描轨迹。
3)计算结果分析及算法有效性说明
图5为本发明仿真算例中实现菱形扫描轨迹的双棱镜旋转角度变化图。图中随着瞄准线指向的顺时针旋转,两棱镜的旋转角度随箭头不断变化,四段弧线表示棱形扫描轨迹四个边相应的棱镜旋转角度变化,其趋势平滑连续。
图6为使用棱镜连续平滑旋转控制方法前两棱镜旋转角度随瞄准线指向方位角的变化趋势:当瞄准线指向由菱形扫描轨迹的第一象限部分过渡到第二象限部分时,两棱镜旋转角均出现幅度为2π的跳跃。
图7为使用棱镜连续平滑旋转控制方法后两棱镜旋转角度随瞄准线指向方位角的变化趋势,由图可以明显看出,该趋势平滑连续,传统控制算法导致的棱镜大幅度运动现象消失,双棱镜旋转的平稳性得到了明显改善。
从实施算例效果可知,本发明设计的双棱镜连续平滑旋转控制方法和基于非近轴矢量光线追迹法实现瞄准线精确指向的双棱镜旋转控制模型能够有效地消除传统控制算法导致的棱镜大幅度运动现象,最大程度上保证了双棱镜运动控制的平稳性及精确性,同时解决了现有控制算法存在的求解不精确的问题。
Claims (2)
1.一种应用于机载红外辅助导航的Risley棱镜系统控制方法,其特征在于:包括以下步骤:
步骤1:将机载红外辅助导航设备工作过程中的扫描轨迹指令离散化为若干瞄准线指向矢量(δi,βi),i=1,2,3...,其中δi,βi分别表示瞄准线指向的方位角度和俯仰角度,-π/2<δi<π/2,-π/2<βi<π/2;并按照下面公式对瞄准线指向矢量(δi,βi)进行矢量变换,得到转换后的瞄准线指向矢量(Φi,Θi),i=1,2,3...:
步骤2:对于步骤1中得到的每一个转换后的瞄准线指向矢量,通过以下步骤得到对应的Risley棱镜对中两个棱镜的旋转角度;其中对应于第i个转换后的瞄准线指向矢量(Φi,Θi),得到的Risley棱镜对中入射棱镜和出射棱镜的旋转角度依次为θ1,i,θ2,i:
步骤2.1:根据第i个转换后的瞄准线指向矢量(Φi,Θi),利用公式
θ12,i=θ11,i+|Δθ|i
计算得到满足瞄准线指向要求的棱镜旋转角度集合:{θ1,i}={θ11,i+2Zπ},{θ2,i}={θ12,i+2Zπ},其中Z为整数集,n1和n2依次为Risley棱镜对中入射棱镜和出射棱镜的折射系数,α1和α2依次为Risley棱镜对中入射棱镜和出射棱镜的顶角;
步骤2.2:在步骤2.1中得到的满足瞄准线指向要求的棱镜旋转角度集合中,按照两个棱镜的实时状态θpre1,θpre2,以棱镜所需转动幅度ξ1,i和ξ2,i最小为要求,得到最终两个棱镜的旋转角度为:
其中
以最终得到的两个棱镜的旋转角度作为控制量,驱动相应驱动装置带动两个棱镜旋转,实现瞄准线正确指向。
2.一种应用于机载红外辅助导航的Risley棱镜系统控制方法,其特征在于:包括以下步骤:
步骤1:将机载红外辅助导航设备工作过程中的扫描轨迹指令离散化为若干瞄准线指向矢量(δi,βi),i=1,2,3...,其中δi,βi分别表示瞄准线指向的方位角度和俯仰角度,-π/2<δi<π/2,-π/2<βi<π/2;并按照下面公式对瞄准线指向矢量(δi,βi)进行矢量变换,得到转换后的瞄准线指向矢量(Φi,Θi),i=1,2,3...:
步骤2:对于步骤1中得到的每一个转换后的瞄准线指向矢量,通过以下步骤得到对应的Risley棱镜对中两个棱镜的旋转角度;其中对应于第i个转换后的瞄准线指向矢量(Φi,Θi),得到的Risley棱镜对中入射棱镜和出射棱镜的旋转角度依次为θ1,i,θ2,i:
步骤2.1:根据第i个转换后的瞄准线指向矢量(Φi,Θi),利用公式
θ21,i=θ22,i+|Δθ|i
计算得到满足瞄准线指向要求的棱镜旋转角度集合:{θ1,i}={θ21,i+2Zπ},{θ2,i}={θ22,i+2Zπ},其中Z为整数集,n1和n2依次为Risley棱镜对中入射棱镜和出射棱镜的折射系数,α1和α2依次为Risley棱镜对中入射棱镜和出射棱镜的顶角;
步骤2.2:在步骤2.1中得到的满足瞄准线指向要求的棱镜旋转角度集合中,按照两个棱镜的实时状态θpre1,θpre2,以棱镜所需转动幅度ξ1,i和ξ2,i最小为要求,得到最终两个棱镜的旋转角度为:
其中
以最终得到的两个棱镜的旋转角度作为控制量,驱动相应驱动装置带动两个棱镜旋转,实现瞄准线正确指向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610268635.9A CN105955281B (zh) | 2016-04-27 | 2016-04-27 | 一种应用于机载红外辅助导航的Risley棱镜系统控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610268635.9A CN105955281B (zh) | 2016-04-27 | 2016-04-27 | 一种应用于机载红外辅助导航的Risley棱镜系统控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105955281A CN105955281A (zh) | 2016-09-21 |
CN105955281B true CN105955281B (zh) | 2018-08-28 |
Family
ID=56915871
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610268635.9A Active CN105955281B (zh) | 2016-04-27 | 2016-04-27 | 一种应用于机载红外辅助导航的Risley棱镜系统控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105955281B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106705969B (zh) * | 2017-02-22 | 2020-04-28 | 西安应用光学研究所 | 无人机光电系统手动模式瞄准线轨迹拟合方法 |
CN111123991B (zh) * | 2019-12-04 | 2023-05-12 | 上海航天控制技术研究所 | 一种基于双光楔红外成像的光轴控制方法 |
CN112433362A (zh) * | 2020-11-02 | 2021-03-02 | 湖南宇正智能科技有限公司 | 利用Risley棱镜的激光扩束扫描装置及方法 |
CN112987557B (zh) * | 2021-02-04 | 2023-05-12 | 上海航天控制技术研究所 | 一种基于双光楔红外成像的跟踪控制方法 |
CN114279397A (zh) * | 2021-12-28 | 2022-04-05 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的运动目标模拟器的装置与方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4940312A (en) * | 1987-09-23 | 1990-07-10 | Messerschmitt-Bolkow-Blohm Gmbh | Scanning prism |
CN103227932A (zh) * | 2013-04-09 | 2013-07-31 | 西安应用光学研究所 | 光电稳定跟踪平台跟踪性能测试装置 |
CN103278142A (zh) * | 2013-04-09 | 2013-09-04 | 西安应用光学研究所 | 光电系统连续跟踪自动切换方法 |
CN103631276A (zh) * | 2013-12-08 | 2014-03-12 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的跟踪装置及其控制方法 |
CN104122900A (zh) * | 2014-07-30 | 2014-10-29 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的复合轴跟踪系统 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6549700B1 (en) * | 2001-06-05 | 2003-04-15 | Sandia Corporation | Optical switch using Risley prisms |
US20110285981A1 (en) * | 2010-05-18 | 2011-11-24 | Irvine Sensors Corporation | Sensor Element and System Comprising Wide Field-of-View 3-D Imaging LIDAR |
-
2016
- 2016-04-27 CN CN201610268635.9A patent/CN105955281B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4940312A (en) * | 1987-09-23 | 1990-07-10 | Messerschmitt-Bolkow-Blohm Gmbh | Scanning prism |
CN103227932A (zh) * | 2013-04-09 | 2013-07-31 | 西安应用光学研究所 | 光电稳定跟踪平台跟踪性能测试装置 |
CN103278142A (zh) * | 2013-04-09 | 2013-09-04 | 西安应用光学研究所 | 光电系统连续跟踪自动切换方法 |
CN103631276A (zh) * | 2013-12-08 | 2014-03-12 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的跟踪装置及其控制方法 |
CN104122900A (zh) * | 2014-07-30 | 2014-10-29 | 中国科学院光电技术研究所 | 一种基于旋转双棱镜的复合轴跟踪系统 |
Non-Patent Citations (2)
Title |
---|
旋转双棱镜光束指向的反向解析解;周远 等;《光学精密工程》;20130731;第21卷(第7期);第1693-1699页 * |
旋转双棱镜光束指向解析解;周远 等;《光学精密工程》;20130630;第21卷(第6期);第1373-1378页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105955281A (zh) | 2016-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105955281B (zh) | 一种应用于机载红外辅助导航的Risley棱镜系统控制方法 | |
CN103439977B (zh) | 适用于光电跟踪仪的高速目标跟踪控制方法 | |
CN106226780B (zh) | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 | |
CN104122900A (zh) | 一种基于旋转双棱镜的复合轴跟踪系统 | |
CN103631276B (zh) | 一种基于旋转双棱镜的跟踪装置的控制方法 | |
CN105353781A (zh) | 一种提高消色差旋转棱镜组指向精度的方法 | |
Juqing et al. | Precision laser tracking servo control system for moving target position measurement | |
CN106020241B (zh) | 一种旋转双棱镜成像对准方法 | |
CN102830714A (zh) | 一种空地激光通信中的超前瞄准方法 | |
CN113189873B (zh) | 一种基于对称误差拟合的旋转双棱镜快速高精度解算方法 | |
CN106529073A (zh) | 基于拦截几何的高超声速目标拦截弹交接班条件分析方法 | |
CN113051743A (zh) | 一种基于轨迹在线规划的末制导系统 | |
CN109884791B (zh) | 一种基于旋转双棱镜的快速高精度扫描方法 | |
CN105242689A (zh) | 一种基于光学反射的云台跟踪视觉系统 | |
CN112269394A (zh) | 一种飞行器路径点跟踪制导方法 | |
CN114755658A (zh) | 一种基于单轴旋转双圆楔形棱镜的便携式激光雷达二维扫描系统及扫描方法 | |
CN104980214A (zh) | 一种星间通信粗精扫描方法 | |
CN113568442A (zh) | 一种对星控制系统及方法 | |
CN207338606U (zh) | 两自由度球型结构卫星接收天线调整平台 | |
CN103345072B (zh) | 中孔透镜光学光轴定位系统 | |
CN111367305B (zh) | 一种高轨光压作用下导引伴飞稳定性控制方法及系统 | |
CN109633895B (zh) | 一种级联棱镜副光束粗精两级扫描装置的扫描方法 | |
CN102063522B (zh) | 光电式头盔跟踪系统灯组布局优化方法 | |
CN114279397A (zh) | 一种基于旋转双棱镜的运动目标模拟器的装置与方法 | |
CN115752400A (zh) | 一种用于工程测量的多测站互联测量系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |