Changes

Summary

  1. feat: Keb: 1. 引入clipper2几何运算库处理多边形的膨胀腐蚀操作。解决之前的膨胀逻辑对某些特殊形状处理存在错误的问题。2. 将最近点膨胀代价升级为sdf碰撞检测代价,鲁棒性更高收敛更快。3. 前轮转向约束使用softplus函数建立梯度平滑的约束,解决在极限转弯场景优化时梯度跳变的问题。 (details)
  2. chore: Keb: 集卡进堆场增加“最后拉直段减小避障半径”的逻辑 (details)
  3. refactor: SSEP: 重构OGM构建流程 (details)
  4. feat: 添加skills到.gitignore以忽略相关文件 (details)
  5. fix: step align状态下,吊具防护,montion状态机切换的bug (details)
  6. fix:修复进充电桩,场景适配错误的bug (details)
  7. fix: Keb: 删除未用到的“BuildKebOGM”方法 (details)
  8. feat(hmi): 新增路径曲线面板 path_curve_detail (details)
  9. refactor:优化引导线曲率跳变的bug (details)
  10. fix: 更新 clang-format 命令的使用说明和检查逻辑 (details)
  11. feat: 添加软约束以支持初始状态的灵活性 (details)
  12. fix: 注释掉停止车辆的初始化日志输出 (details)
  13. fix: Keb: 增加IMV后方碰撞检测距离 (details)
  14. feat:replay界面添加菜单选项 控制是否进行 obj和ogm的碰撞检测 (details)
  15. feat: 注释掉OgmCollisionPos函数中的更新检查 (details)
  16. fix:合并的bug (details)
  17. feat: 重构障碍物风险评估器,另外添加 横路不进行 龙门吊风险限速的功能。 (details)
  18. refactor:优化看门狗功能 (details)
  19. fix: 移除不必要的等待调用以优化重置过程 (details)
  20. fix:西联上下引桥 不创建双黄线约束 (details)
  21. fix: SSEP: 修复新版本优化偶发输出异常的问题 (details)
  22. feat: 添加数据和ssep原型的依赖关系到keb_vis_server可执行文件 (details)
  23. feat: SSEP: 自卸车/tractor的多段倒车和精确倒车可以接受extra param来设置尾部拉直距离 (details)
  24. fix:修复变道完成后目标车道切换错误的bug (details)
  25. fix: SSEP: 启用硬约束时使用 tunnel_constraints_ogm_ 进行碰撞检测,否则使用 ogm_ (details)
  26. feat: 添加堆高机靠近是否切换状态机的开关参数 (details)
  27. refactor: 1.关闭起始变量的收缩。2.车辆停止时,修改dl和ddl 3.关闭全软约束 (details)
  28. feat: <大谢>进堆场机场忽略终点约束 (details)
  29. refactor:优化出堆场 + 短直线+ 进堆场场景的搜索 (details)
  30. feat: 添加堆场间(BETWEEN_YARD)任务条件, 支持堆场间切换KEB横向规划器 (details)
  31. fix:快照播放崩溃的bug (details)
  32. fix:修复停止线赋值的bug (details)
  33. fix: 修复 Clang 编译器下 LLDB 调试器无法查看 STL 容器内容的问题 (details)
  34. fix: 调整 MapEnvelop 扩展点距离参数以优化路径规划 (details)
  35. refactor: 支持多候选参考路段索引查找,增强 UpdateAttr 的鲁棒性 (details)
  36. feat:<keb>临时关闭车头拉直距离段内缩小碰撞buffer的操作 (details)
  37. fix: 下码头面偏离参考线时扩大 path boundary 以避免 PJPO 求解失败 (details)
  38. fix: 开放空间区域同样扩大 path boundary 避免 PJPO 求解失败 (details)
  39. fix: 大榭普通堆高机场地放宽终点约束距离, 修复进堆场 SSEP 搜索失败 (details)
  40. fix: SSEP: 1. 解决威海多段倒车拉直搜索会反复往前的问题。2. 修复杨浦码头面直接进堆场在超过pass point的位置重规划时会规划失败的问题。 (details)
  41. fix: Keb: 改进低贝位进堆场时距离上层障碍物较近的问题 (details)
  42. feat: 更新 CloudTrajectory 中 curr_time_ 的初始化方式为当前时间的纳秒表示 (details)
  43. feat: PJPO 增加软曲率约束并优化起点处理 (details)
  44. feat: 在 HandleMap 中添加地图包络和中心线信息的条件判断,优化路径处理 (details)
  45. feat: 在 GetBoundaryFromKinetics 中添加场景管理器判断,优化路径边界计算 (details)
  46. feat: 在 GetLatPoint 中添加起点曲率限制,优化车辆运动学处理 (details)
  47. feat: 变道安全动态障碍物碰撞判定引入 s-t 时空耦合 (details)
  48. feat: 变道 OGM 碰撞检测点 HMI 标红可视化 (details)
  49. feat: 锁站变道安全校验距离引入可配 buffer 并修正近距障碍物低速阈值 (details)
  50. feat: 添加 UpdateAllSoftFallback 方法以处理软回退逻辑 (details)
  51. fix:  Keb: 参考线发生变化时禁用warm start,调用cold start重新优化路径 (details)
  52. feat: 堆场偏移区配置改用 YardType 枚举, 新增入口高处障碍物类型并延长拉直距离 (details)
  53. 重构: 抽取搜索起点车头车挂框构造为静态函数并复用于入堆场区域 (details)
  54. 修复任务选择器组内多条件匹配语义: AND 改为 OR, 命中任一条件即选中该 group (details)
  55. feat:调整参考线权重,从 0.0 修改为 3.0,以增强路径优化效果 (details)
  56. 场景决策: 修复弯道 NORMAL 兜底与直行上下桥中误判 (details)
  57. BTActRunPlanner: 进入海侧路口区域时退出常规 planner (details)
  58. feat: SSEP: 多段倒车支持无pass point模式。解决到达pass point后重规划会继续往前的问题,解决停车角度歪的问题 (details)
