Real-Time LiDAR Gaussian Splatting SLAM via Geometry-Aware Covariance Coupling¶

会议: ECCV 2026
论文: ECCV 原文
代码: https://github.com/Lab-of-AI-and-Robotics/LiDAR-GS-SLAM
领域: 自动驾驶
关键词: 激光雷达SLAM, 高斯泼溅, 稠密建图, 协方差复用, 实时建图

一句话总结¶

针对大规模激光雷达SLAM中高斯泼溅建图内存爆炸与误差累积难题，提出追踪与建图双向复用G-ICP协方差的紧耦合架构，结合几何控制分引导的平面剪枝与结构自适应分裂，在保持20+ FPS实时运行的同时实现高精度连续表面重建与紧凑图谱存储。

研究背景与动机¶

在大规模室外场景中，基于激光雷达（LiDAR）的SLAM系统是自动驾驶与移动机器人高精度位姿跟踪的基石。然而，传统经典方案如LOAM、FAST-LIO2与KISS-SLAM主要依赖稀疏特征点云或低分辨率体素网格进行几何配准。这类离散稀疏表示虽然能以极低算力保障实时定位，却难以重建连续表面并提供精确的视线可见性推断，难以满足自动驾驶仿真渲染、高精地图构建以及语义几何感知的需求。近年来，神经辐射场（NeRF）与隐式神经表面映射（如PIN-SLAM、NeRF-LOAM）尝试引入连续几何场，但在大尺度在线序列中，全局隐式场的频繁重优化与高昂计算开销使得系统难以达到真正的实时帧率，长距离累积漂移亦容易破坏图谱一致性。

3D高斯泼溅（3DGS）与2DGS凭借显式的空间几何参数和极高的光栅化渲染效率，为实时稠密建图带来了新的可能。然而，直接将高斯泼溅迁移到纯LiDAR大场景在线SLAM中面临两个本质矛盾：其一是无约束图谱爆炸问题，随着车辆长距离行驶，高斯基元随关键帧不断堆叠，GPU显存与光栅化反传开销急剧飙升，实时性迅速瓦解；其二是误差固化效应，LiDAR点云缺乏密集RGB纹理，仅依靠稀疏测距点监督极易产生退化基元，受污染的错误基元在后续里程计配准中会持续作为配准目标，导致误差随长序列恶性累积。此外，LiDAR传感器具有固定的角分辨率，点云密度随测距呈现平方级衰减，且受光束入射角与遮挡影响显著，传统基于图像外观优化的3DGS初始化策略无法适配激光雷达的物理传感特性。

面对上述瓶颈，本文的核心切入点是：激光雷达SLAM的前端几何配准（如G-ICP）与后端高斯基元优化本质上处理的是同一种局部二阶表面几何统计，无需引入额外的高计算量几何估计模块或庞大的神经网络。如果将G-ICP迭代中天然计算的局部协方差矩阵双向贯通——在前端直接用图谱高斯几何作为先验目标，在后端直接复用配准协方差初始化高斯尺度、法向与重要度，并据此设计面向场景几何复杂度的预算自适应控制，就能实现高精度、低显存且免漂移的稠密实时闭环。核心 idea：将快速G-ICP前端配准与球面2D高斯泼溅建图紧密耦合，双向零开销复用局部协方差统计量以初始化各向异性尺度和法向，并利用协方差特征控制分执行多通平面合并剪枝与结构敏感自适应分裂，实现轻量图谱闭环与20+ FPS的实时稠密LiDAR SLAM。

方法详解¶

整体框架¶

系统采用面向大尺度室外LiDAR扫描的球面2D高斯基元表示，每个基元定义为 $g_i = (\mu_i, q_i, \tilde{s}_i, \alpha_i)$，其中 $\mu_i \in \mathbb{R}^3$ 为空间中心，四元数 $q_i$ 约束切平面法向，$\tilde{s}_i \in \mathbb{R}^2$ 为切平面内的各向异性尺度，$\alpha_i$ 为不透明度。整个系统由前端配准追踪、追踪向建图信息传递（初始化与控制分生成）、球面光栅化优化映射，以及自适应图谱预算管理四个核心阶段构成，全流程紧密闭环。

