public Box3D(float xMin, float yMin, float zMin, float xMax, float yMax, float zMax)
{
MinEdge = new Vector3D();
MaxEdge = new Vector3D();
MinEdge.Set(xMin, yMin, zMin);
MaxEdge.Set(xMax, yMax, zMax);
}
public IrrlichtNETCP.Vector3D CalculateSphericalCameraCoordinates(IrrlichtNETCP.Vector3D camPos,
IrrlichtNETCP.Vector3D targetPos)
{
float xCamRotationAnglePHI, xCamRotationAngleTHETA;
IrrlichtNETCP.Vector3D result = new IrrlichtNETCP.Vector3D(); // result is spherical coordinates as a 3D vector in (radius, theta, phi) order
IrrlichtNETCP.Vector3D relCamPos = camPos - targetPos;
float camDistance = (float)Math.Sqrt(relCamPos.DotProduct(relCamPos));
xCamRotationAnglePHI = 0.5f * (float)Math.PI - (float)Math.Asin((double)(relCamPos.Y / camDistance));
if (xCamRotationAnglePHI < 0.0)
{
xCamRotationAnglePHI += 2.0f * (float)Math.PI;
}
if (Math.Abs(relCamPos.X) > 0.0)
{
xCamRotationAngleTHETA = (float)Math.Atan((double)(relCamPos.Z / relCamPos.X));
if (relCamPos.X < 0.0f)
{
xCamRotationAngleTHETA += (float)Math.PI;
}
if (xCamRotationAngleTHETA < 0.0)
{
xCamRotationAngleTHETA += 2.0f * (float)Math.PI;
}
}
else
{
if (relCamPos.Z > 0)
{
xCamRotationAngleTHETA = 0.5f * (float)Math.PI; // 90 deg
}
else
{
xCamRotationAngleTHETA = 1.5f * (float)Math.PI; // 270 deg
}
}
result.Set(camDistance, xCamRotationAngleTHETA, xCamRotationAnglePHI);
return result;
}