四足机器人的"眼睛"革命:中科院让机器人仅凭"内感"就能精准定位

提起机器人定位导航，我们第一时间想到的可能都是那些装满各种摄像头和激光雷达的"科幻机器狗"。但是，当这些"眼睛"和"雷达"遇到沙尘暴、浓雾，或者在漆黑的地下管道中时，它们就像失明的人一样寸步难行。最近，来自中科院光电技术研究所、新加坡科技研究局以及深圳星动力科技的联合研究团队，在2026年2月发表于机器人学顶级期刊的这项研究（论文编号arXiv:2602.17393v2），为我们展示了一种全新的解决方案：让四足机器人完全依靠自身的"内感"系统实现精确定位。

这项研究的核心理念可以用一个生动的比喻来理解：当你在完全黑暗的房间里行走时，即使看不见任何东西，你的身体依然能通过内耳平衡系统、肌肉反馈和关节感受来判断自己的位置和移动方向。研究团队正是受到这种生物学原理的启发，开发出了一套被称为"接触锚定本体感受里程计"（CAPO）的系统，让机器人能够仅仅依靠内置的惯性测量单元和电机传感器就能准确知道自己的位置。

传统的机器人定位就像是一个需要不断看路标的旅行者，必须依赖外部参照物才能确定方向。而这项新技术则让机器人变成了一个经验丰富的盲人，能够通过脚步的触感、身体的倾斜和关节的弯曲程度来"感知"自己在空间中的精确位置。研究团队在多个平台上进行了大规模测试，包括Unitree Go2 EDU机器狗和三台不同的Astrall机器人，测试结果令人惊叹：在长达700米的水平环路中，定位误差仅为7.68米，而在20米的垂直爬行路线中，高度误差控制在0.54米以内。

更令人印象深刻的是，这套系统不仅适用于传统的点足机器人，还能处理轮腿混合式机器人的复杂运动模式。研究团队开发的算法能够智能区分机器人的脚是在地面上"踩实"还是在空中"悬空"，并且能够补偿轮子滚动带来的额外位移，就像一个熟练的舞者能够精确感知每一个动作对身体位置的影响一样。

一、"脚踏实地"的定位智慧

要理解这项技术的精妙之处，我们可以把机器人的每条腿想象成一个敏感的探测器。当机器人在行走时，它的"大脑"会持续监控每条腿传回的信息：这条腿现在承受了多大的重量？关节弯曲到了什么角度？脚掌是否真的踩在了地面上？通过分析这些信息，系统能够判断哪些脚正在与地面接触，这些接触点就成为了机器人定位的"锚点"。

这种接触检测的原理类似于一个人在黑暗中摸索前进。当你的脚踏实地面时，你的身体会感受到来自地面的支撑力，这个力量会通过你的腿部肌肉和关节传递到你的大脑。机器人的系统也是如此工作的：通过测量每个关节电机的扭矩输出，系统能够计算出脚底承受的力量，进而判断这只脚是否真的在地面上发挥支撑作用。

当系统确认某只脚正在可靠接触地面时，它会在"脑海"中记录下这个接触点在世界坐标系中的精确位置。这就好比在地图上插下一面小旗，标记"我曾经在这里踩过"。随着机器人继续移动，只要这只脚保持与地面的接触，系统就会将其视为一个固定的参考点，通过计算其他部位相对于这个参考点的位置变化来推算整个身体的位置。

这种方法的巧妙之处在于，它能够同时使用多个接触点来提高定位精度。就像一个熟练的攀岩者会同时用四肢抓住岩壁上的不同支点来维持平衡一样，机器人可以同时依靠多只脚的接触信息来获得更准确、更稳定的位置估算。当某只脚离开地面时，系统会平滑地将注意力转移到仍在接触地面的其他脚上，确保定位的连续性。

二、应对"编码器噪音"的技术革新

在机器人的世界里，电机编码器就像是关节的"计步器"，负责记录每个关节转动了多少角度。然而，这些"计步器"有一个令人头疼的问题：它们经常会产生突然的"毛刺"信号，就像一个计步器突然显示你在一秒钟内走了一万步一样荒谬。这些错误信号会导致机器人对自己脚部位置的判断出现严重偏差，进而影响整体定位精度。

为了解决这个问题，研究团队开发了一种被称为"逆运动学立方卡尔曼滤波器"（IKVel-CKF）的智能系统。这个系统的工作原理可以比作一个经验丰富的编辑，能够从充满错字和语法错误的草稿中识别出作者的真实意图。它不会简单地相信编码器传来的每一个数据，而是会结合机器人的物理约束和运动规律来"猜测"脚部的真实运动轨迹。

具体来说，这个智能滤波系统维护着一个关于每只脚位置和速度的"最佳猜测"。当新的传感器数据到来时，系统不会直接采用，而是会问："根据机器人的物理结构和当前的运动状态，这个数据合理吗？"如果数据显示某只脚突然以不可能的速度移动，系统会倾向于认为这是传感器错误，并使用更平滑、更符合物理规律的估计值来替代。

这种处理方式带来了显著的改善效果。在研究团队的对比测试中，没有使用智能滤波系统的机器人在水平方向上会出现高达200%的速度估算误差，这些误差像尖锐的噪音一样破坏了整个定位系统的稳定性。而启用了IKVel-CKF系统后，这些误差被压缩到仅有25%的正常信号幅度内，整个系统的表现变得平滑而可靠，就像从一首充满杂音的录音变成了高保真的音乐播放。

三、高度记忆与地面识别的巧思

机器人在复杂环境中行走时面临的一个重要挑战是如何准确记住和识别不同的地面高度。设想一下，当你在一栋多层建筑中反复上下楼梯时，如果每次踏上同一级台阶都被记录为稍微不同的高度，长时间累积下来，你对自己所在楼层的判断就会出现严重偏差。机器人也面临着同样的问题：由于传感器的微小误差，每次踏足同一个平面都可能被记录为略有不同的高度，这些小误差会随时间积累成巨大的定位偏差。

为了解决这个问题，研究团队设计了一个类似"楼层记忆系统"的智能机制。这个系统会记住机器人曾经踩过的各个平面的高度，并给每个记录分配一个"信任度"评分。当机器人再次踩到相似高度的地面时，系统会判断："这很可能是我之前踩过的同一个平面。"然后，它会将当前的高度测量值"对齐"到之前记录的标准高度，就像一个有经验的登山者会说"这应该就是昨天我们休息过的那个平台"一样。

这个系统还具备"遗忘"功能，类似于人类记忆的淡化机制。如果某个平面很长时间没有被重新访问，系统对它的"信任度"会逐渐降低，最终将其从记忆中清除。这样做的好处是避免过度依赖可能已经不再准确的历史数据，同时为新发现的地面特征留出存储空间。

更有趣的是，系统在判断是否为"同一平面"时设置了一个容错范围。如果新测量的高度与已记录平面的差异很小（比如在1厘米以内），系统会认为这就是测量误差，直接使用已记录的标准值。但如果差异较大，系统会将其识别为新的地面特征并建立新的记录。这种设计既保证了对相同平面的一致性识别，又保持了对新环境特征的敏感性，就像一个既不会被小石子绊倒、又能敏锐察觉真正台阶的行人一样。

四、轮腿混合机器人的运动补偿

当机器人配备了轮子而不仅仅是脚掌时，整个定位问题变得更加复杂。这就像是要追踪一个既会走路又会滑旱冰的人的轨迹一样困难。轮子的引入带来了一个有趣的挑战：即使轮子在地面上保持静止，电机编码器也可能显示轮子在"转动"，这是因为机器人腿部的摆动会带动轮子相对于腿部发生旋转。

为了理解这个问题，我们可以想象一个人穿着旱冰鞋在做体操动作。当这个人抬起腿部、改变姿态时，即使旱冰鞋轮子没有在地面上滚动，轮子相对于腿部也会发生转动。如果我们简单地根据轮子的转动来计算人的移动距离，就会得到完全错误的结果。机器人面临的正是这样的困境。

研究团队的解决方案颇具智慧：他们开发了一个"运动分解算法"，能够将轮子编码器记录的总转动分解为两部分：一部分是由于腿部姿态变化引起的"虚假转动"，另一部分是轮子真正在地面上滚动产生的"有效转动"。系统通过实时监测机器人腿部关节的角度变化，计算出这种姿态变化会导致轮子发生多少"虚假转动"，然后从编码器的总读数中减去这部分，剩下的就是轮子真正的滚动量。

