一种滚摆式导引头跟踪回路角增量优化方法

1.一种滚摆式导引头跟踪回路角增量优化方法，其特征在于，包括以下步骤：
当滚转框架的相对当前角位置运动范围绝对值小于等于π/2时，直接输出解算得到的滚转和摆动框架的角位置指令；
当滚转框架的相对当前角位置运动范围绝对值为(π/2,3π/2]时，将摆动框架的角位置指令取负号，然后控制滚转框架的相对当前角位置运动范围绝对值小于π/2；
当滚转框架的相对运动范围绝对值为(3π/2,2π)时，视滚转框架的限位情况优化输出指令，同样保证滚转框架相对当前角位置的运动范围绝对值小于π/2；
应用该方法时：
在失调角度比较小的情况下，滚转框架和摆动框架的控制角增量均可以用反正切函数来表示，
其中，f表示光学系统的焦距，单位是mm；Δθr表示滚转框架的控制角增量，单位是rad；
Δθp表示摆动框架的控制角增量，单位是rad；μ为像元尺寸，单位是mm；⊿y为目标在靶面上水平方向的脱靶量，⊿z为目标在靶面上竖直方向的脱靶量；
该方法具体包括以下步骤：
步骤i：按照式(1)的表示求出滚转框架和摆动框架角增量在[-π/2,π/2]值域内的表达式；
步骤ii：将滚转框架的角增量变换为[0,2π)值域内的表示，将摆动框架的角增量变换为[0,π/2]值域范围内的表示，将图像探测器输出的脱靶量转化为以滚转框架和摆动框架零位为起点的绝对角位置指令；
步骤iii：对绝对角位置指令进行分区，划分出多个子区域；
步骤iv：在每个子区域内分别优化输出的角增量指令；
所述步骤ii中，将摆动框架的角增量变换为[0,π/2]值域范围内的表示的表达式为：
式(2)中，θpi为摆动框架的角增量变换为[0,π/2]值域范围内摆动框架的绝对角位置指令值，θri为摆动框架的角增量变换为[0,π/2]值域范围内滚转框架的绝对角位置指令值；
所述步骤iii的对绝对角位置指令进行分区具体为两级逻辑判断：
在第一级逻辑判断中，判定条件为滚转框架的当前角位置θr，在[0,2π)范围内将θr按照象限的定义分为四个子区域；
在第二级逻辑判断中，判定条件为滚转框架的角增量值，由公式(2)解算出的绝对角位置指令与当前角位置相减即为判定条件；
所述步骤iii中，第二级逻辑判定中共有两个部分：第一级分区中的前三个象限为子区域I，第一级分区中的第四象限为子区域II；
在子区域I中，第二级逻辑判断的条件分别为δθr∈[-π/2,π/2]、δθr∈(π/2,3π/2]和其它；在子区域II中，第二级逻辑判断的条件分别为δθr∈[-π/2,π/2]、δθr∈[-3π/2,-π/2)和其它，其中，δθr为滚转框架绝对角位置指令θri与滚转框架当前角位置θr相减；
所述步骤iv具体为：
子区域I中指令的优化输出为：
子区域II中指令的优化输出为：
其中，θrc为用于控制滚转框架的最终优化完成的滚转框架的角增量指令，θpc为用于控制滚转框架的最终优化完成的摆动框架的角增量指令。

暂无