具身开发者社区

外观

踩坑github.com7 天前

智身钢镚 L2-W Ultra 运行 RoamerX 室内外切换时双激光雷达与 RTK 位姿跳变 ​

室内外跨场景切换瞬间 GNSS/RTK 协方差突变引发 EKF 位姿跳变；需在 RoamerX 配置中启用退化检测与平滑权重过渡。

  • 感知与导航

钢镚 L2-W Ultra钢镚 L2铜锤 M1 Ultra

硬件与软件环境 ​

  • 机型：钢镚 L2-W Ultra（搭载双 96 线工业级 3D 激光雷达 + RTK 定位模块 + 80 TOPS 算力平台）
  • 导航栈：zsibot/genisom_roamerx_open（Ubuntu 22.04 + ROS 2 Humble）

故障现象与报错 ​

机器人在从园区室外进入建筑物走廊（或地下跨楼层通道）的门洞交界处，RTK 状态由固定解（Fixed）掉为浮点解（Float）或单点解，此时 map -＞ odom 的 TF 变换偶发出现 0.5m～1.8m 的瞬时水平跳变，导致局部避障代价地图（Local Costmap）残影阻塞，机器人触发急停驻留。

根因分析 ​

  1. 双源协方差失配：室外 RTK 固定解的水平位置协方差极小（厘米级），当进入建筑遮挡区产生多路径效应时，接收机在掉出固定解前的 1～2 个历元内可能输出带系统偏差的伪固定坐标。
  2. 双 96 线雷达外参标定未锁死 Z 轴约束：前后倾斜安装的两颗 96 线激光雷达若未在点云合并节点（Cloud Merger）中统一转换至 base_link 水平基准系，地面点云配准会产生俯仰角残差。

解决步骤 ​

  1. 调高 RTK 状态切换门限：在 RoamerX 融合定位配置文件中，将 GNSS 观测注入条件严格限制为 status == RTK_FIXED 且水平精度因子 HDOP ＜ 1.2、卫星数 ＞= 14；当不满足条件时立即在因子图中将 GNSS 权重平滑衰减为 0，100% 交由双 96 线 LIO（激光惯性里程计）接管。
  2. 开启位姿跳变抑制（Pose Jump Filter）：在全局重定位与回环检测模块设置单帧最大修正步长（平移 ＜= 0.08m，偏航角 ＜= 2.5°），将大幅修正分摊至后续 20 个控制周期平滑插值到 map -＞ odom，保证局部规划器订阅的 odom 连续无跳变。
  3. 校准双雷达时间同步与外参：确认机载 M12 航插与 PPS 硬件授时同步正常，使用地面平面约束标定两颗 96 线激光雷达相对于 IMU 的旋转矩阵，消除拼接重影。

来源

本页事实对应的公开页面，以原文为准。

  1. GitHub zsibot/genisom_roamerx_open访问 2026-10-21
  2. 智身科技钢镚 L2 官方技术规格访问 2026-10-21