Commit bf5c8b6a5d40a577e06606874e8c3225fb2d58ee by tangwenqing
feat: Keb: 1. 引入clipper2几何运算库处理多边形的膨胀腐蚀操作。解决之前的膨胀逻辑对某些特殊形状处理存在错误的问题。2. 将最近点膨胀代价升级为sdf碰撞检测代价,鲁棒性更高收敛更快。3. 前轮转向约束使用softplus函数建立梯度平滑的约束,解决在极限转弯场景优化时梯度跳变的问题。

The file was addedssep/common/utils/clipper2/include/clipper2/clipper.engine.h
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.version.h
The file was addedssep/common/utils/clipper2/src/clipper.triangulation.cpp
The file was modifiedssep/keb_optimizer/keb_problem.cc
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.minkowski.h
The file was modifiedssep/keb_optimizer/cost_features/imv_steer_constraint.h
The file was modifiedssep/CMakeLists.txt
The file was addedssep/common/utils/clipper2/src/clipper.rectclip.cpp
The file was addedssep/keb_optimizer/distance_field_interpolator.h
The file was modifiedssep/keb_optimizer/keb_problem.h
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.h
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.offset.h
The file was modifiedalgorithm/plan/keb_optimizer.cpp
The file was modifiedssep/data_structures/polyline.cc
The file was modifiedssep/keb_optimizer/imv_keb_optimizer.cc
The file was modifiedoffboard/keb_path_opt_cli/keb_scene_converter.cc
The file was modifiedoffboard/keb_path_opt_cli/keb_optimization_debug_visualizer.cc
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.core.h
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.rectclip.h
The file was addedssep/keb_optimizer/cost_features/sdf_disk_collision_cost.h
The file was modifiedoffboard/keb_path_opt_cli/keb_optimization_debug_visualizer.hpp
The file was modifiedtasks/plan/keb_lane_follow_path_task.cpp
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.triangulation.h
The file was addedssep/common/utils/clipper2/include/clipper2/clipper.export.h
The file was addedssep/common/utils/clipper2/src/clipper.offset.cpp
The file was modifiedssep/keb_optimizer/cost_features/imv_kinematic_constraint.h
The file was modifiedoffboard/keb_path_opt_cli/keb_simulator.cc
The file was addedssep/keb_optimizer/cost_features/cost_functions.h
The file was addedssep/common/utils/clipper2/src/clipper.engine.cpp
Commit 5b1a62a1b19dc733d075fcb7f51dab31938582f4 by tangwenqing
chore: Keb: 集卡进堆场增加“最后拉直段减小避障半径”的逻辑