%%{init: {'flowchart': {'rankSpacing': 24, 'nodeSpacing': 28, 'padding': 6, 'wrappingWidth': 400}}}%%
flowchart TD
    A["输入激光雷达点云<br/>运动畸变校正与体素降采样"] --> B["双向协方差复用与几何加权追踪<br/>可追踪子集筛选 + O(1)目标协方差构建 + 曲率加权G-ICP"]
    B --> C["距离自适应尺度与物理可信度初始化<br/>提取切平面协方差 + 测距比例缩放 + 入射角物理不透明度"]
    C --> D["多任务球面光栅化优化<br/>深度L1 + 有效掩码BCE + 双路法向对齐 + 尺度正则"]
    D --> E["协方差控制分驱动的自适应图谱预算管理<br/>多通正交平面覆盖剪枝 + 局部几何特征敏感分裂"]
    E -->|更新后优化高斯基元与协方差| B

关键设计¶

1. 双向协方差复用与几何加权追踪：以零检索开销构建配准目标并抑制姿态漂移

在大规模SLAM中，逐帧重新对全局或局部点云建立k-NN以计算G-ICP协方差会带来不可忽视的时间瓶颈；同时，未经筛选的全量历史高斯基元会拖垮配准效率。本文设计了可追踪高斯子集选择机制与 $O(1)$ 目标协方差重构方案。系统首先从当前图谱中依据掩码、最近更新关键帧阈值和最低不透明度过滤出紧凑的可追踪子集 $\mathcal{G}_{\text{trk}} = \{g_i \in \mathcal{G} \mid m_i = 1, k_i \ge k_{\min}, \alpha_i \ge \alpha_{\min}\}$。对于每一个目标高斯基元 $g_i$，无需进行任何邻域搜索，直接利用其已经建图优化的局部朝向 $q_i$ 与平面内双轴尺度 $(s_{i,0}, s_{i,1})$，沿法向赋予微小厚度 $\epsilon$，解析构建 $3 \times 3$ 表面协方差矩阵 $C_i^t$。在前端配准时，G-ICP对当前扫描降采样点与目标高斯中心进行关联，并依据各向异性尺度比值定义归一化曲率 $\bar{\kappa}_i \in [0, 1]$，构造几何各向异性匹配权重： $$w(\bar{\kappa}_i) = \min\left(\frac{1}{\bar{\kappa}_i + \epsilon}, \omega_{\max}\right)$$ 该机制自动识别高平整度平面结构（如路面、墙面），显著放大其在位姿优化目标函数中的约束权重，从而充当天然的几何针栓，大幅削减大尺度转弯和高速运动下的旋转漂移。同时，随着后端建图不断精细化各向异性几何参数，目标协方差反向反馈给前端，使配准迭代次数显著减少。

2. 距离自适应尺度与物理可信度初始化：消除远距离空洞并注入传感器感知先验

高斯泼溅优化对基元初始状态极度敏感，随机或固定半径初始化在稀疏LiDAR场景中极易诱发局部发散与退化。本文充分复用前端G-ICP追踪阶段为源点云计算的局部协方差特征值与特征向量分解 $(R_i^s, \sigma_i)$。由于激光雷达扫描具有固有角分辨率，物体距离激光雷达越远，光束打在物体表面的物理线间隔越大；若直接套用单位归一化协方差，远距离高斯基元将无法覆盖点间间隙，导致严重空洞与拟合撕裂。本文将初始切平面尺度设计为与测距 $r_i = \max(\|p_i\|, 1)$ 成正比的距离自适应扩展： $$\mathbf{s}_i^{(0)} = \text{clip}\left(\kappa r_i \boldsymbol{\sigma}_i^{\text{tan}}, s_{\max}\right)$$ 同时，鉴于LiDAR测量质量强烈依赖于光束的飞行距离与物体表面入射角，本文不盲目赋予所有新建基元固定不透明度，而是基于测距指数衰减与法向光线夹角余弦 $c = |\mathbf{n}^\top \hat{\mathbf{r}}|$ 计算物理可信度 $u_i = \exp\left(-(r/r_0)^2\right) \cdot \text{clip}\left(\frac{c - c_0}{1 - c_0 + \epsilon}, 0, 1\right)$。通过 $\alpha_i^{(0)} = \alpha_{\min} + (\alpha_{\max} - \alpha_{\min}) u_i$ 初始化基元不透明度，使垂直反射且处于近场的高质量测量拥有更强的主导权，而大入射角掠射和远距噪声点在建图初期便被抑制，避免恶性误差固化。

