Changes

Summary

  1. feat_out:字段修改 (details)
  2. feat_out:增加雷达巡检消息 (details)
  3. feat:添加场桥和岸桥运动状态 (details)
Commit 92e52015e0ba2d617064def4af0dbc67bc8a8b23 by zhaojianfeng2
feat_out:字段修改
The file was modifiedtos_msgs/msg/PeripheralCmd.msg
Commit 68cababa5e2f53027e8b718834db3f443033ff50 by zhaojianfeng2
feat_out:增加雷达巡检消息

(cherry picked from commit cad3e79db9226bcc3d27e5f60c07da16d5667bca)
The file was addeddiagnose_msgs/msg/InspectRequest.msg
The file was modifieddiagnose_msgs/CMakeLists.txt
Commit fdd614ce091725cdc56c152cb01c189827fd7782 by wuyanjun110
feat:添加场桥和岸桥运动状态
The file was modifiedcloud_msgs/msg/CraneInfo.msg

Summary

  1. 修复牵引车进堆场掉头时专家路径抄近道 (details)
  2. 将潍坊低贝位入堆场的搜索终点拉直距离调整为 19.5 米 (details)
  3. fix: 细分拖挂车净距验收中疑似碰撞的扫掠区间 (details)
  4. fix: 修正拖挂车 KEB 精修后仍超限的运动学误差 (details)
  5. fix: 沿历史绕行路径拼接前进 SSEP 搜索入口 (details)
  6. fix: 按地图掉头弧长校验带途经点的进场候选 (details)
  7. fix: 入场参考线延长越界时保留可用区间 (details)
  8. Project stopped truck starts onto the guide in WBCA no-shift smooth mode (details)
  9. fix: 滚动地图裁掉搜索起点时保留路口入口引导线 (details)
  10. fix: 按路口实际执行首段更新换向距离和停车线 (details)
  11. fix: 允许 Lane Follow KEB 绕开原 SSEP 终点 (details)
  12. feat: 支持双向 IMV 按作业端搜索进出库路径 (details)
  13. fix: 按路口实际绕行路径更新换向停车距离 (details)
  14. feat: 接入罗泾 IMV 进出库选端与重规划 (details)
Commit e179e60b52aa7d2ea75075d78c5ccac741e6af12 by liuhongshuo
修复牵引车进堆场掉头时专家路径抄近道

比较专家候选线与地图参考线在搜索起终点之间的弧长。专家路径明显截短时保留地图参考线用于双向搜索。
The file was modifiedssep/scenarios/tractor_trailer_enter_yard_planner.h
Commit 16cebea5df0ee8402724e801720874d2ee9e68a2 by liuhongshuo
将潍坊低贝位入堆场的搜索终点拉直距离调整为 19.5 米
The file was modifieddata/ssep/into_yard_junction_ec.cpp
Commit 459afb43d940925d95bca5becad691e44e0ec49a by wuyanjun110
fix: 细分拖挂车净距验收中疑似碰撞的扫掠区间

General 净距验收先沿用原连续扫掠。粗包络接触障碍时,从该区间原有的起步豁免状态重验十个子区间,按车头和挂车各自的运动上界计算余量。

覆盖窄间隙通过、真实接触及转动途中碰撞,保留原车身外扩和障碍物检查。
The file was modifiedssep/scenarios/tractor_trailer_parking_collision.h
The file was modifiedssep/test/parking_collision_provenance_test.cc
The file was modifiedssep/scenarios/tractor_trailer_general_planner.h
Commit ee557017a07861e7198317de2e778dd5aa8b72cf by wuyanjun110
fix: 修正拖挂车 KEB 精修后仍超限的运动学误差

严格位置验收在固定权重精修后仍失败时,使用现有有界投影修正状态和步长,再用原运动学阈值逐边验收。保留固定端点、机械边界及软终点各分量已达到的容差。

诊断模式按最终轨迹重算代价。补充固定端点、软终点容差和诊断数值的回归用例。
The file was modifiedssep/test/tractor_trailer_kinematic_weight_test.cc
The file was modifiedssep/keb_optimizer/keb_problem.h
The file was modifiedssep/keb_optimizer/keb_problem.cc
The file was modifiedssep/keb_optimizer/tractor_trailer_keb_optimizer.cc
Commit 42a17bf42ff0f4e2ee4407a16924ebeb0eab6923 by wuyanjun110
fix: 沿历史绕行路径拼接前进 SSEP 搜索入口

首个前进搜索段与当前行驶路径连续且自车仍位于入口之前时,保留绕行前缀与搜索节点。普通路口补足车后参考线,重搜等待期间保留已接入的入口并更新出口。

