使用偏航和俯仰创建旋转矩阵并模拟FPS摄像机

时间:2014-07-05 12:01:43

标签: c# opengl 3d

首先,我必须说我想在这里做的只是关于点,而不是对象或任何其他东西。我在这里使用OpenGL更多的是用于计算。

所以这是我的问题。我想在我的2D环境中显示一些3d点(例如winform或图像); 为此,我写了这个函数:(它是在C#中使用OpenTK(OpenGL包装器)但我相信如果你知道OpenGL,你可以理解它,无论你对C#的了解如何)

    private Vector3 GetProjectedLocation(
        Vector3 pointPosition,
        Vector3 cameraPosition,
        Matrix4 cameraRotationMatrix)
    {
        float horizentalFov = MathHelper.DegreesToRadians(60.0f);
        float viewRatio = (float)this.RenderSize.Width / this.RenderSize.Height;
        Vector3 cameraReference = new Vector3(0, 0, -1);
        Vector3 transformedReference = Vector3.Transform(cameraReference, Matrix4.Invert(cameraRotationMatrix));
        Vector3 cameraLookatTarget = cameraPosition + transformedReference;
        Matrix4 modelMatrix = Matrix4.Identity;
        Matrix4 viewMatrix = Matrix4.LookAt(cameraPosition, cameraLookatTarget, new Vector3(0, 1, 0));
        Matrix4 projectionMatrix = Matrix4.CreatePerspectiveFieldOfView(horizentalFov, viewRatio, 0.1f, 100.0f);
        Matrix4 viewModelMatrix = viewMatrix * modelMatrix;
        return Helper.Project(
            pointPosition,
            viewModelMatrix,
            projectionMatrix,
            new Rectangle(new Point(), this.RenderSize));
    }

我还写了另一个名为Project cuz的函数,我在O​​penTK中找不到它:

    public static Vector3 Project(Vector3 point, Matrix4 viewmodel, Matrix4 projection, Rectangle viewport)
    {
        Vector4 point4 = new Vector4(point, 1.0f);
        Vector4 pointModel = Vector4.Transform(point4, viewmodel);
        Vector4 pointProjection = Vector4.Transform(pointModel, projection);
        pointProjection.W = (float)(1.0 / pointProjection.W);
        pointProjection.X *= pointProjection.W;
        pointProjection.Y *= pointProjection.W;
        pointProjection.Z *= pointProjection.W;
        return new Vector3
                   {
                       X = (float)((pointProjection.X * 0.5 + 0.5) * viewport.Width + viewport.X),
                       Y = (float)((pointProjection.Y * 0.5 + 0.5) * viewport.Height + viewport.Y),
                       Z = (float)((1.0 + pointProjection.Z) * 0.5)
                   };
    }

当所有三个值(偏航,俯仰和滚转)都为零时,它似乎按预期工作。我可以通过改变偏航和使用音高值垂直移动水平点。 Roll也按照应有的方式移动它。

当我将音高设置为90度时,问题就出现了。在这种情况下,偏航而不是水平移动,垂直移动,更糟糕的是,仅将其向下移动。无论我走向正面还是负面(-20度或+ 20度)它总是会下降。有趣的是,当音高为90度时,Roll具有相同的效果,它只能像偏航那样垂直向下移动。将音高设置为-90deg具有相同的效果,但此时的偏航和滚动仅将其向上移动。

当我的两个轴平行时我看起来像万向节锁定问题而且我丢失了一个方向,在这种情况下是滚动。我仍然不明白为什么偏航只能朝一个方向发挥作用。

任何方式,问题在于这种锁定在垂直查看时发生,这是我的程序在大多数时间看起来的地方。我已经读过如果我改变旋转顺序,我可以将万向节锁移到顶部(不太常见的地方)。我尝试过多次订单而找不到好订单。所以这是我的代码,也许我做错了:

    private Matrix4 CreateRotationMatrix(char axis, float radians)
    {
        float c = (float)Math.Cos(radians);
        float s = (float)Math.Sin(radians);

        if (axis == 'X')
        {
            return new Matrix4(1.0f, 0.0f, 0.0f, 0.0f, 0.0f, c, -s, 0.0f, 0.0f, s, c, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f);
        }
        if (axis == 'Y')
        {
            return new Matrix4(c, 0.0f, s, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, -s, 0.0f, c, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f);
        }
        return new Matrix4(c, -s, 0.0f, 0.0f, s, c, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 0.0f, 1.0f);
    }

    private Matrix4 MatrixFromEulerAngles(Vector3 euler, string order)
    {
        return CreateRotationMatrix(order[2], GetEulerAngle(order[2], euler))
               * CreateRotationMatrix(order[1], GetEulerAngle(order[1], euler))
               * CreateRotationMatrix(order[0], GetEulerAngle(order[0], euler));
    }

    private float GetEulerAngle(char angle, Vector3 euler)
    {
        if (angle == 'X') return euler.X;
        if (angle == 'Y') return euler.Y;
        return angle == 'Z' ? euler.Z : 0f;
    }

你有什么想法吗?

以下是我知道的订单: “XYZ”,“XZY”,“YXZ”,“YZX”,“ZXY”,“ZYX”

我可以提供一个示例程序来自己查看问题。

1 个答案:

答案 0 :(得分:1)

我认为问题的一部分来自您在第一个代码块中使用LookAt函数。这些功能的工作方式是计算本地" up"通过查看全球" up"矢量,它垂直于你正在寻找的方向。在您查找的情况下,全局" up"向量(上述代码中的(0,1,0))没有与观察方向垂直的分量,结果可能是不确定的或不稳定的。当你向下看时也是如此。

相反,尝试计算" up" LookAt函数的向量为:

Vector3 localUpVec = Vector3.Transform(new Vector3(0, 1, 0), Matrix4.Invert(cameraRotationMatrix));
Matrix4 viewMatrix = Matrix4.LookAt(cameraPosition, cameraLookatTarget, localUpVec);

或者甚至更好,您可以完全绕过LookAt功能并自行计算:

Matrix4 viewMatrix = Matrix4.Subtract( Matrix4.Transpose(cameraRotationMatrix), Matrix4.Translation(cameraPosition) );