CN103630135B - 一种角速率输入的姿态算法结构与参数优化方法 - Google Patents
一种角速率输入的姿态算法结构与参数优化方法 Download PDFInfo
- Publication number
- CN103630135B CN103630135B CN201310632713.5A CN201310632713A CN103630135B CN 103630135 B CN103630135 B CN 103630135B CN 201310632713 A CN201310632713 A CN 201310632713A CN 103630135 B CN103630135 B CN 103630135B
- Authority
- CN
- China
- Prior art keywords
- circular cone
- error compensation
- cone error
- sin
- item
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种新的角速率输入的姿态算法结构与参数优化方法,针对传统角速率输入的姿态算法圆锥误差补偿结构不能充分利用已有角速率信息的问题,提出了一种改进的姿态算法圆锥误差补偿结构,从而给出一种新的角速率输入的姿态算法结构;在定义经典圆锥运动形式和分析几个必要的圆锥运动特性的基础上,对提出的姿态算法圆锥误差补偿结构进行简化处理,获得了一种压缩的姿态算法圆锥误差补偿结构;定义了圆锥误差补偿误差准则,并推导了该误差准则的具体描述;选定了圆锥误差补偿优化目标和方法并实施了圆锥误差补偿结构参数的优化设计,获得一种新的角速率输入的带有圆锥误差补偿结构优化参数的姿态算法,使捷联惯导姿态解算综合性能得到提高。
Description
技术领域
本发明涉及一种角速率输入的姿态算法结构与参数优化方法,属于惯性导航技术领域。
背景技术
自20世纪50年代末捷联惯性导航系统的概念被提出以来,经过50多年的发展,捷联惯导系统已经广泛应用于国防、交通等多个领域。总的来说,高精度的捷联惯导系统的性能主要依赖于两个方面:高精度的惯性器件和导航算法。所以,研究获得高精度的捷联惯性导航算法是诸多捷联惯导领域的学者们持续追求的目标之一,其中捷联惯导姿态算法是这一目标的首要任务。
自1971年后,捷联惯导姿态算法的设计工作均集中在获得一种近似积分旋转矢量微分方程的方法上。自1983年后,Miller、Ignagni和Savage等陆续将时域泰勒级数展开方法、频域泰勒级数展开方法和最小二乘方法等方法应用于传统的角增量输入的双速捷联惯导姿态算法结构上,进行姿态算法圆锥误差补偿的优化设计;自2000年后,黄昊、曾庆化和汤传业等先后将频域泰勒级数展开方法和最小二乘方法等方法应用于纯角速率输入的双速捷联惯导姿态算法结构,进行姿态算法圆锥误差补偿的优化设计,但姿态算法中所采用的圆锥误差补偿结构不甚合理,在圆锥误差补偿设计时未能考虑已有的由角速率拟合的角增量信息,导致圆锥误差补偿算法、姿态算法乃至整个捷联惯性导航系统的精度不能达到应有的水平。
发明内容
发明目的:针对上述现有技术,提出一种角速率输入的姿态算法结构与参数优化方法,在此基础上,能够更好的补偿姿态算法中的圆锥误差,从而获得一种高精度的捷联惯导姿态算法。
技术方案:一种角速率输入的姿态算法结构与参数优化方法,包括以下步骤:
步骤(1),建立用于角速率输入的姿态算法的圆锥误差补偿结构:
在一个姿态更新周期内,以拟合角增量子样周期为时间间隔顺序抽取角速率采样值,并拟合角增量子样;然后,建立用于姿态更新的更新旋转矢量的解算形式和圆锥误差补偿结构;
步骤(2),简化所述圆锥误差补偿结构,得到压缩圆锥误差补偿结构:
定义经典圆锥运动,忽略角增量子样的拟合误差,并只考虑角速率采样叉乘项、角增量子样叉乘项、角速率采样与角增量子样叉乘项的各自在x轴上的第一个分量,建立压缩圆锥误差补偿结构,得到压缩圆锥误差补偿项;
步骤(3),基于步骤(2)所述的压缩圆锥误差补偿结构,建立角速率输入的圆锥误差补偿误差准则:
定义圆锥误差补偿项误差为圆锥误差补偿项的理论值与数值计算值在误差矢量的第一个轴向分量上的分量差;
步骤(4),建立圆锥误差补偿结构参数优化目标和圆锥误差补偿结构参数优化方法:
圆锥误差补偿优化设计的目标:使圆锥误差补偿项误差的绝对数值达到最小;
圆锥误差补偿结构参数优化设计方法是:根据所述目标,将圆锥误差补偿项误差展开成关于圆锥频率参数的幂级数,令幂级数前3N-1个低阶项的系数为零,并求解得到的线性方程组,得到优化的圆锥误差补偿系数;其中N为一个姿态更新周期包含的拟合角增量子样周期数。
作为本发明的优选方案,所述步骤(1)中建立用于角速率输入的姿态算法的圆锥误差补偿结构具体步骤如下:首先,定义姿态更新周期的开始时刻为tl-1,结束时刻为tl,姿态更新周期为Tl,拟合角增量子样周期为Tk,角速率采样周期为T;其中,一个姿态更新周期包含的拟合角增量子样周期数为N,即Tl=NTk;拟合一个角增量所用的顺序角速率采样数为M+1,即Tk=MT;从时刻tl-1开始在一个姿态更新周期内,即时间区间[tl-1,tl]内以Tk为时间间隔顺序抽取的第i+1个角速率采样值为ωi,其中按照时间发生的先后顺序,i取值为0,1,..,N;从时刻tl-1开始在一个姿态更新周期内,即时间区间[tl-1,tl]内使用时间区间[tl-1+(k-1)Tk,tl-1+kTk]内的角速率采样值拟合的第k个角增量子样为Δαk,其中按照时间发生的先后顺序,k取值为1,2,..,N;然后,给出用于姿态更新的更新旋转矢量的解算形式和圆锥误差补偿结构:所述更新旋转矢量φl为φl=αl+δφl,所述圆锥误差补偿项δφl为 其中,αl为一个姿态更新周期内总的拟合角增量,ηij、μij和ξij分别为对应于角速率采样叉乘项、角增量子样叉乘项和角速率采样与角增量子样叉乘项的圆锥误差补偿系数,i、j和k为符号下标。
步骤(2)简化所述圆锥误差补偿结构,得到压缩圆锥误差补偿结构的具体步骤如下:定义经典圆锥运动Φ(t)=[0acosΩtasinΩt]T,其中t为时刻,Φ(t)为载体系相对参考系在t时刻的旋转矢量,并将载体系定义为b系,将参考系定义为n系,a为半锥角,Ω为圆锥运动频率,[]T为[]的转置;在此基础上,定义t时刻b系相对于n系的角速度在b系下的投影为: 令角速度采样值其中i=0,1,...,N,忽略角增量子样Δαj的拟合误差,并令其中j=1,2,...,N,得到角速率采样叉乘项ωi×ωj的第一个分量[ωi×ωj]x等于Ω2sin2asin[(j-i)ΩTk],角增量子样叉乘项Δαi×Δαj的第一个分量[Δαi×Δαj]x等于角速率采样与角增量子样叉乘项ωi×Δαj的第一个分量[ωi×Δαj]x等于只考虑角速率采样叉乘项、角增量子样叉乘项、角速率采样与角增量子样叉乘项的各自在x轴向上的第一个分量,所述圆锥误差补偿项δφl的补偿结构简化压缩为:
Cq为与ξij相当的圆锥误差补偿系数,在量值上等于所有的ξ(i-q),i-ξi,(i-q+1)之和。
步骤(3)基于步骤(2)所述的压缩圆锥误差补偿结构,建立角速率输入的圆锥误差补偿误差准则的具体步骤如下:在圆锥运动条件下,圆锥误差补偿项数值计算误差表现为,误差矢量的第一个轴向分量是常值分量,其余两个轴向分量是周期分量,并将误差矢量的第一个轴向定义为x轴;定义圆锥误差补偿项误差e为圆锥误差补偿项的理论值与数值计算值在x轴上的分量之差,即其中,δφx为更新旋转矢量圆锥误差补偿项理论值在x轴上的分量,为更新旋转矢量圆锥误差补偿项数值计算值在x轴上的分量;圆锥误差补偿项理论值在x轴上的分量δφx等于将所述叉乘项分量[ωi×ωj]x、[Δαi×Δαj]x和[ωi×Δαj]x的分析表达式代入圆锥误差补偿形式的压缩结构 中,得到圆锥误差补偿项数值计算值在x轴上的分量为
从而导出圆锥误差补偿项误差e为:
其中β为与角增量子样周期Tk有关的圆锥频率参数。
所述步骤(4)中建立圆锥误差补偿结构参数优化目标和圆锥误差补偿结构参数优化方法的具体步骤为:圆锥误差补偿优化设计的目标是:使圆锥无差补偿项误差e的绝对数值达到最小;圆锥误差补偿结构参数优化设计方法是:根据三角函数关系式sin2(β/2)=(1-cosβ)/2,所述圆锥误差补偿项误差e得到为如下形式:
再根据三角级数关系式 和 得到圆锥误差补偿项误差e关于圆锥频率参数β的幂级数形式表达式:
令圆锥误差补偿项误差e关于β的幂级数项β2k+1的系数为零,k=1,2,...,3N-1;得到线性方程组:
k=1,2,...,3N-1;解该线性方程组,得到优化的圆锥误差补偿系数An、Bp和Cq。
有益效果:(1)为获得高精度的捷联惯导姿态算法,本发明从改进姿态解算结构入手:
对传统的角速率输入的捷联惯导姿态算法结构中的圆锥误差补偿结构做深入的改进,设计一种新的圆锥误差补偿结构。新的角速率输入的圆锥误差补偿结构中不仅包括了原有角速率采样信息,而且还包括了新的拟合角增量信息。关于角速率采样序列和拟合角增量序列在时间上的分布关系,可设定的方式有很多种,本发明中使用的角速率采样序列ωi(i=0,1,...,N)和拟合角增量序列Δαj(j=1,2,...,N)为同步等时间间隔关系,且在一个姿态更新周期内用于圆锥误差补偿的角速率采样数比拟合角增量数大1个,如图2所示;
(2)优化设计圆锥误差补偿结构中的待定参数,以获得尽可能高的圆锥误差补偿精度:
基于圆锥运动特性,简化新设计的姿态算法圆锥误差补偿结构,得到压缩的圆锥误差补偿结构,以方便圆锥误差补偿结构参数优化设计过程的实施;
实施圆锥误差补偿结构参数的优化设计:基于压缩的圆锥误差补偿结构,定义圆锥误差补偿项误差;将圆锥误差补偿项误差展开成关于圆锥频率参数β的幂级数,令幂级数前3N-1个低阶项的系数为零,并求解得到的线性方程组,得到优化的圆锥误差补偿系数;其中N为一个姿态更新周期包含的拟合角增量子样周期数。
综上所述,本发明采用的角速率输入的姿态算法圆锥误差补偿结构充分考虑了角速率采样和拟合角增量子样信息的充分利用问题,从而为捷联惯导姿态解算提供一个优越的框架基础。同时,采用提出的姿态算法圆锥误差补偿结构简化处理方法,获得了姿态算法圆锥误差补偿结构的压缩形式,使圆锥误差补偿结构参数优化过程更简单。采用选定的圆锥误差补偿优化方法获得的圆锥误差补偿结构优化参数具有很好的适用性,使得带有圆锥误差补偿结构优化参数的姿态算法的综合性能得到提高。
附图说明
图1为本发明方法的流程图;
图2为角速率采样序列与拟合角增量序列分布关系示意图;
图3为姿态更新周期、拟合角增量子样周期和角速率采样周期之间的关系示意图。
具体实施方式
下面结合附图对本发明做更进一步的解释。
一种角速率输入的姿态算法结构与参数优化方法,包括以下步骤:
步骤(1),建立用于角速率输入的姿态算法的圆锥误差补偿结构:
在一个姿态更新周期内,以拟合角增量子样周期为时间间隔顺序抽取角速率采样值,并拟合角增量子样;然后,建立用于姿态更新的更新旋转矢量的解算形式和圆锥误差补偿结构;
步骤(2),简化所述圆锥误差补偿结构,得到压缩圆锥误差补偿结构:
定义经典圆锥运动,忽略角增量子样的拟合误差,并只考虑角速率采样叉乘项、角增量子样叉乘项、角速率采样与角增量子样叉乘项的各自在x轴上的第一个分量,建立压缩圆锥误差补偿结构,得到压缩圆锥误差补偿项;
步骤(3),基于步骤(2)所述的压缩圆锥误差补偿结构,建立角速率输入的圆锥误差补偿误差准则:
定义圆锥误差补偿项误差为圆锥误差补偿项的理论值与数值计算值在误差矢量的第一个轴向分量上的分量差;
步骤(4),建立圆锥误差补偿结构参数优化目标和圆锥误差补偿结构参数优化方法:
圆锥误差补偿优化设计的目标:使圆锥误差补偿项误差的绝对数值达到最小;
圆锥误差补偿结构参数优化设计方法是:根据所述目标,将圆锥误差补偿项误差展开成关于圆锥频率参数β的幂级数,令幂级数前3N-1个低阶项的系数为零,并求解得到的线性方程组,得到优化的圆锥误差补偿系数;其中N为一个姿态更新周期包含的拟合角增量子样周期数。
其中,步骤(1)中建立用于角速率输入的姿态算法的圆锥误差补偿结构具体步骤如下:
首先,定义姿态更新周期的开始时刻为tl-1,结束时刻为tl,姿态更新周期为Tl,拟合角增量子样周期为Tk,角速率采样周期为T;其中,一个姿态更新周期包含的拟合角增量子样周期数为N,即Tl=NTk;拟合一个角增量所用的顺序角速率采样数为M+1,即Tk=MT;从时刻Tl-1开始在一个姿态更新周期内,即时间区间[tl-1,tl]内以Tk为时间间隔顺序抽取的第i+1个角速率采样值为ωi,其中按照时间发生的先后顺序,i取值为0,1,...,N;从时刻tl-1开始在一个姿态更新周期内,即时间区间[tl-1,tl]内使用时间区间[tl-1+(k-1)Tk,tl-1+kTk]内的角速率采样值拟合的第k个角增量子样为Δαk,其中按照时间发生的先后顺序,k取值为1,2,...,N;然后,给出用于姿态更新的更新旋转矢量的解算形式和圆锥误差补偿结构:
现代捷联惯导系统中使用的经典姿态更新数值计算通式为:
其中, 和分别为第l-1个和第l个更新周期结束时刻载体的姿态矩阵,和分别为第l个更新周期内的更新姿态矩阵和数值更新旋转矢量,为的各元素构成的叉乘反对称矩阵,|·|为取模值。
新的角速率输入的更新旋转矢量解算形式和圆锥误差补偿结构为:
φl=αl+δφl(5);
其中,αl为一个姿态更新周期内总的拟合角增量, Tk=MT,[s0s1…sM]=HC-1,H=[11/2…1/(M+1)],
其中,其中Δαk为第l个姿态更新周期内的第k个拟合角增量子样,为第k个拟合角增量子样周期内的第m+1个角速率采样,Tk为姿态更新周期内的拟合角增量子样时间间隔(即拟合角增量子样周期),T为固定的角速率采样时间间隔,N为一个姿态更新周期内的拟合角增量子样数,M为一个拟合角增量子样周期内用于拟合Δαk的顺序角速率采样的个数,sk为使用角速率采样对Δαk进行近似的拟合系数;
圆锥误差补偿项δφl为:
其中,ηij、μij和ξij分别为对应于角速率采样叉乘项、角增量子样叉乘项和角速率采样与角增量子样叉乘项的圆锥误差补偿系数,i、j和k为符号下标。记ω0为第1个角增量子样周期内第1个角速率采样记ωk为第k个角增量子样周期内最后一个角速率采样姿态更新周期、拟合角增量子样周期和角速率采样周期之间的关系如图3所示。
步骤(2)简化所述圆锥误差补偿结构,得到压缩圆锥误差补偿结构的具体步骤如下:
定义经典圆锥运动形式为:
Φ(t)=[0acosΩtasinΩt]T(1)
其中t为时刻,Φ(t)为载体系(定义为b系)相对参考系(定义为n系)在t时刻的旋转矢量,a为半锥角,Ω为圆锥运动频率,[]T为[]的转置。
则时间区间[t,t+Tl]内的更新旋转矢量的近似分析表达式
在此基础上,与式(1)定义的圆锥运动相一致,定义t时刻b系相对于n系的角速度在b系下的投影为:
在b系下令角速度采样值ωi为其中i=0,1,..,N;当角速率采样频率足够高时,忽略角增量子样Δαj的拟合误差,并令其中j=1,2,...,N,得到角速率采样叉乘项ωi×ωj的在x轴向上的第一个分量[ωi×ωj]x为
[ωi×ωj]x=Ω2sin2asin[(j-i)ΩTk](8),
角增量子样叉乘项在x轴向上的Δαi×Δαj的第一个分量[Δαi×Δαj]x为
角速率采样与角增量子样叉乘项ωi×Δαj在x轴向上的的第一个分量[ωi×Δαj]x为
显然,式(8)、式(9)和式(10)中的叉乘项在x轴向上的分量与j-i有关,而与i、j无关,若只考虑x轴向上的第一分量,式(7)描述的圆锥误差补偿项δφl的补偿结构简化压缩为:
其中,An为与ηij相当的圆锥误差补偿系数,在量值上等于所有的η(i-n),i之和;Bp为与μij相当的圆锥误差补偿系数,在量值上等于所有的μ(i-p),i之和;Cq为与ξij相当的圆锥误差补偿系数,在量值上等于所有的ξ(i-q),i-ξi,(i-q+1)之和; k=1,2,...,M。
步骤(3)基于步骤(2)所述的压缩圆锥误差补偿结构,建立角速率输入的圆锥误差补偿误差准则的具体步骤如下:
在圆锥运动条件下,圆锥误差补偿项数值计算误差表现为,误差矢量的第一个轴向分量是常值分量,其余两个轴向分量是周期分量,并将误差矢量的第一个轴向定义为x轴;定义圆锥误差补偿项误差e为圆锥误差补偿项的理论值与数值计算值在x轴上的分量之差,即其中,δφx为更新旋转矢量圆锥误差补偿项理论值在x轴上的分量,为更新旋转矢量圆锥误差补偿项数值计算值在x轴上的分量。
根据式(2),时间区间[tl-1,tl-1+Tl]内的圆锥误差补偿项理论值在x轴上的分量δφx为:
将所述叉乘项分量[ωi×ωj]x、[Δαi×Δαj]x和[ωi×Δαj]x的分析表达式:式(8)、式(9)和式(10)代入圆锥误差补偿形式的压缩结构式(11)中,得到圆锥误差补偿项数值计算值δφl在x轴上的分量为:
从而导出圆锥误差补偿项误差e为:
其中β=ΩTk,β为与角增量子样周期Tk有关的圆锥频率参数。
步骤(4)中建立圆锥误差补偿结构参数优化目标和圆锥误差补偿结构参数优化方法的具体步骤为:
圆锥误差补偿优化设计的目标是:使圆锥无差补偿项误差e的绝对数值达到最小;圆锥误差补偿结构参数优化设计方法是:根据三角函数关系式sin2(β/2)=(1-cosβ)/2,有
再根据式(15)和式(16)描述的关系,圆锥误差补偿项误差e式(14)可写为:
再根据三角级数关系式:
得到圆锥误差补偿项误差e式(17)关于圆锥频率参数β的幂级数形式表达式:
令圆锥误差补偿项误差e关于β的幂级数项β2k+1的系数为零,k=1,2,..,3N-1;得到线性方程组:
其中,k=1,2,...,3N-1;解由式(21)给出的线性方程组,得到优化的圆锥误差补偿系数An、Bp和Cq。
至此,获得一种由式(4)、式(5)、式(6)和式(7)共同描述并附加由式(21)确定的圆锥误差补偿系数的捷联惯导姿态算法,以及获得一种单独由式(7)描述的捷联惯导圆锥误差补偿结构。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (4)
1.一种角速率输入的姿态算法结构与参数优化方法,其特征在于包括以下步骤:
步骤(1),建立用于角速率输入的姿态算法的圆锥误差补偿结构:
在一个姿态更新周期内,以拟合角增量子样周期为时间间隔顺序抽取角速率采样值,并拟合角增量子样;然后,建立用于姿态更新的更新旋转矢量的解算形式和圆锥误差补偿结构;
所述建立用于角速率输入的姿态算法的圆锥误差补偿结构具体步骤如下:首先,定义姿态更新周期的开始时刻为结束时刻为姿态更新周期为拟合角增量子样周期为Tk,角速率采样周期为T;其中,一个姿态更新周期包含的拟合角增量子样周期数为N,即拟合一个角增量所用的顺序角速率采样数为M+1,即Tk=MT;从时刻开始在一个姿态更新周期内,即时间区间内以Tk为时间间隔顺序抽取的第i+1个角速率采样值为ωi,其中按照时间发生的先后顺序,i取值为0,1,...,N;从时刻开始在一个姿态更新周期内,即时间区间内使用时间区间内的角速率采样值拟合的第k个角增量子样为Δαk,其中按照时间发生的先后顺序,k取值为1,2,...,N;然后,给出用于姿态更新的更新旋转矢量的解算形式和圆锥误差补偿结构:所述更新旋转矢量为所述圆锥误差补偿项为 其中, 为一个姿态更新周期内总的拟合角增量,ηij、μij和ζij分别为对应于角速率采样叉乘项、角增量子样叉乘项和角速率采样与角增量子样叉乘项的圆锥误差补偿系数,i、j和k为符号下标;
步骤(2),简化所述圆锥误差补偿结构,得到压缩圆锥误差补偿结构:
定义经典圆锥运动,忽略角增量子样的拟合误差,并只考虑角速率采样叉乘项、角增量子样叉乘项、角速率采样与角增量子样叉乘项的各自在x轴上的第一个分量,建立压缩圆锥误差补偿结构,得到压缩圆锥误差补偿项;
步骤(3),基于步骤(2)所述的压缩圆锥误差补偿结构,建立角速率输入的圆锥误差补偿误差准则:
定义圆锥误差补偿项误差为圆锥误差补偿项的理论值与数值计算值在误差矢量的x轴上的第一个分量上的分量差;
步骤(4),建立圆锥误差补偿结构参数优化目标和圆锥误差补偿结构参数优化方法:
圆锥误差补偿优化设计的目标:使圆锥误差补偿项误差的绝对数值达到最小;
圆锥误差补偿结构参数优化设计方法是:根据所述目标,将圆锥误差补偿项误差展开成关于圆锥频率参数的幂级数,令幂级数前3N-1个低阶项的系数为零,并求解得到的线性方程组,得到优化的圆锥误差补偿系数;其中N为一个姿态更新周期包含的拟合角增量子样周期数。
2.根据权利要求1所述的一种角速率输入的姿态算法结构与参数优化方法,其特征在于:步骤(2)简化所述圆锥误差补偿结构,得到压缩圆锥误差补偿结构的具体步骤如下:定义经典圆锥运动Φ(t)=[0acosΩtasinΩt]T,其中t为时刻,Φ(t)为载体系相对参考系在t时刻的旋转矢量,并将载体系定义为b系,将参考系定义为n系,a为半锥角,Ω为圆锥运动频率,[]T为[]的转置;在此基础上,定义t时刻b系相对于n系的角速度在b系下的投影为: 令角速度采样值ωi为其中i=0,1,...,N,忽略角增量子样Δαj的拟合误差,并令其中j=1,2,...,N,得到角速率采样叉乘项ωi×ωj的第一个分量[ωi×ωj]x等于Ω2sin2asin[(j-i)ΩTk],角增量子样叉乘项Δαi×Δαj的第一个分量[Δαi×Δαj]x等于角速率采样与角增量子样叉乘项ωi×Δαj的第一个分量[ωi×Δαj]x等于 只考虑角速率采样叉乘项、角增量子样叉乘项、角速率采样与角增量子样叉乘项的各自在x轴向上的第一个分量,所述圆锥误差补偿项的补偿结构简化压缩为: 其中,An为与ηij相当的圆锥误差补偿系数,在量值上等于所有的η(i-n),i之和;Bp为与μij相当的圆锥误差补偿系数,在量值上等于所有的μ(i-p),i之和;Cq为与ζij相当的圆锥误差补偿系数,在量值上等于所有的ξ(i-q),i-ξi,(i-q+1)之和。
3.根据权利要求2所述的一种角速率输入的姿态算法结构与参数优化方法,其特征在于:步骤(3)基于步骤(2)所述的压缩圆锥误差补偿结构,建立角速率输入的圆锥误差补偿误差准则的具体步骤如下:在圆锥运动条件下,圆锥误差补偿项数值计算误差表现为,误差矢量的第一个轴向分量是常值分量,其余两个轴向分量是周期分量,并将误差矢量的第一个轴向定义为x轴;定义圆锥误差补偿项误差e为圆锥误差补偿项的理论值与数值计算值在x轴上的分量之差,即其中,δφx为更新旋转矢量圆锥误差补偿项理论值在x轴上的分量,为更新旋转矢量圆锥误差补偿项数值计算值在x轴上的分量;圆锥误差补偿项理论值在x轴上的分量δφx等于将所述叉乘项分量[ωi×ωj]x、[Δαi×Δαj]x和[ωi×Δαj]x的分析表达式代入圆锥误差补偿形式的压缩结构 中,得到圆锥误差补偿项数值计算值在x轴上的分量为
从而导出圆锥误差补偿项误差e为:
其中β为与角增量子样周期Tk有关的圆锥频率参数。
4.根据权利要求3所述的一种角速率输入的姿态算法结构与参数优化方法,其特征在于:所述步骤(4)中建立圆锥误差补偿结构参数优化目标和圆锥误差补偿结构参数优化方法的具体步骤为:圆锥误差补偿优化设计的目标是:使圆锥误差补偿项误差e的绝对数值达到最小;圆锥误差补偿结构参数优化设计方法是:根据三角函数关系式sin2(β/2)=(1-cosβ)/2,所述圆锥误差补偿项误差e得到为如下形式:
再根据三角形数关系式 和
得到圆锥误差补偿项误差e关于圆锥频率参数β的幂级数形式表达式:
令圆锥误差补偿项误差e关于β的幂级数项β2k+1的系数为零,k=1,2,...,3N-1;得到线性方程组:
k=1,2,...,3N-1;解该线性方程组,得到优化的圆锥误差补偿系数An、Bp和Cq。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310632713.5A CN103630135B (zh) | 2013-11-29 | 2013-11-29 | 一种角速率输入的姿态算法结构与参数优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310632713.5A CN103630135B (zh) | 2013-11-29 | 2013-11-29 | 一种角速率输入的姿态算法结构与参数优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103630135A CN103630135A (zh) | 2014-03-12 |
CN103630135B true CN103630135B (zh) | 2016-06-01 |
Family
ID=50211423
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310632713.5A Active CN103630135B (zh) | 2013-11-29 | 2013-11-29 | 一种角速率输入的姿态算法结构与参数优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103630135B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108168545B (zh) * | 2017-12-04 | 2021-03-23 | 东北电力大学 | 一种拟牛顿法优化补偿系数的圆锥误差补偿算法 |
CN110455288A (zh) * | 2019-08-06 | 2019-11-15 | 东南大学 | 一种基于角速度高次多项式的姿态更新方法 |
CN113252032B (zh) * | 2021-06-04 | 2021-10-22 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种基于流水式旋转矢量的圆锥误差补偿方法及系统 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101294811A (zh) * | 2008-05-29 | 2008-10-29 | 北京航空航天大学 | 采用奇异摄动方法进行圆锥误差与划船误差补偿的捷联惯导系统 |
CN102997920A (zh) * | 2012-12-11 | 2013-03-27 | 东南大学 | 基于角速率输入的构造频域捷联惯导姿态优化方法 |
-
2013
- 2013-11-29 CN CN201310632713.5A patent/CN103630135B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101294811A (zh) * | 2008-05-29 | 2008-10-29 | 北京航空航天大学 | 采用奇异摄动方法进行圆锥误差与划船误差补偿的捷联惯导系统 |
CN102997920A (zh) * | 2012-12-11 | 2013-03-27 | 东南大学 | 基于角速率输入的构造频域捷联惯导姿态优化方法 |
Non-Patent Citations (2)
Title |
---|
段广仁等."角速率输入条件下圆锥误差补偿算法".《中国空间科学技术》.2012,(第1期), * |
汤传业等."一种角速率输入的圆锥算法设计".《中国惯性技术学报》.2013,第21卷(第4期), * |
Also Published As
Publication number | Publication date |
---|---|
CN103630135A (zh) | 2014-03-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103630135B (zh) | 一种角速率输入的姿态算法结构与参数优化方法 | |
CN103837895B (zh) | 拟合初至波获取短波长静校正量的方法 | |
CN104501804B (zh) | 一种基于gps测量数据的卫星在轨轨道预报方法 | |
CN103759731B (zh) | 角速率输入条件下单子样旋转矢量姿态方法 | |
CN105511259A (zh) | 一种伺服电机分数阶pi控制器的参数整定方法 | |
CN101848529A (zh) | 一种无线传感器网络的多重主成分分析数据压缩方法 | |
CN107609267A (zh) | 一种月球有限推力多次捕获轨道实现方法 | |
CN102721977A (zh) | 高精度转换波各向异性叠加速度分析方法 | |
CN106202294A (zh) | 基于关键词和主题模型融合的相关新闻计算方法及装置 | |
CN103115624A (zh) | 一种基于地磁匹配的地磁日变修正方法 | |
CN112992290B (zh) | 一种基于机器学习和团簇模型的钙钛矿带隙预测方法 | |
CN103593519A (zh) | 一种基于试验设计的运载火箭总体参数优化方法 | |
CN102033851A (zh) | 一种水文时间序列小波互相关分析方法 | |
CN103364842A (zh) | 一种捷联式航空重力仪误差分离方法 | |
CN104182651A (zh) | 用于三分量检波器接收的微地震事件方位角自动质控方法 | |
CN104202817A (zh) | 大型室内空间中的多热点信号指纹地图的存储和匹配方法 | |
CN109657237A (zh) | 时间词的抽取方法及装置 | |
CN102043887A (zh) | 基于误差估计的网格自适应方法 | |
CN108168545A (zh) | 一种拟牛顿法优化补偿系数的圆锥误差补偿算法 | |
Innocenti et al. | Improved forecasts of solar wind parameters using the Kalman filter | |
CN104679856A (zh) | 一种基于组合规则约束的航天器测试数据提取方法 | |
CN106150491B (zh) | 一种油藏的勘探方法及装置 | |
CN110365314A (zh) | 具有稀疏系数的可分离二维fir滤波器的设计方法 | |
CN109724598A (zh) | 一种gnss/ins松组合时延误差的估计及补偿方法 | |
CN104296748A (zh) | 基于双边补偿结构的捷联惯导姿态圆锥补偿算法设计方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |