精读笔记

Problem Setting

论文标题：SCAN-Planner: Spatial Collision-Aware Local Planning for Route-Guided Long-Range Quadruped Navigation（arXiv preprint / 2026）。这篇论文实际处理的是四足机器人在长距离任务中的局部轨迹生成问题：机器人只拿到粗全局路线和局部3D观测，却必须连续穿过窄通道、桌椅、楼梯、悬空结构和大尺度场景。真正困难不在“找路”本身，而在三个约束同时成立：身体是yaw相关的长条体，环境是3D但运动应贴地，地图是局部但任务是长程。以前方法通常在这里做取舍：圆形膨胀实时但不表达机身方向；完整3D规划能绕障但会产生对地面机器人不真实的竖直绕行；2.5D地形图贴地但丢失悬空障碍与桌下通道。SCAN-Planner的目标就是在不把问题升维到完整姿态规划的情况下，把这些约束压进一个仍可实时运行的局部规划框架。

Motivation

作者的核心动机是：四足局部规划缺的不是更复杂的全身动力学优化，而是一个和任务物理结构对齐的碰撞/搜索表示。对窄通道而言，机器人是否可通过取决于heading下的长条footprint，而不是中心点或固定半径；对3D室内场景而言，桌面、椅背、低台阶、楼梯不能被2.5D高度图一刀切；对楼梯和坡道而言，planner又不能像无人机一样通过抬高轨迹来避障。关键缺口是“3D碰撞感知”和“地面运动先验”长期被分开处理。SCAN-Planner的方向来自一个很实用的观察：只要执行heading大体跟随轨迹切向，很多yaw-aware身体约束可以在碰撞检查阶段补进去，而不必把yaw加入优化状态。

Core Idea

核心思想可以概括为：低维优化，高保真检查，贴地引导。轨迹仍是position-only B-spline，继承EGO-Planner类方法的实时性；但每个检查点的yaw由局部轨迹切向诱导，并用双圆柱footprint在膨胀3D occupancy map中做稀疏碰撞查询。这样改变的是建模方式：planner不再把机器人当成各向同性圆盘，而是把“可通行性”显式绑定到轨迹方向上。

第二个思想是把3D绕障自由度约束到一个地面跟随的局部搜索面。Projected A*不是在完整3D体素中找任意路径，而是在入口/出口高度插值得到的倾斜面上搜索，再把结果转成rebound方向约束，并抑制z方向更新。这等于给优化器加入一个强inductive bias：障碍规避主要发生在水平面，z只表达地形趋势而非绕障自由度。与prior的本质区别不是“用了A*或B-spline”，而是重新组织了信息流：全3D occupancy用于判定身体是否撞，优化自由度却被限制为符合地面机器人运动的低维形变。

Method

1. Yaw-aware twin-cylinder footprint：解决四足机身各向异性。用两个沿机身纵向偏置的竖直圆柱覆盖身体，在按圆柱半径和上下clearance膨胀后的3D occupancy map中只查两个中心点。它的核心变化是把原本靠保守半径编码的身体安全，改成依赖轨迹切向yaw的稀疏身体检查。

2. Position-only B-spline + induced yaw：解决实时性与身体约束的冲突。yaw不作为优化变量，而由相邻控制点差分得到。这牺牲了独立姿态机动能力，但换来低维优化和与常规前向行走执行的一致性。

3. Projected A* rebound guidance：解决不可微碰撞地图与连续轨迹优化之间的接口问题。检测到碰撞段后，在贴地插值面上搜索无碰撞引导路径，再构造anchor-direction形式的rebound约束。它不是全局规划，而是给局部优化提供一个逃离局部碰撞的结构化梯度。

4. z-gradient suppression / height-regularized initialization：解决3D规划对地面机器人产生虚假竖直绕障的问题。初始轨迹的高度按水平弧长线性过渡，优化更新中抑制竖直方向，使轨迹在楼梯/坡道上保持垂直趋势，绕障主要横向发生。

5. Sliding map + boundary fallback：解决局部地图与长距离路线之间的断裂。滑窗地图保证高分辨率局部碰撞检查，boundary fallback在目标不可达或死胡同时把失败转化为朝地图边界的有界恢复运动。但这依赖外部coarse route，本身不是完整长程规划器。

Key Insight / Why It Works

最关键的有效性来源是representation alignment，而不是更强的搜索或优化。四足机器人在这类任务里的瓶颈常常不是动力学可行性，而是局部几何可行性被错误表示：圆形膨胀把窄通道错误关掉，2.5D地图把桌下空间错误关掉，完整3D规划又打开了不该有的空中绕障自由度。SCAN-Planner的贡献是把这三类错误同时压低：用yaw-aware footprint恢复窄通道可行性，用3D occupancy保留悬空结构信息，用贴地搜索面约束z自由度。

最可能的核心贡献是yaw-aware碰撞检查与position-only优化的解耦。它抓住了一个工程上很强的近似：多数四足导航执行中，身体heading会跟随轨迹切向，因此不用显式优化yaw也能获得足够准确的身体占据评估。这比完整SE(2)/SE(3)搜索更scalable，比各向同性膨胀更不保守。

