无法根据俯仰和偏航正确计算法线/方向矢量

Question

我的投球和打哈欠都搞砸了。我有垫子的俯仰和偏航，但光束的俯仰和偏航都搞砸了。如何计算垫的俯仰和偏航的法向量？我在stackoverflow上尝试了一大堆数学，但到目前为止都失败了。

我接下来尝试做的是将光束的俯仰和偏航从垫子的俯仰和偏航中分离出来，并分别计算它们。这基本上有效，但偏航仍然完全混乱。

我过去是通过光束的偏航和俯仰来计算方向向量的，这是一个util minecraft用来计算暴徒的方向向量：

public static Vec3d getVectorForRotation3d(float pitch, float yaw) {
    float f = MathHelper.cos(-yaw * 0.017453292F - (float) Math.PI);
    float f1 = MathHelper.sin(-yaw * 0.017453292F - (float) Math.PI);
    float f2 = -MathHelper.cos(-pitch * 0.017453292F);
    float f3 = MathHelper.sin(-pitch * 0.017453292F);
    return new Vec3d((double) (f1 * f2), (double) f3, (double) (f * f2));
}

但这显然失败了，所以最后，我尝试了以下使用垫的音高：

    double pitch = ((te.getPadPitch() + 90) * Math.PI) / 180;
    double yaw = ((te.getPadYaw() + 90) * Math.PI) / 180;
    double x = Math.sin(pitch) * Math.cos(yaw);
    double y = Math.sin(pitch) * Math.sin(yaw);
    double z = Math.cos(pitch);
    Vec3d lookvec = new Vec3d(x, y, z);

俯仰和偏航都是按照球员头部旋转的方式计算的。当我在垫子上使用垫子时，垫子的俯仰和偏航是100%正确的，但当我在横梁上使用垫子时，垫子的俯仰和偏航是错误的。它们都使用GL函数

虽然俯仰和偏航不尊重球员头部的方向系统，但它与垫板一起工作。

    GlStateManager.rotate(te.getPadYaw(), 0, 0, 1);
    GlStateManager.rotate(te.getPadPitch(), 1, 0, 0);

这条线是这样画的：

    public static void drawConnection(BlockPos pos1, BlockPos pos2, Color color) {
    GlStateManager.pushMatrix();

    GL11.glLineWidth(1);

    GlStateManager.disableTexture2D();
    GlStateManager.color(color.getRed(), color.getGreen(), color.getBlue(), 0.7f);
    GlStateManager.translate(0.5, 0.7, 0.5);

    VertexBuffer vb = Tessellator.getInstance().getBuffer();
    vb.begin(GL11.GL_LINES, DefaultVertexFormats.POSITION);
    vb.pos(pos2.getX() - pos1.getX(), pos2.getY() - pos1.getY(), pos2.getZ() - pos1.getZ()).endVertex();
    vb.pos(0, 0, 0).endVertex();
    Tessellator.getInstance().draw();

    GlStateManager.enableTexture2D();

    GlStateManager.popMatrix();
}

我得到了pos1和pos2（目前，最近）：

        double pitch = ((te.getPadPitch() + 90) * Math.PI) / 180;
    double yaw = ((te.getPadYaw() + 90) * Math.PI) / 180;
    double x = Math.sin(pitch) * Math.cos(yaw);
    double y = Math.sin(pitch) * Math.sin(yaw);
    double z = Math.cos(pitch);
    Vec3d lookvec = new Vec3d(x, y, z);

    Vec3d centervec = new Vec3d(te.getPos().getX() + 0.5, te.getPos().getY() + 0.8, te.getPos().getZ() + 0.5);
    Vec3d startvec = centervec.add(lookvec);

    Vec3d end = startvec.add(new Vec3d(lookvec.xCoord * 30, lookvec.yCoord * 30, lookvec.zCoord * 30));
    RayTraceResult result = te.getWorld().rayTraceBlocks(startvec, end, true, false, true);
    Utils.drawConnection(te.getPos(), result.getBlockPos(), Color.RED);

我如何计算法向量或垂直于刹车片的向量，从刹车片的俯仰和偏航来计算？

我现在不知所措，因为我几乎尝试了在谷歌上找到的所有东西，大部分都没有运气。

编辑：有人告诉我，将光束的俯仰和偏航与垫的俯仰和偏航分开是不必要的，我同意，但我就是不能让它以其他方式工作。为什么光束绘制数学与垫数学不同？

Answer 1

Minecraft的偏航旋转有点奇怪。它们不会夹在0到360之间。例如，如果你向右旋转头部很长时间，你最终会旋转超过1000度。当夹在0到360度之间时，1000度变成280度。如果数字是负数，那么你应该从360中减去这个数字。这是一个夹在0到360之间的角度的例子：

public static float clamp(float angle) {
    angle = angle % 360; // Gets the remainder when dividing angle by 360
    if(angle < 0) {
        angle = 360 - angle;
    }
    return angle;
}

如果您使用此设置角度，事情将始终在0到360之间。此外，这是直接来自MCP源代码的片段，其中旋转偏航/俯仰被转换为旋转矢量：

/**
 * Creates a Vec3 using the pitch and yaw of the entities rotation.
 */
protected final Vec3 getVectorForRotation(float pitch, float yaw)
{
    float f = MathHelper.cos(-yaw * 0.017453292F - (float)Math.PI);
    float f1 = MathHelper.sin(-yaw * 0.017453292F - (float)Math.PI);
    float f2 = -MathHelper.cos(-pitch * 0.017453292F);
    float f3 = MathHelper.sin(-pitch * 0.017453292F);
    return new Vec3(f1 * f2, f3, f * f2);
}

Answer 2

我不确定这是否是你的问题，但对我来说，当我处理它们时，mc返回了一些混乱的偏航位置，这就是我如何修复的

    if (Yaw < -180.0) Yaw += 360;
    else if (Yaw > 180) Yaw -= 360;