旋转矩阵旋转向量欧拉角四元数的关系
Posted fuzhuoxin
tags:
篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了旋转矩阵旋转向量欧拉角四元数的关系相关的知识,希望对你有一定的参考价值。
- 向量的矩阵形式
有两个向量:
[overrightarrow {
m{a}} = ({a_1},{a_2},{a_3})]
[overrightarrow { m{b}} = ({b_1},{b_2},{b_3})]
叉乘的结果表示一个向量,这个向量向量垂直于a,b向量构成的平面。
[overrightarrow a imes overrightarrow {
m{b}} = left| {egin{array}{*{20}{c}}
{{e_1}}&{{e_2}}&{{e_3}}
{{a_1}}&{{a_2}}&{{a_3}}
{{b_1}}&{{b_2}}&{{b_3}}
end{array}}
ight| = left[ {egin{array}{*{20}{c}}
{{a_2}{b_3} - {a_3}{b_2}}
{{a_3}{b_1} - {a_1}{b_3}}
{{a_1}{b_2} - {a_2}{b_1}}
end{array}}
ight] = left[ {egin{array}{*{20}{c}}
0&{ - {a_3}}&{{a_2}}
{{a_3}}&0&{ - {a_1}}
{ - {a_2}}&{{a_1}}&0
end{array}}
ight]left[ {egin{array}{*{20}{c}}
{{b_1}}
{{b_2}}
{{b_3}}
end{array}}
ight] = {a^ wedge }b]
将向量a对应的矩阵表示出来,为一个反对称矩阵,每一个向量都对应着一个反对称矩阵。这就引出向量的矩阵形式。
[{a^ wedge } = left[ {egin{array}{*{20}{c}}
0&{ - {a_3}}&{{a_2}}
{{a_3}}&0&{ - {a_1}}
{ - {a_2}}&{{a_1}}&0
end{array}}
ight]]
- 坐标变换的易混点
在齐次变换中
[{{ m{p}}_1} = {T_{12}} ullet {p_2}]
[{{ m{p}}_2} = {T_{23}} ullet {p_3}]
T12表示,把坐标系{2}的向量变换到坐标系{1}中,T23同理,如果把坐标系{3}下的向量变换到坐标系{1}中为:
[{{ m{p}}_1} = {T_{12}} ullet {T_{23}} ullet {p_3}]
- 旋转向量和欧拉角:
SO(3)的旋转矩阵有9个量,但是只有3个自由度,同理SE(3)有16个量,但是也只有6个自由度。在实际的旋转中,任意的旋转都可用一个旋转轴和一个旋转角来表示,我们使用一个向量,方向与旋转轴一致,长度等于旋转角,这样只需要一个三维向量即可描述旋转。对于SE(3),用一个旋转向量和一个平移向量即可表达,恰好自由度为6.如果用旋转向量来描述R:旋转轴为一个单位长度的向量n,角度为$ heta $,那么$ heta { m{n}}$可以表示这个旋转。旋转矩阵R和旋转向量$ heta { m{n}}$的转换过程为罗德里格斯变换:
[R = cos heta I + (1 - cos heta )n{n^T} + sin heta {n^ wedge }]
此处末尾的${{ m{n}}^ wedge }$ 如上面所示,代表矩阵表示的向量。那么反过来通过旋转矩阵获取转角 $ heta $;
$$ heta { m{ = arccos}}frac{{tr(R) - 1}}{2}$$
tr(R)为矩阵R的迹。对于转轴n,Rn=n;表示为转轴绕自身转动不生改变,从数学来说n是矩阵R特征值为1时对应的特征向量。从现在来看旋转轴和旋转角来表示的旋转是紧凑的,没有冗余性,但是欧拉角RPY的空间中,当一个旋转达到$underline { m{ + }} 90^circ $是就出现了奇异性。相当于地球的经纬度中当纬度为$underline { m{ + }} 90^circ $时,经度无意义。
那么如何解决冗余性和奇异性呢,于是又提出了四元数,既不冗余有没有奇异性。
- 四元数
$q = {q_0} + {q_1}i + {q_2}j + {q_3}k$其中i,j,k 为四元数的三个虚部,关系为:
[left{ {egin{array}{*{20}{c}}
{{i^2}{
m{ = }}{j^2}{
m{ = }}{k^2}{
m{ = }}; - 1}
{ij = k,ji = - k}
{jk = i,kj = - i}
{ki = j,ik = - j}
end{array}}
ight.]
i,j,k的关系就像三维坐标系一样,用单位四元数可以表示空间中的任意一个旋转,与复数有一些不同,在复数中,乘以i代表旋转90°,但在四元数中,乘以i对应着旋转180°,保证$ij = k$,对应着绕i旋转180°,在绕j旋转180°等于绕k旋转180°。${i^2} = - 1$意味着绕i轴旋转360°得到一个相反的东西。四元数之间的运算满足上面四个关系。
- 用四元数表示旋转
空间的一个三维点$p = [x,y,z] in {R^3}$,由一个单位四元数q指定的旋转,三维点$p$经过旋转之后变为$p‘$,在原始的矩阵描述为$p‘ = Rp$,在四元数中描述时:$p = {[0,x,y,z]^T} = {[0,u]^T}$,相当于把四元数的三个虚部与空间中的三个轴对应,旋转后的$p‘$可以表示为:$p‘ = qp{q^{ - 1}}$(不用纠结为什么左乘一个q右乘一个q的逆,运算规则就是这样),结果仍然为四元数。把$p‘$的虚部取出得到旋转之后的坐标。
以上是关于旋转矩阵旋转向量欧拉角四元数的关系的主要内容,如果未能解决你的问题,请参考以下文章