基于这个"净滚动量"，系统能够计算出轮子接触点在地面上的实际移动距离和方向。这个信息被用来更新之前记录的"接触锚点"位置，确保即使在轮子滚动的情况下，机器人仍能准确追踪自己的位置。这种处理方式使得同一套算法既能处理传统的点足机器人，也能适应轮腿混合式机器人的复杂运动模式，展现了系统设计的优雅和通用性。

五、基于几何约束的航向角修正

机器人定位面临的最后一个重大挑战是"航向角漂移"问题。航向角就是机器人面朝的方向，类似于指南针上的指针方向。传统的惯性传感器在长时间使用后，其航向角读数会逐渐偏离真实方向，就像一个磁性逐渐减弱的指南针会指向错误的方向一样。这种偏差随时间累积，最终会导致机器人对自己位置和朝向的判断出现严重错误。

研究团队开发的解决方案基于一个巧妙的几何原理：当机器人同时用多只脚接触地面时，这些接触点之间的相对位置关系在世界坐标系中是固定不变的。换句话说，如果机器人站在那里不动，它的四只脚构成的四边形形状在地面上是固定的，不会因为传感器漂移而改变。

系统利用这个原理来检测和修正航向角误差。它会比较两套信息：第一套是根据当前惯性传感器读数和腿部关节角度计算出的足部相对位置；第二套是之前记录的接触点在世界坐标系中的位置关系。如果这两套信息不匹配，说明航向角可能出现了偏差。系统会计算需要多大的航向角修正才能让这两套信息重新一致，然后应用这个修正量来校准惯性传感器的读数。

这种校准过程特别适合在机器人长时间静止站立时进行。当机器人四足稳定着地时，系统会持续进行这种几何一致性检查和校准，有效抑制航向角的长期漂移。在研究团队的测试中，这种方法能够显著改善长距离行走后的定位精度，就像一个经验丰富的导航员会定期通过地标来校准自己的指南针一样。

更有趣的是，即使在惯性传感器完全失效的情况下，这套系统仍能提供一个基于纯几何关系的航向角估算。虽然这种"后备模式"的精度会有所降低，但它为机器人提供了一个可靠的安全网，确保在各种极端条件下都能维持基本的定位能力。

六、实验验证与性能表现

为了验证这套定位系统的实际效果，研究团队设计了一系列严苛的测试，这些测试就像是给机器人设置的"定向越野赛"。他们首先在物理仿真环境中进行了初步验证，让虚拟机器人在包含障碍物的平地环路和具有楼梯的垂直路径上行走，结果显示新系统的表现远超传统的激光雷达SLAM方法，特别是在垂直高度估算方面优势明显。

真正的考验来自于实体机器人测试。研究团队使用了四台不同的机器人平台，包括一台Unitree Go2 EDU机器狗和三台不同配置的Astrall机器人。这些机器人被要求在完全依赖内部传感器的情况下，完成各种复杂的闭环路径行走任务，就像蒙着眼睛完成一场精确的舞蹈表演。

测试结果令人印象深刻。在一项约200米的水平环路测试中，点足型机器人A的最终位置误差仅为0.1638米，这意味着在走了相当于两个足球场长度的距离后，机器人对自己位置的判断误差还不到17厘米。轮腿混合型机器人B在相同距离的测试中实现了0.2264米的误差，考虑到轮子滚动增加的复杂性，这个结果同样值得称赞。

更令人瞩目的是垂直路径的测试结果。在包含约15米垂直高度变化的复杂路径中，两台机器人的高度误差都控制在0.22米以内。这就好比一个人爬了五层楼高的楼梯后，对自己高度的估算误差还不到一个台阶的高度。最极端的测试是使用机器人C进行的约700米超长距离水平环路，虽然最终误差增加到7.68米，但相对于总距离而言，这个1.1%的误差率仍然展现了系统的可靠性。

特别值得一提的是垂直定位的一致性。在Unitree Go2 EDU进行的重复台阶爬升测试中，机器人连续五次上下同一个台阶，最终的垂直位置误差小于0.1米，几乎可以忽略不计。这种一致性对于需要在多层环境中工作的机器人来说至关重要，就像一个送餐机器人必须准确知道自己在几楼一样。

七、技术局限与未来展望

任何技术创新都不可能是完美无缺的，这套系统也有其固有的局限性。最主要的挑战来自于对"理想接触"假设的依赖。系统的核心逻辑是假设机器人的脚在接触地面时是完全静止的，但现实世界中，轮子可能会打滑，脚掌可能会在粗糙表面上发生微小滑动，这些情况都会影响定位精度。

特别是对于轮腿混合机器人，打滑问题更加突出。当机器人在湿滑地面或松软土壤上行走时，轮子与地面之间的滑动会导致系统高估或低估实际移动距离。目前的算法还无法自动检测和补偿这种滑动，这在一定程度上限制了系统在恶劣环境中的应用。研究团队承认，开发智能的滑动检测和补偿机制是未来工作的重要方向。

另一个限制来自于接触检测的简单化处理。当前系统仅仅根据垂直方向的力来判断脚是否与地面接触，这种方法对于标准的点足步态行走是可靠的，但对于轮腿混合模式中可能出现的轻微接触或滚动接触情况，判断准确性会下降。如果将检测阈值设得过低，可能会错误地将悬空的脚判断为着地；如果设得过高，又可能漏掉真正的轻微接触。

此外，系统对地形的假设相对简化。在轮子接触点的传播计算中，算法假设地面是水平的，这在平地环境中是合理的，但在斜坡或不规则地形上会引入额外误差。虽然这种误差在短距离内可以忽略，但在长距离行走中可能会累积成显著的偏差。

尽管存在这些局限，研究团队对系统的未来发展充满信心。他们计划在下一阶段工作中集成更智能的滑动检测算法，可能会利用运动学与惯性信息之间的不一致性来识别滑动事件。同时，他们也在探索自适应的接触检测方法，能够根据不同的运动模式和环境条件动态调整检测阈值。

对于地形适应性的改进，团队正在研究基于多点接触几何关系的局部地面倾斜估算方法，这将使系统能够更好地处理斜坡和不规则地形。另外，他们还在考虑如何减少IKVel-CKF模块的计算开销，以便在资源受限的嵌入式系统中实现实时运行。

说到底，这项研究为机器人定位技术开辟了一个全新的方向。它证明了在没有外部传感器帮助的情况下，机器人也能通过精妙的算法和对自身运动的深度理解实现高精度定位。这种"内省式"的定位方法不仅提高了机器人在恶劣环境中的生存能力，也为未来开发更加自主、更加智能的机器人系统提供了重要的技术基础。

当我们看到机器人能够像经验丰富的盲人一样，仅凭触觉和身体感知就能在复杂环境中准确导航时，不禁会思考：这种技术会如何改变未来机器人的设计理念？它是否预示着我们正在迈向一个机器人更加依赖"内在智慧"而不是"外在感官"的时代？对于那些希望深入了解这项技术细节的读者，可以通过论文编号arXiv:2602.17393v2查询中科院光电技术研究所发表的完整研究报告，其中包含了更详细的算法描述和实验数据。

Q&A

Q1：CAPO接触锚定定位技术是如何工作的？

A：CAPO技术让机器人通过监测每只脚的受力情况来判断哪些脚正在接触地面，然后将这些接触点作为固定的参考"锚点"。机器人会记住这些接触点的世界坐标位置，通过计算身体相对于这些锚点的位置变化来推算自己的精确位置，就像一个人在黑暗中通过脚步感知来判断自己的位置一样。

Q2：这套系统相比传统的激光雷达定位有什么优势？

A：最大优势是完全不依赖外部环境信息，能够在沙尘暴、浓雾、黑暗等恶劣条件下正常工作。传统激光雷达在这些环境中会失效，而CAPO系统仅依靠机器人内部的惯性传感器和电机反馈就能实现定位。此外，这套系统成本更低，不需要昂贵的激光雷达设备，同时减少了计算负担。

Q3：IKVel-CKF滤波器解决了什么问题？

A：这个滤波器主要解决电机编码器产生的"噪音毛刺"问题。电机编码器在记录关节转动时经常出现突然的错误信号，导致机器人对脚部位置的判断出现严重偏差。IKVel-CKF就像一个智能编辑，能够识别并过滤这些不合理的数据，将速度估算误差从200%降低到25%，大大提高了定位系统的稳定性和精度。