⨂
\bigotimes
⨂张量积
已知:
r
i
=
[
r
x
i
r
y
i
r
z
i
]
r^i=\left[ \begin{matrix} r^i_x& r^i_y&r^i_z \\ \end{matrix} \right]
ri=[rxiryirzi](三维矢量
r
r
r在
i
i
i坐标系的投影)
r
b
=
[
r
x
b
r
y
b
r
z
b
]
r^b=\left[ \begin{matrix} r^b_x& r^b_y&r^b_z \\ \end{matrix} \right]
rb=[rxbrybrzb](三维矢量
r
r
r在
i
i
i坐标系的投影)
Q
b
i
=
c
o
s
θ
2
+
u
∗
s
i
n
θ
2
Q^i_b=cos\frac{θ}{2}+u*sin\frac{θ}{2}
Qbi=cos2θ+u∗sin2θ为4元组3角函数表达式 (i->b)
r
i
=
Q
b
i
⨂
r
b
r^i=Q^i_b\bigotimes r^b
ri=Qbi⨂rb
推导:
r
B
=
[
0
r
b
]
r^B=\left[ \begin{matrix} 0 \\ r^b\\ \end{matrix} \right]
rB=[0rb]
Q
b
i
。
r
b
。
Q
i
b
=
M
Q
b
i
(
r
b
。
Q
i
b
)
=
M
Q
b
i
M
Q
i
b
[
0
r
b
]
=
[
1
0
1
×
3
0
3
×
1
C
b
i
]
[
0
r
b
]
=
[
0
C
i
b
r
b
]
=
[
0
r
i
]
Q^i_b。r^b。Q^b_i=M_{Q^i_b}(r^b。Q^b_i)=M_{Q^i_b}M_{Q^b_i}\left[ \begin{matrix} 0 \\ r^b\\ \end{matrix} \right]=\left[ \begin{matrix} 1 & 0_{1\times3} \\ 0_{3\times1} & C^i_b\\ \end{matrix} \right]\left[ \begin{matrix} 0 \\ r^b\\ \end{matrix} \right]=\left[ \begin{matrix} 0 \\ C_i^br^b\\ \end{matrix} \right]=\left[ \begin{matrix} 0 \\ r^i\\ \end{matrix} \right]
Qbi。rb。Qib=MQbi(rb。Qib)=MQbiMQib[0rb]=[103×101×3Cbi][0rb]=[0Cibrb]=[0ri]
即:
r
i
为
Q
B
i
。
r
b
。
Q
i
b
的
虚
部
(
。
为
4
元
数
乘
法
)
r^i为Q^i_B。r^b。Q^b_i的虚部(。为4元数乘法)
ri为QBi。rb。Qib的虚部(。为4元数乘法)
w
i
b
b
w^b_{ib}
wibb为b系绕i系的角速度;
r
˙
i
=
0
(
r
i
为
固
定
矢
量
)
\dot r^i=0(r^i为固定矢量)
r˙i=0(ri为固定矢量)
则Q的导数为:证明略
Q
˙
b
i
=
1
2
Q
b
i
w
i
b
b
=
1
2
w
i
b
i
Q
b
i
\dot Q^i_b=\frac{1}{2}Q^i_bw^b_{ib}=\frac{1}{2}w^i_{ib}Q^i_b
Q˙bi=21Qbiwibb=21wibiQbi
Q
b
i
=
[
c
o
s
θ
2
u
∗
s
i
n
θ
2
]
Q^i_b=\left[ \begin{matrix} cos\frac{θ}{2}\\ u*sin\frac{θ}{2}\\ \end{matrix} \right]
Qbi=[cos2θu∗sin2θ]
Q
˙
b
i
=
[
−
θ
2
˙
s
i
n
θ
2
u
˙
s
i
n
θ
2
+
u
θ
˙
2
c
o
s
θ
2
]
\dot Q^i_b=\left[ \begin{matrix} -\dot \frac{θ}{2}sin\frac{θ}{2}\\ \dot usin\frac{θ}{2}+u \frac{\dot θ}{2}cos\frac{θ}{2}\\ \end{matrix} \right]
Q˙bi=[−2θ˙sin2θu˙sin2θ+u2θ˙cos2θ]
w
i
b
b
=
u
θ
˙
+
u
˙
s
i
n
θ
−
u
×
u
˙
(
1
−
c
o
s
θ
)
w^b_{ib}=u\dot θ+\dot usinθ-u\times \dot u(1-cosθ)
wibb=uθ˙+u˙sinθ−u×u˙(1−cosθ)
捷联惯导系统学习2.4(4元数微分方程)
最新推荐文章于 2022-11-27 23:22:58 发布