我写了一个简单的算法来瞄准3D空间。它应该返回从Start
到End
所需的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);
}
结果应该是弧度。 谢谢你的建议。
答案 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);