3. 协方差控制分驱动的自适应图谱预算管理：在平坦区激进压缩与在复杂结构处定向分裂

长期在线建图的根本瓶颈在于基元总量无限制增长引发的显存耗尽。本文利用前端追踪导出的协方差特征值 $\lambda_{i,0} \ge \lambda_{i,1} \ge \lambda_{i,2}$ 计算局部线度 $\text{linear}_i$ 与曲率 $\text{curv}_i$，并与G-ICP配准残差 $\text{res}_i$ 线性加权，融合出单一连续的几何控制分： $$c_i = \text{clip}\left(w_l \widetilde{\text{linear}}_i + w_c \widetilde{\text{curv}}_i + w_r \widetilde{\text{res}}_i, 0, 1\right)$$ 权重设定为 $w_l = 0.55, w_c = 0.30, w_r = 0.15$。低控制分精确指代平整开阔区域（如路面、平整建筑立面），而高控制分代表边缘、角落与复杂几何纹理。基于该控制分，系统实施双向预算重调控：在平坦区，采用多通正交平面投影策略将三维基元映射到二维网格，选出不透明度最高的基元作为代表，沿切平面自适应放大其覆盖半径，将落入其有效覆盖范围内的冗余平坦基元全部剪枝剔除，实现极高倍率的几何压缩；在复杂结构区，筛选高控制分且高质量的候选基元，沿其长轴主方向 $\mathbf{a}_i = R(q_i)\mathbf{e}_0$ 向两侧位移分裂出两个子高斯，打破几何对称性，使梯度反传能够驱使两个子基元自适应吸附精细微结构，从而在极低存储开销下维持极高的几何重建保真度。

损失函数 / 训练策略¶

后端建图在有效深度像素掩码 $\mathbf{M}_D = \mathbb{I}[D > 0]$ 下通过端到端梯度下降优化高斯参数 $\Theta = \{\mu, q, \tilde{s}, \alpha\}$，总目标函数定义为： $$\mathcal{L} = \mathcal{L}_{\text{depth}} + \lambda_{\alpha}\mathcal{L}_{\alpha} + \lambda_{n}\mathcal{L}_{n} + \lambda_{s}\mathcal{L}_{\text{scale}}$$ 其中深度项采用掩码L1损失，不透明度项采用仅惩罚有效区域的交叉熵 $\mathcal{L}_{\alpha} = \frac{1}{|\Omega_D|}\sum_{i\in\Omega_D} -\log(\hat{A}_i + \epsilon)$ 以压制虚假空洞。法向监督项 $\mathcal{L}_n$ 联合了前端G-ICP几何法向 $\mathbf{N}_{\text{g-icp}}$ 与球面渲染深度推导的表面法向 $\mathbf{N}_{\text{surf}}$，采用余弦相似度损失；为避免初期表面法向噪声导致发散，$\mathbf{N}_{\text{surf}}$ 的监督仅在自适应分裂激活后阶段性开启。尺度正则项 $\mathcal{L}_{\text{scale}} = \sum_{i=1}^N \max(0, \max(s_{i,x}, s_{i,y}) - s_{\max})$ 则对异常膨胀的高斯实施硬边界惩罚，防止产生穿透墙面的虚影。超参数配置为 $\lambda_{\alpha} = 0.1, \lambda_n = 1, \lambda_s = 10$，法向分支权重为 $\lambda_{n,g} = 0.05, \lambda_{n,s} = 0.01$。回环检测触发后，通过位姿图优化计算关键帧刚体增量，并以关键帧分块刚性变换更新从属高斯基元，避免全局重新优化的巨大开销。

实验关键数据¶

主实验¶

在手持室内外基准（Newer College、Oxford Spires）与大尺度车载自动驾驶基准（KITTI Odometry）上全面评测位姿跟踪精度（ATE RMSE，单位：米）与连续建图质量（精度Acc、完整度Com、Chamfer-L1，单位：厘米；F-score，单位：%，截断阈值 $\tau = 0.2\text{ m}$），并记录端到端系统运行帧率（FPS）。

表1：大规模基准绝对轨迹误差对比（ATE RMSE [m] ↓）

