Changes

Summary

  1. fix: 同路口重搜先停稳并从当前定位构建起点 (details)
  2. fix: 保留车后弯道并平滑拼接 SSEP 参考线 (details)
  3. fix: SSEP 重搜期间复用有效 KEB 历史路径 (details)
  4. fix: 优化 SSEP KEB 首段转向状态变化率 (details)
  5. feat: 新增可配置的倒车优先拖挂停车策略 (details)
  6. test: 收录金玺拖挂停车场景并完善物理质量回归 (details)
  7. feat: 支持配置低安全阈值区域前后余量 (details)
  8. fix: 允许无途径点的充电任务从行驶进入对准 (details)
Commit ffc82d3f0353a69ab1d90f9268c5f2aedeb37f56 by wuyanjun110
fix: 同路口重搜先停稳并从当前定位构建起点

仅对当前路口内同任务重搜进入 TO_MOTIONLESS,连续搜索与 fallback 保留原流程。
等待请求跨输入异常与阶段重置保留,由停止线负责停车,停稳后再构造环境。
统一定位起点与轮角校验,同步状态编码、场景回放生成物及生命周期回归。
The file was modifiedtasks/deciders/search_decider/ex_lane_change_search_decider.cpp
The file was modifiedtasks/deciders/search_decider/search_decider_lifecycle.cpp
The file was modifiedtasks/other_tasks/stitch_path_to_reference_line.cpp
The file was modifiedtasks/deciders/search_decider/search_decider_lifecycle.hpp
The file was modifieddata/plan/ssep_data.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_encoder.cpp
The file was modifiedTesting/routing_map_guard_test.cpp
The file was modifieddata/ssep/ssep_ec.hpp
The file was modifiedtasks/deciders/search_decider/reverse_search_decider.cpp
The file was modifiedtasks/deciders/search_decider/forward_search_decider.cpp
The file was modifiedreplayer/scene_data/generated/compact_typed_field_codec.hpp
The file was modifiedTesting/search_decider_lifecycle_test.cpp
The file was modifieddata/ssep/into_yard_junction_ec.cpp
The file was modifiedtasks/deciders/search_decider/out_yard_junction_search_decider.cpp
The file was modifiedtasks/deciders/search_decider/seaside_junction_search_decider.cpp
The file was modifiedtasks/deciders/other_decider/replan_decider.cpp
The file was modifiedcommon/util/express.cpp
The file was modifieddata/ssep/open_space_ec.cpp
The file was modifiedproto/plan_data.proto
The file was modifiedreplayer/scene_data/generated/compact_scene_descriptor.pb
The file was modifieddocs/ssep_search_lifecycle.md
The file was modifiedtasks/other_tasks/stitch_trailer_path_to_ref_line.cpp
The file was modifiedTesting/ssep_path_corridor_test.cpp
The file was modifiedtasks/deciders/search_decider/into_yard_junction_search_decider.cpp
The file was modifieddata/vehicle/deviation_status.cpp
The file was modifiedtasks/deciders/search_decider/normal_junction_search_decider.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_encoder.hpp
The file was modifiedreplayer/scene_data/generated/compact_typed_field_codec.cpp
The file was modifieddata/ssep/out_yard_junction_ec.cpp
The file was modifiedtasks/deciders/search_decider/open_space_search_decider.cpp
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
The file was modifieddata/ssep/bridge_junction_ec.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifiedreplayer/scene_data/generated/plan_frame_decoder.cpp
The file was modifieddata/ssep/ssep_ec.cpp
The file was modifiedtasks/deciders/search_decider/bridge_junction_search_decider.cpp
The file was modifiedTesting/scene_replay_foundation_test.cpp
The file was modifieddata/app/fsm/motion_fsm/motion_fsm.cpp
The file was modifieddata/ssep/ssep_common.hpp
The file was modifieddata/ssep/seaside_junction_ec.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_descriptor.pb
The file was modifieddata/ssep/normal_junction_ec.cpp
The file was modifiedreplayer/scene_data/generated/scene_replay_api_descriptor.pb
The file was modifiedreplayer/scene_data/generated/plan_frame_decoder.hpp
Commit 2c9028f468748a19e17b8d322b8c23c2971ba8b7 by wuyanjun110
fix: 保留车后弯道并平滑拼接 SSEP 参考线

