两个三维向量的夹角计算

最新推荐文章于 2025-05-30 07:38:19 发布

原创最新推荐文章于 2025-05-30 07:38:19 发布 · 4.2w 阅读

26 ·

CC 4.0 BY-SA版权

两个向量的夹角计算公式：θ=acos(v1⋅v2/||v1||||v2||)

需要注意的θ的范围再0~pi之间，怎么解决0~2pi的问题呢？

这里就需要用到向量的叉乘，根据叉乘后的向量与屏幕方向来确定角度是否超过180°。

代码如下：

float Angle(osg::Vec3f line1, osg::Vec3f line2, osg::Vec3f direction)
{
	line1.normalize();
	line2.normalize();
	float temp = (line1 * line2);
	// 1和-1时为0和180°
	if (fabs(fabs(temp) - 1) < EPSILON)
	{
		return temp > 0 ? 0 : osg::PI;
	}
	float angle = (float)acos(temp);

	// 两个向量的叉乘结果与屏幕方向是否一致来判断角度是否超过180°
	osg::Vec3f axis = line1 ^ line2;
	return axis * direction > 0 ? angle : 2 * osg::PI - angle;
}