Почему этот простой algorthim всегда возвращает одно и то же значение?

Question

Я написал простой алгоритм для прицеливания в трехмерном пространстве.Он должен возвращать X, Y и Z вращение, необходимое для указания от Start до End.По какой-то причине он всегда возвращает одни и те же значения, независимо от того, как я манипулирую 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);
    }

Результат должен быть в радианах.Спасибо за совет.

Answer 1

Заметили ли вы, что вы используете ylen дважды в CalcAngle2D?

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

Используйте xlen в соответствующих случаях в Math.Atan2(double y, double x) и оцените правильность программы.

Answer 2

Разве вы не должны возвращать xlen в CalcAngle2D?

т.е.

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