test: verify lateral LS scenarios

2026-08-04 08:52:05 +08:00
parent f19df53f73
commit 4d83ed2036
4 changed files with 249 additions and 5 deletions
@@ -41,7 +41,7 @@ public sealed class SequentialConvexOptimizer
        }

        LateralCandidate iterate = CreateInitialIterate(input);
-        var warmStart = Array.Empty<double>();
+        var warmStart = new double[new LateralVariableLayout(input.ReferenceStations.Count).VariableCount];
        LateralPath lastValidatedPath = null;
        double previousObjective = 0d;
        bool hasPreviousObjective = false;