Skip to content

Next Gen STEP AP242 Native-ish BREP Geometric Modeling Kernel

5.3 KB
Raw Blame
using Aetheris.Kernel.Firmament.FirmamentV2;
using Aetheris.Kernel.Firmament.Materializer;

namespace Aetheris.Kernel.Firmament.Tests;

/// <summary>`|> Round(r)` geometry: the arc is tangent to both trimmed neighbours and joins them continuously.</summary>
public sealed class ProfileCornerRoundTests
{
    public static TheoryData<string, LineArcProfileCurve2D, LineArcProfileCurve2D, double> Corners() => new()
    {
        // Convex and concave line corners, at right and oblique angles.
        { "line-line convex", new LineArcLineSegment2D((-20, 0), (0, 0)), new LineArcLineSegment2D((0, 0), (0, 20)), 3 },
        { "line-line concave", new LineArcLineSegment2D((-20, 0), (0, 0)), new LineArcLineSegment2D((0, 0), (0, -20)), 3 },
        { "line-line oblique", new LineArcLineSegment2D((-20, 0), (0, 0)), new LineArcLineSegment2D((0, 0), (10, 15)), 2 },
        // A line into a clockwise arc whose start tangent turns left of the line.
        { "line-arc", new LineArcLineSegment2D((-20, 0), (0, 0)), new LineArcCircularArc2D((10, 0), 10, Math.PI, -Math.PI / 2), 2 },
        // A counter-clockwise arc into a line leaving it at a corner.
        { "arc-line", new LineArcCircularArc2D((0, 10), 10, -Math.PI / 2, Math.PI / 4), new LineArcLineSegment2D((10 * Math.Sin(Math.PI / 4), 10 - 10 * Math.Cos(Math.PI / 4)), (20, 20)), 1 },
        // Two arcs meeting at a corner.
        { "arc-arc", new LineArcCircularArc2D((0, 10), 10, -Math.PI / 2, Math.PI / 3), new LineArcCircularArc2D((10 * Math.Sin(Math.PI / 3) + 8, 10 - 10 * Math.Cos(Math.PI / 3)), 8, Math.PI, -Math.PI / 3), 1 },
    };

    [Theory]
    [MemberData(nameof(Corners))]
    public void RoundIsTangentAndContinuous(string name, LineArcProfileCurve2D previous, LineArcProfileCurve2D next, double radius)
    {
        var result = ProfileCornerRound.TryRound(previous, next, radius, out var failure);
        Assert.True(result is not null, $"{name}: {failure}");
        Assert.Equal(radius, result.Arc.Radius, 12);
        AssertJoin(result.Previous, result.Arc, name + " entry");
        AssertJoin(result.Arc, result.Next, name + " exit");
        // The centre is exactly one radius from both neighbours' carriers.
        Assert.Equal(radius, CarrierDistance(previous, result.Arc.Center), 9);
        Assert.Equal(radius, CarrierDistance(next, result.Arc.Center), 9);
        // A round replaces a corner, so it turns by less than a half circle.
        Assert.InRange(Math.Abs(result.Arc.SweepAngleRadians), 1e-6, Math.PI);
    }

    [Fact]
    public void TangentJunctionsAndOversizedRadiiAreRefused()
    {
        var line = new LineArcLineSegment2D((-20, 0), (0, 0));
        Assert.Null(ProfileCornerRound.TryRound(line, new LineArcLineSegment2D((0, 0), (20, 0)), 2, out var straight));
        Assert.Contains("tangentially", straight);
        Assert.Null(ProfileCornerRound.TryRound(line, new LineArcLineSegment2D((0, 0), (0, 5)), 8, out var large));
        Assert.Contains("too large", large);
        Assert.Null(ProfileCornerRound.TryRound(line, new LineArcLineSegment2D((1, 0), (1, 5)), 1, out var apart));
        Assert.Contains("do not meet", apart);
    }

    private static void AssertJoin(LineArcProfileCurve2D a, LineArcProfileCurve2D b, string where)
    {
        var (end, tangentA) = EndOf(a); var (start, tangentB) = StartOf(b);
        Assert.True(Math.Abs(end.X - start.X) < 1e-9 && Math.Abs(end.Y - start.Y) < 1e-9, $"{where}: gap {end} -> {start}");
        Assert.True(Math.Abs(tangentA.X * tangentB.Y - tangentA.Y * tangentB.X) < 1e-9 && tangentA.X * tangentB.X + tangentA.Y * tangentB.Y > 0, $"{where}: not tangent");
    }

    private static ((double X, double Y) Point, (double X, double Y) Tangent) StartOf(LineArcProfileCurve2D c) => c switch
    {
        LineArcLineSegment2D l => (l.Start, Unit(l.End.X - l.Start.X, l.End.Y - l.Start.Y)),
        LineArcCircularArc2D a => (Point(a, a.StartAngleRadians), Tangent(a, a.StartAngleRadians)),
        _ => throw new InvalidOperationException()
    };

    private static ((double X, double Y) Point, (double X, double Y) Tangent) EndOf(LineArcProfileCurve2D c) => c switch
    {
        LineArcLineSegment2D l => (l.End, Unit(l.End.X - l.Start.X, l.End.Y - l.Start.Y)),
        LineArcCircularArc2D a => (Point(a, a.StartAngleRadians + a.SweepAngleRadians), Tangent(a, a.StartAngleRadians + a.SweepAngleRadians)),
        _ => throw new InvalidOperationException()
    };

    private static double CarrierDistance(LineArcProfileCurve2D c, (double X, double Y) p) => c switch
    {
        LineArcLineSegment2D l => Math.Abs((l.End.X - l.Start.X) * (p.Y - l.Start.Y) - (l.End.Y - l.Start.Y) * (p.X - l.Start.X)) / Math.Sqrt(Math.Pow(l.End.X - l.Start.X, 2) + Math.Pow(l.End.Y - l.Start.Y, 2)),
        LineArcCircularArc2D a => Math.Abs(Math.Sqrt(Math.Pow(p.X - a.Center.X, 2) + Math.Pow(p.Y - a.Center.Y, 2)) - a.Radius),
        _ => throw new InvalidOperationException()
    };

    private static (double X, double Y) Point(LineArcCircularArc2D a, double t) => (a.Center.X + a.Radius * Math.Cos(t), a.Center.Y + a.Radius * Math.Sin(t));
    private static (double X, double Y) Tangent(LineArcCircularArc2D a, double t) => Unit(-Math.Sin(t) * Math.Sign(a.SweepAngleRadians), Math.Cos(t) * Math.Sign(a.SweepAngleRadians));
    private static (double X, double Y) Unit(double x, double y) { var l = Math.Sqrt(x * x + y * y); return (x / l, y / l); }
}