feat: add LeadIn hierarchy (7 classes)

Co-Authored-By: Claude Sonnet 4.6 <noreply@anthropic.com>
2026-03-12 23:07:31 -04:00
parent 9b3cf10222
commit f17db1d2f9
7 changed files with 245 additions and 0 deletions
@@ -0,0 +1,44 @@
+using System.Collections.Generic;
+using OpenNest.Geometry;
+using OpenNest.Math;
+
+namespace OpenNest.CNC.CuttingStrategy
+{
+    public class LineLineLeadIn : LeadIn
+    {
+        public double Length1 { get; set; }
+        public double ApproachAngle1 { get; set; } = 90.0;
+        public double Length2 { get; set; }
+        public double ApproachAngle2 { get; set; } = 90.0;
+
+        public override List<ICode> Generate(Vector contourStartPoint, double contourNormalAngle,
+            RotationType winding = RotationType.CW)
+        {
+            var piercePoint = GetPiercePoint(contourStartPoint, contourNormalAngle);
+
+            var secondAngle = contourNormalAngle + Angle.ToRadians(ApproachAngle1);
+            var midPoint = new Vector(
+                contourStartPoint.X + Length2 * System.Math.Cos(secondAngle),
+                contourStartPoint.Y + Length2 * System.Math.Sin(secondAngle));
+
+            return new List<ICode>
+            {
+                new RapidMove(piercePoint),
+                new LinearMove(midPoint),
+                new LinearMove(contourStartPoint)
+            };
+        }
+
+        public override Vector GetPiercePoint(Vector contourStartPoint, double contourNormalAngle)
+        {
+            var secondAngle = contourNormalAngle + Angle.ToRadians(ApproachAngle1);
+            var midX = contourStartPoint.X + Length2 * System.Math.Cos(secondAngle);
+            var midY = contourStartPoint.Y + Length2 * System.Math.Sin(secondAngle);
+
+            var firstAngle = secondAngle + Angle.ToRadians(ApproachAngle2);
+            return new Vector(
+                midX + Length1 * System.Math.Cos(firstAngle),
+                midY + Length1 * System.Math.Sin(firstAngle));
+        }
+    }
+}