保持准确搜索首点与前方路径,优先沿历史和原参考线补足后视范围。
逐步调整车后连接锚点并校验去重后的实际接缝,移除整段搜索头切线兜底。
加入任务 52851 几何 fixture、大偏移、短历史、弯道及换头回归。
The file was modifieddocs/ssep_search_lifecycle.md
The file was modifiedtasks/other_tasks/stitch_path_to_reference_line.hpp
The file was addedTesting/fixtures/stitch_52851_offset_replan.hpp
The file was modifiedTesting/reference_line_replan_test.cpp
The file was modifiedtasks/other_tasks/stitch_path_to_reference_line.cpp
Commit 2d26dfb54d41917a06e60f1ab9c36ad017017bad by wuyanjun110
fix: SSEP 重搜期间复用有效 KEB 历史路径

校验任务、方向、姿态及剩余长度,补齐车辆至优化首点的历史前缀后写回。
新 SSEP 完成但尚未成功接入时继续保持,接替后释放旧优化输出;失效时按原策略兜底。
补充连续等待、前缀接头、输入失效和新结果接替回归。
The file was modifieddocs/ssep_search_lifecycle.md
The file was modifiedtasks/plan/keb_path_optimize_task.hpp
The file was modifiedTesting/ssep_path_corridor_test.cpp
The file was modifiedtasks/plan/keb_path_optimize_task.cpp
Commit 1124716aaedfe26f79f04c4f26944358b3442658 by wuyanjun110
fix: 优化 SSEP KEB 首段转向状态变化率

IMV General 保持既有首点姿态、曲率和 beta,允许首 pinch 与 beta_dot 在限值内优化。
初始导数收紧到合法范围,其他调用默认保留首点全固定行为。
仅调整 KEB 优化,不修改轮角传输、操作头转换或粗搜索接口,并覆盖正反向及默认兼容测试。
The file was addedTesting/imv_keb_start_derivatives_test.cpp
The file was modifiedssep/keb_optimizer/imv_keb_optimizer.cc
The file was modifiedssep/keb_optimizer/imv_keb_optimizer.h
The file was modifiedCMakeLists.txt
The file was modifiedssep/keb_optimizer/keb_problem.h
The file was modifiedssep/scenarios/imv_general_planner.h
The file was modifieddocs/ssep_search_lifecycle.md
The file was modifiedssep/keb_optimizer/keb_problem.cc
Commit d75778feffec805a3ef4323aede4f58cb33feed9 by wuyanjun110
feat: 新增可配置的倒车优先拖挂停车策略

通过 ReversePriority 显式启用独立搜索器和规划器,修复假途经点、零米及短距离拉直、短路径起点偏移。
首轮允许双向搜索且不限制前进调整次数,换向代价逐次翻倍,按累计代价和换向次数进行支配剪枝。
保持用户倒车曲率限制,加强优化几何约束,并在输出前检查完整车头和挂车的连续扫掠碰撞。
区分原始线段、独立栅格占用和 access 清除语义,保留旧场景默认行为。

验证:56 项 C++ 测试通过,pnc_node 和离线回放程序构建通过,两份现场及短距离回放通过。
The file was addedssep/coarse_search/searcher_builders/tractor_trailer_single_segment_parking_searcher_builder.h
The file was addedssep/scenarios/tractor_trailer_parking_curvature.h
The file was modifiedssep/scenarios/scenario_planner_factory.h
The file was modifiedssep/coarse_search/bidirectional_hybrid_astar_search_engine.h
The file was modifiedssep/keb_optimizer/keb_problem.cc
The file was modifiedTesting/search_decider_lifecycle_test.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was addedssep/scenarios/tractor_trailer_parking_maneuver.h
The file was modifiedssep/data_structures/ssep_input.cc
The file was modifiedssep/keb_optimizer/keb_problem.h
The file was modifiedssep/maps/ogm.cc
The file was addedssep/scenarios/tractor_trailer_reverse_priority_parking_planner.h
The file was addedconfig/config_truck/ssep_port_scenarios_jinxi.yaml
The file was modifiedssep/coarse_search/bidirectional_hybrid_astar_search_engine.cc
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.cc
The file was modifieddata/ssep/forward_ec.cpp
The file was addedssep/test/parking_collision_provenance_test.cc
The file was addedssep/keb_optimizer/cost_features/parking_geometric_curvature_constraint.h
The file was modifiedtasks/deciders/search_decider/forward_search_decider.cpp
The file was modifiedTesting/ssep_scenario_config_lifecycle_test.cpp
The file was modifiedssep/offboard/ssep_planner_wrapper.cc
The file was modifiedssep/test/CMakeLists.txt
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.h
The file was addedssep/coarse_search/searcher_builders/tractor_trailer_single_segment_parking_searcher_builder.cc
The file was modifiedssep/ssep_planner.cc
The file was modifiedssep/keb_optimizer/cost_features/tractor_trailer_kinematic_constraint.h
The file was addedssep/scenarios/tractor_trailer_parking_collision.h
The file was modifieddata/ssep/ssep_ec.hpp
The file was modifiedssep/test/ssep_planner_test.cc
The file was modifiedssep/maps/ogm.h
The file was modifieddocs/ssep_scenario_config_lifecycle.md
The file was modifiedssep/maps/ogm_builder.cc
Commit f33a41d5c3a2946198b43893290ca8246a18ea2e by wuyanjun110
test: 收录金玺拖挂停车场景并完善物理质量回归

