Changes

Summary

  1. feat_out: weiqiao adapt (details)
Commit 57af896a5bd2da6b233052f2536db2925a00c44f by matao
feat_out: weiqiao adapt
The file was modifiedsins/strapdown_truck.cpp

Summary

  1. fix: PeripheralCmd 使用 cmd_belt_speed 字段 (details)
Commit 7f9c41c68f95627a651c9218492a05ba33b7d0db by zhaojianfeng2
fix: PeripheralCmd 使用 cmd_belt_speed 字段

与 tos_msgs/PeripheralCmd(rc_dev_qiangang)对齐,修复 orin-slave32 #534 编译错误。
The file was modifiedsrc/ros_traffic.cpp

Summary

  1. fix: 按实际车道航向判断上码头连接形状 (details)
  2. fix: 按潍坊 4552 车道校正默认岸线航向 (details)
  3. fix: 优化堆场出库搜索并补齐候选路径验收 (details)
  4. feat: 增加直行出堆场弯道禁停独立开关 (details)
  5. fix: 拒绝包含非连续车道链的任务路由 (details)
  6. fix: 统一搜索任务进度并保留跨场景初始直行状态 (details)
  7. fix: 避免精准倒车候选优化被搜索子阶段时限截断 (details)
Commit 4ef682261f5cfef3202714bdbb52fd089f55585b by wuyanjun110
fix: 按实际车道航向判断上码头连接形状

前后车道已知且目标为码头车道时,比较连接处实际航向,避免港口岸线配置将同向或反向平行连接误判为直角上码头。保留纵向道路分类和配置兜底。

新增旋转、正反向、30 度和 150 度邻近边界及潍坊错误岸线配置回归。分布式编译完成,当前工作区 129 项路由相关测试通过;未执行完整搜索回放。
The file was modifiedTesting/routing_transition_test.cpp
The file was modifieddata/map/pnc_map/routing_extension/routing_data.cpp
Commit 7b4342f85e049949a16d79a38c6fbeebc5b35322 by wuyanjun110
fix: 按潍坊 4552 车道校正默认岸线航向

将潍坊默认岸线航向由 2.346 rad 调整为地图 4552_0_3 轴线的 3.9150972784460487 rad,供缺少前车道等分支使用;保留显式 ROS 参数覆盖。

补充缺前车道时的同向、反向、跨 2π 和垂直方向测试,覆盖横向道路与码头道路。clang-format 21 格式化及分布式编译通过,129 项路由相关测试全部通过。
The file was modifieddata/config/cfg_func_sw.cpp
The file was modifiedTesting/routing_transition_test.cpp
Commit 92b48add30ec766584605be2418097cf6d503a9a by wuyanjun110
fix: 优化堆场出库搜索并补齐候选路径验收

对带固定前进头段的双向兜底搜索降低保守圆盘软罚权重,使用真实车身连续碰撞检查约束可行性,避免短距离调整被长距离绕行挤掉。

按新增运动基元检查首段清障与换向接缝,空占用区域快速跳过;最后一个搜索器的候选经过优化和完整验收后才返回,失败继续原队列。统一规划时限,补齐优化后的障碍、约束图与分段自相交验收,并完善自交诊断。

验证:相关 113 项测试通过;魏桥原始场景及另一出库场景通过;现有同类型回归集 1 例基础验收通过;青岛 372 原始输入 21 例 CPU 回放中 16 例基础验收通过,5 例达到搜索节点上限,未完成修改前后对照,不宣称全量无回归。
The file was addedssep/data_structures/path_validation.h
The file was modifiedssep/scenarios/truck_bulk_yark_in_out_planner.cc
The file was modifiedssep/scenarios/truck_bulk_yark_in_out_planner.h
The file was modifiedssep/coarse_search/multi_stage_hybrid_astar_search_engine.cc
The file was modifiedssep/test/imv_enter_station_candidate_test.cc
The file was modifiedssep/scenarios/imv_enter_station_candidate.h
The file was modifiedssep/scenarios/first_segment_clearance_checker.h
The file was modifiedssep/test/truck_bulk_exit_fallback_test.cc
The file was modifiedssep/coarse_search/multi_stage_hybrid_astar_search_engine.h
The file was modifiedssep/scenarios/forward_clearance_check.h
The file was modifiedssep/ssep_planner.cc
The file was modifiedssep/test/forward_clearance_check_test.cc
Commit b53a46f85c8dfac191f4007dd24181b3fe3e4034 by wuyanjun110
feat: 增加直行出堆场弯道禁停独立开关

新增 use_func_straight_out_yard_park,默认启用;按路口通行方向单独过滤直行出堆场禁停,保留原出堆场总开关及转弯、穿场行为。

