Changes

feat: 增加堆高机侧向吊具高度防护

按堆高机与车身的横纵向位置及垂直朝向识别侧向作业场景。

场景内采用可配置的 5.5 米吊具高度阈值，并追加角度、横向距离和纵向容错配置及回放序列化。

feat: 显示障碍物朝向与速度方向

修正速度方向访问器，并为外部聚类障碍物初始化速度方向。

HMI 使用较浅、较短的箭头区分 heading 和速度方向，同时过滤场桥虚拟障碍物及聚类障碍物。

feat: 补充 SL 边界语义访问器

新增左右边界、中心位置及横纵向跨度访问接口，统一屏蔽 start/end 顺序差异。

补充数学函数直接依赖，并整理头文件格式。

fix: 提前窄路靠边车辆绕行判定

缩短动态障碍转静态时的确认帧数和近期位移窗口，降低停车后开始绕行的等待时间。\n\n靠边判断增加障碍外缘到真实道路边界的距离证据，使窄路上绝对横向偏移较小但实际已贴边的车辆能够及时放行；道路边界无效时保留原中心带判据。

fix: 防止DP搜索中断后绕行路径错误回正

DP完整路径无解时，从最深层的最优可行节点回溯，仅保留无碰撞、无越界的搜索前缀。

保持失败帧不发起新绕行决策，并让后续路径边界维持中断前的绕行侧位置，避免采用硬约束节点之后的虚假回目标车道段。

fix: 稳定动态障碍绕行边界切换

隔离 UseHis 最终执行路径与动态交互路径，并改用原始可行 gap 计算窄会车空间，消除历史 DP 反灌造成的边界闪烁。

横向切入采用让速不让道，切入完成或障碍后缘超过自车后释放来源侧车道边界，同时保留 KEB 碰撞防护。

增加 OG 到 obj 的占用交接标签，以历史原始 OG 作为新 box 的成熟度证据；仅旁路 age，侧向与 KEB 构图均保留原始 bbox 且不额外膨胀。

fix: 稳定窄路会车的 DP 采样边界

在自车纵向范围内延后边界收缩，并结合历史可行 gap、当前道路边界、安全缓冲和栅格余量保证最小通行空间。

锁存贴右进入与退出状态，对各采样断面的对向车几何独立做短时保持，避免快速来车时边界逐帧收缩和放开。

fix: 过滤未沿道路对齐的会车收边

MEETING 障碍只有通过沿当前道路逆向对齐确认后才能进入动态边界收窄，避免弯道外侧、支路横穿或调头车辆误触发狭窄会车。

补充 along 诊断字段，便于回放区分标签命中与沿路对开确认。

fix: 修正 DP 动态障碍横向范围过滤

使用障碍物 SL 横向边界与走廊横向宽度进行比较，修复原先混用 s 边界造成的量纲错误。\n\n避免前方动态障碍被提前过滤，恢复 DP 动态碰撞代价的有效性。

feat: 支持受控低速车辆超车

新增清扫车和洒水车类型，支持明确类型授权与可配置速度门控的低速超车候选。\n\n实现单目标锁定、左侧单向 DP 采样、目标扫掠与短时掉帧占用、动作承诺及超车限速，并在切入、会车、路口、倒车和目标失效时统一退出。\n\n按道路姿态区分静止车辆绕行：纵向对齐车辆使用短等待，斜停或横停车辆仅在确认静止并长时间堵塞后开放，避免方向和靠边判据旁路姿态保护。\n\n补充配置、诊断标记和快照序列化兼容。

fix: 收紧快速对向会车边界

快速对向车改用到达时刻对齐和局部参考线投影，投影异常时按当前状态匀速回退。

窄会车仅保留真实不足的断面，并按整组更新历史贴右区域，避免移动预测留下长尾收边和跨支路误收缩。

fix: 保持绕行路径连续性

绕行未获得足够回中空间或本帧 DP 无解时，请求沿用历史路径，避免车辆提前回目标车道后陷入首层无解。

历史路径复用增加参考线锚点与当前可行走廊校验；校验失败时交由上层停车兜底，并修正拖挂路径使用错误参考线的问题。

fix: 修正录包触发模块标识

将快照录包触发消息的模块名由 decision 统一为 pnc，与当前节点其他对外消息保持一致。

fix: recover lattice planner from stop fallback loop

fix: 延迟普通出堆场区域切换

普通出堆场场景按挂尾所在路段确定反馈区域，挂尾仍在堆场或堆垛区时保持对应安全档位，完全离开后再切换为出堆场路口。

复用按需计算的挂尾路段查询，避免非相关场景执行额外地图查询，并保持 open space 原有逻辑不变。

fix: 稳定任务切换期间区域状态

车辆静止且 PNC local map 尚未稳定时沿用上一帧区域状态，地图恢复或车辆起步后退出保持。

通过新 routing 接收标志和 task id 变化识别任务首帧，避免场景状态尚未更新时短暂回退到普通道路或路口区域；保留 PARK_LOCK 专用判定优先级。

fix: serialize WBCA max cost

fix: 低速出桥场景适配锁站安全档位

启用低速安全阈值调整时，将 REGION_OUT_BRIDGE 纳入锁站安全档位转换范围，避免该枚举因数值位于 REGION_STACKER 之后而被遗漏。

fix: 延迟普通出堆场区域切换

普通出堆场场景按挂尾所在路段确定反馈区域，挂尾仍在堆场或堆垛区时保持对应安全档位，完全离开后再切换为出堆场路口。

复用按需计算的挂尾路段查询，避免非相关场景执行额外地图查询，并保持 open space 原有逻辑不变。

fix: 稳定任务切换期间区域状态

车辆静止且 PNC local map 尚未稳定时沿用上一帧区域状态，地图恢复或车辆起步后退出保持。

通过新 routing 接收标志和 task id 变化识别任务首帧，避免场景状态尚未更新时短暂回退到普通道路或路口区域；保留 PARK_LOCK 专用判定优先级。

fix: 修正录包触发模块标识

将快照录包触发消息的模块名由 decision 统一为 pnc，与当前节点其他对外消息保持一致。

fix: plan from history in low speed

fix: plan from history in low speed

fix: 堆场内open space场景误报REGION_OUT_BRIDGE提前降安全阈值, 改按guide line查挂尾所在路段类型, 挂出堆场后再切换

fix: 修正场景规划器过早退出判断

修正横向偏差与航向角阈值表达式的括号错误，避免将比较结果传入 fabs 导致左右判断不对称。

补齐出堆场区域切换判断，并校验搜索路径坐标长度，防止错误退出及无效路径访问。

fix: update WBCA for truck and imv

feat: 支持真石 IMV 按途经点多段停车

真石 IMV 进场且携带搜索途经点时，切换到 IMV 多段停车规划器并构建 pass posture。

收紧途经点支持范围，避免真石 CAR/TT 意外启用随机途经点采样，同时保持其他港区原有逻辑不变。

feat: 支持右转路口前停车

新增默认关闭的右转路口停车功能开关。

根据路口转向类型识别标准右转并生成规则停车约束，同时增加独立停车原因便于区分。

fix: use history path for IMV direct link

fix: use history path for IMV direct link

fix: 修复缓刹遇障碍后无法进入停止态

NStop 执行期间进入 MOVE_BRAKE 后保持障碍制动，避免 MOVE_NSTOP 与 MOVE_BRAKE 循环切换。

车辆静止退出 MOVE_BRAKE 时恢复 NN_STOP 停车原因，使 MotionStopFsm 直接进入 STOP_CTRL。

feat: 右转停车后自动起步

右转停车约束使用路口停车类型，接入现有安全自动起步流程。

启用右转停车功能且确认标准右转时，停车 1.2 秒后自动尝试起步；其他路口停车保持原有 3 秒等待和障碍物检查逻辑。

fix: speed down unexpectly in wbca smooth mode.

fix: 修复普通场景缓冲区数据失效问题

将缓冲区有效标记和距离更新移出堆高机场景判断，使通过基础路径匹配筛选的缓冲区点均能正常生效。

保留堆高机障碍物对缓冲区停车距离的动态调整逻辑。