Organizations: State Key Laboratory of Industrial Control Technology, Institute of Cyber Systems and Control, Zhejiang University, Hangzhou, China. · Huzhou Institute of Zhejiang University, Huzhou, China. · The Chinese University of Hong Kong, Shenzhen, China.
Time-of-Flight (ToF) cameras possess compact design and high measurement precision to be applied to various robot tasks. However, their limited sensing range restricts deployment in large-scale scenarios. Depth completion has emerged as a potential solution to expand the sensing range of ToF cameras, but existing research lacks dedicated datasets and struggles to generalize to ToF measurements. In this paper, we propose a full-stack framework that enables depth completion in large-scale scenarios for short-range ToF cameras. First, we construct a multi-sensor platform with a reconstruction-based pipeline to collect real-world ToF samples with dense large-scale ground truth, yielding the first LArge-ScalE scenaRio ToF depth completion dataset (LASER-ToF). Second, we propose a sensor-aware depth completion network that incorporates a novel 3D branch with a 3D-2D Joint Propagation Pooling (JPP) module and Multimodal Cross-Covariance Attention (MXCA), enabling effective modeling of long-range relationships and efficient 3D-2D fusion under non-uniform ToF depth sparsity. Moreover, our network can utilize the sparse point cloud from visual SLAM as a supplement to ToF depth to further improve prediction accuracy. Experiments show that our method achieves an 8.6% lower mean absolute error than the second-best method, while maintaining lightweight design to support onboard deployment. Finally, to verify the system's applicability on real robots, we deploy proposed method on a quadrotor at a 10Hz runtime, enabling reliable large-scale mapping and long-range planning in challenging environments for short-range ToF cameras.
Figures & tables
Fig. 1: (a) Previous paradigms typically acquire ground truth through a depth camera and subsample it to synthesis uniform sparse inputs for training. Sensor-agnostic networks developed under this paradigm struggle to transfer to real-world ToF completion. (b) Our framework first focuses on obtaining real-world ToF sampling and generating dense depth ground truth in large-scale scenarios. Then, we propose a sensor-aware depth completion network. This framework expands the applicability of ToF cameras in large-scale robot applications in (c) .
Dataset
Scene
Ground Truth Acquisition Method
Max Reliable Range
Sequence?
ToF data?
Avg. Return Density
Resolution
Quantity
NYU-Depth V2 [ 5 ]
Indoor
Depth-Camera-Based
Near, <6m
✓
✗
68%
304*228
48,238
TOFDC [ 6 ]
In/Outdoor
✗
✓
98.5%
512*384
10,560
VOID [ 12 ]
In/Outdoor
Near, <3m
✓
✗
95.1%
640*480
40,800
DenseLivox [ 13 ]
In/Outdoor
Accumulation-Based
Far, >20m
✗
✗
88.3%
Unknown
19,428
DIODE [ 14 ]
In/Outdoor
✗
✗
99.6%/66.9%
1024*768
27,858
KittiDC [ 7 ]
Outdoor
✓
✗
22%
1216*256
87,898
TABLE I: Statistics of LASER-ToF compared to other depth completion datasets.
Fig. 2: Data synchronization and dataset production pipeline.
Fig. 3: Our multi-sensor data collection platform.
Fig. 4: Dataset visualization: RGB image (input), sparse depth (input), and ground truth. Color bars on the right indicate the farthest distance of depth maps.
Fig. 5: ToFormer Network Architecture. Given an input RGBD image, a multi-scale encoder is adopted for 2D RGB-D fusion and 3D-2D cross-modal fusion. Point clouds are backprojected from RGBD image, aligned with 2D features, and fed into the 3D branch. Early fusion is conducted between the 3D feature map X3d and 2D feature map X2d through the MXCA module. Then, multi-level depth maps are upsampled by the decoder, and the full-resolution depth map D^1/1 will be refined by the SPN module.
Fig. 6: (a) Illustration of our 3D branch design details. (b) Non local Propagation Properties of proposed 3D Branch: (1)-(2) Ground truth and sparse depth. (3)-(4) As the number of EdgeConv iterations increases, the aggregation basis of point clouds shifts from distance to geometric structure. (5) Overlayed dense activation map of X3d . (c) Previous 3D-2D fusion patterns of [ 22 , 23 ] .
Fig. 7: Visualized comparison of raw depth map acquired through different method. Our reconstruction-based method has significantly higher overall quality compared to the accumulation-based method.
Fig. 8: Our direct validation method, designed specifically for comparing depth map from accumulation (stationary phase) and reconstruction (moving phase).
Scene
Dstatic as Ground Truth
Return Density
RMSE (m)
REL
Max Depth (m)
Dstatic
Dmotion
Outdoor-1
0.241
0.007
32.48
67.8%
92.7%
Outdoor-2
0.108
0.009
97.41
50.5%
56.8%
Outdoor-3
0.232
0.004
21.74
78.6%
88.0%
Outdoor-4
0.079
0.008
36.58
72.3%
79.0%
Indoor-1
0.023
0.002
24.88
75.4%
80.7%
TABLE II: Quantitative evaluation of Dmotion when take Dstatic as ground truth and return density comparison.
RGB with ToF-Only as Input
RGB with ToF&Visual as Input
Method
RMSE ↓ (mm)
MAE ↓ (mm)
REL ↓
δ1↑
RMSE ↓ (mm)
MAE ↓ (mm)
REL ↓
δ1↑
Params. ↓ (M)
FLOPs ↓ (G)
NLSPN [ 8 ]
1140.49
496.24
0.0605
94.7
1033.02
412.91
0.0530
95.7
26.23
972.48
MDANet [ 17 ]
1212.54
619.98
0.0791
93.9
1102.83
521.72
0.0725
94.2
3.04
323.52
PENet [ 16 ]
1105.80
528.64
0.0674
94.5
949.98
421.33
0.0582
95.7
131.92
585.61
DySPN [ 9 ]
1170.58
547.37
0.0701
94.1
1058.74
467.00
0.0634
94.8
26.80
934.18
CFormer [ 10 ]
1086.06
526.65
0.0694
94.2
987.86
447.64
0.0630
95.0
82.51
769.88
TABLE III: Quantitative results on LASER-ToF benchmark. ( xx : best; xx : second-best. Horizontal group 1 and 3: supervised methods. Horizontal group 2: generalizable methods.)
Fig. 9: Qualitative results on the LASER-ToF benchmark. Upper part: An outdoor staircase scene, where only ToF is used as sparse depth input. Depth is available only for the few steps directly in front of the sensor. Lower part: An office scene, near-range and far-range depths are provided by ToF and visual SLAM respectively, yet the textureless white wall yields no valid depth points.
Fig. 10: Visualized comparison of geometric details for four best methods in indoor and outdoor scenarios. The zoomed-in regions show fine-grained differences.
Fig. 11: Relative mean absolute error (REL) across depth ranges. As the depth increases toward far range, all methods exhibit a rising error trend. Our method maintains the lowest error across nearly all depth ranges.
Fig. 12: Error maps comparison. (a) A large hall scene in which the far-range depth is provided by visual SLAM but contains noise. (b) A challenging scene involving outliers caused by ground reflections and multiple large missing regions. (c) The same scene as in (b) when only ToF depth is used and SLAM depth is unavailable.
Method
RMSE ↓ (m)
REL ↓
δ1↑
δ2↑
δ3↑
CSPN [ 19 ]
0.117
0.016
99.2
99.9
100.0
GuideNet [ 54 ]
0.101
0.015
99.5
99.9
100.0
NLSPN [ 8 ]
0.092
0.012
99.6
99.9
100.0
CFormer [ 10 ]
0.091
0.012
99.6
99.9
100.0
DySPN [ 9 ]
0.090
0.012
99.6
99.9
100.0
BP-Net [ 27 ]
0.089
0.012
99.6
99.9
100.0
TABLE IV: Quantitative evaluation under uniform sparse depth setting on NYUv2.
Base
SPN
MXCA
3D
RMSE ↓ (mm)
REL ↓
GFLOPs ↓
(A)
✓
×
×
×
957.15
0.0541
417.73
(B)
✓
✓
×
×
950.87
0.0526
429.82
(C)
✓
×
✓
✓
942.23
0.0525
495.40
(D)
✓
✓
×
✓
935.15
0.0510
483.90
(E)
✓
✓
✓
×
936.39
0.0522
440.52
(F)
✓
✓
✓
✓
924.07
0.0501
507.49
TABLE V: Ablation studies of ToFormer’s main components on LASER-ToF Depth Dataset.
3D Branch
Interaction
Sparse-to-Dense (w/o JPP)
Dense-to-Dense (w/ JPP)
RMSE (mm)
974.32
924.07
TABLE VI: Ablation studies of the 3D branch without and with JPP module.
SLAM method
Keypoint
RMSE ↓ (mm)
MAE ↓ (mm)
ORB-SLAM [ 42 ]
Oriented FAST [ 43 ]
924.07
379.06
Vins-Mono [ 41 ]
Shi-Tomasi [ 44 ]
1025.37
435.45
Superpoint-SLAM [ 57 ]
Superpoint [ 45 ]
1000.62
408.71
No backend optimization
1068.61
540.42
Tracking degradation (50% visual points)
946.88
393.34
Tracking degradation (20% visual points)
974.10
422.63
TABLE VII: Ablation studies on the types and behaviors of SLAM.
Method
Params. ↓ (M)
FLOPs ↓ (G)
Runtime ↓ (ms)
RMSE ↓ (mm)
NLSPN [ 8 ]
26.23
219.01
22.6
1033.02
MDANet [ 17 ]
3.04
86.27
134.7
1102.83
PENet [ 16 ]
131.92
156.16
329.8
949.98
DySPN [ 9 ]
26.80
233.55
55.4
1058.74
CFormer [ 10 ]
82.51
172.08
159.6
987.86
LRRU [ 26 ]
20.84
323.74
45.5
1200.87
TABLE VIII: Computational cost comparison with previous methods at 320 × 240 resolution.
Fig. 13: Large-scale grid mapping experiments. (a) A long corridor. (b) A circular large-scale environment.
Fig. 14: Illustration of our quadrotor’s hardware and onboard algorithm with ToF depth completion model integrated.
Fig. 15: Long-range path planning experiments across three environments with increasing complexity.
Scene I: Single Wall
ToF Depth
Energy Cost ↓ ( m2/s5 )
Traj. Length ↓ ( m )
Time ↓ ( s )
Avg. Speed ↑ ( m/s )
w/o DC
7.87
13.29
17.26
0.77
w/ DC
5.93
10.18
12.57
0.81
Scene II: Dead End
w/o DC
-
-
-
-
w/ DC
7.51
13.00
15.48
0.84
TABLE IX: Quantitative results of the path planning experiment across three scenes.
Tsinghua Shenzhen International Graduate School, Tsinghua University, Shenzhen 518055, China · Guangdong Laboratory of Artificial Intelligence and Digital Economy (SZ), Shenzhen 518060, China