捷联式惯导与平台式惯导最本质的区别在于用数学平台代替物理平台
捷联式惯导概要
捷联式惯导的加速度计是直接装在载体上的,得出的是载体坐标系(b系)内的数据,但是载体坐标系不能当作导航坐标系。
捷联式系统加速度计测得的比力分量如下
f
b
=
[
f
x
b
f
y
b
f
z
b
]
f^{b}=\begin{bmatrix}f_{x}^{b}\\f_{y}^{b}\\f_{z}^{b}\end{bmatrix}
fb=⎣⎡fxbfybfzb⎦⎤
只有将 f b f^{b} fb转到 f n f^{n} fn(导航坐标系n系),才能把载体的水平加速度和重力加速度分开,以进行有效的地表导航。b系到n系公式如下:
f
n
=
C
b
n
f
b
f^{n}=C_{b} ^{n} f^{b}
fn=Cbnfb
因此计算机必须能实时地提供方向余弦矩阵
C
b
n
C_{b}^{n}
Cbn,才能实现转换。
为了实时地提供方向余弦矩阵
C
b
n
C_{b}^{n}
Cbn,就必须解以下微分方程组:
C
′
=
Ω
n
b
b
C
b
n
C {}'=\Omega_{nb}^{b}C_{b}^{n}
C′=ΩnbbCbn
Ω
n
b
b
\Omega_{nb}^{b}
Ωnbb 为:
在捷联式惯导系统中,还有3个陀螺安装在载体上,他们的测量轴分别与载体坐标系b的3个轴重合,这样他们可以测得载体相对惯性空间的角速度 w i b b w_{ib}^{b} wibb,下面的ib表示b系到i系,上面的b表示在载体坐标系测量的结果。
需要将
w
i
b
b
w_{ib}^{b}
wibb转换为
w
n
b
n
w_{nb}^{n}
wnbn,因为上式的
Ω
n
b
b
\Omega_{nb}^{b}
Ωnbb是在nb两个系中的变量。
转换方程如下:
w
i
b
n
=
C
b
n
w
i
b
b
w_{ib}^{n}=C_{b}^{n}w_{ib}^{b}
wibn=Cbnwibb
上式表示载体坐标系载体相对于惯性空间的角速度经过变换后得到导航坐标系载体相对于惯性空间的加速度
w
n
b
n
=
w
i
b
n
−
w
i
n
n
=
w
i
b
n
−
(
w
i
e
n
+
w
e
n
n
)
w_{nb}^{n}=w_{ib}^{n} - w_{in}^{n}=w_{ib}^{n} -(w_{ie}^{n} +w_{en}^{n} )
wnbn=wibn−winn=wibn−(wien+wenn)
上式中
w
i
n
n
w_{in}^{n}
winn为导航坐标系相对惯性空间的角速度。
w
i
e
n
w_{ie}^{n}
wien 与
w
e
n
n
w_{en}^{n}
wenn分别为地球自身角速度和到导航坐标系相对地球的角速度
w i b b w_{ib}^{b} wibb可以测得, w i e n w_{ie}^{n} wien与 w e n n w_{en}^{n} wenn与 C b n C_{b}^{n} Cbn需要提供。
图太渣了,以后有时间自己画一个
惯性器件的误差补偿原理
找了一张图,完美的解释了补偿原理
捷联式惯导系统基本力学方程式两个矩阵微分方程(导航位置方程和姿态方程)。载体位置和状态都是在不断变化的,因此,在解两个矩阵微分方程时,要求提供相应的位移角速率和姿态速率方程。
1.捷联式惯导的基本力学编排方程
1.捷联式惯导系统的原理框图
上图中的p既是n导航坐标系
姿态速度方程为:
C
′
=
Ω
n
b
b
C
b
n
C {}'=\Omega_{nb}^{b}C_{b}^{n}
C′=ΩnbbCbn
w
n
b
b
w_{nb}^{b}
wnbb时姿态矩阵的速率。
姿态矩阵的速率方程需要转换到载体坐标系中运算:
w
n
b
b
=
w
i
b
b
−
C
n
b
w
i
n
n
=
w
i
b
n
−
C
n
b
(
w
i
e
n
+
w
e
n
n
)
w_{nb}^{b}=w_{ib}^{b} -C_{n}^{b} w_{in}^{n}=w_{ib}^{n} -C_{n}^{b}(w_{ie}^{n} +w_{en}^{n} )
wnbb=wibb−Cnbwinn=wibn−Cnb(wien+wenn)
与上面的相似的方程区别时在载体坐标系b系
位移角速率为
w
e
n
n
w_{en}^{n}
wenn,它在位置方程中由位移角速率方程求得。
2 .姿态方程
实现机体坐标系至导航坐标系转换的捷联矩阵
C
b
n
C_{b}^{n}
Cbn应满足如下的矩阵方程:
[
x
n
y
n
y
n
]
=
C
b
n
[
x
b
y
b
y
b
]
\begin{bmatrix}x_{n}\\y_{n}\\y_{n}\end{bmatrix}=C_{b}^{n}\begin{bmatrix}x_{b}\\y_{b}\\y_{b}\end{bmatrix}
⎣⎡xnynyn⎦⎤=Cbn⎣⎡xbybyb⎦⎤
由于方向余弦阵
C
b
n
C_{b}^{n}
Cbn是正交矩阵,因而
C
b
n
=
[
C
n
b
]
−
1
=
[
C
n
b
]
T
C_{b}^{n}= [C_{n} ^{b}] ^{-1}=[C_{n} ^{b}] ^{T}
Cbn=[Cnb]−1=[Cnb]T,令
C
b
n
=
[
T
11
T
12
T
13
T
21
T
22
T
23
T
31
T
32
T
33
]
C_{b}^{n}= \begin{bmatrix}T_{11} &T_{12} &T_{13}\\T_{21} &T_{22}& T_{23}\\T_{31} &T_{32} &T_{33}\end{bmatrix}
Cbn=⎣⎡T11T21T31T12T22T32T13T23T33⎦⎤
于是
C
b
n
=
[
c
o
s
γ
c
o
s
φ
−
s
i
n
γ
s
i
n
θ
s
i
n
φ
−
c
o
s
θ
s
i
n
φ
s
i
n
γ
c
o
s
φ
+
c
o
s
γ
s
i
n
θ
s
i
n
φ
c
o
s
γ
s
i
n
φ
+
s
i
n
γ
s
i
n
θ
c
o
s
φ
c
o
s
θ
c
o
s
φ
s
i
n
γ
s
i
n
φ
−
c
o
s
γ
s
i
n
θ
c
o
s
φ
−
s
i
n
γ
c
o
s
θ
s
i
n
θ
c
o
s
γ
c
o
s
θ
]
C_{b}^{n}= \begin{bmatrix}cos\gamma cos\varphi-sin\gamma sin\theta sin\varphi &-cos\theta sin\varphi &sin\gamma cos\varphi +cos\gamma sin\theta sin\varphi\\cos\gamma sin\varphi+sin\gamma sin\theta cos\varphi& cos\theta cos\varphi & sin\gamma sin\varphi -cos\gamma sin\theta cos\varphi\\-sin\gamma cos\theta &sin\theta &cos\gamma cos\theta\end{bmatrix}
Cbn=⎣⎡cosγcosφ−sinγsinθsinφcosγsinφ+sinγsinθcosφ−sinγcosθ−cosθsinφcosθcosφsinθsinγcosφ+cosγsinθsinφsinγsinφ−cosγsinθcosφcosγcosθ⎦⎤
由姿态矩阵确定飞行器姿态角
因为
C
b
n
C_{b}^{n}
Cbn是姿态角
γ
,
θ
,
φ
\gamma, \theta ,\varphi
γ,θ,φ 的函数。可得
γ
,
θ
,
φ
\gamma, \theta ,\varphi
γ,θ,φ的主值为
{
θ
m
i
a
n
=
a
r
c
s
i
n
T
32
γ
m
i
a
n
=
a
r
c
t
a
n
−
T
31
T
33
φ
m
i
a
n
=
a
r
c
t
a
n
−
T
32
T
33
\begin{cases} & \theta_{mian}= arcsinT_{32} \\ & \gamma_{mian}= arctan\frac{-T_{31}}{T_{33}}\\ & \varphi_{mian}= arctan\frac{-T_{32}}{T_{33}} \end{cases}
⎩⎪⎨⎪⎧θmian=arcsinT32γmian=arctanT33−T31φmian=arctanT33−T32
因为姿态角有定义域,俯仰角
θ
\theta
θ的定义域为(-90°,90°),偏航角
γ
\gamma
γ为(-180°,180°),横滚角
φ
\varphi
φ为(0°,360°)。
姿态矩阵微分方程
C
b
n
C_{b}^{n}
Cbn 是时间的函数。为求
C
b
n
C_{b}^{n}
Cbn 需要求解姿态微分方程(姿态速率方程)
C
′
=
Ω
n
b
b
C
b
n
C {}'=\Omega_{nb}^{b}C_{b}^{n}
C′=ΩnbbCbn
上式中
Ω
n
b
b
\Omega_{nb}^{b}
Ωnbb为姿态角速度
w
n
b
b
=
[
w
n
b
x
b
,
w
n
b
y
b
,
w
n
b
z
b
]
T
w_{nb}^{b}=[w_{nbx} ^{b},w_{nby} ^{b},w_{nbz} ^{b}] ^{T}
wnbb=[wnbxb,wnbyb,wnbzb]T组成的反对称阵
将上式子展开如下
原谅这个矩阵方程写起来太复杂了,直接拍照上图。
可以看出,上图中对应9个一阶微分方程。只要给定初始值 γ , θ , φ \gamma, \theta ,\varphi γ,θ,φ ,在姿态角速率 w n b n w_{nb}^{n} wnbn已知的情况下求解,即可确定姿态矩阵 C b n C_{b}^{n} Cbn 中的元素值,进而确定飞行器的姿态角。
3.位置方程
位置矩阵
C
e
n
C_{e}^{n}
Cen的计算
建立导航位置方程的目的,是为了确定载体的质心位置。由于所选导航坐标系的不同,因而质心位置的参数也略有不同,对指北方位系统是纬度
L
L
L和经度
λ
\lambda
λ;而对于游动方位系统就是
L
,
λ
L,\lambda
L,λ和游动方位角
α
\alpha
α。
下面介绍位置矩阵的推导
将地球系(e)到地理系(t)需要先绕Z轴转
90
+
λ
90+\lambda
90+λ让X轴与地理系X轴重合,在绕X轴转动
90
−
L
90-L
90−L使得Z轴与Y轴重合。于是方向余弦矩阵为
C
e
t
=
[
−
s
i
n
λ
c
o
s
λ
0
−
s
i
n
L
c
o
s
λ
−
s
i
n
L
s
i
n
λ
c
o
s
L
c
o
s
L
c
o
s
λ
c
o
s
L
s
i
n
λ
s
i
n
L
]
C_{e}^{t}=\begin{bmatrix}-sin\lambda &cos\lambda &0\\-sinL cos\lambda&-sinL sin\lambda &cosL\\cosL cos\lambda &cosL sin\lambda&sinL\end{bmatrix}
Cet=⎣⎡−sinλ−sinLcosλcosLcosλcosλ−sinLsinλcosLsinλ0cosLsinL⎦⎤
又因为地理系(t)与导航系(n)之间差一个游动方位角
α
\alpha
α,他们之间的方向余弦矩阵为
C
t
n
=
[
c
o
s
α
s
i
n
α
0
−
s
i
n
α
c
o
s
α
0
0
0
1
]
C_{t}^{n}=\begin{bmatrix} cos\alpha&sin\alpha&0\\-sin\alpha&cos\alpha&0\\0&0&1\end{bmatrix}
Ctn=⎣⎡cosα−sinα0sinαcosα0001⎦⎤
所以地球系(e)到导航系(n)之间的方向余弦矩阵也就是位置矩阵
C
e
n
C_{e}^{n}
Cen为
C
e
n
=
C
t
n
C
e
t
C_{e}^{n}=C_{t} ^{n}C_{e} ^{t}
Cen=CtnCet
将上两式子导入展开得到:
嘿嘿,看图
位置矩阵
C
e
n
C_{e}^{n}
Cen的计算
若想要求出对于的位置矩阵
C
e
n
C_{e}^{n}
Cen,需要解
C
e
n
C_{e}^{n}
Cen所对应的微分方程,即
C
e
n
′
=
−
Ω
e
n
n
C
e
n
C_{e}^{n'}=-\Omega_{en}^{n}C_{e}^{n}
Cen′=−ΩennCen
式中
Ω
e
n
n
\Omega_{en}^{n}
Ωenn为位置角速率
w
e
n
n
w_{en}^{n}
wenn的反对称阵。
考虑
w
e
n
z
n
=
0
w_{enz}^{n}=0
wenzn=0,则导航计算机要解算的微分方程为。
即可确定位置矩阵
C
e
n
C_{e}^{n}
Cen中的元素值,进而确定导航位置参数。
位置角速率
w
e
n
n
w_{en}^{n}
wenn方程
速度方程
垂直通道阻尼
与平台式一样
捷联式惯导系统的力学编排
2.捷联式惯导系统误差补偿与初始对准
由于捷联矩阵 C b n C_{b}^{n} Cbn起到了平台的作用,因此导航工作一开始就需要获得捷联矩阵 C b n C_{b}^{n} Cbn的初始值,以便完成导航任务。显然,捷联式惯导系统的初始对准就是确定捷联矩阵的初始值。
陀螺仪和加速度计的误差会导致初始对准误差,初始对准时飞行器的干扰运动也是产生对准误差的重要因素。
2.1捷联式系统误差方程
“数学平台”的误差方程——姿态误差方程
在捷联式惯导系统中,机体姿态角是通过姿态矩阵(“数学平台”)计算出来的。在理想情况下,导航计算机计算的地理坐标系(
t
^
\hat{t}
t^ 表示) 应该和 真地理坐标系(t系) 一致。也就是导航计算机计算的姿态矩阵
C
b
t
˙
\dot{C_{b}^{t}}
Cbt˙与理想姿态矩阵
C
b
t
C_{b}^{t}
Cbt。然而,由于系统存在 测量误差、计算误差和干扰误差等误差源,理想与计算得到的地理坐标系之间有偏差。
用姿态误差矢量角
φ
\varphi
φ 表示理想与计算坐标系之间的误差
捷联式惯导系统中,姿态矩阵 C b t C_{b}^{t} Cbt是通过姿态微分方程 C b t ˙ = C b t Ω t b b \dot{C_{b}^{t}}=C_{b} ^{t}\Omega_{tb} ^{b} Cbt˙=CbtΩtbb, 而 Ω t b b \Omega_{tb} ^{b} Ωtbb取决于姿态角速率 ω t b b \omega_{tb}^{b} ωtbb(上式中t系可以理解为导航坐标系n)。在推导数学平台误差方程过程中,首先应该确定 ω t b b \omega_{tb}^{b} ωtbb,然后将矩阵微分方程(姿态微分方程) C b t ˙ = C b t Ω t b b \dot{C_{b}^{t}}=C_{b} ^{t}\Omega_{tb} ^{b} Cbt˙=CbtΩtbb变换成误差角 φ \varphi φ 表征的姿态误差角方程。
设真地理系
t
t
t 到计算地理系
t
^
\hat{t}
t^ 的方向余弦矩阵为
C
t
t
^
C_{t}^{\hat{t}}
Ctt^ ,由于他们之间相差仅一个小角度
φ
\varphi
φ ,因此有
C
t
t
^
=
[
1
φ
z
−
φ
y
−
φ
z
1
φ
x
φ
y
−
φ
x
1
]
=
I
−
Φ
t
C_{t}^{\hat{t}}=\begin{bmatrix}1&\varphi_{z}&-\varphi_{y}\\ -\varphi_{z}&1&\varphi_{x}\\\varphi_{y}&-\varphi_{x}&1\end{bmatrix}=I- \Phi^{t}
Ctt^=⎣⎡1−φzφyφz1−φx−φyφx1⎦⎤=I−Φt
反之,计算地理系到真地理系的方向余弦矩阵为:
C
t
^
t
=
[
C
t
t
^
]
T
=
I
+
Φ
t
C_{\hat{t}}^{t}=[C_{t} ^{\hat{t}}] ^{T}=I+\Phi ^{t}
Ct^t=[Ctt^]T=I+Φt
其中
Φ
t
=
[
0
φ
z
−
φ
y
−
φ
z
0
φ
x
φ
y
−
φ
x
0
]
\Phi ^{t}=\begin{bmatrix}0&\varphi_{z}&-\varphi_{y}\\ -\varphi_{z}&0&\varphi_{x}\\\varphi_{y}&-\varphi_{x}&0\end{bmatrix}
Φt=⎣⎡0−φzφyφz0−φx−φyφx0⎦⎤
太多太复杂,推导如下图
上式中 Ω \Omega Ω表示地球自转角速率
速度误差方程
加速度计的输出中包含加速度计零偏和机体角运动引起的扰动输出
上式中
δ
V
e
p
y
G
=
∫
t
1
t
2
a
i
b
y
p
d
t
\delta V_{epy}^{G}=\int_{t_{1}} ^{t_{2}}a_{iby} ^{p}dt
δVepyG=∫t1t2aibypdt
δ
V
e
p
x
G
=
∫
t
1
t
2
a
i
b
x
p
d
t
\delta V_{epx}^{G}=\int_{t_{1}} ^{t_{2}}a_{ibx} ^{p}dt
δVepxG=∫t1t2aibxpdt
G代表真地理系,P代表计算地理系,【t1,t2】为计算步长。
位置误差方程
系统误差方程及简要分析
所谓是指计算与真实之差,而描述其变化的微分方程便是误差方程。