欢迎您访问程序员文章站本站旨在为大家提供分享程序员计算机编程知识!
您现在的位置是: 首页

两个三维向量的夹角计算

程序员文章站 2022-03-31 23:01:43
...

两个向量的夹角计算公式:θ=acos(v1v2/||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;
}