The file was modifiedssep/keb_optimizer/keb_problem.cc
The file was modifiedoffboard/keb_path_opt_cli/keb_scene_converter.cc
The file was modifiedssep/maps/ogm_builder.h
The file was modifiedssep/keb_optimizer/keb_problem.h
The file was modifiedtasks/plan/keb_utils_core.hpp
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.cc
The file was modifiedalgorithm/plan/keb_optimizer.cpp
The file was modifiedtasks/plan/keb_utils_core.cpp
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.h
The file was modifiedoffboard/keb_path_opt_cli/keb_simulator.cc
The file was modifiedssep/maps/ogm.cc
The file was modifieddata/config/cfg_lat_plan.cpp
The file was modifiedssep/maps/ogm.h
The file was modifiedssep/maps/ogm_builder.cc
Commit 7af0c7391673b03d1f2c27d375eb87e89d84fdcf by tangwenqing
refactor: SSEP: 重构OGM构建流程

The file was modifiedssep/ssep_planner.cc
The file was addedssep/maps/ogm_config_utils.h
The file was addedssep/maps/ogm_config_utils.cc
Commit be3ce1d49b1c6d7f491a658c7263620f1afcb722 by wuyanjun110
feat: 添加skills到.gitignore以忽略相关文件
The file was modified.gitignore
Commit c8876f9999372ab3bfe13fbffda89c1ecef66548 by wuyanjun110
fix: step align状态下,吊具防护,montion状态机切换的bug
The file was modifieddata/app/fsm/stop_reason.cpp
The file was modifieddata/constrain/longitude_constrain.cpp
The file was modifieddata/app/fsm/motion_fsm/motion_move_fsm/motion_move_fsm.cpp
The file was modifieddata/constrain/longitude_constrain.hpp
Commit a36a7f30bdbce770bcbb209a26e659a01417e257 by wuyanjun110
fix:修复进充电桩,场景适配错误的bug
The file was modifieddata/map/pnc_map/pnc_map_helper.cpp
The file was modifieddata/map/pnc_map/pnc_map_helper.hpp
The file was modifiedplan/prepare/prepare_status.cpp
Commit 72ef714fd0e866823e7d2dd7c0df42e08a47dac7 by tangwenqing
fix: Keb: 删除未用到的“BuildKebOGM”方法

The file was modifiedtasks/plan/keb_utils.cpp
The file was modifiedtasks/plan/keb_utils.hpp
Commit 9303bd8e2d53b8012b3756c1275e8ce4f9599094 by wuyanjun110
feat(hmi): 新增路径曲线面板 path_curve_detail
The file was modifiedhmi/replayer_hmi.hpp
The file was modifiedhmi/node_hmi.hpp
The file was modifiedhmi/replayer_hmi.cpp
The file was modifiedhmi/node_hmi.cpp
The file was addedhmi/widget/path_curve_detail.cpp
The file was addedhmi/widget/path_curve_detail.hpp
Commit aceeded995c38d29a70420d2aa4721405dd9f2f3 by wuyanjun110
refactor:优化引导线曲率跳变的bug
The file was modifiedalgorithm/util/curvature.hpp
The file was modifieddata/common/guide_path.cpp
The file was modifiedalgorithm/util/curvature.cpp
The file was modifieddata/plan/path_data.cpp
Commit c993e76f4bcac3a41330f1f0e86409606f30ba66 by wuyanjun110
fix: 更新 clang-format 命令的使用说明和检查逻辑
The file was modifiedscripts/clang_format.sh
Commit dcf2390c1b8735e60ba08704a7d4c9796a2fb94f by wuyanjun110
feat: 添加软约束以支持初始状态的灵活性

- 在 PiecewiseJerkProblem 中添加了对初始状态的软约束支持,允许在优化过程中对初始位置(l)、速度(dl)和加速度(ddl)进行灵活处理。
- 更新了相关的计算和约束逻辑,以支持软约束的引入。
- 在 PJPO 算法中实现了对初始状态的软化处理,增强了路径优化的鲁棒性。
- 进行了代码格式化和逻辑优化,提高了代码可读性。
The file was modifiedtasks/plan/pjpo_task.cpp
The file was modifiedalgorithm/plan/pjpo.cpp
The file was modifiedmath/piecewise_jerk/piecewise_jerk_path_problem.cpp
The file was modifiedmath/piecewise_jerk/piecewise_jerk_problem.cpp
The file was modifiedmath/piecewise_jerk/piecewise_jerk_problem.hpp
Commit e9c9d88b14b740b58efb48bf08c66eb9620ac484 by wuyanjun110
fix: 注释掉停止车辆的初始化日志输出
The file was modifiedalgorithm/plan/pjpo.cpp
Commit be675513a5048a731785209afa4355e958d793f7 by tangwenqing
fix: Keb: 增加IMV后方碰撞检测距离

