基于光纤陀螺的光电平台姿态检测方法技术

本发明专利技术提出一种基于光纤陀螺的光电平台姿态检测方法，采用正交安装的三只光纤陀螺及正交安装的三只加速度计组成IMU组件，IMU组件安装在光电平台上，且IMU组件能够绕光电平台俯仰轴和方位轴转动上，跟随俯仰轴运动。姿态测量系统通过采样IMU的输出信号，解算得到IMU的空间方位角度、姿态角度。再通过光电稳定平台的方位轴和俯仰轴的测角机构，测出姿态测量系统相对光电稳定平台的相对空间关系，计算获得光电稳定平台的方位角度、姿态角度。

【技术实现步骤摘要】
基于光纤陀螺的光电平台姿态检测方法
本专利技术属于光电检测领域，是一种基于光纤陀螺的光电平台姿态检测方法。该方法利用安装在光电平台上的惯性测量器件组成的测量单元，实现军用光电平台的姿态检测。
技术介绍
随着信息技术、智能弹药、远程打击等技术的发展，各种光电平台系统已经进入了信息化阶段。因此，对武器系统的打击精度、攻击距离、信息共享、反应时间、机动能力都提出更高的要求。传统光电平台系统，只在停下来进行目标观察瞄准时能保障精度，而动态情况下的精度难以满足指标要求。因此，为这些光电平台系统提供姿态信息，配备姿态测量系统是一个重要的解决方案。光电平台必须要了解自身载体的方位角、俯仰角和侧倾角等姿态信息，然后才能为光电系统观察目标、确定目标位置和方位、锁定目标，提供精确的修正量；尤其是间接瞄准观察目标时，它可以根据前方观察者、后方使用者、目标位置等信息，调整平台的姿态，间接测量出目标的地理信息。通过姿态测量系统精确测出光电平台在运动中的方位角度、姿态角度等信息，使观察人员能够获得良好的观瞄、操作能力，进行目标锁定。同时，可以将光电平台的运动数据发送到其它信息单元，用于进行各种补偿解算，提高观瞄精度。姿态测量及为观瞄线相结合具有明显优势：首先，高精度陀螺稳定的光电平台漂移量小；其次，动态稳定性能好，可以实现自动目标跟踪功能，观瞄装置可以在行进中稳定的跟踪目标。我国该项技术的发展与国外还有较大的差距，因此，需要提出新的姿态测量方法，为新型光电稳定平台在各种载体平台的发展提供原理分析和技术支撑。
技术实现思路
本专利技术针对光电稳定平台的姿态检测和在未来装备中的使用问题，面向光电稳定平台的姿态检测需求，提供一种基于光纤陀螺的光电平台姿态检测方法。本专利技术的技术方案为：所述一种基于光纤陀螺的光电平台姿态检测方法，其特征在于：采用正交安装的三只光纤陀螺及正交安装的三只加速度计组成IMU组件，IMU组件安装在光电平台上，且IMU组件能够绕光电平台方位轴和俯仰轴转动，并用过以下步骤进行光电平台姿态检测：步骤1：对IMU组件进行初始对准：控制IMU组件绕光电平台方位轴转动，得到IMU组件转动0度，90度，180度和270度时刻的输出：0度位置三个陀螺输出和三个加速度计输出90度位置三个陀螺输出和三个加速度计输出180度位置三个陀螺输出和三个加速度计输出270度位置三个陀螺输出和三个加速度计输出并得到IMU组件当前姿态和方位角度为：俯仰角度：倾斜角度：方位角度：其中L是光电平台所处的纬度，g为重力加速度，wie为地球的自转角速率；建立IMU组件的初始捷联矩阵并对四元数矩阵Q＝[q0q1q2q3]进行初始化：q0＝cos(α/2)cos(β/2)cos(γ/2)-sin(α/2)sin(β/2)sin(γ/2)，q1＝cos(α/2)sin(β/2)cos(γ/2)+sin(α/2)cos(β/2)sin(γ/2)，q2＝cos(α/2)cos(β/2)sin(γ/2)-sin(α/2)sin(β/2)cos(γ/2)，q3＝-sin(α/2)cos(β/2)cos(γ/2)+cos(α/2)sin(β/2)sin(γ/2)；在初始对准后，光电稳定平台的方位角α2、俯仰角度为β2、倾斜角度γ2与IMU组件的方位角α、俯仰角度为β、倾斜角度γ对应相同；步骤2：采用以下步骤对初始对准后的IMU组件进行方位和姿态测量：步骤2.1：根据三个陀螺在当前采样周期的测量数据ωe2＝[ωe2xωe2yωe2z]以及在上一采样周期的测量数据ωe1＝[ωe1xωe1yωe1z]，得到角度增量E1，E2：E1＝(ωe1-ωin)×h，E2＝(ωe2-ωin)×h其中h为采样周期，ωin通过以下公式计算：Vx为光电平台相对大地坐标系的东向运动速度，Vy为光电平台相对大地坐标系的北向运动速度，R为地球半径；步骤2.2：根据角度增量E1，E2计算向量得到四元数增量其中向量模值步骤2.3：根据得到的四元数增量Qh更新四元数：Qk＝Qk-1·Qh其中Qk-1为上一采样周期得到的四元数，Qk为当前采样周期更新后的四元数，Qk＝[q0kq1kq2kq3k]；步骤2.4：根据更新后的四元数Qk得到当前采样周期IMU组件的捷联矩阵：步骤2.5：根据当前采样周期IMU组件的捷联矩阵得到当前采样周期IMU组件的方位角度和姿态角度：俯仰角度：倾斜角度：方位角度：其中步骤3：采用以下步骤测量光电平台方位和姿态测量：步骤3.1：由光电平台得到当前采样周期IMU组件相对光电平台的方位角度α1k、俯仰角度β1k，计算从IMU组件到光电平台的姿态转换矩阵进一步得到当前采样周期光电平台相对大地坐标系的捷联矩阵步骤3.2：根据当前采样周期光电平台相对大地坐标系的捷联矩阵Cbk得到当前采样周期光电平台的方位角度和姿态角度：俯仰角度：β2k＝sin-1(Cbk(3,2))，倾斜角度：方位角度：其中有益效果本专利技术使用安装在光电平台俯仰轴上的惯性测量器件组成的测量单元，结合光电稳定平台的测角装置，实现光电稳定平台的姿态精确检测。附图说明图1是本专利技术中姿态测量方法的原理框图。具体实施方式下面结合具体实施例描述本专利技术：采用正交安装的三只光纤陀螺及正交安装的三只加速度计组成IMU组件，IMU组件安装在光电平台上，且IMU组件能够绕光电平台俯仰轴和方位轴转动上，跟随俯仰轴运动。姿态测量系统通过采样IMU的输出信号，解算得到IMU的空间方位角度、姿态角度。再通过光电稳定平台的方位轴和俯仰轴的测角机构，测出姿态测量系统相对光电稳定平台的相对空间关系，计算获得光电稳定平台的方位角度、姿态角度。具体光电平台姿态检测步骤如下：步骤1：对IMU组件进行初始对准：光纤陀螺姿态测量系统在进行姿态测量解算之前，系统需要进行初始对准。初始对准采用四位置初始对准的方式进行，四位置对准通过0度和180度，90度和270度位置对应数据相减，可以有效减少开机重复性的误差影响和零位偏置误差。在四位置初始对准过程中，采用机械结构的限位方式来提高转动定位精度和位置归零重复精度，即到位的最终结果是由结构来保证，电机在初始对准过程中起驱动作用和较低精度的到位控制作用。这样可以降低转位控制的要求，以及提高转位重复精度，以满足系统初始对准指标的要求。控制IMU组件绕光电平台方位轴转动，得到IMU组件转动0度，90度，180度和270度时刻的输出：0度位置三个陀螺输出和三个加速度计输出90度位置三个陀螺输出和三个加速度计输出180度位置三个陀螺输出和三个加速度计输出270度位置三个陀螺输出和三个加速度计输出通过得到的陀螺和加速度计数据，得到IMU组件当前姿态和方位角度为：俯仰角度：倾斜角度：方位角度：其中L是光电平台所处的纬度，g为重力加速度，wie为地球的自转角速率；建立IMU组件的初始捷联矩阵并对四元数矩阵Q＝[q0q1q2q3]进行初始化：q0＝cos(α/2)cos(β/2)cos(γ/2)-sin(α/2)sin(β/2)sin(γ/2)，q1＝cos(α/2)sin(β/2)cos(γ/2)+sin(α/2)cos(β/2)sin(γ/2)，q2＝cos(α/2)cos(β/2)sin(γ/2)-sin(α/2)sin(β/2)cos(本文档来自技高网...

【技术保护点】
一种基于光纤陀螺的光电平台姿态检测方法，其特征在于：采用正交安装的三只光纤陀螺及正交安装的三只加速度计组成IMU组件，IMU组件安装在光电平台上，并用过以下步骤进行光电平台姿态检测：步骤1：对IMU组件进行初始对准：控制IMU组件绕光电平台方位轴转动，得到IMU组件转动0度，90度，180度和270度时刻的输出：0度位置三个陀螺输出ωibx1ωiby1ωibz1]]>和三个加速度计输出fibx1fiby1fibz1,]]>90度位置三个陀螺输出ωibx2ωiby2ωibz2]]>和三个加速度计输出fibx2fiby2fibz2,]]>180度位置三个陀螺输出ωibx3ωiby3ωibz3]]>和三个加速度计输出fibx3fiby3fibz3,]]>270度位置三个陀螺输出ωibx4ωiby4ωibz4]]>和三个加速度计输出fibx4fiby4fibz4;]]>并得到IMU组件当前姿态和方位角度为：俯仰角度：β=0.5×(arcsinfiby1-fiby3-2g+arcsinfibx2-fibx4-2g),]]>倾斜角度：γ=0.5×(arcsinfibx1-fibx32gcosβ+arcsinfiby2-fiby4-2gcosβ),]]>方位角度：α=arctan[(ωibx1-ωibx32+wiesinLsinγcosβωibx2-ωibx42-wiesinLsinβ-sinγtanβ)cosβcosγ]]]>其中L是光电平台所处的纬度，g为重力加速度，wie为地球的自转角速率；建立IMU组件的初始捷联矩阵CIMU0e=cosγcosα-sinγsinβsinα-cosβsinαsinγcosα+cosγsinβsinαcosγsinα+sinγsinβcosαcosβcosαsinγsinα-cosγsinβcosα-sinγcosβsinβcosγcosβ]]>并对四元数矩阵Q＝[q0 q1 q2 q3]进行初始化：q0＝cos(α/2)cos(β/2)cos(γ/2)‑sin(α/2)sin(β/2)sin(γ/2)，q1＝cos(α/2)sin(β/2)cos(γ/2)+sin(α/2)cos(β/2)sin(γ/2)，q2＝cos(α/2)cos(β/2)sin(γ/2)‑sin(α/2)sin(β/2)cos(γ/2)，q3＝‑sin(α/2)cos(β/2)cos(γ/2)+cos(α/2)sin(β/2)sin(γ/2)；在初始对准后，光电稳定平台的方位角α2、俯仰角度为β2、倾斜角度γ2与IMU组件的方位角α、俯仰角度为β、倾斜角度γ对应相同；步骤2：采用以下步骤对初始对准后的IMU组件进行方位和姿态测量：步骤2.1：根据三个陀螺在当前采样周期的测量数据ωe2＝[ωe2x ωe2y ωe2z]以及在上一采样周期的测量数据ωe1＝[ωe1x ωe1y ωe1z]，得到角度增量E1，E2：E1＝(ωe1‑ωin)×h，E2＝(ωe2‑ωin)×h其中h为采样周期，ωin通过以下公式计算：ωin=-VyRwiecosL+VxRwiesinL+VxRtanL]]>Vx为光电平台相对大地坐标系的东向运动速度，Vy为光电平台相对大地坐标系的北向运动速度，R为地球半径；步骤2.2：根据角度增量E1，E2计算向量φ^=φxφyφz:]]>φ^=E1+E2+23E1×E2]]>得到四元数增量Qh=cos(φ02)φxφ0sin(φ02)φyφ0sin(φ02)φzφ0sin(φ02),]]>其中向量模值φ0=φ^Tφ^;]]>步骤2.3：根据得到的四元数增量Qh更新四元数：Qk＝Qk‑1·Qh其中Qk‑1为上一采样周期得到的四元数，Qk为当前采样周期更新后的四元数，Qk＝[q0k q1k q2k...

【技术特征摘要】
1.一种面向复合材料铺层单元数控下料工序的展开轮廓线修正方法，其特征在于：包括以下步骤：步骤1：通过以下步骤1.a对不闭合的铺层单元SP展开轮廓CU进行封闭化处理，得到封闭的展开轮廓CC，所述封闭的展开轮廓CC由直线段LL、圆弧段LC和样条线LS组成；并通过以下步骤1.b对展开轮廓CC中圆弧段LC和样条线LS进行离散，分别用直线段连接相邻离散点，得到只由直线段组成的封闭展开轮廓步骤1.a：铺层单元SP经CAD展开软件展开得到展开轮廓CU，对于展开轮廓CU中所有不闭合处的两个线段端点，均采用直线段连接相应的两个线段端点，得到新的展开轮廓CC；步骤1.b：对展开轮廓CC中圆弧段LC和样条线LS进行离散，得到圆弧段LC和样条线LS离散点分别为用直线段分别连接圆弧段LC和样条线LS中的相邻离散点，分别得到近似逼近圆弧段LC和样条线LS的多边形LPS与展开轮廓CC中直线段LL共同构成新的展开轮廓步骤2：采用以下步骤2.a和步骤2.b删除展开轮廓线中在同一直线段上的点，得到新的展开轮廓线步骤2.a：以展开轮廓线CLU中任一连接点Pi(i＝3,4…I)为开始点，沿同一方向对展开轮廓CLU进行搜索，判断搜索方向上连接点Pi(3≤i≤I)到线段Pi-2Pi-1的距离是否满足条件公式中对应点坐标为Pi(xi,yi)、Pi-1(xi-1,yi-1)、Pi-2(xi-2,yi-2)；满足上述条件的连接点Pi为无效连接点PiN，不满足上述条件的连接点Pi为有效连接点PiP；步骤2.b：若连接点Pi为无效连接点PiN，则将线...

【专利技术属性】
技术研发人员：贺峻峰，张建峰，许开銮，李颖娟，朱建军，康婷颋，陈红，康臻，周国良，梁庆仟，杨萌，张夏江，易科，陈颍，
申请(专利权)人：西安应用光学研究所，
类型：发明
国别省市：陕西;61