发明名称 一种基于冗余配置的捷联惯导系统单轴旋转调制方法
摘要 本发明的目的在于提供一种基于冗余配置的捷联惯导系统单轴旋转调制方法,采用一种四陀螺对称斜置式冗余配置方案装备捷联惯导系统,针对构成的四陀螺冗余系统特别设计了单轴连续旋转方案,根据系统方案计算等效在载体系上的陀螺仪测量值,将其带入系统进行导航解算,实时、连续地输出载体姿态、速度及位置导航参数。本发明不仅能够提高系统的可靠性,保证系统在单个陀螺仪发生故障时仍有效工作,而且还能够在不引入任何外部信息的条件下,消除由陀螺仪漂移引起的导航误差,进而提高系统的精度性能。该方法实现了导航系统更为全面的性能提升,在很大程度上保证系统长时间的有效工作,具有很高的工程应用价值。
申请公布号 CN105277213A 申请公布日期 2016.01.27
申请号 CN201510657877.2 申请日期 2015.10.13
申请人 哈尔滨工程大学 发明人 赵琳;管冬雪;牟宏杰;王通达;康瑛瑶;费再慧;董铭涛;刘萍;于东伟;蒋国桉
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 代理人
主权项 一种基于冗余配置的捷联惯导系统单轴旋转调制方法,其特征是:(1)捷联惯导系统的陀螺仪数量为四个,对四个陀螺仪的安装结构采用对称斜置式冗余配置方案,构成四陀螺冗余式捷联惯导系统;(2)安装四陀螺冗余式捷联惯导系统至载体,使系统初始工作时刻的坐标系oxyz与载体系重合,其中x轴、y轴和z轴分别对应于载体系中的右、前、上坐标轴;(3)对步骤(1)中的四陀螺冗余式惯导系统采用单轴连续旋转方案,构成四陀螺冗余式单轴旋转惯导系统;(4)将四陀螺冗余式单轴旋转惯导系统中的四个陀螺仪的测量值分别投影到坐标系oxyz上,并进一步计算在单轴连续旋转条件下载体系上陀螺仪的等效测量值;陀螺仪测量值变换到载体系下的测量方程为<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msubsup><mi>&omega;</mi><mrow><mi>i</mi><mi>b</mi></mrow><mi>b</mi></msubsup><mo>=</mo><msubsup><mi>C</mi><mi>s</mi><mi>b</mi></msubsup><msubsup><mi>&omega;</mi><mrow><mi>i</mi><mi>s</mi></mrow><mi>s</mi></msubsup></mrow>]]></math><img file="FDA0000820028640000011.GIF" wi="229" he="79" /></maths>式中,<img file="FDA0000820028640000012.GIF" wi="76" he="77" />为陀螺仪测量值变换到载体系下的测量值;<img file="FDA0000820028640000013.GIF" wi="68" he="72" />为由单轴旋转引起的坐标系oxyz到载体系的变换矩阵,即<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msubsup><mi>C</mi><mi>s</mi><mi>b</mi></msubsup><mo>=</mo><mfenced open = '[' close = ']'><mtable><mtr><mtd><mrow><msub><mi>cos&omega;</mi><mi>r</mi></msub><mi>t</mi></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>sin&omega;</mi><mi>r</mi></msub><mi>t</mi></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mrow><msub><mi>sin&omega;</mi><mi>r</mi></msub><mi>t</mi></mrow></mtd><mtd><mrow><msub><mi>cos&omega;</mi><mi>r</mi></msub><mi>t</mi></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000820028640000014.GIF" wi="574" he="230" /></maths><img file="FDA0000820028640000015.GIF" wi="72" he="70" />为冗余配置中四陀螺仪测量值投影至坐标系oxyz上的等效测量值,即<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msubsup><mi>&omega;</mi><mrow><mi>i</mi><mi>s</mi></mrow><mi>s</mi></msubsup><mo>=</mo><mfenced open = '[' close = ']'><mtable><mtr><mtd><mrow><mo>-</mo><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mo>-</mo><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mo>-</mo><mi>c</mi><mi>o</mi><mi>s</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd></mtr></mtable></mfenced><mfenced open = '[' close = ']'><mtable><mtr><mtd><msub><mi>&omega;</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&omega;</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&omega;</mi><mn>3</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&omega;</mi><mn>4</mn></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000820028640000016.GIF" wi="931" he="303" /></maths>ω<sub>r</sub>为捷联惯导系统单轴旋转角速率,即ω<sub>r</sub>=2π/T<sub>r</sub>;α为陀螺仪测量值等效至坐标系oxyz的变换矩阵参数,由四陀螺冗余配置结构决定α=54.73°;ω<sub>1</sub>、ω<sub>2</sub>、ω<sub>3</sub>和ω<sub>4</sub>分别为四个陀螺仪的测量值;(5)将步骤(4)计算得到的<img file="FDA0000820028640000021.GIF" wi="72" he="77" />代入导航解算过程,使系统实时连续地输出载体的姿态、速度和位置的导航信息,直至导航任务结束。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室