feat: configure MovementTest OSQP iterations

This commit is contained in:
梁薄云
2026-08-05 12:03:28 +08:00
parent 30234d42df
commit 1a94cc2a6b
4 changed files with 23 additions and 1 deletions
@@ -108,6 +108,8 @@ internal static class TrajectoryObservationChecks
"observer MovementTest exposes maximum curvature with Task-1 default");
Verification.True(source.Contains("public double SolverTimeoutSeconds = 0.50d;"),
"observer MovementTest exposes the test solver timeout default");
Verification.True(source.Contains("public int MaximumOsqpIterations = 12000;"),
"observer MovementTest exposes the test OSQP iteration default");
Verification.True(source.Contains("VehicleLengthMeters = VehicleLengthMeters,"),
"observer MovementTest copies vehicle length into settings");
Verification.True(source.Contains("VehicleWidthMeters = VehicleWidthMeters,"),
@@ -118,12 +120,16 @@ internal static class TrajectoryObservationChecks
"observer MovementTest copies maximum curvature into settings");
Verification.True(source.Contains("SolverTimeoutSeconds = SolverTimeoutSeconds,"),
"observer MovementTest copies solver timeout into settings");
Verification.True(source.Contains("MaximumOsqpIterations = MaximumOsqpIterations,"),
"observer MovementTest copies OSQP iteration limit into settings");
string normalizedSource = source.Replace("\r\n", "\n");
Verification.True(normalizedSource.Contains(
"VehicleMotionState state = ReadVehicleState();\n DateTimeOffset now = state.CapturedAtUtc;"),
"observer host uses the fresh state snapshot time for each observation tick");
Verification.NearlyEqual(0.50d, new TrajectoryObservationSettings().SolverTimeoutSeconds,
"observer settings use the test solver timeout default");
Verification.Equal(12000, new TrajectoryObservationSettings().MaximumOsqpIterations,
"observer settings use the test OSQP iteration default");
var configured = new TrajectoryObservationSettings
{
@@ -132,6 +138,7 @@ internal static class TrajectoryObservationChecks
SafetyMarginMeters = 0.08d,
MaximumCurvaturePerMeter = 0.55d,
SolverTimeoutSeconds = 0.42d,
MaximumOsqpIterations = 9000,
};
TrajectoryObservationSettings snapshot = configured.CreateValidatedSnapshot();
configured.VehicleLengthMeters = 9.10d;
@@ -139,6 +146,7 @@ internal static class TrajectoryObservationChecks
configured.SafetyMarginMeters = 9.30d;
configured.MaximumCurvaturePerMeter = 9.40d;
configured.SolverTimeoutSeconds = 9.50d;
configured.MaximumOsqpIterations = 9500;
Verification.NearlyEqual(1.10d, snapshot.VehicleLengthMeters,
"observer settings snapshot freezes vehicle length");
@@ -150,6 +158,8 @@ internal static class TrajectoryObservationChecks
"observer settings snapshot freezes maximum curvature");
Verification.NearlyEqual(0.42d, snapshot.SolverTimeoutSeconds,
"observer settings snapshot freezes solver timeout");
Verification.Equal(9000, snapshot.MaximumOsqpIterations,
"observer settings snapshot freezes OSQP iteration limit");
CoarsePathPlanningJob job = TrajectoryObservationSetupFactory.CreateBootstrapJob(
new Pose2D(0d, 0d, 0d), new Pose2D(1d, 0d, 0d), snapshot,
@@ -171,6 +181,8 @@ internal static class TrajectoryObservationChecks
AssertInvalidSetting(settings => settings.MaximumCurvaturePerMeter = double.PositiveInfinity,
"maximum curvature");
AssertInvalidSetting(settings => settings.SolverTimeoutSeconds = 0d, "solver timeout");
AssertInvalidSetting(settings => settings.MaximumOsqpIterations = 0, "OSQP iteration limit");
AssertInvalidSetting(settings => settings.MaximumOsqpIterations = -1, "negative OSQP iteration limit");
}
private static void AssertInvalidSetting(Action<TrajectoryObservationSettings> mutate, string name)
@@ -392,7 +404,7 @@ internal static class TrajectoryObservationChecks
Verification.NearlyEqual(10.25d, charts.LsSamples[0].PathS, "observer first LS path S");
Verification.NearlyEqual(0.10d, charts.LsSamples[0].LateralOffset, "observer first LS offset");
var settings = new TrajectoryObservationSettings();
var settings = new TrajectoryObservationSettings { MaximumOsqpIterations = 9000 };
CoarsePathPlanningJob job = TrajectoryObservationSetupFactory.CreateBootstrapJob(
new Pose2D(0d, 0d, 0d), new Pose2D(1d, 0d, 0d), settings,
Array.Empty<TrajectoryObservationObstacle>(), 0L);
@@ -416,6 +428,9 @@ internal static class TrajectoryObservationChecks
Verification.NearlyEqual(settings.SolverTimeoutSeconds,
planningService.Requests[0].Configuration.Scheduling.SolverTimeoutSeconds,
"observer configured solver timeout");
Verification.Equal(settings.MaximumOsqpIterations,
planningService.Requests[0].Configuration.Solver.MaximumOsqpIterations,
"observer configured OSQP iteration limit");
TrajectoryObservationObservation observation = controller.Observe(effectiveAt.AddSeconds(0.5d), state);
Verification.NearlyEqual(0.5d, observation.SelectedPoint.TimeFromStart,