The file was modifiedssep/keb_optimizer/imv_keb_optimizer.cc
Commit b7d0da6551b2d1288386fb5485e8e7358efaf952 by wuyanjun110
feat:replay界面添加菜单选项 控制是否进行 obj和ogm的碰撞检测
The file was modifiedhmi/replayer_hmi.cpp
The file was modifieddata/lattice/ogm_crash_data.hpp
The file was modifieddata/lattice/ogm_crash_data.cpp
The file was modifiedreplayer/replayer_data_process/replayer_data_process.cpp
The file was modifieddata/plan_frame.cpp
The file was modifieddata/config/cfg_hmi.hpp
The file was modifieddata/config/cfg_hmi.cpp
The file was modifiedplan/prepare/prepare_ogm.cpp
Commit 5b60ab02615b439f33dce7bc015d900f4583ecf5 by wuyanjun110
feat: 注释掉OgmCollisionPos函数中的更新检查
The file was modifiedhmi/draw/draw_collision_detection.cpp
Commit 2be76502ab8460d9f50c979959c2bde171ff05e2 by wuyanjun110
fix:合并的bug
The file was modifiedhmi/replayer_hmi.cpp
Commit 2613c75400eb3d06c154c5cccbc3bc4cf8d33eaf by wuyanjun110
feat: 重构障碍物风险评估器,另外添加 横路不进行 龙门吊风险限速的功能。
The file was modifiedalgorithm/plan/obstacle_risk_evaluation.hpp
The file was modifieddata/config/cfg_func_sw.hpp
The file was modifieddata/obstacle/obstacle_decider_attr.hpp
The file was modifiedalgorithm/plan/obstacle_risk_evaluation.cpp
The file was modifieddata/config/cfg_func_sw.cpp
The file was modifieddata/obstacle/obstacle_decider_attr.cpp
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
Commit d428f839d466a526ed34f78e031585e10206975a by wuyanjun110
refactor:优化看门狗功能
The file was modifiedscenarios/parking_scenario/parking_lane_change_stage.cpp
The file was modifiedscenarios/parking_scenario/parking_move_stage.cpp
The file was modifiedscenarios/bulkload_scenario/bulkload_move_backward_stage.cpp
The file was modifiedscenarios/parking_scenario/parking_prepare_stage.cpp
The file was modifiedscenarios/ex_lane_change_scenario/ex_lane_change_stage.cpp
The file was modifiednode/logic.cpp
The file was modifiedscenarios/out_yead_junction_scenario/out_yard_junction_first_stage.cpp
The file was modifiedscenarios/bulkload_scenario/bulkload_move_forward_stage.cpp
The file was modifiedcore/plan_runtime_watchdog.hpp
The file was modifiedscenarios/ex_lane_change_scenario/ex_lane_change_prepare_stage.cpp
The file was modifiedscenarios/lane_change_scenario/lane_change_cancel_stage.cpp
The file was modifiedscenarios/bulkload_scenario/bulkload_ssep_forward_stage.cpp
The file was modifiedscenarios/bulkload_scenario/bulkload_preapre_stage.cpp
The file was modifiedscenarios/lane_change_scenario/lane_change_prepare_stage.cpp
The file was modifiedscenarios/scenario.cpp
The file was modifiedscenarios/bulkload_scenario/bulkload_lane_change_stage.cpp
The file was modifiedscenarios/bulkload_scenario/bulkload_ssep_backward_stage.cpp
The file was modifiedscenarios/lane_follow_scenario/lane_follow_stage.cpp
The file was modifiedscenarios/into_yard_junction_scenario/into_yard_junction_first_stage.cpp
The file was modifiedscenarios/stage.cpp
The file was modifiedscenarios/lane_change_scenario/lane_change_stage.cpp
Commit 42ab29bd0a1c8d4a3800f387b5cc1ef27dc80fcf by wuyanjun110
fix: 移除不必要的等待调用以优化重置过程
The file was modifiedtasks/plan/keb_lane_follow_path_task.cpp
The file was modifiedtasks/plan/keb_path_optimize_task.cpp
Commit bbba4b68d977b68cf50ceb2db84de981abafc74b by wuyanjun110
fix:西联上下引桥 不创建双黄线约束
The file was modifieddata/ssep/bridge_junction_ec.cpp
Commit 34fb15d729dc025a5e709bdc5d855a2b19ba79ae by tangwenqing
fix: SSEP: 修复新版本优化偶发输出异常的问题