补齐 Full 和 Compact ReplayInput 的反向布尔编码,旧快照缺字段默认启用;新增行为与回放兼容测试。
The file was modifiedproto/config.proto
The file was modifieddata/constrain/disable_stop_range.cpp
The file was modifiedTesting/disable_stop_regression_test.cpp
The file was modifieddata/config/cfg_func_sw.hpp
The file was modifiedreplayer/scene_data/generated/config_schema_inputs.json
The file was modifiedTesting/scene_replay_foundation_test.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_descriptor.pb
The file was modifieddata/config/cfg_func_sw.cpp
The file was modifiedreplayer/scene_data/full_custom_codec_exclusions.yaml
The file was modifiedreplayer/scene_data/generated/full_custom_codec_coverage_audit.yaml
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifiedreplayer/scene_data/compact_numeric_policy.yaml
The file was modifiedreplayer/scene_data/generated/scene_replay_api_descriptor.pb
The file was modifiedreplayer/scene_data/generated/compact_exact_numeric_visitor.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_encoder.cpp
The file was modifiedreplayer/scene_data/config_proto_codec.cpp
The file was modifiedreplayer/scene_data/generated/compact_scene_descriptor.pb
Commit ae2163483da602ea6cd0ee66626ed3fcab28fd67 by wuyanjun110
fix: 拒绝包含非连续车道链的任务路由

在路由扩展前校验所有 passage 的地图车道和 successor 关系,
避免将上游错误的跨车道连接直接拼为中心线。多路径接收失败时
清空部分结果,由现有路径解析失败流程拒绝新任务并保留原任务。

补充异常路由、合法换道和接收失败生命周期测试,以及 IGV03
原始任务字段专项验证。旧分支不支持整帧 encoding v10,专项仅
通过已核对兼容的 context 和 exact_numeric 解码恢复任务路由。

验证:130 项路由回归通过;现场 115 帧正常任务接收、329 帧异常
任务拒绝,15 帧无任务单列。clang-format 21.1.8 及 diff 检查通过。
The file was modifieddata/map/pnc_map/routing_extension/routing_data.cpp
The file was modifiedTesting/routing_transition_test.cpp
The file was modifiedTesting/hmi_collision_render_test.cpp
Commit 18f980d13dac11b925a60f7d862e59c6d26d5f05 by wuyanjun110
fix: 统一搜索任务进度并保留跨场景初始直行状态

抽取公共任务签名和进度失效清理,供初始直行与脱挂车出库倒车复用。
将初始直行锚点和完成状态独立保存在 SsepData,依据实际车辆位置更新,避免场景切换后重搜再次要求直行 2.5 米。
补齐旧请求迁移、Full/Compact 编解码和生命周期回归测试。

验证:pnc_node 构建及 Proto 合同检查通过;1066 项测试通过,14 项可选数据测试跳过。尚未执行原始 bag 连续回放。
The file was modifiedreplayer/scene_data/generated/plan_frame_encoder.cpp
The file was modifieddata/plan/ssep_task_context.hpp
The file was modifiedproto/pnc_scene/compact_replay_input.proto
The file was modifiedreplayer/scene_data/compact_numeric_leaf_contract.csv
The file was modifieddocs/ssep_search_lifecycle.md
The file was modifiedreplayer/scene_data/plan_frame_full_mapping.yaml
The file was modifiedreplayer/scene_data/compact_numeric_policy.yaml
The file was modifiedproto/plan_data.proto
The file was modifiedreplayer/scene_data/generated/compact_exact_numeric_visitor.cpp
The file was modifiedplan/prepare/prepare_state.cpp
The file was modifiedreplayer/scene_data/generated/compact_scene_descriptor.pb
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifiedreplayer/scene_data/generated/scene_replay_api_descriptor.pb
The file was modifiedreplayer/scene_data/full_proto_custom_encoder.cpp
The file was modifieddata/plan/ssep_data.cpp
The file was modifieddata/plan/ssep_data.hpp
The file was modifiedreplayer/scene_data/compact_custom_field_proto_codec.cpp
The file was modifieddata/plan/ssep_task_context.cpp
The file was modifieddata/ssep/ssep_ec.cpp
The file was addeddata/other/task_progress.hpp
The file was addeddata/other/head_straight_progress.cpp
The file was modifiedreplayer/scene_data/compact_proto_codec.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_codec_coverage_audit.yaml
The file was modifiedTesting/parking_pass_progress_test.cpp
The file was modifiedTesting/routing_map_guard_test.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_field_roles.json
The file was modifiedreplayer/scene_data/plan_frame_field_roles.csv
The file was addeddata/other/head_straight_progress.hpp
The file was modifiedTesting/scene_replay_foundation_test.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_descriptor.pb
The file was modifiedTesting/ssep_scenario_config_lifecycle_test.cpp
Commit 09e90baa4f94b732f1dabfba5e5535f9b36e5217 by wuyanjun110
fix: 避免精准倒车候选优化被搜索子阶段时限截断

节点展开继续使用子阶段截止时间,已生成候选的净空检查、优化和延伸
改用本次调整请求的剩余总预算,避免仍有时间的有效候选被提前丢弃。
保留总时限、外层细网格重试预留以及碰撞和运动学硬约束。

验证:相关单元测试 30/30、已有刚性停车回归 21/21 通过。
现场 10 例在显式 1.5 米拉直实验下全部通过独立验收,最后两例复测通过;
保留 2 米、仅修预算的代表对照为 2/3 通过。未修改默认拉直距离或任务点。
The file was modifiedssep/scenarios/truck_accurate_reversing_planner.cc