方法	类型	Newer-Quad	Newer-Math	Oxford-Obs	Oxford-Keb	KITTI-00	KITTI-01	KITTI-07	KITTI-08	KITTI-09
KISS-SLAM [8]	纯点云稀疏SLAM	0.100	0.151	0.494	0.367	1.699	19.632	0.435	3.982	1.687
PIN-SLAM [23]	隐式神经建图	0.097	0.071	0.150	12.196	0.913	3.670	0.281	1.778	1.246
SuMa [1]	面元Surfel建图	0.249	0.210	5.145	16.803	1.200	Fail	0.405	2.210	3.884
Splat-LOAM [7]	高斯泼溅SLAM	0.138	0.818	17.494	0.770	Fail	Fail	Fail	Fail	Fail
Ours	协方差耦合GS	0.080	0.160	0.336	0.177	1.080	2.260	0.338	2.900	1.260

表2：连续网格重建质量与端到端系统速度对比（Newer College & Oxford Spires）

数据集	序列	指标	Voxblox (GT位姿)	VDBFusion (GT位姿)	PIN-SLAM (在线位姿)	Splat-LOAM (在线位姿)	Ours (在线位姿)
Newer College	Quad	Acc (cm) ↓ / Com (cm) ↓	16.58 / 19.00	14.88 / 14.09	17.11 / 22.83	12.23 / 18.91	7.62 / 15.02
		C-L1 (cm) ↓ / F-score (%) ↑	17.79 / 64.00	14.49 / 76.27	19.97 / 60.59	15.57 / 72.06	11.32 / 86.78
		运行速度 FPS ↑	66.10 (仅建图)	26.44 (仅建图)	7.62 (系统全速)	3.91 (系统全速)	22.15 (系统全速)
Newer College	Math	C-L1 (cm) ↓ / F-score (%) ↑	14.00 / 77.23	10.61 / 84.59	18.18 / 63.78	15.02 / 73.66	16.48 / 70.35
		运行速度 FPS ↑	82.70 (仅建图)	45.40 (仅建图)	11.04 (系统全速)	2.54 (系统全速)	25.25 (系统全速)
Oxford Spires	Obs	C-L1 (cm) ↓ / F-score (%) ↑	15.86 / 71.73	10.93 / 83.68	24.42 / 44.15	36.34 / 6.14	20.83 / 56.89
		运行速度 FPS ↑	143.00 (仅建图)	48.16 (仅建图)	8.20 (系统全速)	1.52 (系统全速)	17.99 (系统全速)
Oxford Spires	Keb	C-L1 (cm) ↓ / F-score (%) ↑	13.83 / 77.29	10.20 / 84.99	29.19 / 33.93	28.26 / 33.97	18.64 / 64.02
		运行速度 FPS ↑	140.30 (仅建图)	43.69 (仅建图)	8.62 (系统全速)	5.77 (系统全速)	19.58 (系统全速)

消融实验¶

表3：前端向后端传递先验及建图监督消融分析（Quad 与 Keble College）

消融变体配置	Quad: ATE (m) ↓	Quad: C-L1 (cm) ↓	Quad: F-score (%) ↑	Keb: ATE (m) ↓	Keb: C-L1 (cm) ↓	Keb: F-score (%) ↑	说明
A. w/o 协方差初始化 (单位阵)	0.088	22.190	48.688	0.283	24.020	44.123	失去切向各向异性先验，基元朝向发散
B. w/o 距离自适应尺度	0.087	11.635	85.996	0.479	22.558	51.582	远距离点云间隙产生大量撕裂空洞
C. w/o 物理不透明度初始化	0.085	11.450	86.020	0.451	22.210	53.173	边缘掠射噪声未被有效压制
D. w/o G-ICP法向损失	0.099	11.600	85.899	0.325	21.428	55.522	缺乏局部法向约束，配准目标退化
E. w/o 特征感知管理	0.089	11.729	86.237	0.222	19.379	63.217	短期影响轻微，长程导致内存累积
F. 完整系统 (Full Model)	0.079	11.320	86.776	0.212	18.640	64.024	所有模块协同达到最佳重建与定位

表4：图谱管理策略在重建保真度与资源开销间的权衡消融（Quad 与 Keble College）