The file was modifiedssep/keb_optimizer/keb_problem.cc
Commit fc11109b411434af2c1576ab31bc526414572915 by wuyanjun110
feat: 添加数据和ssep原型的依赖关系到keb_vis_server可执行文件
The file was modifiedoffboard/keb_vis_server/CMakeLists.txt
Commit dcdcb59ecbcb8a6c3f9e3855c6413a5932fd26c6 by tangwenqing
feat: SSEP: 自卸车/tractor的多段倒车和精确倒车可以接受extra param来设置尾部拉直距离

The file was modifiedssep/scenarios/scenario_planner_factory.h
The file was modifiedssep/scenarios/truck_accurate_reversing_planner.cc
The file was modifiedssep/scenarios/truck_multi_segment_parking_planner.h
The file was modifiedssep/scenarios/truck_accurate_reversing_planner.h
Commit 59d9ca2c7297bdf49abd6f72e63f19136f01a75e by wuyanjun110
fix:修复变道完成后目标车道切换错误的bug
The file was modifiedhmi/draw/draw_map.cpp
The file was modifieddata/plan/reference_line_info.cpp
Commit 626f5302148dff1d0e44b0e882d968958c623674 by tangwenqing
fix: SSEP: 启用硬约束时使用 tunnel_constraints_ogm_ 进行碰撞检测,否则使用 ogm_

The file was modifiedssep/scenarios/tractor_trailer_enter_yard_planner.h
Commit b9e4184e63310b64757ecda7a87a85ac35332129 by wuyanjun110
feat: 添加堆高机靠近是否切换状态机的开关参数

新增 CfgFuncSw::use_func_stacker_close_switch_fsm_(默认 true),
控制 TaskAlignFsm move2lock / LockToDone 中堆高机靠近触发的状态机切换。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
The file was modifieddata/config/cfg_func_sw.hpp
The file was modifieddata/config/cfg_func_sw.cpp
The file was modifieddata/app/fsm/task_fsm/task_align_fsm/task_align_fsm.cpp
Commit 7b96a6a2732a9d5b6237c0c145012521be41fab4 by wuyanjun110
refactor: 1.关闭起始变量的收缩。2.车辆停止时,修改dl和ddl 3.关闭全软约束
The file was modifiedalgorithm/plan/pjpo.cpp
Commit 2f08ec55f85fce32706cf3970a8fe7fbbde0186f by wuyanjun110
feat: <大谢>进堆场机场忽略终点约束
The file was modifieddata/ssep/into_yard_junction_ec.cpp
The file was modifieddata/ssep/field_junction_ec.hpp
Commit 721a4e31ae95125d507ef6d44828045909389114 by wuyanjun110
refactor:优化出堆场 + 短直线+ 进堆场场景的搜索
The file was modifieddata/ssep/field_junction_ec.hpp
The file was modifieddata/ssep/into_yard_junction_ec.hpp
The file was modifieddata/ssep/out_yard_junction_ec.hpp
The file was modifieddata/ssep/out_yard_junction_ec.cpp
Commit c2d6a5e60ae17c4145c7b8cffdb412b40e0a3e1c by wuyanjun110
feat: 添加堆场间(BETWEEN_YARD)任务条件, 支持堆场间切换KEB横向规划器

- 新增 TaskConditionType::BETWEEN_YARD, 判定复用 IsThroughYard()
  (STRAIGHT_OUT/INTO_YARD_MULTI/SINGLE_BEFORE 四个 region)
- 收窄 YARD_PJPO_SWITCH_ENABLED 为 IsInYard(), 与 BETWEEN_YARD 互斥,
  避免堆场间时 PJPO 抢占 KEB
