Changes

Update vehicleInfo.groovy

Add new file

fix: 远程单次直线步进END后不退出循环重回MOVE

UpdateFSMState 每周期被调两次(pilot_update 一次, 失败 stage 经
ResetSuccessorTasks 仍强制执行的 MOTION_FSM_TASK 一次), fsm_interface
的 last_motion_sub_state_type 被第二次快照拍平, REMOTE_MOVE->REMOTE_END
边沿被吞, is_need_increase_remote_idx_ 永不置位, cur_remote_idx_ 不推进,
finishReqRemoteCtrl 不触发, REMOTE_END 停 remote_align_stop_sec 后经
RemoteInit 无条件重回 REMOTE_MOVE 直至超时.

prepare 改为自持上周期 remote 子状态判 END 进入沿, 不再依赖
fsm_interface 的 last_*; REMOTE_STOP 跳过判断同步替换恢复原语义.

fix: park子状态机收普通任务卡死PARK_MOVE无法退出

bulk分支(FSM_TYPE_B)在PARK_LOCK收到无散货途径点的普通任务时,
Lock2Init/Init2Move仅凭routing标志放行进入PARK_MOVE, 而该态下
Move2Adjust(需bulk_in点)与Park_Bulk2Travel(需bulk_out点)恒假,
只能靠再次取消任务解锁(实车卡死近4小时):
- Lock2Init/Init2Move补散货途径点检查, 普通任务不再进入死区
- Park_Bulk2Travel新增逃生: 新任务无任何散货途径点且地图可用时退回TRAVEL

同修停车场分支(FSM_TYPE_A)同类隐患: Park_Park2Travel对PARK_MOVE
放行新routing逃生, 但带双卡死判据(switch恒KEEP+停留超20s),
正常进位途中刷新停车任务不受影响

另补EnumType2String缺失的E_TASK_FSM/E_MOTION_FSM映射,
日志不再把正常事件误打成E_NO_STATE

chore: SSEP: 集卡多段倒车自适应CPU/GPU模式，回退部分CPU参数

fix: Keb: 修复IMV重规划时起点曲率异常的问题

fix: 修正纵向轨迹基础计算边界

修正轨迹点投影的绝对 s 计算、可行域减速边界和加速段距离公式。

补齐终点采样，允许数值稳定的微小时长 jerk 段，并实现 PiecewiseJerkTraj 深拷贝。

feat: 增强纵向碰撞连续扫掠

按时间和空间双阈值补齐轨迹点间的连续碰撞检测，并统一牵引车与挂车扫掠轨迹。

细化 OGM 首碰位置，修正碰撞距离重复扣除 ego s 的问题。

fix: 统一纵向停车规划与限速约束

建立统一停车上下文与运行状态，明确普通规划继承规划曲线起点、FSM 安全制动继承车辆反馈。

将严格停车改为 jerk 受限的多候选采样并支持上一条安全曲线续接，统一零速硬约束、动态限速和碰撞检查。

压缩停车诊断序列化，在回放端重建可派生数据，并补齐停车、重入、重载、限速及连续扫掠回归测试。

feat: 增加 Lattice 停车诊断界面

增加候选轨迹、ST、s-v、t-a 和停车时序视图，展示停车上下文、候选筛选及失败原因。

接入在线 HMI 与回放 HMI，共用压缩后的诊断数据并支持回放重建结果展示。

feat:s弯下码头面不搜索的bug

fix: 防止终点制动阶段重新提速

- 在同一停车约束内跨帧锁存正常规划制动承诺
- 统一收紧停车候选、参考速度和历史续接的加速度约束
- 补充高速近终点重加速及状态清理、序列化回归测试

fix: 支持停车终点释放后的低速前移

统一为所有硬速度约束保留 0.5 km/h 容差，同时继续严格限制停车终点的空间边界。

在停车未激活但硬终点仍有效时采样精确收敛到终点的低速五次曲线，解决动态跟车距离缩短后车辆无法继续前移的问题，并补充容差与候选生成测试。

fix: 修正短距停车前移速度

按剩余距离和舒适动力学搜索最高可行巡航峰值，并同步候选曲线与参考曲线。

保留 0.5 km/h 仅作为硬限速容差，移除其对前移速度的误用；在终点匹配范围内从继承位置生成零速保持，消除厘米级残差规划失败。

fix: 隔离停车目标跨帧状态

严格校验约束 ID 与投影后停车终点连续性，防止新终点继承旧目标的制动承诺、安全曲线和 OGM hold。补充空 ID、同 ID 跳变、失活目标和 FSM 重入回归测试。

