惯性导航系统误差传播特性分析报告.docx
- 文档编号:28338377
- 上传时间:2023-07-10
- 格式:DOCX
- 页数:63
- 大小:392.20KB
惯性导航系统误差传播特性分析报告.docx
《惯性导航系统误差传播特性分析报告.docx》由会员分享,可在线阅读,更多相关《惯性导航系统误差传播特性分析报告.docx(63页珍藏版)》请在冰豆网上搜索。
惯性导航系统误差传播特性分析报告
惯性导航系统误差传播特性分析报告
一、系统误差方程的建立及分析
1、误差源
1)元件误差
主要有陀螺的漂移、标度因数误差、加速度计的零偏和标度因数误差、计算机的舍入误差、电流变换装置的误差等。
2)安装误差
主要指加速度计和陀螺仪在平台上的安装误差。
3)初始条件误差
包括平台的初始误差以及以及计算机在解算方程时的初始给定误差。
4)运动干扰
主要是冲击和振动造成的干扰。
5)其它误差
如地球曲率半径的描述误差、有害加速度补偿忽略二阶小量造成的误差等等。
2、误差分析的方法
1)误差分析的目的是定量地估算惯导系统测算结束时的准确程度。
正确的地理位置由当地地理坐标系來量取,而实际的测算结果是由系统计算得出的。
为了研究两者的偏差,这里引入了一个计算机坐标系(用c來标识),即将c系和t系作比较,从而定义岀各种误差最。
2)一般情况下,所有误差源均可看成是对理想特性的小扰动,因而各个误差星都是对系统的一阶小偏差输入星。
因此,在研究各误差星Z间的关系时,完全可以取一阶近似而忽略二阶以上的小量。
3)误差分析要求首先建立误差方程,即反映各误差量之间有机联系的方程。
这种方程是依据系统的机械编排方程通过微分处理来求収。
3、坐标系及小角度下的坐标变换矩阵
由地理纬度L和经度所确定的当地地理坐标系oxtytzt,与由计算纬度S和经度入c所确定的计算机坐标系一般来说是不重合的,它们之间存在着小角度的位置偏差。
如图所示:
以指北方位系统为例,其平合坐标系P与地理坐标系t一般來说也存在着小角度的位置偏差。
同样,p系与C系之间也存在着小角度的位置偏差。
1)t系与C系之间的方向余弦矩阵
定义纬度误差最和经度误差量:
由于这种误差,使t系与C系之间存在着小偏差矢最角
&
%.
显然有如下关系
XI
■-<5L'
=
^ZcosL
2」
说sinL
如图所示,设t系与C系一开始是重合的:
然后c系先绕oxt轴转0x'得oxtiytizti系;再绕oytl轴转eyftJoXt2yt2Zt2系,最后绕OZt2轴转e,便得到计算机系oxcyczco即有
Z
J一J
cos&z
sind
01
COS。
0
一SillOy
J
_1
0
0_
二
一sing
cos&z
0
0
1
0
0
COS&x
sin©
_0
0
1J
[sin0y
0
COS&v
0
-sin@
cosgj
在小角度条件下,取一阶近似值,有
JcosQ=cos0=cosQ=1(sinQ=q,sin0=^sinQ=6Z
由此可得:
不难证明,作为小偏角e,在t系和c系上的投影是相等的,即有
&=®c=
2)t系与p系之间的方向余弦矩阵
设p系与t系有小误差角屮,写成列矩阵
仿前可得
3)c系与p系之间的方向余弦矩阵设P系与c系有小误差角屮,写成列矩阵
相应的方向余弦矩阵为
化
1
一屮工
4)t系c系与p系三者之间的关系
ctp=C^Ctc0=屮+。
由三个坐标系的转动关系可知,p系对于t系的误差角可分解为P系对于C系再加上C系对于t系的误差角。
这种关系通过方向余弦矩阵的转换可以看得更
清楚。
上式的意义:
通过引入计算机坐标系C,把平台系相对地理系的误差角
分成了两部分:
一部分是计算机系相对地理系的误差角屮,它主要反映了导航参数误差及。
这种误差通过给平台的指令角速率转化为平台误差角的一部分;另一部分是平台系相对计算机系的误差屮,它主要反映了陀螺平台自身的漂移角速度£以及施矩轴线偏离了正确位置所造成的平台误差角。
4、系统误差方程的建立
1)定义误差量
上式为地理位置和速度误差量的定义式,也可称为这些导航参数(时间函数)的变分或一阶微分。
平台系相对地理系的误差角分量,根据前而的定义可用0x,0y,血來表示。
同时,以上各最对应的初始值以及一阶导数也得到了定义。
此外,用务问怎表示陀螺仪的干扰力矩引起的半台绕三个轴的漂移角速率,用Vx,Vy表示东向和北向加速度计的零偏误差。
2)误差传递方向
惯性平台的两个水平控制回路既有交联影响,同时乂构成了一个大的闭环系统。
因而误差量之间的相互影响也具有相同的特点。
下图是惯性半台误差传递方
交叉耦合
久必0
•必・必・0
闭环系统可以分为三段:
第一段由半台误差角速率祗羸、兀通过一次积分并加上初始偏差,形成平台误差角Z机,从而引起加速度测量的交义耦合误差,再加上加速度计的零偏误差,最后形成加速度误差傀,冈:
第二段由负,函通过一次积分并加上初始给定误差,形成速度误差氓,%而后除以地球曲率半径,再通过一次积分并加上初始误差,最后形成导航位置误差恥八取务
第三段由朮,卡构成对陀螺仪的指令角速率误差,加上陀螺平台本身的漂移误差角速率弓卮,以及平台相对计算机系的偏角“c"y,%的影响,最终形成平台系相对地理系的误差角速率ddd,正好传递了一周。
由此可见,在建立系统误差方程飢兀可以分为三段导出各误差量之间的函数关系,即速度误差方程、经纬度误差方程和平台误差方程。
3)速度误差方程的建立
参照指北方位惯导系统的速度方程,不计高度通道,则计算机系解算的速度方程为:
丈=益+
H
(2冬sinL(.
/
2©sinLt
anallttviRrR
式中,用地球半径代替了主曲率半径;第,如是加速度计的实际输出信息。
若只考虑平台误差角及加速度计的零偏误差,则
JfK+Qf;-0yff+y
将两式综合后,进行误差最代换,得到:
弋二£+(2咎讥+薯tanl^+^fHy^+Vxv^=fy-2qsinR+菁tanLt*-0zg+0x^+Vy
与原方程:
g=E+2a^sinL+
耳二乌-2QsinL+
相减。
同时利用关系式:
LC=L+(5LsinLc=sinL+cosL兀tanLc=tanL+sec2L^L
经整理可得到速度误差方程:
dvy--2皱sinL+
^^tanL他-
R
V
anL氐+ImsinL+—tanLdvIR丿
vV
2mcosLv*+—^-sec2L 2如cosLv: HA \7 y+ 2a)^sinL+—tanLvl 兀丿• ie •v1、 2皱sinL+— R \7 V;+g+* 上式中令=£=0£=4=社=0,便得到静基座的速度误差方程: 严=2%sinL函-%g+vx[函=-2佥sillL函+gg+Vy 由方程右端可见,影响速度误差的有三类因素: 一是加速度计的零偏;二是由于平台相对水平面有倾斜,导致加速度计敏感一部分重力加速度;其三是计算机在补偿加速度计输出量中的有害加速度时,把速度误差内C,冈的因素也带了进去。 这三种影响在静基座方程中尤为明显。 载体本无哥氏加速度,可是由于计算机算得了&X,%,结果进行了错误补偿,导致了误差项。 4)经、纬度误差方程 出=_醯 cosLsinL 根据上式,将主曲率半径换为地球半径,则有: 应= 8k— 刃y 西secLL%secLtanL兀~~R+R 令vx=0,便得到静基座经纬度误差方程: ^L= 3A= ~R~ 讯secL 5)平台误差方程 由于在指北方位系统的平台指令角速率方程中,曾假定平台系与地理系完全重合,所以不可能提供平台系相对地理系的误差角的表达式。 因此必须改变上述假定,重新建立误差角关系式: 0=0+0 对上式两端求导,即得平台误差角速率: d=0+Q 式中,0是计算机系相对地理系的误差角速率,在小角度情况下可把它看成0,对e求导可得其分量式: •••6y=S^lcosL-SlsinL-L•••0Z=51siiiL+说sinL・L 0表示平台系相对计算机系的误差角速率。 它的形成有两方面的原因: 一是陀螺半台本身存在着相对惯性空间的漂移角速率£,二是屮本身乂改变了计算机对陀螺的施矩轴方位,从而造成一种附加影响。 屮角的分量方程为: 必=0-氏=0+弘] 0y=Oy_&y=g_^COSL>0z=@-2=4-况sinL\ 经过整理并略去二阶小最,可得动基座平台误差方程: 兀= VA( sinL+—tanLcosL+ R cosL+薯sec? L)+应(愆cosL+ £=•一qsii】L<$L-败(绥sinL+罟Q冬 兀=—tanL+ R 令vi=v^=O,得到静基座平台误差方程: .dv. %=--+g©sinL-cosL+rx &=警■-©sinL-兀-g©sinL+ry ■dv ©=^-taiiL+农cosL・<3L+姪①cosL+sz 方程右端是引起平台误差角速率的误差项。 按其性质可分为三类: 一是陀螺半台的漂移项: 二是由平台误差角引起的交义耦合误差项;三是由于导航参数的误差引起的误差项。 在静基座条件下,%%丄等并不一定为零。 因为惯导系统的初始对准就有误差0xo,go,04加速度计的零偏也总是存在的,必然造成加速度误差矶,馮,再通过积分运算就会产生兀&2等误差量,而这些误差量通过对半台的指令力矩,又会进一步影响平台的误差角速率。 5、系统误差分析 1)静基座误差方程为 成=西竺匕R =2匕sinL<^y-^yg+Vxdvy=-2a^sinL刃x+0xg+^y乩旦 R <0x=—^^+0/^4sinL-0z如cosL+$xR 瓯atsinL兀中sin女 7IK tanL+6^cosl;•忆+0烬cosL+R 写成状态方程矩阵形式为 _0 2qsinL 0 0 —o 0一 一2皱sinL 0 0 g 0 0 3L 0 i/R 0 0 0 0 0 -l/R 0 0 qsinL 一®ecosL i/R 0 一皱sinL -皱sinL 0 0 tanL/R 0 cosL 如cosL 1c 0 0 V/ Vy dL 0 + J 6 进行拉氏变换得到 S濒(s卜詈现(s)+矶 気(S「 •0 2皱sinL 0 0 _§ 0_ s%(s) 一2皱sillL 0 0 g 0 0 s兀(s) 0 i/R 0 0 0 0 s%(s) 0 -l/R 0 0 a;csinL -69cCOSL S0y(s) i/R 0 _qsinL 一皱sinL 0 0 S0z(s). tanL/R 0 qcosL OJeCOSL 0 0 ■ 巴(s)l 輛(s) <5L(s) 久) 1 0 0」s) + 0如 + 6(s) 0y(s) 勺(s) 0(s)_ 坨(s)_ 2)系统误差的周期特性分析 用列矩阵X(t)表示误差列向量,用F表示系数阵,用W(t)表示误差因素列向量,于是上述误差方程组可写为: 相应的拉氏变化方程为: 文(t)二FX(t)+W(t) 拉氏变换的解为: sX(s)=FX(s)+Xo(s)+W(s) 由于略去导致傅科振荡的两个交叉耦合项,可使求解简单,乂不妨害对解的主要特性的了解,故: /、/、—]「/、 X(s)=(sI-F)1[X0(s)+W(s)] 系统特征方程为: 考察特征方程的根,可了解系统是否具有周期性,并可找到相应的振荡频率。 其中,/=§为舒勒角频率的平方。 R 由(s2+<)=0 得到一组特征根f厂土j咳 咳为地球自转角频率,相应的振荡周期1;=2刃4=2仆时,称地转周期。 再由(s? +血)+4s? &siii2L=0 展开得s44-2s3(^y;+2^siii2L)+^=° 此式不能求精确解析解,但考虑册>>&,因而可近似写成 由此得出另两组近似解: s34=±j(d9s+a)esinL) s56=±j(d9,-69csinL) 系统的特征根全为虚根,说明系统为无阻尼振荡系统,振荡角频率共有三个: 5=% V马=d+兮 马=叫_戟 ①和©分别为舒勒角频率和傅科角频率,相应的周期为 T=2兀©=84.8min 耳==—————=34h(L=45°) co^sinL 由于3、>>兮,故型和马数值上相差不大。 因此,在误差量的解析表 达式中将会出现两个相近频率的线性组合,即 x(t)=\siii(6Ws+ajesinL)t+冷siii(d^一a>esiiiL)t对上式进行和差化积运算,得: x(t)=2\cos(69iesinL)t・sin(69st) 结果是舒勒振荡的幅值受到傅科频率的调制。 总之,在惯性导航的误差传播特性中,将包含有三种可能的周期变化成分。 首先是地转周期I;,舒勒周期T,和傅科周期耳。 3)系统误差传播特性曲线的求取 通过误差传播特性曲线可以看出特定的误差最对于特定误差因素的响应形式。 略去导致傅科振荡的两个交义耦合项,可使求解简单,乂不妨害对解的主要特性的了解。 因此需要求出误差方程的近似解析解。 二、实验初始条件及要求 1、初始条件: 设陀螺的常值漂移为0.1°/h,加速度计的常值零偏误差为0.OOOlg,当地纬度39°: 起始条件误差为: 速度误差0.lm/s,位置误差为0.0005°,水平姿态谋差为20角秒,方位姿态误差为5角分。 运行吋间t=24小时(利用Matlab分析软件)。 2、实验要求: 1)推导出陀螺漂移引起的系统误差,并画出误差传播曲线: 2)推导出加速度计零偏引起的系统误差,并画出误差传播曲线: 3)推导出初始条件误差引起的系统误差,并画出误差传播曲线: 4)对结果必要的分析并能得出一些结论。 三、实验处理过程 考虑到求解的简单,乂不妨害对解的主要特性的了解, 建立的系数阵为 [0, 0, 0, 0, 0] [0, 0, 0, g, 0, 0] [0, 1/R, 0, 0, 0, 0] [0, -1/R, 0, 0,wie*sin(L), -wie*cos(L)] [1/R, 0, -wie*sin(L), -wie*sin(L), 0, 0] [tan< (L)/R,O, wie*cos(L), wie*cos(L), 0, 0] 用Matlab求特征矩阵C=(sI-F)有: C11=(R*s)/(R*s'2+g) C】2=0 C13=(R*g*s*wie*sin(L))/((s"2+wie2)*(R*s"2+g)) Ci4=(R*g*s*wie*sin(L))/((s~2+wie2)*(R*s2+g)) C15=-(R*g*(s"2-wie~2*sin(L)2+wie"2))/((s"2+wie*2)*(R*s"2+g)) Ci<=-(R*g*wie"2*sin(2*L))/(2*(s"2+wie"2)*(R*s-2+g)) 0 (R*s)/(R*s"2+g) -(R*g*wie"2)/((s"2+wie*2)*(R*s"2+g))(R*g*s-2)/((s"2+wie"2)*(R*s~2+g))(R*g*s*wie*sin(L))/((s*2+wie*2)*(R*s*2+g))-(R*g*s*wie*cos(L))/((s2+wie2)*(R*s2+g)) ^31=0 C32=1/(I^s2+g) C33=(R*s*3+(R*wie2+g)*s)/((s2+wie"2)*(R*s2+g))C34=(g*s)/((s~2+wie"2)*(R*s"2+g)) C35=(g*wie*sin(L))/((s~2+wie'2)*(R*s~2+g)) C36=-(g*wie*cos(L))/((s*2+wie*2)*(R*s"2+g)) C41二0 C42二T/(R*s'2+g) C43=-(R*s*wie*2)/((s2+wie*2)*(R*s2+g)) C44=(R*s3)/((s"2+wie"2)*(R*s"2+g)) C45二(R*s"2*wie*sin(L))/((s"2+wie2)*(R*s"2+g)) C46=-(R*s'2*wie*cos(L))/((s'2+wie~2)*(R*s*2+g)) C51二1/(R*s2+g) C52R C53=-(R*s"2*wie*sin(L))/((s'2+wie"2)*(R*s"2+g))Cs4=-(R*s*2*wie*sin(L))/((s"2+wie2)*(R*s"2+g)) C55二(R*s*(s"2-wie*2*sin(L)2+wie2))/((s*2+wie"2)*(R*s"2+g)) C“=(R*s*wie"2*sin(2札))/(2*(s2+wie'2)*(R*s"2+g)) C^j^anCL)/(R*s*2+g) ^63=(wie*(R*s"2*cos(L)"2+g))/(cos(L)*(s"2+wie2)*(R*s*2+g))C64=(wie*(R*s*2*cos(L)*2+g))/(cos(L)*(s*2+wie"2)*(R*s*2+g))C^5=-(s*sin(L)*(g-R*wie"2*cos(L)2))/(cos(L)*(s*2+ wie2)*(R*s2+g)) C“=(R*s3+(R*wie2*sin(L)2+g)*s)/((s'2+wie2)*(R*s2+g)) 各式中,常数值g表示币: 力加速度,ws表示舒勒角频率,wie表示地球自转角速度,R表示地球半径,L表示当地纬度。 Dx表示东向加速度计常值冬偏,Dy表示北向加速度计常值冬偏,Ex表示东向陀螺漂移,Ey表示北向陀螺漂移,Ez表示方位陀螺漂移。 DxO表示初始东向速度误差,DyO表示初始北向速度误差,L0表示初始纬度位置误差,NO表示初始经度位置误差,QxO表示初始东向姿态误差,QyO表示初始北向姿态谋差,QzO表示初始方位姿态误差。 dVx表示系统东向速度误差,dVy表示系统北向速度误差: dL表示纬度误差,dN表示经度误差;Qx、Qy、Qz表示平台误差。 1、陀螺漂移引起的系统误差,及误差传播曲线1)东向陀螺漂移(&)引起的系统误差及误差传播曲线 dVxs=(Ex*R*g*wie*sin(L))/((s*2+wie"2)*(R*s*2+g))dVxt=(Ex*R*g*sin(t*wie)*sin(L))/(g-R*wie2)- (Ex*R"(3/2)*g~(l/2)*wie*sin((g"(l/2)*t)/R"(1/2))*sin(L))/(g-R*wie"2) dVys=(Ex*R*g*s)/((s*2+wie"2)*(R*s*2+g))dVyt=(Ex*R*g*cos(t*wie))/(g-R*wie*2) (Ex*R*g*cos((g~(l/2)*t)/R(1/2)))/(g-R*wie"2) dLs=(Ex*g)/((s*2+wie"2)*(R*s"2+g))dLt=(Ex*g*sin(t*wie))/(wie*(g-R*wie*2)) (Ex*R_(l/2)*g'(l/2)*sin((g"(l/2)*t)/R'(l/2)))/(g-R*wie"2) dNs=(Ex*g*wie*sin(L))/(cos(L)*(s2+wie2)*(R*s2+g))dNt=((Ex*g*sin(t*wie)*sin(L))/(g-R*wie-2) (Ex*R"(1/2)*g(l/2)*wie*sin((g"(1/2)*t)/R"(1/2))*sin(L))/(g R*wie~2))/cos(L) Qxs=(Ex*R*s2)/((s2+wie2)*(R*s2+g)) Qxt=(Ex*R'仃/2)*g-(l/2)*sin((g"(l/2)*t)/R~(l/2)))/(g- R*wie"2)-(Ex*R*wie*sin(t*wie))/(g-R*wie"2) Qys=-(Ex*R*s*wie*sin(L))/((s"2+wie"2)*(R*s"2+g)) Qyt=(Ex*R*wie*cos((g'(l/2)*t)/R(l/2))*sin(L))/(g-R*wie"2)- (Ex*R*wie*cos(t*wie)*sin(L))/(g-R*wie"2) Qzs=(Ex*wie*(R*s2*cos(L)2+g))/(s*cos(L)*(s2 wie2)*(R*s2+g)) Qzt=-((Ex*cos(t*wie)*(g-R*wie2*cos(L)2))/(wie*(g-R*wie~2))-Ex/wie+(Ex*R*wie*cos((g~(l/2)*t)/R~(l/2))*(cos(L)- l)*(cos(L)+1))/(g-R*wie*2))/cos(L) coCo (S/E)x>9 rLLo 505 东向速度渓基 5t/s 10 x104 ooo (S/EMA9 t/s 经度误差 10 x104 0.01 0 -0.010 Ixe 纬度误差 5 t/s 10 5 0 x104 x104东向姿态误差 505 Vs 10 x104 50-50 t/s 10 4 x10 105北向姿态误差 t/s 10 x104 0.02 0-0.02 方向姿态i吴差 5t/s 10 4 x10 2)北向陀螺漂移(勺)引起的系统误差及误差传播曲线
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 惯性 导航系统 误差 传播 特性 分析 报告