捷联惯导系统学习2.3(方向余弦阵微分方程)

张量
如何证明一矢量的一导为角速度与该矢量的叉乘?

参数说明:
		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=Crd
则微分方程:
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+Cd(rd)=d(C)rd+C(wi×rd)=0
得到方向余弦的微分方程为
d ( C ) = − C ∗ w i × d(C)=-C*w_i\times d(C)=Cwi×

求解方向余弦的微分方程:令 Ω ( 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)e0tΩ(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)e0tΩ(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] e0tΩ(t1)dt1=I+θtsin(θt)[θ(T)×]+θt21cos(θt)[θ(T)×2]

那么时间 [ 0 , T ] [0,T] [0,T]拓展到 [ t m − 1 , t m ] [t_{m-1}, t_m ] [tm1,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)=tm1tmw(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=Cm1Cmm1
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 Cmm1=emm1Ω(t1)dt1=I+θtsin(θt)[θ(T)×]+θt21cos(θt)[θ(T)×]2

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值