角度函数偶尔会返回 NaN

Question

我在 Unity 项目中使用了这个角度函数，但它偶尔会返回 NaN，我不明白为什么。我从网上复制了这段代码，所以我不完全理解它是如何工作的

    public static float Angle(Vector3 vec1, Vector3 angleVec, Vector3 vec2)
    {
        float lengthA = Mathf.Sqrt(Mathf.Pow(angleVec.x - vec1.x, 2) + Mathf.Pow(angleVec.y - vec1.y, 2));
        float lengthB = Mathf.Sqrt(Mathf.Pow(vec2.x - angleVec.x, 2) + Mathf.Pow(vec2.y - angleVec.y, 2));
        float lengthC = Mathf.Sqrt(Mathf.Pow(vec2.x - vec1.x, 2) + Mathf.Pow(vec2.y - vec1.y, 2));

        float calc = ((lengthA * lengthA) + (lengthB * lengthB) - (lengthC * lengthC)) / (2 * lengthA * lengthB);
        float returnAngle = Mathf.Acos(calc) * Mathf.Rad2Deg;
        if (System.Single.IsNaN(returnAngle))
        {
            Debug.LogError("NAN");
        }
        return returnAngle;

    }

谁能帮我修复这个代码

Answer 1

余弦函数的范围是[-1, 1]，所以反余弦函数的域是[-1, 1]。这意味着对于 [-1, 1] 之外的任何 x，arccos(x) 是未定义的。

如果lengthA 或lengthB 为0，则calc 为无穷大，acos(infinity) 未定义。

https://dotnetfiddle.net/S3zwr5

您必须编写一个if 语句来处理这种情况。