发明名称 一种惯组光学瞄准棱镜安装误差的标定方法
摘要 本发明提供了一种惯组光学瞄准棱镜安装误差的标定方法。该标定方法通过绕惯组光学瞄准棱镜的棱线转动几个位置,各个位置上使用固定在一处位置的自准直经纬仪与惯组光学瞄准棱镜准直。惯组的相对姿态依靠惯性导航解算提供,经纬仪视准轴的相对姿态可由码盘读数计算获得。依据各个位置上经纬仪与惯组光学瞄准棱镜准直的初始条件,建立包含惯组光学瞄准棱镜安装误差Z<sub>0</sub>(偏转量)、Y<sub>0</sub>(倾斜量)的多元超定方程组,求解多元超定方程组即可获取惯组光学瞄准棱镜的安装误差Y<sub>0</sub>、Z<sub>0</sub>。本发明的惯组转动过程中的姿态由惯性导航解算给出,转动过程可在普通平台上手动完成,对测试设备要求低,易于实现,标定参数全面,具有较强的通用性。
申请公布号 CN105910624A 申请公布日期 2016.08.31
申请号 CN201610302867.1 申请日期 2016.05.04
申请人 湖北航天技术研究院总体设计所 发明人 沈小龙;刘明;王安迪;胡华锋;杨道安
分类号 G01C25/00(2006.01)I;G01C1/06(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 代理人
主权项 一种惯组光学瞄准棱镜安装误差的标定方法,采用自准直经纬仪与惯组光学瞄准棱镜准直的方式进行标定,其特征在于标定过程中,惯组在各个标定位置上的相对姿态由惯性导航解算得出,通过以下步骤实现:(1)惯组放置在平台上,自准直经纬仪架设在惯组光学瞄准棱镜的正前方,且能够引入北向方位基准的位置,自准直经纬仪视准轴与惯组光学瞄准棱镜等高,距离0.5m~5m均可,惯组光学瞄准棱镜的棱线竖直,通光面朝向自准直经纬仪,调平自准直经纬仪。(2)连接惯组电缆通电加温至工作温度,启动惯组数据采集。(3)规划标定过程中的惯组静止位置,静止位置不少于3个。(4)在第1个静止位置,操作自准直经纬仪分别用正镜和倒镜与惯组光学瞄准棱镜准直,采集记录自准直经纬仪正镜的水平盘、竖盘读数H<sub>L1</sub>、V<sub>L1</sub>,倒镜水平盘、竖盘读数H<sub>R1</sub>、V<sub>R1</sub>。操作自准直经纬仪正镜瞄准北向方位基准,记录自准直经纬仪正镜的水平盘读数H<sub>LB</sub>和北向方位基准的北向方位角B<sub>0</sub>。(5)在第i个静止位置,操作自准直经纬仪分别用正镜和倒镜与惯组光学瞄准棱镜准直,采集记录自准直经纬仪正镜的水平盘、竖盘读数H<sub>Li</sub>、V<sub>Li</sub>,倒镜水平盘、竖盘读数H<sub>Ri</sub>、V<sub>Ri</sub>,测量完毕后,旋转惯组到下一位置,重复该步骤测量,直到最后一个位置测量完毕,当最后一个位置测量完毕后,停止惯组数据采集。(6)利用标定过程中惯组采集的数据进行导航计算。(7)计算第1位置时自准直经纬仪视准轴的北向方位角S<sub>T1</sub>,计算各个位置T系(自准直经纬仪坐标系)到L系的转角α<sub>i</sub>和自准直经纬仪视准轴的俯仰角β<sub>i</sub>,计算方法如下:S<sub>T1</sub>=B<sub>0</sub>+H<sub>L1</sub>‑H<sub>LB</sub><maths num="0001"><math><![CDATA[<mrow><msub><mi>H</mi><mi>i</mi></msub><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><mfrac><mrow><msub><mi>H</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>+</mo><msub><mi>H</mi><mrow><mi>R</mi><mi>i</mi></mrow></msub><mo>-</mo><mi>&pi;</mi></mrow><mn>2</mn></mfrac></mtd><mtd><mrow><mo>(</mo><msub><mi>H</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>&lt;</mo><msub><mi>H</mi><mrow><mi>R</mi><mi>i</mi></mrow></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>H</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>+</mo><msub><mi>H</mi><mrow><mi>R</mi><mi>i</mi></mrow></msub><mo>+</mo><mi>&pi;</mi></mrow><mn>2</mn></mfrac></mtd><mtd><mrow><mo>(</mo><msub><mi>H</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>&gt;</mo><msub><mi>H</mi><mrow><mi>R</mi><mi>i</mi></mrow></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FSA0000129731950000011.GIF" wi="692" he="259" /></maths><maths num="0002"><math><![CDATA[<mrow><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>=</mo><mfenced open = "{" close = ""><mtable><mtr><mtd><msub><mi>S</mi><mrow><mi>M</mi><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>S</mi><mrow><mi>T</mi><mn>1</mn></mrow></msub><mo>+</mo><mn>2</mn><msub><mi>k</mi><mn>1</mn></msub><mi>&pi;</mi><mo>(</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>)</mo></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>+</mo><mo>(</mo><msub><mi>H</mi><mi>i</mi></msub><mo>-</mo><msub><mi>H</mi><mn>1</mn></msub><mo>)</mo><mo>+</mo><mn>2</mn><msub><mi>k</mi><mi>i</mi></msub><mi>&pi;</mi><mo>(</mo><mi>i</mi><mo>&NotEqual;</mo><mn>1</mn><mo>)</mo></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FSA0000129731950000012.GIF" wi="661" he="150" /></maths><maths num="0003"><math><![CDATA[<mrow><msub><mi>&beta;</mi><mi>i</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>V</mi><mrow><mi>R</mi><mi>i</mi></mrow></msub><mo>-</mo><msub><mi>V</mi><mrow><mi>L</mi><mi>i</mi></mrow></msub><mo>-</mo><mi>&pi;</mi></mrow><mn>2</mn></mfrac></mrow>]]></math><img file="FSA0000129731950000013.GIF" wi="339" he="112" /></maths>式中:k<sub>i</sub>的取值为整数,其取值需保证α<sub>i</sub>的取值范围在(‑π,π];S<sub>T1</sub>为第1位置自准直经纬仪正镜准直时,其视准轴的北向方位角;S<sub>M1</sub>为第1位置M系‑Y轴的北向方位角;B<sub>0</sub>为北向方位基准的北向方位角;H<sub>LB</sub>为自准直经纬仪正镜瞄准北向方位基准时的水平盘读数;H<sub>Li</sub>、H<sub>Ri</sub>分别为第i位置时,自准直经纬仪正镜、倒镜的水平盘读数;V<sub>Li</sub>、V<sub>Ri</sub>分别为第i位置时,自准直经纬仪正镜、倒镜的竖盘读数;α<sub>i</sub>为第i位置时,T系绕Z轴沿最短路径转动到与L系重合时转动的角度;β<sub>i</sub>为第i位置时,自准直经纬仪视准轴俯仰角,在水平面上方为正,水平面下方为负。(8)根据各个位置上,惯性导航解算出惯组的相对基准和自准直经纬仪保持的相对基准,结合各个位置上自准直经纬仪视准轴与惯组光学瞄准棱镜准直的条件,建立包含惯组光学瞄准棱镜安装误差倾斜量Y<sub>0</sub>、偏转量Z<sub>0</sub>的多元超定方程:[Y<sub>0</sub>sin(γ<sub>i</sub>‑α<sub>i</sub>)+Z<sub>0</sub>cos(γ<sub>i</sub>‑α<sub>i</sub>)+ψ<sub>i</sub>cosα<sub>i</sub>‑θ<sub>i</sub>sinα<sub>i</sub>]=β<sub>i</sub>式中:Y<sub>0</sub>、Z<sub>0</sub>分别为惯组光学瞄准棱镜安装误差的倾斜量和偏转量,即惯组光学瞄准棱镜的安装误差;ψ<sub>i</sub>、θ<sub>i</sub>、γ<sub>i</sub>为i位置时,L系到M系的姿态矩阵<img file="FSA0000129731950000021.GIF" wi="74" he="61" />对应的欧拉角,转动顺序为Z、Y、X;α<sub>i</sub>为第i位置时,T系绕Z轴沿最短路径转动到与L系重合时转动的角度;β<sub>i</sub>为第i位置时,自准直经纬仪视准轴的俯仰角。(9)求解多元超定方程:[Y<sub>0</sub>sin(γ<sub>i</sub>‑α<sub>i</sub>)+Z<sub>0</sub>cos(γ<sub>i</sub>‑α<sub>i</sub>)+ψ<sub>i</sub>cosα<sub>i</sub>‑θ<sub>i</sub>sinα<sub>i</sub>]=β<sub>i</sub>,获取惯组光学瞄准棱镜的安装误差Y<sub>0</sub>、Z<sub>0</sub>。
地址 430040 湖北省武汉市金山大道9号
您可能感兴趣的专利