PadLoc: Training-Free Floor-Plan Localization by Sparse Geometric Matching
Organizations: HTW Berlin – University of Applied Sciences
Abstract
We propose PadLoc, a training-free localization back-end that places a moving sensor within a known floor plan. Floor plans are cheap, persistent, and robust to appearance change, but recent learned-depth methods localize against them by filtering per-frame depth through dense pose grids. PadLoc keeps the swappable depth front-end and replaces the dense grid back-end with sparse geometric matching: dominant wall orientations define a small pose-candidate set, masked normalized cross-correlation scores observed free space against the plan, and a moving-pose Gaussian-mixture Bayes filter plus consensus readout decodes the trajectory. Holding each competitor's depth fixed, PadLoc matches or beats UnLoc's forward filter and the F3Loc filter at every Gibson trajectory length, and UnLoc's offline refinement from on; it exceeds Z-FLoc's published results with a shared MapAnything front-end. On Bonn LiLocBench, PadLoc improves pooled SR@1m over UnLoc by 23-32 pp under wheel odometry and 35-43 pp with ground-truth motion; with full-FOV LiDAR plus wheel odometry the same readout reaches 100% SR@1m at 9-10 cm median error on the static sequence. On the Hilti-Trimble Localization Challenge PadLoc localizes a camera-only fisheye rig on construction floors hundreds of metres across at 0.90-0.98 online SR@2m on three of five sessions; adding learned wall isolation, applied to every session, covers all five at 0.67-0.92 with the localizer unchanged throughout. PadLoc thus matches or outperforms dense grid back-ends while preserving sensor modularity and a compact state that does not grow with trajectory length.
Figures & tables
| SR | R | SR | R | SR | R | SR | R | SR | R | |
| F3Loc mono depth | ||||||||||
| F3Loc filter | 0.291 | 0.27 | 0.345 | 0.23 | 0.550 | 0.21 | 0.705 | 0.18 | 0.892 | 0.18 |
| PadLoc frozen | 0.496 | 0.29 | 0.585 | 0.28 | 0.766 | 0.27 | 0.821 | 0.24 | 0.946 | 0.28 |
| F3Loc comp_s depth | ||||||||||
| F3Loc filter | 0.366 | 0.21 | 0.410 | 0.18 | 0.622 | 0.16 | 0.795 | 0.14 | 0.946 | 0.15 |
| UnLoc fwd | .573/.17 | .610/.14 | .771/.11 | .798/.11 | .822/.12 |
|---|---|---|---|---|---|
| UnLoc refined | .670 /.18 | .717 /.17 | .765/.16 | .791/.14 | .783/.17 |
| PadLoc frozen | .601/.20 | .695/.17 | .774/.15 | .839/.15 | .811/.19 |
| PadLoc accum | .667/.18 | .715/.18 | .809 /.14 | .856 /.13 | .846/.14 |
| PadLoc frozen, | .624/.18 | .694/.15 | .809 /.12 | .849/.11 | .887 /.11 |
| SR | R | SR | R | SR | R | |
| back-end build-up | ||||||
| per-frame NCC argmax | 0.108 | 3.11 | 0.081 | 3.21 | 0.216 | 2.37 |
| accumulation (argmax) | 0.817 | 0.17 | 0.928 | 0.14 | 1.000 | 0.13 |
| consensus, gate/heal off | 0.687 | 0.21 | 0.856 | 0.15 | 0.919 | 0.14 |
| GM-BF gate & heal | 0.731 | 0.20 | 0.919 | 0.15 | 1.000 | 0.19 |
| UnLoc | PadLoc cons , wheel | |||||
|---|---|---|---|---|---|---|
| scene | 150 | 300 | 450 | 150 | 300 | 450 |
| static_0 | 0.32 | 0.59 | 0.68 | 0.59 | 0.79 | 0.89 |
| dynamics_0 | 0.33 | 0.43 | 0.60 | 0.67 | 0.71 | 0.60 |
| lt_changes_0 | 0.21 | 0.43 | 0.21 | 0.60 | 0.71 | 0.79 |
| lt_ch_dyn_0 | 0.33 | 0.44 | 0.39 | 0.45 | 0.63 | 0.72 |
| pooled SR@1 m | 0.30 | 0.49 | 0.46 | 0.56 | 0.71 | 0.79 |
| session | SR@2 m | mean | score | |||
|---|---|---|---|---|---|---|
| az55 | seg | (m) | ||||
| floor_1 | 3923 | 0.977 | 0.710 | 0.718 | 0.90 | 68.1 |
| run_2 | 2569 | 0.907 | 0.953 | 0.895 | 0.68 | 74.3 |
| 05-05 | 5594 | 0.898 | 0.813 | 0.920 | 1.11 | 62.3 |
| run_1 | 3067 | 0.456 | 0.689 | 0.689 | 2.68 | 32.3 |
| UG1 | 6124 | 0.156 | 0.000 | 0.668 | 5.62 | 0 9.9 |
Appendix figures & tables25 assets
Supplementary material from the paper’s appendix.
Appendix
| parameter | value | set by |
| fixed across all datasets | ||
| wall-hit mask weight | Gibson | |
| column-drop threshold | Gibson | |
| overlap-rejection threshold | Gibson | |
| heading-overlap exponent | own sweep (unique opt.) | |
| top- peaks / mixture cap | Gibson | |
| setting | |||||
|---|---|---|---|---|---|
| published ( , ) | .731 | .840 | .919 | 1.000 | 1.000 |
| .746 | .835 | .910 | .974 | 1.000 | |
| .728 | .840 | .928 | 1.000 | 1.000 | |
| .713 | .835 | .937 | 1.000 | 1.000 | |
| .709 | .815 | .928 | .987 | 1.000 | |
| cutoff | .705 | .815 | .937 | .974 | 1.000 |
| SR | R | SR | R | SR | R | |
|---|---|---|---|---|---|---|
| 0.683 | 0.24 | 0.901 | 0.16 | 0.973 | 0.21 | |
| (deployed) | 0.731 | 0.20 | 0.919 | 0.15 | 1.000 | 0.19 |
| (0.769) | 0.20 | 0.910 | 0.15 | 1.000 | 0.17 | |
| (0.761) | 0.21 | 0.892 | 0.16 | 1.000 | 0.13 | |
| (0.817) | 0.17 | 0.928 | 0.16 | 1.000 | 0.19 | |
| SR | R | SR | R | SR | R | |
| LiDAR + wheel (clean) | ||||||
| per-frame NCC argmax | 0.542 | 0.20 | 0.724 | 0.12 | 0.526 | 0.21 |
| accumulation full | 1.000 | 0.08 | 1.000 | 0.09 | 1.000 | 0.10 |
| D455 RGB-D + VO (high-drift) | ||||||
| per-frame NCC argmax | 0.153 | 7.7 | 0.069 | 7.7 | 0.105 | 10.3 |
| SR | SR | SR | ||||
|---|---|---|---|---|---|---|
| 0 | 0.971 | 0.18 | 0.883 | 0.29 | 0.905 | 0.76 |
| 2 | 0.974 | 0.18 | 0.884 | 0.28 | 0.911 | 0.73 |
| 5 | 0.979 | 0.18 | 0.887 | 0.27 | 0.918 | 0.71 |
| 10 | 0.982 | 0.18 | 0.898 | 0.26 | 0.920 | 0.68 |
| 0.983 | 0.18 | 0.916 | 0.25 | 0.913 | 0.53 | |
| SR | R | SR | R | SR | R | SR | R | SR | R | |
| F3Loc mono depth | ||||||||||
| F3Loc filter | 0.511 | 0.25 | 0.530 | 0.24 | 0.703 | 0.19 | 0.808 | 0.18 | 0.892 | 0.18 |
| PadLoc delayed | 0.608 | 0.28 | 0.695 | 0.28 | 0.775 | 0.26 | 0.846 | 0.26 | 0.946 | 0.26 |
| F3Loc comp_s depth | ||||||||||
| F3Loc filter | 0.567 | 0.21 | 0.580 | 0.19 | 0.757 | 0.15 | 0.872 | 0.14 | 0.946 | 0.14 |
| UnLoc fwd | .703/.13 | .748/.13 | .809/.11 | .821/.12 | .809/.14 |
|---|---|---|---|---|---|
| UnLoc refined | .670/.18 | .717/.17 | .765/.16 | .791/.14 | .783/.17 |
| PadLoc delayed | .695/.16 | .757 /.16 | .799/.13 | .835/.15 | .823/.18 |
| PadLoc accum | .667/.18 | .715/.18 | .809/.14 | .856 /.13 | .846/.14 |
| PadLoc delayed, | .716 /.16 | .737/.15 | .828 /.10 | .854/.11 | .887 /.12 |
| Gibson ( ) | ||||||
|---|---|---|---|---|---|---|
| consensus, gate/heal off | 0.806 | 0.18 | 0.883 | 0.14 | 0.973 | 0.13 |
| GM-BF gate & heal | 0.843 | 0.16 | 0.937 | 0.13 | 1.000 | 0.18 |
| -overlap weight | 0.817 | 0.18 | 0.928 | 0.14 | 1.000 | 0.18 |
| column drop | 0.810 | 0.19 | 0.910 | 0.13 | 1.000 | 0.17 |
| consensus heal | 0.832 | 0.18 | 0.910 | 0.14 | 0.973 | 0.18 |
| Bonn LiDAR + wheel ( ) | ||||||
| UnLoc | PadLoc cons , wheel | |||||
|---|---|---|---|---|---|---|
| scene | 150 | 300 | 450 | 150 | 300 | 450 |
| static_0 | 0.37 | 0.59 | 0.74 | 0.59 | 0.79 | 0.89 |
| dynamics_0 | 0.33 | 0.43 | 0.60 | 0.67 | 0.71 | 0.60 |
| lt_changes_0 | 0.28 | 0.43 | 0.21 | 0.60 | 0.71 | 0.79 |
| lt_ch_dyn_0 | 0.35 | 0.41 | 0.39 | 0.47 | 0.63 | 0.72 |
| pooled SR@1 m | 0.34 | 0.48 | 0.48 | 0.56 | 0.71 | 0.79 |
| depth | motion | SR | R | SR | R |
|---|---|---|---|---|---|
| LiDAR | VO | 1.000 | 0.10 | 0.947 | 0.12 |
| LiDAR | wheel | 1.000 | 0.09 | 1.000 | 0.10 |
| LiDAR | VO | 0.931 | 0.10 | 0.947 | 0.12 |
| D455 RGB-D | VO | 0.966 | 0.22 | 0.842 | 0.31 |
| LiDAR , | VO | 0.966 | 0.09 | 0.895 | 0.14 |
| SR@1 m at | |||||
|---|---|---|---|---|---|
| cell | |||||
| 0.731 | 0.840 | 0.919 | 1.000 | 1.000 | |
| 0.743 | 0.815 | 0.928 | 0.974 | 1.000 | |
| 0.679 | 0.795 | 0.919 | 0.962 | 1.000 | |
| 0.638 | 0.750 | 0.892 | 0.949 | 1.000 | |
| 0.511 | 0.640 | 0.802 | 0.910 | 0.973 | |
| cell | SR | RMSE | SR | RMSE |
|---|---|---|---|---|
| 1.000 | 0.086 | 1.000 | 0.102 | |
| 1.000 | 0.103 | 1.000 | 0.095 | |
| 1.000 | 0.121 | 1.000 | 0.124 | |
| 1.000 | 0.204 | 0.947 | 0.227 | |
| Gibson, F3Loc depth | |||||
|---|---|---|---|---|---|
| F3Loc filter ( mono ) | .212/2.32 | .264/1.89 | .435/0.41 | .577/0.22 | .730/0.17 |
| PadLoc frozen ( mono ) | .352/0.85 | .423/0.47 | .562/0.29 | .620/0.26 | .685/0.25 |
| F3Loc filter ( comp_s ) | .289/1.95 | .337/1.34 | .524/0.25 | .687/0.13 | .804/0.13 |
| PadLoc frozen ( comp_s ) | .420/0.54 | .513/0.32 | .687/0.19 | .736/0.19 | .737/0.19 |
| Bonn per-sequence (columns ) | |||||
| depth | SR@1 m | med/p90 ( ∘ ) | wrong fam. | fail. wrong-fam. | ||
|---|---|---|---|---|---|---|
| UnLoc | 15 | 268 | 0.731 | 2.6 / 90.1 | 13.8 % | 37/72 |
| UnLoc | 20 | 200 | 0.840 | 1.7 / 13.1 | 9.5 % | 19/32 |
| UnLoc | 35 | 111 | 0.919 | 1.7 / 7.3 | 6.3 % | 7/9 |
| UnLoc | 50 | 78 | 1.000 | 1.3 / 3.5 | 0.0 % | – |
| UnLoc | 100 | 37 | 1.000 | 1.4 / 3.6 | 0.0 % | – |
| comp_s | 15 | 268 | 0.563 | 3.4 / 172.7 | 25.7 % | 68/117 |
| scene | |||||
|---|---|---|---|---|---|
| Spencerville | 0.72 (39) | 0.79 (29) | 0.81 (16) | 1.00 (11) | 1.00 (5) |
| Spotswood | 0.75 (20) | 0.73 (15) | 1.00 (8) | 1.00 (6) | 1.00 (3) |
| Springhill | 0.74 (27) | 0.90 (20) | 0.91 (11) | 1.00 (8) | 1.00 (4) |
| Stilwell | 0.71 (45) | 0.85 (34) | 0.89 (19) | 1.00 (13) | 1.00 (6) |
| Stokes | 0.62 (24) | 0.78 (18) | 0.70 (10) | 1.00 (7) | 1.00 (3) |
| Sumas | 0.95 (20) | 0.93 (15) | 1.00 (8) | 1.00 (6) | 1.00 (3) |
Map-Based Localization
Map-Based Localization estimates a device or robot’s position and orientation by matching sensor observations to stored maps.
See all 114 papers