OpenSpace 在主备参考线间拼接时分别标记两端来源。补充滚动地图边界、无地图引导、搜索段标识和换向后的回归用例,并刷新回放字段审计指纹。
The file was modifieddata/plan/search_reference_prefix.cpp
The file was modifieddata/plan/guide_line.cpp
The file was modifiedtasks/other_tasks/stitch_path_to_reference_line.cpp
The file was modifieddata/plan/guide_line.hpp
The file was modifiedTesting/reference_line_replan_test.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_member_inputs.json
The file was modifieddata/plan/search_reference_prefix.hpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifiedtasks/other_tasks/stitch_path_to_reference_line.hpp
Commit 4e2bbb479a16c7e78d25044c61cb4da3c18e69a1 by wuyanjun110
fix: 按地图掉头弧长校验带途经点的进场候选

保留原始地图引导线用于专家路径长度比较。带途经点的掉头候选被拒绝时,双向搜索的引导距离和参考线代价共同回退到地图。合并普通和低贝位的构造分支,并覆盖两种场景的接受和拒绝路径。
The file was modifiedssep/scenarios/tractor_trailer_enter_yard_planner.h
The file was modifiedssep/test/ssep_planner_test.cc
The file was modifiedssep/scenarios/scenario_planner_factory.h
Commit 5062fd3d74b8c8709e9828bc9d7d36e0c575377f by wuyanjun110
fix: 入场参考线延长越界时保留可用区间

按地图有效弧长裁剪前后延长量,保留末点并跳过连续重复采样点。匹配失败或采样区间退化时返回失败,避免提交空参考线。覆盖末端短于 7.5 米、非整步长以及连续构造失败的边界。
The file was modifieddata/ssep/into_yard_junction_ec.cpp
The file was modifiedTesting/ssep_scenario_config_lifecycle_test.cpp
Commit 2885736ca7eeda66a687a98ef8c1364c1f20072c by chenran
Project stopped truck starts onto the guide in WBCA no-shift smooth mode
The file was modifiedTesting/wbca_smooth_continuity_test.cpp
The file was modifiedtasks/plan/path_optimization_task.cpp
The file was modifiedtasks/plan/path_optimization_task.hpp
Commit f5d1ac3ba7edb81f327c953f3d5c2abb6d4bcb3b by wuyanjun110
fix: 滚动地图裁掉搜索起点时保留路口入口引导线

路口前进首段复用搜索结果时,核对任务、路口、分段、请求和搜索接缝,使用上一帧已验收的入口节点重建引导线。覆盖地图连续裁剪、历史失效和切换倒车段的情况。
The file was modifieddata/plan/ssep_task_context.hpp
The file was modifieddata/plan/ssep_task_context.cpp
The file was modifiedreplayer/scene_data/generated/plan_frame_member_inputs.json
The file was modifiedTesting/reference_line_replan_test.cpp
The file was modifieddata/plan/guide_line.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
Commit 1eada7d8a0f7a78bf1cee6d82d4f82354a0774dc by wuyanjun110
fix: 按路口实际执行首段更新换向距离和停车线

沿倒车入口引导线计算到真实换向点的距离,计入车身至搜索起点之间的余量。接收新分段时撤销旧距离,等当前执行路径覆盖换向点后再恢复,避免回退历史路径时提前放行。

回归覆盖接管失败、跨帧恢复和倒车停车线的车尾位置。
The file was modifieddata/plan/ssep_data.cpp
The file was modifiedTesting/bulk_speed_limit_test.cpp
The file was modifieddata/vehicle/vehicle_destination.cpp
The file was modifiedtasks/other_tasks/stitch_path_data_to_path.cpp
The file was modifieddata/plan/ssep_task_context.cpp
Commit e6e0066e46ecfc558f10f2625b0a56f63e4409c8 by wuyanjun110
fix: 允许 Lane Follow KEB 绕开原 SSEP 终点

刚体车绕障路径偏离 SSEP 参考终点超过 0.50 m 时,Lane Follow 改为校验整条候选的曲率。搜索 KEB 继续使用严格终点校验。

增加绕行、后段曲率超限和 0.50 m 匹配边界的对照测试。
The file was modifiedssep/test/rigid_truck_parking_validation_test.cc
The file was modifiedssep/keb_optimizer/rigid_truck_keb_optimizer.h
The file was modifiedtasks/plan/keb_lane_follow_path_task.cpp
The file was modifiedssep/keb_optimizer/rigid_truck_keb_optimizer.cc
The file was modifiedalgorithm/plan/keb_optimizer.cpp
Commit 26beb384a21bff660f1d62af673ca2cba98aa13d by wuyanjun110
feat: 支持双向 IMV 按作业端搜索进出库路径

使用图纸 A 头的物理航向作为搜索起点,由作业模式选择领行端。进出库优先单向行驶,无解时允许前后调整,并校验重规划时可复用的历史路径。

