四元数基本概念&&四元数3D旋转(求两个四元数的夹角)

四元数基本概念

  • 1. 四元数定义
  • q=a+bi+cj+dk (a,b,c,d\in \mathbb{R})
  • i^{2}=j^{2}=k^{2}=ijk=-1
  • 向量形式:q=\begin{bmatrix} a\\ b\\ c\\ d\\ \end{bmatrix}
  • 模长:\left \| q \right \|=\sqrt{a^{2}+b^{2}+c^{2}+d^{2}}
  • 2. 四元数加减法
  • q1=a+bi+cj+dk     q2=e+fi+gj+hk
  • q1\pm q2=\left ( a\pm e \right )+\left ( b\pm f \right )i+\left ( c\pm g \right )j+\left ( d\pm h \right )k
  • 3. 四元数的逆和共轭
  • qq-1=q-1q=1(q\neq 0)
  • q=a+bi+cj+dk  q*=a-bi-cj-dk
  • q*q=qq*=\left \| q \right \|^{2}  q-1=\frac{q*}{\left \| q \right \|^{2}}
  • 当q是单位四元数时,q-1=q*
  • 4. 四元数乘法
  • 4.1 标量乘法
  • q=a+bi+cj+dk    ;   标量s
  • sq=sa+sbi+scj+sdk  四元数与标量相乘满足乘法交换律:sq=qs
  • 4.2 四元数的乘法
  • q1=a+bi+cj+dk       q2=e+fi+gj+hk        q1\cdot q2\not \neq q2\cdot q1
  • 1ijk
    11ijk
    ii-1k-j
    jj-k-1i
    kkj-i-1
  • q1\cdot q2=\left ( a+bi+cj+dk \right )\cdot \left ( e+fi+gj+hk \right )\\=\left ( ae+afi+agj+ahk \right )+\left ( bei+bfi^{2}+bgij+bhik \right )+\left ( cej+cfji+cgj^{2}+chjk \right )+\left ( dek+dfki+dgkj+dhk^{2} \right )\\=\left ( ae-bf-cg-dh \right )+\left ( be+af-dg+ch \right )i+\left ( ce+df+ag-bh \right )j+\left ( de-cf+bg+ah \right )k
  • 写成矩阵形式:q1\cdot q2=\begin{bmatrix} a & -b& -c &-d \\ b & a& -d& c\\ c & d& a&-b \\ d& -c& b& a \end{bmatrix}\begin{bmatrix} e\\ f\\ g\\ h \end{bmatrix}      q2\cdot q1=\begin{bmatrix} a & -b& -c &-d \\ b & a& d&- c\\ c & -d& a&b \\ d& c& -b& a \end{bmatrix}\begin{bmatrix} e\\ f\\ g\\ h \end{bmatrix}

 四元数3D旋转

 四元数q1,经过旋转四元数q后得到四元数q2

qq1=q2(左乘)     q=q2q1^{-1}

q1^{-1}=q*=a-bi-cj-dk

q2q1^{-1}=\begin{bmatrix} e& -f& -g& -h\\ f& e & -h&g \\ g & h & e &-f \\ h &-g &f & e \end{bmatrix}\begin{bmatrix} a\\ -b\\ -c\\ -d \end{bmatrix}

四元数转欧拉角:

\left\{\begin{matrix} \varphi =arctan2\left ( \frac{2\left ( ab+cd \right )}{1-2\left ( b^{2} +c^{2}\right )^{2}} \right )\\ \theta =arcsin\left ( 2\left ( ac-bd \right ) \right )\\ \psi =arctan2\left ( \frac{2\left ( ad+bc \right )}{1-2\left ( c^{2} +d^{2}\right )^{2}} \right ) \end{matrix}\right.

计算出三轴欧拉角,欧拉角具有旋转顺序

 

 

  • 0
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 2
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值