Changes

Summary

  1. fix: 防止散货停车搜索期间提前进入 PARK_LOCK (details)
  2. fix: 修复散货出库搜索首段尚未就绪时的拼接崩溃 (details)
  3. feat: 支持刚性卡车多段停车按配置半径优先换向 (details)
  4. feat: 支持刚性车沿引导线动态选择搜索终点 (details)
  5. feat: 支持散货出库多段搜索以前进挡接入 (details)
  6. fix: 恢复拖挂多段停车短尾的一次换向搜索 (details)
  7. feat: 将配置限速框应用于路口多段调整 (details)
  8. refactor: 复用刚性卡车多段停车的换向点约束 (details)
Commit ccf09c249d0083abc965fc5e23bbde8c70bdbc44 by wuyanjun110
fix: 防止散货停车搜索期间提前进入 PARK_LOCK

任务状态机先于本帧搜索上下文运行。本帧缺少上下文时,使用同一任务上一帧的搜索状态判断能否锁定,避免车辆靠近 routing 终点时跳过尚未执行的搜索路径。

补充经 FromHis 恢复数据的回归用例,覆盖请求中、运行中、搜索完成但尚无分段,以及任务切换后的锁定判断。
The file was modifiedTesting/reverse_pickup_lifecycle_test.cpp
The file was modifieddata/app/fsm/task_fsm/task_park_fsm/park_fsm_transition/bulk_transition.cpp
Commit 256ff9929b299910f5d97e5762f7c56044c6c542 by wuyanjun110
fix: 修复散货出库搜索首段尚未就绪时的拼接崩溃

出库位置条件可能在异步搜索完成前选中直接拼接。按等待策略处理后,直接拼接先校验当前分段,再读取方向。缺段时清空本帧路径并返回任务错误。

增加同一拼接任务的回归用例,验证已有输出在缺段时失效,并在搜索分段就绪后恢复。
The file was modifiedTesting/ssep_path_corridor_test.cpp
The file was modifiedtasks/other_tasks/stitch_path_data_to_path.cpp
Commit f0c62971c10948a7dee83000e504e5ddc1ba87ba by wuyanjun110
feat: 支持刚性卡车多段停车按配置半径优先换向

复用拖挂车的换向半径参数。刚性卡车缺省沿用原搜索,配置后在粗搜索和优化中校验同一任务换向段,近点搜索失败时用剩余时间放宽范围。

补充参数说明和回归测试,覆盖缺省值、零值、受阻回退及优化后换向段归属。
The file was modifiedssep/scenarios/tractor_trailer_multi_segment_parking_planner.h
The file was modifiedssep/scenarios/parking_reference_region.h
The file was modifiedssep/scenarios/truck_multi_segment_parking_planner.h
The file was modifiedssep/test/truck_parking_retry_test.cc
The file was modifieddocs/ssep_scenario_config_lifecycle.md
Commit be02366efe95ea8f2da6be7e00a8ebe8145dd5c7 by wuyanjun110
feat: 支持刚性车沿引导线动态选择搜索终点

按原目标投影里程和前移距离生成候选接入点,通用搜索的终点判定、运动学启发和解析连接使用同一组目标。覆盖引导线末端、相邻分支和反向接入。
The file was modifiedssep/coarse_search/searcher_builders/rigid_truck_general_searcher_builder.cc
The file was modifiedssep/test/search_condition_identity_test.cc
The file was modifiedssep/coarse_search/searcher_builders/rigid_truck_general_searcher_builder.h
The file was addedssep/coarse_search/conditions/guide_line_goal_window.h
Commit e8506ff9d814cef58167d368fb2b6c51aa598529 by wuyanjun110
feat: 支持散货出库多段搜索以前进挡接入

没有可用出入口时直接使用刚性车通用多段搜索,有出入口时沿可用堆场口接入引导线窗口。通过场景参数独立约束到达挡位,在粗搜、短段裁剪、优化和最终分段时验收,并保留中途倒车和转弯。
The file was modifiedssep/coarse_search/searcher_builders/bulk_yard_in_out_path_searcher_builder.cc
The file was modifiedssep/ssep_planner.cc
The file was modifiedssep/test/search_condition_identity_test.cc
The file was modifiedssep/scenarios/truck_bulk_yark_in_out_planner.h
The file was modifieddocs/ssep_scenario_config_lifecycle.md
The file was modifiedssep/coarse_search/multi_stage_hybrid_astar_search_engine.cc
The file was modifiedssep/coarse_search/multi_stage_hybrid_astar_search_engine.h
The file was modifiedssep/scenarios/truck_bulk_yark_in_out_planner.cc
The file was modifiedssep/coarse_search/searcher_builders/bulk_yard_in_out_path_searcher_builder.h
The file was modifiedssep/test/truck_bulk_exit_fallback_test.cc
Commit 0aba2a6ffc2f4ae4633b041bc4eef9e04c578ac5 by wuyanjun110
fix: 恢复拖挂多段停车短尾的一次换向搜索

为短于一个搜索步长的正尾段分阶段选择倒向起点。一前一倒阶段从完整步长起步,未匹配引导线时以该偏移推算参考换向姿态;进入多段调整时仍使用配置的精确尾长。零尾段继续关闭反向直线预采样。

在规划器构建入口覆盖零尾段、短于一步、等于一步和多步的情况,并在同一搜索器上验证换向阶段切换。Orin 同输入回放复现 10 月 11 日 15:29 的 76.25 米倒车路径。
The file was modifiedssep/coarse_search/bidirectional_hybrid_astar_search_engine.h
The file was modifiedssep/coarse_search/searcher_builders/tractor_trailer_multi_segment_parking_bidirectional_searcher_builder.cc
The file was modifiedssep/test/ssep_planner_test.cc
The file was modifiedssep/coarse_search/bidirectional_hybrid_astar_search_engine.cc
The file was modifiedssep/coarse_search/searcher_builders/tractor_trailer_multi_segment_parking_bidirectional_searcher_builder.h
Commit 93bbc6bd46f28029263412ceed24e303fc5ea06e by wuyanjun110
feat: 将配置限速框应用于路口多段调整

复用路口调整的任务激活判定,使前进和倒车段按当前路径及车身与限速框的交集施加限速。补充普通、岸边路口的双向、离框和退出调整测试,更新配置说明。
The file was modifiedTesting/bulk_speed_limit_test.cpp
The file was modifieddocs/bulk_open_space_speed_limit.md
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
Commit d20a5190ab76ad6aefb3b902349fcbf706cc8a52 by wuyanjun110
refactor: 复用刚性卡车多段停车的换向点约束

精优化和失败重试共用刚性卡车 KEB 优化器的换向点处理,沿用各阶段的参考路径和权重,仅为方向明确的换向点添加位置与航向代价。
The file was modifiedssep/scenarios/truck_multi_segment_parking_planner.h