fix: 修正双头 IMV 直线步进方向

双头 IMV 在反向形式下默认保持固定车身方向，不再无条件按 reversing_mode 翻转步进距离。\n\n新增功能开关以兼容需要沿用旧方向定义的车辆，并支持配置动态更新及序列化。

fix: 修复纵向停车限速恢复与无解兜底

去除跨帧制动速度锁存，改为根据当前停车距离和动力学状态决定是否立即制动。

区分当前位置与前方硬限速，为前方低限速生成满足物理恢复包络和终点停车条件的候选。

正常规划无解时输出限 jerk 的最大减速兜底轨迹，并在后续周期持续重试正常规划以便恢复行驶。

补充硬限速、短距停车、制动恢复和现场回归测试。

feat: 引导线绘制车道 ID

在每段连续车道的中点标注 lane ID，并根据视图缩放调整字号。\n跳过空 ID 和无效路径索引，避免重复文字与越界访问。

feat: 支持短直道路口连续搜索

抽取短直道连接下一路口的公共判定逻辑，并在引桥搜索中将终点延伸至下一路口 end_s。

新增默认关闭的 SSEP 功能开关，统一控制引桥、出堆场及后续场景的启用行为，同时支持动态更新与快照序列化。

perf: 缩小版本宏的编译影响范围

将 VERSION_NODE、COMMIT_NODE 和 NODE_MSG_VERSION 从全局定义调整为仅作用于实际读取版本信息的 5 个源文件。

避免每次提交变化都改写全部编译命令并触发全量重编，使其余编译单元能够跨提交复用 ccache，同时保留程序版本信息。

fix: 修复相邻道路逆向车误触发窄会车

窄会车净空计算前过滤完全位于最右可行边界之外的障碍断面，避免负净空将相邻平行道路车辆误判为极窄会车。\n\n障碍跨越可行边界时仍按零净空保守处理，并补充 outside_right 诊断计数。

doc: SSEP: 补充搜索模块相关的注释和文档

fix: 防止 Lattice 轨迹合成陷入死循环

将轨迹合成的无界浮点循环改为整数索引有界采样，并拒绝非法采样步长、非有限时域和异常大的采样规模。\n\n补充制动曲线时长校验、Lattice 阶段 watchdog 定位及零步长、无限时域和超大时域回归测试。

feat: 统一无ID聚类障碍运动跟踪

新增内部稳定航迹，统一维护聚类 polygon、UTM 速度、命中丢失和运动状态，并处理普通目标与聚类之间的短时交接及分裂伴随片段。\n\nReverseApproach 改为消费统一航迹并仅保留停止线 latch；普通横向侵入改用统一速度计算 TTC，移除旧 OccupyGrid 边界差分限速。DrivingCorridor 仅在侧避栅格屏蔽确认移动聚类的 polygon 扫掠区域，保留纵向原始 OGM 安全约束。\n\n补充 PlanFrame/HMI 诊断与回放冻结数据，统一 Replayer 的 OGM 输入，并序列化新增横向 TTC 参数。

fix: 序列化直道路口边界开关

将 use_func_straight_junction_use_road_boundary_ 纳入 CfgFuncSw v19 快照，确保 PNC Node 与 Replayer 使用同帧开关生成 RoadBoundary。

fix: 修复进堆场规划器头文件引用路径

更新 YardEntryReferencePathGenerator 重构后的头文件目录，解决 ssep_planner 编译时找不到头文件的问题。

fix: 调整散货出场禁横移区域判定

使用任务 FSM 的 TRAVEL_OUT 子状态判断太阳纸业散货出场阶段，避免流控状态与实际任务阶段不一致。

补充振石散货场景在最后一段 SSEP 路径上的横移放行逻辑。

fix: 调整散货出场禁横移区域判定

使用任务 FSM 的 TRAVEL_OUT 子状态判断太阳纸业散货出场阶段，避免流控状态与实际任务阶段不一致。

补充振石散货场景在最后一段 SSEP 路径上的横移放行逻辑。

feat: 散货进场末段切换 PJPO 规划

新增 bulk in 最后一段 SSEP 路径条件，并在散货前向阶段支持横向规划器选择器。命中条件时同步选择 PJPO 任务及 active lateral planner，保证 HMI 展示与实际规划器一致。

fix: 增强 SSEP 目标路径有效性校验

引导线构造与路径拼接前统一使用 Path::IsAvailable 校验 SSEP 目标路径。路径点不足时回退历史引导线，避免继续访问 front、back 或执行坐标转换。

feat: 振石进场按参考线构造搜索起点

