First_Dev_Dept/ParkingRobot
10
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fix: resolve EM overview marker and segment overlaps

Browse Source
This commit is contained in:
梁薄云
2026-08-09 19:43:47 +08:00
parent 2705487651
commit 444cc3af2a
4 changed files with 60 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files
ClumsyPilot/TrajectoryPlanningVisualization/Web/app.js
+22 -16
View File
@@ -146,7 +146,6 @@
if (!worldLegend) return;
worldLegend.replaceChildren();
const staticLines = safeArray(snapshot.staticPolylines);
const directionSegments = safeArray(snapshot.directionSegments);
const dynamicLines = safeArray(frame.dynamicPolylines);
const markers = safeArray(snapshot.staticMarkers).concat(safeArray(frame.dynamicMarkers));
const entries = [];
@@ -163,20 +162,25 @@
const current = dynamicLines.find(line => lineKind(line) !== "active-segment" && lineKind(line) !== "previous" && line.lineStyle !== 1);
if (coarse) add("coarse", coarse.legendChinese || "粗路径", "legend-line legend-coarse");
if (smooth) add("smooth", smooth.legendChinese || "完整 Local G2 路径", "legend-line legend-smooth");
if (active || directionSegments.length)
add("segment", active && active.legendChinese || "当前方向段", "legend-line legend-segment");
if (active)
add("segment", active.legendChinese || "当前方向段", "legend-line legend-segment");
if (previous) add("previous", previous.legendChinese || "上一条 EM 轨迹", "legend-line legend-previous");
if (current) add("current", current.legendChinese || "当前 EM 轨迹", "legend-line legend-current");
if (markers.some(marker => lineKind(marker) === "smooth-start"))
add("smooth-start", "平滑路径起点", "legend-marker legend-smooth-start");
if (markers.some(marker => lineKind(marker) === "plan-start"))
add("plan-start", "EM 规划起点", "legend-marker legend-plan-start");
if (markers.some(marker => lineKind(marker) === "vehicle"))
add("vehicle", "当前车辆", "legend-marker legend-vehicle");
if (markers.some(marker => lineKind(marker) === "gear-switch" || lineKind(marker) === "gear-switch-end"))
add("gear", "换向点 / s_end", "legend-marker legend-gear");
if (markers.some(marker => lineKind(marker) === "final-goal"))
add("goal", "平滑路径终点", "legend-marker legend-goal");
const smoothStartMarker = markers.find(marker => lineKind(marker) === "smooth-start");
const planStartMarker = markers.find(marker => lineKind(marker) === "plan-start");
const vehicleMarker = markers.find(marker => lineKind(marker) === "vehicle");
const gearMarker = markers.find(marker => lineKind(marker) === "gear-switch" || lineKind(marker) === "gear-switch-end");
const goalMarker = markers.find(marker => lineKind(marker) === "final-goal");
if (smoothStartMarker)
add("smooth-start", smoothStartMarker.labelChinese || "平滑路径起点", "legend-marker legend-smooth-start");
if (planStartMarker)
add("plan-start", planStartMarker.labelChinese || "EM 规划起点", "legend-marker legend-plan-start");
if (vehicleMarker)
add("vehicle", vehicleMarker.labelChinese || "当前车辆", "legend-marker legend-vehicle");
if (gearMarker)
add("gear", gearMarker.labelChinese || "换向点 / s_end", "legend-marker legend-gear");
if (goalMarker)
add("goal", goalMarker.labelChinese || "平滑路径终点", "legend-marker legend-goal");
entries.forEach(entry => {
const item = element("div", "world-legend-item");
item.append(element("span", "world-legend-swatch " + entry.swatchClass),
@@ -201,15 +205,17 @@
if (path) overlay.append(svg("path", { d: path, class: "world-line " + css }));
};
const staticLines = safeArray(snapshot.staticPolylines);
const dynamicLines = safeArray(frame.dynamicPolylines);
const hasDynamicActiveSegment = dynamicLines.some(line => lineKind(line) === "active-segment");
staticLines.filter(line => lineKind(line) === "global" || lineKind(line) === "coarse")
.forEach(line => addLine(line, "world-coarse"));
staticLines.filter(line => lineKind(line).includes("local-g2") || lineKind(line).includes("g2"))
.forEach(line => addLine(line, "world-local-g2"));
staticLines.filter(line => lineKind(line) !== "global" && lineKind(line) !== "coarse" && !lineKind(line).includes("local-g2") && !lineKind(line).includes("g2"))
.forEach(line => addLine(line, "world-static"));
safeArray(snapshot.directionSegments).forEach(segment => addLine(segment,
segment.segmentIndex === frame.activeSegmentIndex ? "world-segment-active" : "world-direction-inactive"));
const dynamicLines = safeArray(frame.dynamicPolylines);
safeArray(snapshot.directionSegments)
.filter(segment => !hasDynamicActiveSegment || segment.segmentIndex !== frame.activeSegmentIndex)
.forEach(segment => addLine(segment, "world-direction-inactive"));
dynamicLines.filter(line => lineKind(line) === "active-segment")
.forEach(line => addLine(line, "world-segment-active"));
dynamicLines.filter(line => lineKind(line) === "previous" || line.lineStyle === 1)