- stage.cpp: task 运行失败日志降频 LOG_EVERY_N 1->100

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
The file was modifieddata/config/cfg_stage.cpp
The file was modifiedscenarios/task_condition_evaluator.cpp
The file was modifieddata/config/cfg_stage.hpp
The file was modifiedscenarios/stage.cpp
Commit e3346d428150297af330c94301c0645ecb1776db by wuyanjun110
fix:快照播放崩溃的bug
The file was modifiedreplayer/replayer_data_process/replayer_data_process.cpp
The file was modifieddata/plan/guide_line.cpp
Commit c985b5d139bd58bfced869c12fd281635385d23d by wuyanjun110
fix:修复停止线赋值的bug
The file was modifieddata/map/pnc_map/pnc_map_path.cpp
Commit 7208d3d12ea79d541e5468946bb14f96755e6321 by wuyanjun110
fix: 修复 Clang 编译器下 LLDB 调试器无法查看 STL 容器内容的问题
The file was modifiedCMakeLists.txt
Commit ae7311500c04fd8ac201a456995c22500151a2b8 by wuyanjun110
fix: 调整 MapEnvelop 扩展点距离参数以优化路径规划
The file was modifieddata/map/envelop/map_envelop.cpp
Commit c9307e98a239504f9c8b930abc637985f9344354 by wuyanjun110
refactor: 支持多候选参考路段索引查找,增强 UpdateAttr 的鲁棒性
The file was modifieddata/map/reference/reference_road_section.cpp
The file was modifieddata/map/reference/reference_road_section.hpp
Commit e65ecba034e9ae68666f2a036d3ac12d4ef5c7d2 by wuyanjun110
feat:<keb>临时关闭车头拉直距离段内缩小碰撞buffer的操作
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.cc
Commit 3ea23e0b598bb67c67622c88d38bdbd563dd7d44 by wuyanjun110
fix: 下码头面偏离参考线时扩大 path boundary 以避免 PJPO 求解失败

在 GetBoundaryFromKinetics 中, 除 IsInIntoYardPlanner 外, 海侧路口区域
(IsInSeasideJunctionRegion) 同样触发 ssep_into_yard_replan 路径边界扩大,
解决下码头面车辆偏离参考线时 PJPO 因边界过窄求解失败的问题。

附带补充 SmoothTask 起点平滑日志(start_ref_point/overlap_distance)便于排查。
The file was modifiedtasks/deciders/lat_decider/path_bounds_decider.cpp
The file was modifiedtasks/plan/smooth_task.cpp
Commit c9fd9bbde51ad4efe2c55708d2f78334455aeb14 by wuyanjun110
fix: 开放空间区域同样扩大 path boundary 避免 PJPO 求解失败

GetBoundaryFromKinetics 触发条件再补充 IsInOpenSpaceRegion, 使开放空间
区域偏离参考线时也走 ssep_into_yard_replan 边界扩大逻辑。
The file was modifiedtasks/deciders/lat_decider/path_bounds_decider.cpp
Commit 0df4a0712a596b8291cf5ce6adbe43f989093c0d by wuyanjun110
fix: 大榭普通堆高机场地放宽终点约束距离, 修复进堆场 SSEP 搜索失败

GetEndStraightDis 中 DAXIE 区域且 is_normal_stacking_yard_ 时, terminal_constrain_dis
直接取 dst_accu_distance_after_end_stop_line_(不再扣除 5m straighten_extend_buffer),
避免 end_straighten_dis_ 被过度压缩导致进堆场 SSEP 搜索失败。
The file was modifieddata/ssep/into_yard_junction_ec.cpp
Commit 4087e2163c2b30f8fb152efde2d0612718dbb0dc by tangwenqing
fix: SSEP: 1. 解决威海多段倒车拉直搜索会反复往前的问题。2. 修复杨浦码头面直接进堆场在超过pass point的位置重规划时会规划失败的问题。

The file was modifiedssep/scenarios/tractor_trailer_multi_segment_parking_planner.h
The file was modifiedssep/scenarios/scenario_planner_factory.h
Commit f7249bacf26ce9e5f0c547161e6b20c21212f097 by tangwenqing
fix: Keb: 改进低贝位进堆场时距离上层障碍物较近的问题

The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.cc
The file was modifiedtasks/plan/keb_path_optimize_task.cpp
The file was modifiedalgorithm/plan/keb_optimizer.cpp
The file was modifiedoffboard/keb_path_opt_cli/keb_scene_converter.cc
The file was modifiedtasks/plan/keb_utils_core.cpp
The file was modifiedssep/keb_optimizer/keb_utils.cc
The file was modifieddata/config/cfg_lat_plan.cpp
Commit a792e8252fb9ffb453c1c3472598c59b44671b51 by wuyanjun110
feat: 更新 CloudTrajectory 中 curr_time_ 的初始化方式为当前时间的纳秒表示
The file was modifieddata/plan/cloud_trajectory.hpp
Commit b7dbb9a609c445bef1a6e6740c93f76b85c4565b by wuyanjun110
feat: PJPO 增加软曲率约束并优化起点处理

