参数说明:
r:r是在i系的固定矢量
rd:i系固定矢量r在d系的投影
C:i系到d系的转换矩阵
wi:在b系观察 b系相对于i系的角速度
-wi:i系相对于b系的角速度
d():微分
已知:
d
(
r
)
=
0
(
在
i
系
的
固
定
矢
量
)
d(r)=0(在i系的固定矢量)
d(r)=0(在i系的固定矢量)
d
(
r
d
)
=
−
w
i
×
r
d
d(r_d)=-w_i\times r_d
d(rd)=−wi×rd(证明)
转换矩阵
r
=
C
∗
r
d
r=C*r_d
r=C∗rd
则微分方程:
d
(
r
)
=
d
(
C
)
∗
r
d
+
C
∗
d
(
r
d
)
=
d
(
C
)
∗
r
d
+
C
∗
(
−
w
i
×
r
d
)
=
0
d(r)=d(C)*r_d+C*d(r_d)=d(C)*r_d+C*(-w_i\times r_d)=0
d(r)=d(C)∗rd+C∗d(rd)=d(C)∗rd+C∗(−wi×rd)=0
得到方向余弦的微分方程为
d
(
C
)
=
−
C
∗
w
i
×
d(C)=-C*w_i\times
d(C)=−C∗wi×
求解方向余弦的微分方程:令
Ω
(
t
)
=
−
C
(
t
)
∗
(
w
i
(
t
)
×
)
Ω(t)=-C(t)*(w_i(t)\times)
Ω(t)=−C(t)∗(wi(t)×)
约束条件:在0-T时间内定轴旋转
即:
Ω
(
t
2
)
Ω
(
t
1
)
=
Ω
(
t
1
)
Ω
(
t
2
)
(
t
1
,
t
2
属
于
[
0
,
T
]
)
(
证
略
)
Ω(t_2)Ω(t_1)=Ω(t_1)Ω(t_2) (t_1,t_2 属于[0,T])(证略)
Ω(t2)Ω(t1)=Ω(t1)Ω(t2)(t1,t2属于[0,T])(证略)
得到方向余弦的微分方程的解为:
C
(
t
)
=
C
(
0
)
e
∫
0
t
Ω
(
t
1
)
d
t
1
C(t)=C(0)e^{\int_0^t {Ω(t_1)}}dt_1
C(t)=C(0)e∫0tΩ(t1)dt1
若:在[0,T]内
θ
(
T
)
=
∫
0
T
w
(
T
)
d
T
;
θ(T)=\int_0^Tw(T)dT;
θ(T)=∫0Tw(T)dT;
θ
t
=
∣
θ
(
T
)
∣
θ_t=|θ(T)|
θt=∣θ(T)∣
C
(
t
)
=
C
(
0
)
∗
e
∫
0
t
Ω
(
t
1
)
d
t
1
=
C
(
0
)
∗
C
t
0
C(t)=C(0)*e^{\int_0^t {Ω(t_1)d_{t1}}}=C(0)*C_t^0
C(t)=C(0)∗e∫0tΩ(t1)dt1=C(0)∗Ct0
e
∫
0
t
Ω
(
t
1
)
d
t
1
=
I
+
s
i
n
(
θ
t
)
θ
t
[
θ
(
T
)
×
]
+
1
−
c
o
s
(
θ
t
)
θ
t
2
[
θ
(
T
)
×
2
]
e^{\int_0^t {Ω(t_1)d_{t1}}}=I+\frac{sin(θ_t)}{θ_t}[θ(T)\times]+\frac{1-cos(θ_t)}{θ_t^2}[θ(T)\times^2]
e∫0tΩ(t1)dt1=I+θtsin(θt)[θ(T)×]+θt21−cos(θt)[θ(T)×2]
那么时间
[
0
,
T
]
[0,T]
[0,T]拓展到
[
t
m
−
1
,
t
m
]
[t_{m-1}, t_m ]
[tm−1,tm],
方向时间微分方程为(捷联惯导姿态阵)为:
C
m
C_{m}
Cm
θ
(
T
)
=
∫
t
m
−
1
t
m
w
(
t
m
)
d
t
m
;
θ(T)=\int_{t_{m-1}}^{t_m}w(t_m)dt_m;
θ(T)=∫tm−1tmw(tm)dtm;
θ
t
=
∣
θ
(
T
)
∣
θ_t=|θ(T)|
θt=∣θ(T)∣
那么递推公式为:
C
m
=
C
m
−
1
∗
C
m
m
−
1
C_m=C_{m-1}*C_{m}^{m-1}
Cm=Cm−1∗Cmm−1
C
m
m
−
1
=
e
∫
m
m
−
1
Ω
(
t
1
)
d
t
1
=
I
+
s
i
n
(
θ
t
)
θ
t
[
θ
(
T
)
×
]
+
1
−
c
o
s
(
θ
t
)
θ
t
2
[
θ
(
T
)
×
]
2
C_{m}^{m-1}=e^{\int_m^{m-1}{Ω(t_1)d_{t1}}}=I+\frac{sin(θ_t)}{θ_t}[θ(T)\times]+\frac{1-cos(θ_t)}{θ_t^2}[θ(T)\times]^2
Cmm−1=e∫mm−1Ω(t1)dt1=I+θtsin(θt)[θ(T)×]+θt21−cos(θt)[θ(T)×]2