将两份现场记录和两个短距离合成场景登记为正式回归清单,按共享数据目录保存原始文件及 SHA-256 来源记录。
扩展统一运行器,显式应用场景参数且保持源数据不变,支持不限路径段数的 TT 停车验收。
独立检查运动方向、起终点两航向、曲率及完整车身扫掠碰撞,修复近直线微小转角的数值退化。
增加参数覆盖、源文件校验、异常输出和旧运行器兼容性测试,并记录运行方式。

验证:全部 50 项 Python 测试及统一清单 4 个场景回放通过,归档文件 SHA-256 前后保持一致。
The file was addedssep/test/local_regression/tt_reverse_priority_tail0_quality.json
The file was addedssep/test/local_regression/tt_reverse_priority_manifest.tsv
The file was addedssep/test/local_regression/test_parking_maneuver.py
The file was modifiedssep/test/local_regression/README.md
The file was addedssep/test/local_regression/parking_collision_quality.py
The file was addedssep/test/local_regression/tt_parking_quality.py
The file was addedssep/test/local_regression/tt_reverse_priority_tail1_quality.json
The file was addeddocs/ssep_jinxi_20260911_parking.md
The file was addedssep/test/local_regression/run_tt_single_parking_case.py
The file was addedssep/test/local_regression/test_parking_collision_quality.py
The file was addedssep/test/local_regression/test_tt_parking_regression.py
The file was addedssep/test/local_regression/test_parking_geometric_curvature.py
The file was modifiedssep/test/local_regression/run_ssep_regression.py
The file was addedssep/test/local_regression/tt_reverse_priority_cases.json
Commit 12bb70597490c8c5d24c3fa732b290224948b355 by wuyanjun110
feat: 支持配置低安全阈值区域前后余量

低安全阈值区域交集判定默认向车头前方扩展 5 米、车尾后方扩展 0.5 米,支持独立 ROS 参数配置,负值按 0 使用。

同步 Full 与 Compact 配置合同、编解码和生成产物,确保 Recorded 与 Candidate 回放恢复相同余量;补充默认值与非默认值回放测试。

验证:工程任务入口编译通过,生成物及 Proto 兼容性检查通过;回放基础测试合计 241 项通过,1 项因缺少可选 bag 跳过。
The file was modifiedreplayer/scene_data/config_proto_codec.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifiedTesting/scene_replay_foundation_test.cpp
The file was modifiedreplayer/scene_data/generated/compact_typed_field_codec.hpp
The file was modifiedreplayer/scene_data/generated/scene_replay_api_descriptor.pb
The file was modifieddata/config/cfg_safe_const.hpp
The file was modifiedreplayer/scene_data/generated/plan_frame_encoder.hpp
The file was modifiedreplayer/scene_data/generated/compact_scene_descriptor.pb
The file was modifiedreplayer/scene_data/generated/config_schema_inputs.json
The file was modifiedreplayer/scene_data/generated/plan_frame_decoder.hpp
The file was modifiedreplayer/scene_data/generated/plan_frame_descriptor.pb
The file was modifiedplan/prepare/prepare_status.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_decoder.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_encoder.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_codec_coverage_audit.yaml
The file was modifiedconfig/config_imv/plan.yaml
The file was modifieddata/config/cfg_safe_const.cpp
The file was modifiedproto/config.proto
The file was modifiedreplayer/scene_data/generated/compact_typed_field_codec.cpp
Commit b413d88eaddcf42f4cfa888ec9f8a63298a0728e by wuyanjun110
fix: 允许无途径点的充电任务从行驶进入对准

Travel2Align 不再无条件排除 TO_CHARGE;充电任务存在 parking 或 bulk 途径点时继续禁止进入,均不存在时按原有目标有效性、对准距离等条件判断。

验证:通过工程 task 指定的 pnc-build.sh 构建 pnc_node,暂存 diff 检查通过。
The file was modifieddata/app/fsm/task_fsm/task_fsm.cpp