相对四元数计算的关节角测量

时间:2018-12-08 05:19:40

标签: quaternions euler-angles

我正在尝试使用2个IMU计算肘关节的角度,但是我的计算不一致,这是我的计算方法:

我正在尝试使用2个包含陀螺仪,加速度计和磁力计的IMU计算肘关节的角度。我在腕部和肘部之间放置了一个IMU,在肘部和肩膀之间放置了另一个。校准后,我认为初始位置是将手臂放下(大约垂直于地面)。

现在我想要的是,如果我将肘部固定到某个角度,无论我如何在3D空间中移动手臂,由于肘部角度是固定的,因此两个IMU的角度计算应给出相同的值

这是我的计算方式(相对于上臂): q_u-上臂四元数(规范化) q_l-下臂四元数(标准化)

quatDiff = q_u * inverse(q_l)

但是问题是,当我在3D空间中移动手臂时,quatDiff获得了不同的值。

有人可以解释一下,此计算中存在什么问题或正确的解决方法是什么?

谢谢。

0 个答案:

没有答案