两个三维向量的夹角计算

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

没有更多推荐了,返回首页