- piecewise_jerk 支持软曲率约束(kappa_ref/kappa_max/slack)及 all_soft 回退
- pjpo 起点 init_dl/init_ddl 限幅收紧, 消除起点曲率尖峰与外扩自激
- 补充 pjpo 曲率约束相关测试
- 清理 PJPO 调试 trace 日志
The file was modifiedmath/piecewise_jerk/piecewise_jerk_path_problem.hpp
The file was modifiedTesting/pjpo_case_test.cpp
The file was modifiedmath/piecewise_jerk/piecewise_jerk_problem.hpp
The file was modifiedmath/piecewise_jerk/piecewise_jerk_problem.cpp
The file was modifiedtasks/plan/pjpo_task.cpp
The file was modifiedalgorithm/plan/pjpo.cpp
The file was modifiedmath/piecewise_jerk/piecewise_jerk_path_problem.cpp
The file was modifiedalgorithm/plan/pjpo.hpp
Commit 965d7b2a75bafa32202b4c386c097d9f3dd662f8 by wuyanjun110
feat: 在 HandleMap 中添加地图包络和中心线信息的条件判断,优化路径处理
The file was modifiedreplayer/replayer_data_process/replayer_data_process.cpp
Commit 89119eedda78c243c52dcf28b819bcaf596d458a by wuyanjun110
feat: 在 GetBoundaryFromKinetics 中添加场景管理器判断,优化路径边界计算
The file was modifiedtasks/deciders/lat_decider/path_bounds_decider.cpp
Commit 93918e80527f8f7b718da6994ce59587e4087a24 by wuyanjun110
feat: 在 GetLatPoint 中添加起点曲率限制,优化车辆运动学处理
The file was modifieddata/plan/start_point_data.cpp
Commit 2881e36fca41bd9ae4d967d26eddb4d6117dd43d by wuyanjun110
feat: 变道安全动态障碍物碰撞判定引入 s-t 时空耦合

- CheckObjSafe 对速度足够的动态障碍物, 要求自车比其晚到冲突点至少 dt_gate
  (跟在其后变道), 过滤"障碍物未来才驶入路径"的纯空间重叠误判
- 障碍物过慢(< obj_min_v_kmh)时退回空间包络判定
- 新增开关 use_func_lane_change_st_time_gate_ 及 dt_gate / obj_min_v 阈值
The file was modifieddata/config/cfg_func_sw.cpp
The file was modifieddata/config/cfg_env_const.hpp
The file was modifieddata/config/cfg_env_const.cpp
The file was modifieddata/plan/switch_data.cpp
The file was modifieddata/config/cfg_func_sw.hpp
Commit df8ea0ed18c380880597450188436adbaf42b3e6 by wuyanjun110
feat: 变道 OGM 碰撞检测点 HMI 标红可视化

CheckOgmSafe 收集落进安全检测区的 OGM 占用栅格点存入 switch_data(不序列化),
DrawUnsafeArea 单独用 DrawOgmCrashPoints 标红, 直观显示哪块碰撞导致变道不安全。
upper/underlying 两层都判断, 下层碰撞时短路跳过上层。
The file was modifieddata/plan/switch_data.hpp
The file was modifiedhmi/draw/draw_area.cpp
The file was modifieddata/obstacle/ogm.cpp
The file was modifiedhmi/draw/draw_area.hpp
The file was modifieddata/obstacle/ogm.hpp
The file was modifieddata/plan/switch_data.cpp
Commit 8acf76576fdb77b153e5472b588d07b769012797 by wuyanjun110
feat: 锁站变道安全校验距离引入可配 buffer 并修正近距障碍物低速阈值

新增 lock_station_lane_change_safety_check_distance_buffer_ 配置项,
锁站(NEAR_SEASIDE_PASSING_PT)变道时用该 buffer 替代固定 +5.0;
修正 obstacle_near_speed_lower_thr_ 误写成 upper_thr 的赋值 bug。
The file was modifieddata/config/cfg_safe_const.hpp
The file was modifieddata/plan/switch_data.cpp
The file was modifieddata/config/cfg_safe_const.cpp
Commit 93284b6b898f83da2fb2d3be5561dc8d2826f770 by wuyanjun110
feat: 添加 UpdateAllSoftFallback 方法以处理软回退逻辑
The file was modifiedtasks/plan/pjpo_task.hpp
The file was modifiedtasks/plan/pjpo_task.cpp
The file was modifieddata/plan/smooth_data.cpp
Commit 92d0e0be4b06853615aeeb5832cbe87e382faa68 by tangwenqing
fix:  Keb: 参考线发生变化时禁用warm start,调用cold start重新优化路径

