设在任意t时刻,动坐标系b系绕参考坐标系r系
oxryr
平面上的单位转轴
u(t)=⎡⎣⎢cosΩtsinΩt0⎤⎦⎥
转动了
ϕ
角度。
根据
Q(t)=cosϕ2+u(t)sinϕ2
则可得到:
Q(t)=⎡⎣⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢cos(ϕ/2)sin(ϕ/2)cosΩtsin(ϕ/2)sinΩt0⎤⎦⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥
微分:
Q˙(t)=⎡⎣⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢0−sin(ϕ/2)sinΩtsin(ϕ/2)cosΩt0⎤⎦⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥
由:
Q˙(t)=12Q(t)⨂ω(t)
得:
ωq(t)=2Q∗(t)⨂Q˙(t)=⎡⎣⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢0−ΩsinϕsinΩtΩsinϕcosΩt−2Ωsin2(ϕ/2)⎤⎦⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥
即:
ω(t)=⎡⎣⎢⎢⎢⎢⎢⎢−ΩsinϕsinΩtΩsinϕcosΩt−2Ωsin2(ϕ/2)⎤⎦⎥⎥⎥⎥⎥⎥=Ωsinϕ⎡⎣⎢⎢⎢⎢⎢⎢−sinΩtcosΩttan(ϕ/2)⎤⎦⎥⎥⎥⎥⎥⎥
因
Q(t)=cosϕ2+ϕ(t)ϕsinϕ2
可得:
ϕ(t)=ϕ⎡⎣⎢⎢⎢⎢⎢⎢cosΩtsinΩt0⎤⎦⎥⎥⎥⎥⎥⎥
整理一下思路:
u(t)→Q(t)→ω(t)
另外还可:
u(t)→ϕ(t)→Q(t)→ω(t)
参考自《捷联惯导算法与组合导航原理讲义(严恭敏)》《惯性导航(秦永元)》