根据车身航向变化和带方向的行程计算曲率,校验前后轴轮角,必要时由 KEB 精修。补充正反向、重规划和轮角回归,并同步回放入口方向的显示。
The file was modifiedssep/test/keb_normal_extension_test.cc
The file was modifiedssep/keb_optimizer/keb_problem.h
The file was modifiedssep/offboard/scene_replay/README.md
The file was modifiedssep/test/local_regression/README.md
The file was modifiedssep/scenarios/scenario_planner_factory.h
The file was addedssep/scenarios/imv_parking_replan.h
The file was modifiedssep/common/utils/common.hpp
The file was modifiedssep/offboard/servers/scene_vis_html_template.cc
The file was modifiedssep/test/local_regression/test_render_terminal_entrance.py
The file was addedssep/scenarios/imv_parking_adjustment.h
The file was modifiedssep/test/local_regression/render_regression_report.py
The file was modifiedssep/ssep_planner.cc
The file was modifiedssep/keb_optimizer/imv_keb_optimizer.cc
The file was modifiedssep/scenarios/imv_enter_station_planner.h
The file was modifiedssep/test/imv_enter_station_candidate_test.cc
The file was modifiedssep/coarse_search/searcher_builders/imv_general_searcher_builder.cc
The file was addedssep/keb_optimizer/imv_path_steering.cc
The file was modifiedssep/scenarios/imv_exit_parking_spot_planner.h
The file was modifiedssep/coarse_search/searcher_builders/imv_general_searcher_builder.h
The file was modifiedssep/ssep_planner.h
The file was modifiedssep/scenarios/imv_parking_validation.h
The file was modifiedssep/scenarios/imv_search_extra_params.h
The file was modifiedssep/test/local_regression/test_scene_vis_geometry.py
Commit 9eeccb9d67ff7ba71061d18402f793e5f42ca924 by wuyanjun110
fix: 按路口实际绕行路径更新换向停车距离

滚动路径只覆盖首段的一部分时,沿已规划的绕行部分和剩余搜索段计算到换向点的距离。复用首段路径时同步刷新目的地,覆盖车辆与原搜索起点重合的情况。

统一换向点位置和朝向的匹配条件,保留提前截断路径的停车余量,补充路径拼接到纵向停车线的回归测试。
The file was modifieddata/vehicle/vehicle_destination.cpp
The file was modifiedTesting/bulk_speed_limit_test.cpp
The file was modifiedTesting/CMakeLists.txt
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifiedtasks/other_tasks/stitch_path_data_to_path.cpp
The file was modifieddata/plan/ssep_task_context.hpp
The file was modifieddata/plan/ssep_task_context.cpp
The file was modifieddata/vehicle/vehicle_destination.hpp
The file was modifiedreplayer/scene_data/generated/plan_frame_member_inputs.json
Commit 1984ccb2c75f6c9f43eb6631bc17b923cb131677 by wuyanjun110
feat: 接入罗泾 IMV 进出库选端与重规划

在线规划按任务阶段和车位轴线选择顺路的作业端,使用物理车身航向构造搜索输入。等待停车、重试和换向重搜时保持本次任务的方向,出库按末段行驶方向衔接道路。

在路径分段、投影延伸和下发时保持曲率与领行端一致。将选端与终点引导线调整限定在匹配的港口规则,并增加原有停车规则及新旧场景切换的测试。
The file was modifiedtasks/deciders/search_decider/forward_search_decider.cpp
The file was modifiedTesting/ssep_path_corridor_test.cpp
The file was modifieddocs/ssep_scenario_config_lifecycle.md
The file was modifieddata/other/flow_control.cpp
The file was modifieddata/ssep/location_condition.cpp
The file was modifieddata/plan/ssep_data.hpp
The file was modifieddata/other/flow_control.hpp
The file was modifieddata/ssep/forward_ec.cpp
The file was addedTesting/ssep_input_empty_map.cpp
The file was modifieddata/plan/ssep_data.cpp
The file was modifieddata/ssep/forward_ec.hpp
The file was modifiedTesting/ssep_scenario_config_lifecycle_test.cpp
The file was modifieddata/ssep/ssep_ec.hpp
The file was modifiedreplayer/scene_data/generated/plan_frame_member_inputs.json
The file was modifiedTesting/ssep_path_curvature_test.cpp
The file was modifieddata/ssep/ssep_ec.cpp
The file was modifiedtasks/plan/ssep_task.cpp
The file was modifiedTesting/CMakeLists.txt
The file was modifiedtasks/deciders/other_decider/replan_decider.cpp
The file was modifieddata/ssep/location_condition.hpp
The file was modifiedTesting/scenario_search_exit_test.cpp
The file was modifiedreplayer/scene_data/generated/full_custom_cpp_member_inputs.json
The file was modifieddata/app/fsm/task_fsm/task_travel/task_travel_fsm.cpp