管理模式配置	Quad: F-score (%) ↑	Quad: #GS基元数 ↓	Quad: 存储大小 ↓	Quad: 峰值显存 ↓	Keb: F-score (%) ↑	Keb: #GS基元数 ↓	Keb: 存储大小 ↓	Keb: 峰值显存 ↓
Baseline (仅不透明度剪枝)	87.179	239,175	9.6 MB	2.9 GB	64.863	546,400	21.9 MB	4.1 GB
仅结构敏感分裂 (Split)	88.040	248,060	9.9 MB	4.8 GB	56.681	591,567	23.7 MB	4.2 GB
仅多通平面剪枝 (Plane Prune)	86.521	119,285	4.8 MB	4.5 GB	59.327	341,435	13.7 MB	4.1 GB
分裂 + 平面剪枝 (Full)	86.776	129,885	5.0 MB	4.5 GB	64.024	344,473	13.8 MB	4.3 GB

表5：后端向前端反馈优化的有效性分析

配置变体	ATE RMSE (m) ↓	追踪速度 (FPS) ↑	核心机制作用
w/o GS优化 (图谱冻结/无反馈)	0.099	17.69	缺乏优化几何支撑，配准迭代步数激增
w/o 几何各向异性加权	0.088	22.66	平面路面约束减弱，旋转漂移加剧
w/o 可信度滤波筛选	0.085	20.47	不稳定噪声点参与配准拖慢匹配
Full (完整双向反馈)	0.079	23.70	优质目标协方差促成极速收敛与高抗噪性

关键发现¶

协方差初始化的决定性作用：若禁用追踪协方差对高斯的初始化（表3-A），Newer College Quad的F-score暴跌38.09%（从86.78%降至48.69%），证明了物理空间几何先验比完全交由网络自由梯度下降学习更具稳定性。
图谱预算压缩的高效性：结合平面覆盖剪枝与特征分裂（表4），系统在Quad序列上将高斯基元总数由23.9万锐减至12.9万（压缩率45.7%），持久化存储由9.6 MB降至5.0 MB，而重建F-score仅有不到0.4%的微小波动；在KITTI-00大尺度轨迹上，基元数从248万大幅下降至151万，磁盘占用从61.3 MB压缩至42.1 MB。
双向耦合的提速正反馈：实验证实“建图不仅不拖累追踪，反而在加速追踪”（表5）。由于优化后的高斯提供了极度精确的曲面朝向与尺度，前端G-ICP的目标协方差构建由原本耗时的近邻搜索转化为 $O(1)$ 常数时间查表，且配准收敛迭代显著变少，追踪帧率从17.69 FPS跃升至23.70 FPS。

亮点与洞察¶

零开销双向几何复用：将激光雷达SLAM中原本独立的G-ICP配准协方差分解与2D高斯基元切平面参数直接贯通，前端产物即后端先验，后端优化即前端目标，无需训练任何神经网络。
各向异性尺度比值作为抗漂移针栓：巧妙利用高斯内部尺度长短轴比值量化平面平整度，推导出配准几何权重，使得路面与平整墙壁自动获得更高权重，本质上以极轻量代价替代了传统的显式点线面特征提取。
几何控制分打破对称性分裂：沿高斯切平面主轴施加正负偏移生成双子基元，天然打破了高斯优化在复杂边界处的梯度对称死锁，使基元能灵敏感知建筑边缘与微结构。

局限与展望¶

弱几何与剧烈退化场景依赖：系统强依赖G-ICP给出的局部几何统计，在开阔空旷、稀疏灌木丛植被或缺乏几何特征的长直隧道中，协方差极易退化，可能导致初始化法向失真。
动态障碍物干扰：目前虽然依赖入射角与测距物理置信度抑制了部分瞬态噪声，但尚未引入显式的动态目标分割网络，在车辆人流密集的路口容易产生拖尾重影。
大回环下的全局一致性更新：回环闭合采用分块刚体增量更新高斯位置，未进行全图高斯全局重优化，在特大累积漂移校正后局部拼接缝隙可能存在微小几何不连续。

评分¶

新颖性: ⭐⭐⭐⭐☆ 巧妙将经典G-ICP协方差与现代2DGS各向异性参数双向闭环，物理先验融合度极高
实验充分度: ⭐⭐⭐⭐⭐ 涵盖Newer College、Oxford Spires与KITTI三大基准，主实验、消融实验与资源分析详实
写作质量: ⭐⭐⭐⭐⭐ 逻辑严密，图文对照自洽，公式与机制交代清晰
价值: ⭐⭐⭐⭐⭐ 为纯LiDAR驱动的实时稠密几何SLAM和高精地图构建树立了高实用性范式