我想找出2个向量(2D,3D)之间的顺时针角度。
点积的经典方式给了我内角(0-180度),我需要使用一些if语句来确定结果是否是我需要的角度或其补码。
您知道直接计算顺时针角度的方法吗?
我想找出2个向量(2D,3D)之间的顺时针角度。
点积的经典方式给了我内角(0-180度),我需要使用一些if语句来确定结果是否是我需要的角度或其补码。
您知道直接计算顺时针角度的方法吗?
Answers:
就像点积与角度的余弦成比例一样,行列式也与其正弦成正比。因此,您可以像这样计算角度:
dot = x1*x2 + y1*y2 # dot product between [x1, y1] and [x2, y2]
det = x1*y2 - y1*x2 # determinant
angle = atan2(det, dot) # atan2(y, x) or atan2(sin, cos)
该角度的方向与坐标系的方向匹配。在左手坐标系中,即x在计算机图形学中很常见,y指向右,y指向下方,这意味着您将获得顺时针角度的正号。如果坐标系的方向是y向上的数学方向,则您将获得数学惯例中的逆时针角度。更改输入的顺序将更改符号,因此,如果您对符号不满意,只需交换输入即可。
在3D中,任意放置的两个矢量定义了自己的旋转轴,垂直于两个方向。该旋转轴没有固定的方向,这意味着您也不能唯一地固定旋转角度的方向。一种常见的约定是让角度始终为正,并以适合正角度的方式定向轴。在这种情况下,归一化向量的点积足以计算角度。
dot = x1*x2 + y1*y2 + z1*z2 #between [x1, y1, z1] and [x2, y2, z2]
lenSq1 = x1*x1 + y1*y1 + z1*z1
lenSq2 = x2*x2 + y2*y2 + z2*z2
angle = acos(dot/sqrt(lenSq1 * lenSq2))
一种特殊情况是矢量不是任意放置,而是位于具有已知法向矢量n的平面内的情况。然后,旋转轴也将沿方向n,并且n的方向将固定该轴的方向。在这种情况下,您可以调整上面的2D计算,包括将n用作行列式以使其尺寸为3×3。
dot = x1*x2 + y1*y2 + z1*z2
det = x1*y2*zn + x2*yn*z1 + xn*y1*z2 - z1*y2*xn - z2*yn*x1 - zn*y1*x2
angle = atan2(det, dot)
起作用的一个条件是法向矢量n具有单位长度。如果不是,则必须将其标准化。
正如@Excrubulent在建议的编辑中指出的那样,该行列式也可以表示为三元乘积。
det = n · (v1 × v2)
这在某些API中可能更容易实现,并且对这里发生的事情给出了不同的看法:叉积与角度的正弦成比例,并且将垂直于平面,因此是n的倍数。因此,点积将基本上测量该矢量的长度,但要附加正确的符号。
qAtan2(y, x)
Qt框架的实现,但是如果有人和我有同样的问题,这可能会有所帮助。
atan2
通常在[-180°,180°]范围内。为了得到[0°,360°]无的情况下区别,一个可以取代atan2(y,x)
用atan2(-y,-x) + 180°
。
要计算角度,您只需调用atan2(v1.s_cross(v2), v1.dot(v2))
2D情况。哪里s_cross
是叉积的标量模拟(平行四边形的有符号面积)。对于2D情况,将是楔形生产。对于3D情况,您需要定义顺时针旋转,因为从平面的一侧是顺时针方向是一个方向,从平面的另一侧是另一个方向=)
编辑:这是逆时针角度,顺时针角度正好相反
atan2f
将y坐标作为第一个参数,因此应为angle = atan2f(v2.y, v2.x) - atan2f(v1.y, v1.x)
。
cross
,并dot
通过在2D情况下的明确公式,这将消除所有疑虑cross
返回三维矢量(但是这只是一个建议,你可以忽略)。-否则,我喜欢这种解决方案,因为它只需要一个atan2f
函数调用。
这个答案与MvG的答案相同,但解释不同(这是我努力理解MvG解决方案为何有效的结果)。我将其发布给其他人发现它很有帮助的机会。
相对于给定法线()的视点,theta
从x
到的逆时针角度为y
n
||n|| = 1
atan2(dot(n,cross(x,y)),dot(x,y))
(1)= atan2(|| x || || y ||sinθ,|| x || || y ||cosθ)
(2)= atan2(sin(theta),cos(theta))
(3)= x轴与向量之间的逆时针角度(cos(theta),sin(theta))
(4)=θ
其中||x||
表示的大小x
。
步骤(1)注意
cross(x,y)= || x || || y || sin(θ)n,
所以
点(n,交叉(x,y))
=点(n,|| x || || y ||sinθn)
= || x || || y || sin(θ)点(n,n)
等于
|| x || || y || 罪恶(theta)
如果||n|| = 1
。
步骤(2)从的定义开始atan2
,注意atan2(cy, cx) = atan2(y,x)
,其中c
是标量。步骤(3)从的定义开始atan2
。步骤(4)从的几何定义如下cos
和sin
。
两个向量的标量(点)乘积可让您获得它们之间角度的余弦值。要获得角度的“方向”,您还应该计算叉积,它将使您(通过z坐标)检查角度是否为顺时针方向(即,是否应从360度中提取角度)。
对于2D方法,可以使用余弦定律和“方向”方法。
要计算段P3:P1顺时针扫描到段P3:P2的角度。
P1 P2 P3
double d = direction(x3, y3, x2, y2, x1, y1);
// c
int d1d3 = distanceSqEucl(x1, y1, x3, y3);
// b
int d2d3 = distanceSqEucl(x2, y2, x3, y3);
// a
int d1d2 = distanceSqEucl(x1, y1, x2, y2);
//cosine A = (b^2 + c^2 - a^2)/2bc
double cosA = (d1d3 + d2d3 - d1d2)
/ (2 * Math.sqrt(d1d3 * d2d3));
double angleA = Math.acos(cosA);
if (d > 0) {
angleA = 2.*Math.PI - angleA;
}
This has the same number of transcendental
上面建议的操作,只有一个或多个浮点运算。
它使用的方法是:
public int distanceSqEucl(int x1, int y1,
int x2, int y2) {
int diffX = x1 - x2;
int diffY = y1 - y2;
return (diffX * diffX + diffY * diffY);
}
public int direction(int x1, int y1, int x2, int y2,
int x3, int y3) {
int d = ((x2 - x1)*(y3 - y1)) - ((y2 - y1)*(x3 - x1));
return d;
}
如果以“直接方式”表示避免 if
声明,那么我认为没有真正通用的解决方案。
但是,如果您的特定问题允许在角度离散化中损失一些精度,并且可以在类型转换中花费一些时间,则可以将phi角度的[-pi,pi)允许范围映射到某些有符号整数类型的允许范围内。然后,您将免费获得互补性。但是,我实际上并没有真正使用此技巧。最有可能的是,浮点数到整数和整数到浮点数转换的开销将超过直接性的任何好处。当完成大量角度计算时,最好在编写可自动向量化或可并行化的代码时设置优先级。
另外,如果您的问题详细信息使得在角度方向上肯定有更多可能的结果,那么您可以使用编译器的内置函数将此信息提供给编译器,从而可以更有效地优化分支。例如,在gcc的情况下,这就是__builtin_expect
功能。将其包装到诸如此类likely
和unlikely
宏中(例如在Linux内核中)时,使用起来会更方便:
#define likely(x) __builtin_expect(!!(x), 1)
#define unlikely(x) __builtin_expect(!!(x), 0)
在两个向量xa,ya和xb,yb之间的顺时针2D情况的公式。
角度(vec.a-vec,b)= pi()/ 2 *((1 + sign(ya))*(1-sign(xa ^ 2))-(1 + sign(yb))*(1-符号(xb ^ 2))
+pi()/4*((2+sign(ya))*sign(xa)-(2+sign(yb))*sign(xb))
+sign(xa*ya)*atan((abs(ya)-abs(xa))/(abs(ya)+abs(xa)))
-sign(xb*yb)*atan((abs(yb)-abs(xb))/(abs(yb)+abs(xb)))
只需复制并粘贴。
angle = (acos((v1.x * v2.x + v1.y * v2.y)/((sqrt(v1.x*v1.x + v1.y*v1.y) * sqrt(v2.x*v2.x + v2.y*v2.y))))/pi*180);
别客气 ;-)
std::atan2()
?