振石 bulk in 场景复用前港的动态搜索起点计算，根据车辆速度和目标点在参考线上的位置选择前向搜索起点。

feat: 散货进场末段切换 PJPO 规划

新增 bulk in 最后一段 SSEP 路径条件，并在散货前向阶段支持横向规划器选择器。命中条件时同步选择 PJPO 任务及 active lateral planner，保证 HMI 展示与实际规划器一致。

fix: 增强 SSEP 目标路径有效性校验

引导线构造与路径拼接前统一使用 Path::IsAvailable 校验 SSEP 目标路径。路径点不足时回退历史引导线，避免继续访问 front、back 或执行坐标转换。

feat: 振石进场按参考线构造搜索起点

振石 bulk in 场景复用前港的动态搜索起点计算，根据车辆速度和目标点在参考线上的位置选择前向搜索起点。

doc: SSEP: 增加keb optimizer及离线工具的说明文档

fix: SSEP: 修复IMV多段倒车入库采样曲率设置错误的问题

fix: 修复 Lattice 制动恢复与硬限速约束

正常规划从制动兜底恢复时仅清除继承的负加速度，并在再次无解时续接上一条制动曲线，避免低速锁存和连续制动弱化。

统一 FSM 安全制动的规划拼接起点，完善 stop 轨迹标志生命周期和短路径截断兜底；同时按约束来源区分 0.5 km/h 硬限速容差，停车及障碍物约束保持严格。

补充制动切换、恢复重试、短路径和分类限速回归测试。

docs: 记录纵向规划连续性规则

明确正常规划、安全制动和兜底轨迹之间的起点继承、状态切换及标志生命周期要求，避免后续改动重新引入速度跳变或低速锁存。

fix: 平滑普通硬限速恢复制动

普通地图、曲率和 REQ 限速按正常减速度恢复，并继承已有负加速度。\n\n前方限速、障碍物及停车约束仍保留最大制动能力，避免削弱 ST 与终点停车安全边界。\n\n增加限速切换及现场停车失败帧的回归测试。

fix: 平滑前方普通硬限速制动

- 普通限速按边界距离选择最小可达减速度，距离充足时使用正常或继承值
- 严格安全来源继续使用最大减速度，停车阶段保留独立最大制动上限
- 补充 12.49 km/h 降至 8 km/h 现场参数及紧边界回归

fix: 降低锁站缩距区域限速

进入缩短跟车距离区域时，在锁站基础限速上额外降低 0.3 m/s，减小该区域内的跟车速度。

doc: SSEP:  补充ssep子模块的整体说明文档

fix: 增强 routing 地图转换边界保护

校验车辆路由索引和各类 RoadSegments 的 route_path_idx，避免无效快照触发越界访问。\n\n修正 standby relative segments 访问与清理逻辑，避免接收新路由时同帧重复推进状态，并为在线与 replayer 地图恢复补充失败返回和回归测试。

feat: 基于 SSEP 包络优化 Bulk 场景判断

按搜索路径与换向段构建 SSEP 包络，统一 BulkIn/BulkOut 互斥判断，并支持双向 IMV 倒车航向、入口临界区域和往返路径切段防抖。\n\n序列化 FlowControl、包络用途及保换向拓扑的压缩路径，使 replayer 可稳定恢复诊断与绘制数据；同时增加原地 BulkOut 重规划时间门限和完整归档回归测试。

fix: 修复 SSEP 重叠路径切段失败

切段判断改为直接校验当前分段真实末点的位置和航向，避免往返路径在同坐标重叠处被最近点投影到较早路段。\n\n保留双向 IMV reversing_mode 的航向还原，并补充自重叠路径及反转航向回归测试。

fix: 修复侧绕历史路径失效触发无轨迹停车

DP 搜索截断时保留当前安全前缀和既有侧绕决策，历史路径校验失败后恢复语义状态，不再使侧绕任务直接失败。\n\n历史路径仅复用当前执行区间内且通过方向、参考线和走廊校验的点；最终执行路径真实余量接入纵向既有无轨迹安全判断，由纵向决定停车时机。

fix: 调整梁山港 Bulk 场景规划模式

将梁山港牵引车 Bulk 进出场景从通用规划切换为单段泊车规划，匹配现场作业路径需求。

chore: SSEP: 单段倒车时不使用倒车曲率限制策略

fix: 细分梁山港 Bulk 场景规划模式

梁山港 Bulk 进场去料堆任务继续使用单段泊车规划，其余 Bulk 进出任务恢复使用通用牵引车规划，避免所有任务统一套用泊车模式。