Projected A*和z抑制是第二层关键，它们的价值在于给rebound优化提供正确方向的局部证据。EGO式rebound本身不是新东西；新点是把rebound路径限制在符合地面运动的投影面上，避免优化器利用z方向“作弊”。这属于better inductive bias，而不是更强的test-time compute。

Sliding map和fallback更像系统工程但很必要。它们提升部署鲁棒性，尤其是长距离任务中的内存和边界问题；但这部分的创新程度有限，更接近ROG-Map/局部规划系统中的工程整合。长距离能力的主要来源不是planner产生长期推理，而是外部全局路线、局部滑窗和失败恢复之间的接口做得一致。

Relation To Prior Work

这篇最接近EGO-Planner谱系：B-spline优化、碰撞段检测、rebound约束、L-BFGS求解都明显继承了梯度式局部重规划路线。它不是从头提出一种新规划范式，而是把EGO式局部优化改造成适合四足身体和3D地面场景的版本。

相对RC-ESDF、RoA-Planner等whole-body/yaw-aware路线，SCAN-Planner的差异是避免显式yaw状态搜索或旋转优化。它用轨迹切向诱导yaw，承认并利用“导航执行通常面向前进方向”这个先验，因此更轻量，但表达能力也更窄。

相对ART-Planner、CMU-Planner这类四足/地面导航方法，它的优势不是更懂地形，而是更能生成连续、平滑、3D碰撞一致的局部轨迹。ART/CMU更偏采样、轨迹库或地形可通行性；SCAN-Planner更偏连续优化与占据几何。

看似新的部分中，滑动地图、占据膨胀、rebound search、B-spline优化都不是新概念；实质创新在于组合后的约束一致性：yaw-aware身体检查贯穿初始化、碰撞检测、A*引导、安全检查和执行，而不是只在某个后处理阶段补一个碰撞检测器。

Dataset / Evaluation

评估覆盖面比较符合论文claim：密集随机障碍验证窄通道和各向异性footprint；桌面/悬空结构验证3D occupancy优于2.5D；楼梯验证贴地z约束；真实Go2平台验证系统可部署；跨楼层和校园任务验证滑窗地图和粗路线引导下的长距离运行。相比只做仿真的planner论文，这里的真机证据比较有说服力。

但evaluation仍有明显限制。第一，缺少系统性消融，无法判断性能提升到底来自yaw-aware twin-cylinder、projected A*、z抑制、滑窗fallback还是参数调优。第二，baseline适配是否公平文中未充分说明，例如EGO-Planner-3D在楼梯场景“飞过障碍”的失败更像任务约束不匹配，而不是算法本身弱。第三，动态障碍实验偏展示性质，没有严格压力测试高速度、多目标、遮挡和感知延迟。第四，长距离实验依赖预定义检查点或商业地图路线，因此并不能证明自主探索或长期拓扑规划能力。

Limitation

最大限制是induced yaw假设。若场景需要侧身通过、倒退、原地旋转、非完整约束下的复杂姿态调整，轨迹切向yaw会把可行姿态空间压掉；这时SCAN-Planner可能比显式yaw-range搜索更弱。

第二，贴地插值面是强先验，也是上限。它适合楼梯、坡道、局部高度平滑变化，但对多层交叉结构、非单调高度、断续平台、需要先上后下的局部路径，线性高度插值可能错误。文中未充分说明复杂多层情况下如何选择正确高度层。

第三，terrain traversability被简化为clearance和step阈值，没有真正建模足端可达性、摩擦、坡度、支撑面质量或控制器失败边界。因此所谓“3D unstructured navigation”更多是几何碰撞层面的，不是完整地形可行性推理。

第四，长距离能力本质上是局部planner接外部route，不是端到端长程规划。fallback把死胡同转化为边界运动，但也可能只是把问题推迟到下一窗口；若粗路线质量差或局部地图持续遮挡，planner没有形成长期记忆或拓扑反思。

第五，增益归因不清。论文展示的优势很可能来自多个工程选择叠加：更合适的机器人模型、更保守/更贴合的高度先验、更高分辨率局部地图和真机调参。它不是单一算法ic insight带来的压倒性提升。

Takeaway

• 1. 对地面机器人而言，“3D感知”不等于“3D自由运动”。
• 更好的方向是保留3D碰撞证据，但把优化自由度投影到符合接触运动的低维流形上。
• 2. 身体模型不一定要进入完整状态空间。
• 把姿态相关约束放在碰撞检查和约束生成阶段，常常能以很小计算代价获得大部分whole-body planning收益。

一句话总结

SCAN-Planner是EGO式局部轨迹优化向四足长距离部署场景的一次表示对齐型演化：它没有发明新的规划范式，但用yaw-aware身体检查、贴地3D引导和滑窗地图把已有局部规划机制改造成更适合真实四足导航的系统。