67 lines
3.1 KiB
C#
67 lines
3.1 KiB
C#
using Microsoft.VisualStudio.TestTools.UnitTesting;
|
||
using NavisworksTransport.Utils.CoordinateSystem;
|
||
using System.Numerics;
|
||
|
||
namespace NavisworksTransport.UnitTests.CoordinateSystem
|
||
{
|
||
[TestClass]
|
||
public class RealObjectProjectedExtentResolverTests
|
||
{
|
||
[TestMethod]
|
||
public void Ground_DualAxisCorrection_ShouldProjectAgainstFinalPose()
|
||
{
|
||
var convention = new ModelAxisConvention(LocalAxisDirection.PositiveX, LocalAxisDirection.PositiveY);
|
||
Vector3 targetForward = Vector3.Normalize(new Vector3(-0.8987f, 0.0f, 0.4386f));
|
||
Vector3 targetUp = Vector3.UnitY;
|
||
|
||
Quaternion baseline = Quaternion.Normalize(Quaternion.CreateFromRotationMatrix(new Matrix4x4(
|
||
-0.8987f, 0.0000f, 0.4386f, 0f,
|
||
0.0000f, 1.0000f, 0.0000f, 0f,
|
||
-0.4386f, 0.0000f,-0.8987f, 0f,
|
||
0f, 0f, 0f, 1f)));
|
||
|
||
var adapter = new HostCoordinateAdapter(CoordinateSystemType.YUp);
|
||
Quaternion final = adapter.ComposeHostQuaternion(
|
||
baseline,
|
||
new LocalEulerRotationCorrection(90.0, 0.0, 90.0));
|
||
|
||
var extents = RealObjectProjectedExtentResolver.CalculateProjectedSemanticExtents(
|
||
convention,
|
||
forwardSize: 6.0,
|
||
sideSize: 2.0,
|
||
upSize: 4.0,
|
||
baseline,
|
||
final,
|
||
targetForward,
|
||
targetUp);
|
||
|
||
Vector3 localSize = convention.CreateScaleVector3(6.0, 2.0, 4.0);
|
||
Vector3 rotatedLocalX = Vector3.Normalize(Vector3.Transform(Vector3.UnitX, final));
|
||
Vector3 rotatedLocalY = Vector3.Normalize(Vector3.Transform(Vector3.UnitY, final));
|
||
Vector3 rotatedLocalZ = Vector3.Normalize(Vector3.Transform(Vector3.UnitZ, final));
|
||
Vector3 targetSide = Vector3.Normalize(Vector3.Cross(targetForward, targetUp));
|
||
|
||
double expectedForward = ProjectExtent(localSize, rotatedLocalX, rotatedLocalY, rotatedLocalZ, targetForward);
|
||
double expectedSide = ProjectExtent(localSize, rotatedLocalX, rotatedLocalY, rotatedLocalZ, targetSide);
|
||
double expectedUp = ProjectExtent(localSize, rotatedLocalX, rotatedLocalY, rotatedLocalZ, targetUp);
|
||
|
||
Assert.AreEqual(expectedForward, extents.forwardExtent, 1e-5);
|
||
Assert.AreEqual(expectedSide, extents.sideExtent, 1e-5);
|
||
Assert.AreEqual(expectedUp, extents.upExtent, 1e-5);
|
||
Assert.AreNotEqual(4.0, extents.upExtent, 1e-3, "双轴旋转后，Ground 的法线尺寸不应停留在旧高度。");
|
||
}
|
||
|
||
private static double ProjectExtent(
|
||
Vector3 localSize,
|
||
Vector3 rotatedLocalX,
|
||
Vector3 rotatedLocalY,
|
||
Vector3 rotatedLocalZ,
|
||
Vector3 targetAxis)
|
||
{
|
||
return System.Math.Abs(Vector3.Dot(rotatedLocalX, targetAxis)) * localSize.X +
|
||
System.Math.Abs(Vector3.Dot(rotatedLocalY, targetAxis)) * localSize.Y +
|
||
System.Math.Abs(Vector3.Dot(rotatedLocalZ, targetAxis)) * localSize.Z;
|
||
}
|
||
}
|
||
}
|