为什么这个简单的算法总是返回相同的值?

时间:2011-04-13 12:34:44

标签: c# algorithm xna


我写了一个简单的算法来瞄准3D空间。它应该返回从StartEnd所需的X,Y和Z旋转。 出于某种原因,无论我如何操纵End,它总是返回相同的值 这里出了点问题,但我无法理解。有人可以告诉我我做错了吗?

public static void CalcAngle(Vector3 start, Vector3 end, out float xAngle,
 out float yAngle, out float zAngle, bool Radians)
    {
        Vector2 xzPlaneStart = new Vector2(start.X, start.Z);
        Vector2 xzPlaneEnd = new Vector2(end.X, end.Z);
        Vector2 xyPlaneStart = new Vector2(start.X, start.Y);
        Vector2 xyPlaneEnd = new Vector2(end.X, end.Y);
        Vector2 zyPlaneStart = new Vector2(start.Z, start.Y);
        Vector2 zyPlaneEnd = new Vector2(end.Z, end.Y);

        float xrot, yrot, zrot;
        xrot = yrot = zrot = float.NaN;
        xrot = CalcAngle2D(zyPlaneStart, zyPlaneEnd); //Always 0.78539
        yrot = CalcAngle2D(xzPlaneStart, xzPlaneEnd); //Always -2.3561945
        zrot = CalcAngle2D(xyPlaneStart, xyPlaneEnd); //Always 0.78539
        if (Radians)
        {
            xAngle = xrot;
            yAngle = yrot;
            zAngle = zrot;
        }
        else
        {
            xAngle = MathHelper.ToDegrees(xrot);
            yAngle = MathHelper.ToDegrees(yrot);
            zAngle = MathHelper.ToDegrees(zrot);
        }
    }
    public static float CalcAngle2D(Vector2 v, Vector2 end)
    {
        float xlen = end.X - v.X;
        float ylen = end.Y - v.Y;
        return (float)Math.Atan2((double)ylen, (double)ylen);
    }

结果应该是弧度。 谢谢你的建议。

2 个答案:

答案 0 :(得分:4)

您是否注意到在ylen

中使用了CalcAngle2D?两次
return (float)Math.Atan2((double)ylen, (double)ylen); 

xlen中使用Math.Atan2(double y, double x),并评估该计划的正确性。

答案 1 :(得分:2)

你不应该在xlen中回复CalcAngle2D吗?

return (float)Math.Atan2((double)**xlen**, (double)ylen);