Skip to content

Next Gen STEP AP242 Native-ish BREP Geometric Modeling Kernel

2.7 KB
Raw Blame
using Aetheris.Humanoid;
using Xunit;

namespace Aetheris.Humanoid.Tests;

public sealed class HumanoidRestX2Tests
{
    [Fact]
    public void CanonicalCorpusRoundtripsFromIndependentSourceRest()
    {
        var source = CanonicalAdultTemplate.Create();
        var normalized = HumanoidRestPoseNormalizer.Normalize(source);
        var cases = new[]
        {
            new AnatomicalJointRequest(HumanoidJointKind.LeftShoulder, AbductionDegrees: 90),
            new AnatomicalJointRequest(HumanoidJointKind.LeftElbow, 90),
            new AnatomicalJointRequest(HumanoidJointKind.LeftHip, 70),
            new AnatomicalJointRequest(HumanoidJointKind.LeftHip, AbductionDegrees: 45),
            new AnatomicalJointRequest(HumanoidJointKind.LeftKnee, 90)
        };
        foreach (var request in cases)
        {
            var solved = HumanoidKinematicSolver.Solve(normalized.Skeleton,
                new("roundtrip", normalized.Skeleton.SkeletonId, normalized.Skeleton.RestPoseId, 0, [request]));
            Assert.NotNull(solved.Pose);
            Assert.All(solved.Pose!.SemanticResiduals,
                residual => Assert.InRange(residual.MaximumAbsoluteDegrees, 0, .05));
        }
    }

    [Fact]
    public void Height1800RetainsRestPoseMeasurementsAndAttachments()
    {
        var normalized = HumanoidRestPoseNormalizer.Normalize(CanonicalAdultTemplate.Create());
        var shaped = HumanoidMorphing.Apply(normalized,
            new Dictionary<HumanoidMorphId, double> { [HumanoidMorphId.Height] = 1800 });
        Assert.Equal(CanonicalHumanoidRestPose.Id, shaped.Skeleton.RestPoseId);
        Assert.Equal(normalized.Surface.ConnectivityHash, shaped.Surface.ConnectivityHash);
        var height = HumanoidMeasurements.Evaluate(shaped).Single(x => x.Measurement == HumanoidMeasurementId.Height);
        Assert.True(height.IsValid);
        Assert.Equal(1800, height.ValueMm!.Value, 6);
        var solve = HumanoidKinematicSolver.Solve(shaped.Skeleton,
            new("height1800-shoulder90", shaped.Skeleton.SkeletonId, shaped.Skeleton.RestPoseId,
                shaped.ShapeRevision, [new(HumanoidJointKind.LeftShoulder, AbductionDegrees: 90)]), shaped.ShapeRevision);
        Assert.True(solve.IsSolved, string.Join("; ", solve.Diagnostics.Select(x => x.Code + ": " + x.Message)));
        var pose = solve.Pose!;
        Assert.InRange(pose.SemanticResiduals.Max(x => x.MaximumAbsoluteDegrees), 0, .05);
        foreach (var site in new[] { "site:Wrist.Left", "site:UpperArm.Left", "site:Chest", "site:Waist", "site:Thigh.Left", "site:Foot.Left" })
        {
            var frame = HumanoidPosing.EvaluateAttachment(shaped, site, pose.PoseState);
            Assert.True(double.IsFinite(frame.Position.X + frame.Position.Y + frame.Position.Z));
        }
    }
}