Wolfram Alpha 告诉我这q=(7.0711e-01,1.5272e-16,-7.0711e-01,0e+00)
是一个旋转,结果在用于生成四元数的数据的上下文中是有意义的(基于分析最小二乘点的一些简单测试数据的配准......)。
我的代码给了我一个不同的答案,但我不知道为什么。我已经检查了我的代码几次,但我没有发现任何东西。那可能只是我需要睡觉,明天可能会非常明显,但我不确定。
代码:
// given a column vector q known to be a unit quaternion
double xx = q[0]*q[0], xy = q[0]*q[1], xz = q[0]*q[2], xw = q[0]*q[3];
double yy = q[1]*q[1], yz = q[1]*q[2], yw = q[1]*q[3];
double zz = q[2]*q[2], zw = q[2]*q[3];
arma::mat rotation;
// yes, I know I could get rid of some of these multiplications
rotation << (1 - 2 * yy - 2 * zz) << (2 * xy - 2 * zw) << (2 * xz + 2 * yw)
<< arma::endr
<< (2 * xy + 2 * zw) << (1 - 2 * xx - 2 * zz) << (2 * yz - 2 * xw)
<< arma::endr
<< (2 * xz - 2 * yw) << (2 * yz + 2 * xw) << (1 - 2 * xx - 2 * yy)
<< arma::endr;
// and now I have the wrong result
我的结果:
-2.2204e-16 2.1598e-16 -1.0000e+00
2.1598e-16 -1.0000e+00 -2.1598e-16
-1.0000e+00 -2.1598e-16 2.2204e-16