The file was modifiedalgorithm/plan/keb_optimizer.cpp
Commit 2a07415f0d6a3151c058882dfa307f69bb6cc136 by wuyanjun110
feat: 堆场偏移区配置改用 YardType 枚举, 新增入口高处障碍物类型并延长拉直距离
The file was modifieddata/other/flow_control.cpp
The file was modifieddata/ssep/into_yard_junction_ec.hpp
The file was modifieddata/ssep/into_yard_junction_ec.cpp
The file was modifieddata/config/cfg_env_const.cpp
The file was modifieddata/config/cfg_env_const.hpp
The file was modifiedsink/ros_sink_pnc_status.cpp
Commit 532faa6b508d1177a3642e663079cabd4114de4d by wuyanjun110
重构: 抽取搜索起点车头车挂框构造为静态函数并复用于入堆场区域

- 新增 OnlineRegionContourCreator::AddStartPostureBoxes 静态函数, 集中生成膨胀后的车头(及车挂)框
- open_space_ec 起点框内联逻辑改为调用该函数
- into_yard_junction_ec 构建 plan_region_contour 时合并起点框, 并集失败则保持原轮廓兜底
The file was modifieddata/ssep/online_region_contour_creator.hpp
The file was modifieddata/ssep/into_yard_junction_ec.cpp
The file was modifieddata/ssep/online_region_contour_creator.cpp
The file was modifieddata/ssep/open_space_ec.cpp
Commit cc74e335904e25e57018da0c2a3a0bc6c7f69057 by wuyanjun110
修复任务选择器组内多条件匹配语义: AND 改为 OR, 命中任一条件即选中该 group
The file was modifiedscenarios/stage.cpp
Commit a7c5fb041881154e18f4df7f2b1605ce023db3c0 by wuyanjun110
feat:调整参考线权重,从 0.0 修改为 3.0,以增强路径优化效果
The file was modifiedtasks/plan/keb_lane_follow_path_task.cpp
Commit 2bbd2fb7ee835a3c61b859336e93797bc7d40e10 by wuyanjun110
场景决策: 修复弯道 NORMAL 兜底与直行上下桥中误判

- U/S 弯 NORMAL 兜底判据统一为 BendForwardIntersection, 让桥后及海侧弯后短桥的弯能进 *_NORMAL_*_BEFORE(原 CurrentBendOut<LAT/LONG> 门挡住桥上游拓扑, 卡在 seaside INSIDE)
- 直行上/下桥中判据 StraightUp/DownBridgeInside 补前方 IsBend 早退, 与 Before 版对齐; 前方有弯道时不再误判为直行下桥中, 修复 BRIDGE_MULTI_LANES 被 STRAIGHT_INTO_BRIDGE_DOWN_*_INSIDE 遮蔽
The file was modifieddata/scenario/scenario_region_condition.cpp
The file was modifieddata/scenario/scenario_region_bt.cpp
Commit 76b17b6698b320a0995125d13bbf32f3eb24810f by wuyanjun110
BTActRunPlanner: 进入海侧路口区域时退出常规 planner
The file was modifieddata/scenario/scenario_planner_action.cpp
Commit f354f26aed1119909f4b5eee277a8dfb1c7fe9bd by tangwenqing
feat: SSEP: 多段倒车支持无pass point模式。解决到达pass point后重规划会继续往前的问题,解决停车角度歪的问题

The file was modifiedssep/coarse_search/searcher_builders/tractor_trailer_multi_segment_parking_bidirectional_searcher_builder.cc
The file was modifiedssep/scenarios/planner_utils.cc
The file was modifiedssep/coarse_search/searcher_builders/tractor_trailer_multi_segment_parking_bidirectional_searcher_builder.h
The file was modifiedssep/scenarios/scenario_planner_factory.h
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.cc
The file was modifiedssep/scenarios/planner_utils.h
The file was modifiedssep/scenarios/tractor_trailer_multi_segment_parking_planner.h
The file was modifiedssep/scenarios/tractor_trailer_single_segment_parking_planner.h