两个三维向量的夹角计算
程序员文章站
2022-03-31 23:01:43
...
两个向量的夹角计算公式:θ=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;
}
上一篇: matlab查找两个向量中不同的元素
下一篇: 用分类汇总的功能解决无序数据的统计问题