以其他矢量为轴旋转矢量
本文关键字:旋转 其他 | 更新日期: 2023-09-27 17:57:55
我在一个项目中需要用v2作为旋转轴来旋转向量v1,但我在向量和旋转方面遇到了一些问题。对此有很多解释,但我找不到一个能解决我问题的。你能解释一下怎么做吗,就好像我是一个五岁的孩子一样?
我试图做的是将四元数导出的矩阵与我的"v1"相乘这样做:
angle = (Convert.ToDouble(Console.ReadLine()) * Math.PI / 180);
cosA = Math.Cos(angle);
sinA = Math.Sin(angle);
oneMinusCosA = 1 - cosA;
matrix[0, 0] = gravityVector[0] * gravityVector[0] * oneMinusCosA + cosA;
matrix[0, 1] = gravityVector[0] * gravityVector[1] * oneMinusCosA + gravityVector[2] * sinA;
matrix[0, 2] = gravityVector[0] * gravityVector[2] * oneMinusCosA - gravityVector[1] * sinA;
matrix[1, 0] = gravityVector[1] * gravityVector[1] * oneMinusCosA - gravityVector[2] * sinA;
matrix[1, 1] = gravityVector[1] * gravityVector[1] * oneMinusCosA + cosA;
matrix[1, 2] = gravityVector[1] * gravityVector[2] * oneMinusCosA - gravityVector[0] * sinA;
matrix[1, 0] = gravityVector[2] * gravityVector[0] * oneMinusCosA - gravityVector[1] * sinA;
matrix[1, 1] = gravityVector[2] * gravityVector[1] * oneMinusCosA - gravityVector[0] * sinA;
matrix[1, 2] = gravityVector[2] * gravityVector[2] * oneMinusCosA + cosA;
result = new double[3];
for (int i = 0; i < 3; i++)
{
result[i] = objectRotation[i] * matrix[i, 0] + objectRotation[i] * matrix[i, 1] + objectRotation[i] * matrix[i, 2];
Console.WriteLine(result[i]);
}
但我得到了错误的结果。有人能帮我理解为什么,或者帮我找到另一个解决方案吗?
示例:
v1(1,0,0) v2(0,1,0) angle=90 -> vf(0,0,-1)
v1(sqrt2/2 , sqrt2/2 , 0) v2(-sqrt2/2 , sqrt2/2 , 0) angle = 90 -> vf(0,0,-1)
*OBS:我需要它应用于每个向量和每个角度,不仅适用于90度(或π/2弧度,无关紧要),也适用于我用作示例的那些向量。
*OBS(2):如果你能用C#(首选)或C++发布代码,我会很高兴。
回答我自己的问题,您可以通过应用以下公式进行旋转:
vf = v1 * cosA + (v1 . v2) * v2 * (1 - cosA) + (v2 x v1) * sinA
下面是如何得出公式:
基本
f垂直于a,v1和v2
*其中p是v1在v2 上的投影
p = (v1 . v2) * v2
a = v1 - p = v1 -(v1 . v2) * v2
f = (v2 x v1)/|(v2 x v1)| * |a|
a'= a * cos(θ) + f * sin(θ)
vf = a'+ p