- 博客(11)
- 收藏
- 关注
原创 四元数-坐标系转换-旋转-转欧拉角
1.四元数世界坐标系转换到父节点坐标系下公式:Q=Q父-1*Q子//把四元数转到父坐标系下ChildLocalQuat VDFULL::GetChildLocalQuat(quaternion father,quaternion child){ quaternion invq = father.inv(); // 求出father的逆 quaternion child_loc = invq * child; auto ChildLocal = child_loc.get_vector4
2021-07-26 18:13:09
3691
原创 正向运动学-四元数c++
正向运动学:通过点与点的向量以及向量始点的旋转信息推算出向量末点在空间中的位置。(旋转信息可以是四元数或者旋转矩阵,都是可以相互转化的,本文采取的是四元数的方式)直接上公式:已知四元数Q:P子=P父-(Q*(V父-V子)*Q-1) 已知旋转矩阵Rt:P子=P父-Rt*(V父-V子)首先需要了解一些基本的数学理论向量就不用说了,四元数是(w,x,y,z),需要注意w的位置,一般都是w在前,xyz在后,规范的四元数模数是等于1的,即w^2+x^2+y^2+z...
2021-07-26 17:53:33
1108
2
空空如也
空空如也
TA创建的收藏夹 TA关注的收藏夹
TA关注的人