feat: host EM observation dashboard

This commit is contained in:
梁薄云
2026-08-06 11:48:46 +08:00
parent 819ff7324b
commit fbd3ba618a
4 changed files with 361 additions and 13 deletions
@@ -24,6 +24,7 @@ internal static class TrajectoryObservationChecks
VerifiesObservationSourceUsesRequiredOperatorText();
VerifiesOperatorDocumentationUsesExactUiEntry();
VerifiesMovementTestVehicleInputsAndSettingsSnapshot();
VerifiesMovementTestKeepsNativePainterLazyAndConditional();
VerifiesPlanningConfigurationDiagnosticUsesEffectiveConfiguration();
RejectsInvalidObservationSettings();
VerifiesStartGoalBoundsUseOnlyConfiguredPadding();
@@ -1025,6 +1026,17 @@ internal static class TrajectoryObservationChecks
}
}
private static void VerifiesMovementTestKeepsNativePainterLazyAndConditional()
{
string movementTestPath = Path.Combine(Directory.GetCurrentDirectory(), "ClumsyPilot",
"ParkrobTrajplanner", "tarjplanner_movementtest", "MovementTest.TrajectoryObservationTest.cs");
string source = new UTF8Encoding(false, true).GetString(File.ReadAllBytes(movementTestPath));
Verification.True(!source.Contains("static readonly TrajectoryObservationPresentation"),
"MovementTest has no static eager Painter presentation");
Verification.True(source.Contains("settings.EnableNativePainterVisualization ? new TrajectoryObservationPresentation() : null"),
"MovementTest creates Painter only under the native visualization flag");
}
private static bool Throws(Action action)
{
try { action(); return false; }
@@ -1,6 +1,7 @@
using System;
using System.Collections.Generic;
using System.Globalization;
using System.IO;
using System.Linq;
using System.Reflection;
using System.Threading;
@@ -20,6 +21,8 @@ internal static class TrajectoryObservationVisualizationChecks
VerifiesKinematicChartsKeepKnotAndIntervalSemantics();
VerifiesHandoffUsesSharedReferenceSAndSurvivesProjectionFailure();
VerifiesDynamicSnapshotContainsObservationEvidenceWithoutCyclePoints();
VerifiesWebPublisherFusesFaultWithoutStoppingObserverTicks();
VerifiesWebPublisherGatesAtConfiguredCadenceAndSkipsDisabledOutput();
}
private static void VerifiesStaticSnapshotExportsFrozenConfigurationAndGeometry()
@@ -215,6 +218,116 @@ internal static class TrajectoryObservationVisualizationChecks
"projection failure is reported while dynamic snapshot construction remains available");
}
private static void VerifiesWebPublisherFusesFaultWithoutStoppingObserverTicks()
{
var settings = new TrajectoryObservationSettings { EnableWebVisualization = true };
var sink = new RecordingVisualizationSink { ThrowOnPublish = true };
var logs = new List<string>();
var publisher = new TrajectoryObservationVisualizationPublisher(settings, sink, logs.Add);
DateTimeOffset now = DateTimeOffset.UnixEpoch;
publisher.Start(CreateStaticSnapshot(settings));
Verification.True(!publisher.TryPublish(now, () => CreateDynamicSnapshot(now)),
"publisher reports a failed web publish");
Verification.True(!publisher.TryPublish(now.AddSeconds(1d), () => throw new InvalidOperationException("must not build after fuse")),
"publisher permanently disables web output after the first fault");
Verification.Equal(1, sink.PublishCalls, "publisher invokes the throwing sink once");
Verification.Equal(1, sink.StopCalls, "publisher stops the sink once after its fault");
Verification.Equal(1, logs.Count, "publisher logs the web fault once");
Verification.True(publisher.FaultReason.Contains("网页"), "publisher records an immutable Chinese web fault reason");
TrajectoryObservationBootstrapResult bootstrap = Bootstrap(settings);
DateTimeOffset tickAt = now.AddSeconds(1d);
var controller = new TrajectoryObservationController(bootstrap, settings,
new FixedPlanningService(CreateTrajectory("publisher-loop", tickAt, 2, EmTerminalType.Goal,
EmLongitudinalMode.RollingContinuation, TravelDirection.Forward)), "publisher-loop");
var loop = new TrajectoryObservationLoop(controller);
var state = new VehicleMotionState(new Pose2D(0d, 0d, 0d), 0d, null, tickAt, 1L);
TrajectoryObservationLoopTick firstTick = loop.Tick(tickAt, state, CancellationToken.None);
TrajectoryObservationLoopTick secondTick = loop.Tick(tickAt.AddSeconds(settings.ObserverPeriodSeconds), state,
CancellationToken.None);
Verification.True(firstTick.PlanningStarted || secondTick.PlanningStarted || secondTick.PlanningCompleted,
"observer loop continues producing ticks after a web publisher fault");
}
private static void VerifiesWebPublisherGatesAtConfiguredCadenceAndSkipsDisabledOutput()
{
var settings = new TrajectoryObservationSettings
{
EnableWebVisualization = true,
WebRefreshRateHz = 10d,
};
var sink = new RecordingVisualizationSink();
var publisher = new TrajectoryObservationVisualizationPublisher(settings, sink, _ => { });
DateTimeOffset start = DateTimeOffset.UnixEpoch;
publisher.Start(CreateStaticSnapshot(settings));
for (int index = 0; index <= 20; index++)
publisher.TryPublish(start.AddMilliseconds(index * 50), () => CreateDynamicSnapshot(start));
Verification.True(sink.PublishCalls <= 11, "20 Hz observer ticks publish no more than 11 snapshots at 10 Hz over one second");
Verification.Equal(11, sink.PublishCalls, "publisher includes the initial 10 Hz snapshot");
publisher.Stop();
publisher.Stop();
Verification.Equal(1, sink.StopCalls, "publisher stop is idempotent");
var disabledSettings = new TrajectoryObservationSettings { EnableWebVisualization = false };
var disabledSink = new RecordingVisualizationSink();
var disabledPublisher = new TrajectoryObservationVisualizationPublisher(disabledSettings, disabledSink, _ => { });
int factoryCalls = 0;
disabledPublisher.Start(CreateStaticSnapshot(disabledSettings));
disabledPublisher.TryPublish(start, () =>
{
factoryCalls++;
return CreateDynamicSnapshot(start);
});
Verification.Equal(0, disabledSink.StartCalls, "disabled web visualization does not start a service");
Verification.Equal(0, factoryCalls, "disabled web visualization does not build dynamic snapshots");
}
private static PlanningVisualizationStaticSnapshot CreateStaticSnapshot(TrajectoryObservationSettings settings)
{
TrajectoryObservationBootstrapResult bootstrap = Bootstrap(settings);
var controller = new TrajectoryObservationController(bootstrap, settings,
new FixedPlanningService(CreateTrajectory("publisher-static", DateTimeOffset.UnixEpoch, 2,
EmTerminalType.Goal, EmLongitudinalMode.RollingContinuation, TravelDirection.Forward)), "publisher-static");
return new TrajectoryObservationStaticSnapshotBuilder().Build(bootstrap,
ReadEffectiveConfiguration(controller), settings.CreateValidatedSnapshot(), 0L);
}
private static PlanningVisualizationDynamicSnapshot CreateDynamicSnapshot(DateTimeOffset now)
{
return new PlanningVisualizationDynamicSnapshot(1L, now, "OBSERVE_ONLY", 0, "Forward",
new VisualizationPose(0d, 0d, 0d), Array.Empty<VisualizationPolyline>(),
Array.Empty<VisualizationMarker>(), Array.Empty<VisualizationChart>(), Array.Empty<VisualizationValue>(),
new VisualizationCycleSummary(1L, now, "Success", true, 0d, 0, "Forward", "RollingContinuation",
"Goal", 0d, 0d, string.Empty));
}
private sealed class RecordingVisualizationSink : ITrajectoryObservationVisualizationSink
{
public bool ThrowOnPublish { get; set; }
public int StartCalls { get; private set; }
public int PublishCalls { get; private set; }
public int StopCalls { get; private set; }
public PlanningVisualizationSessionInfo Start(PlanningVisualizationOptions options,
PlanningVisualizationStaticSnapshot snapshot)
{
StartCalls++;
return new PlanningVisualizationSessionInfo(new Uri("http://127.0.0.1:12345/?token=test"), "test");
}
public void Publish(PlanningVisualizationDynamicSnapshot snapshot)
{
PublishCalls++;
if (ThrowOnPublish) throw new InvalidOperationException("synthetic publish failure");
}
public void Stop()
{
StopCalls++;
}
}
private static TrajectoryObservationBootstrapResult Bootstrap(TrajectoryObservationSettings settings)
{
CoarsePathPlanningJob job = TrajectoryObservationSetupFactory.CreateBootstrapJob(