Towards Optimal Beacon Placement for Range-Aided Localization (2405.11550v1)
Abstract: Range-based localization is ubiquitous: global navigation satellite systems (GNSS) power mobile phone-based navigation, and autonomous mobile robots can use range measurements from a variety of modalities including sonar, radar, and even WiFi signals. Many of these localization systems rely on fixed anchors or beacons with known positions acting as transmitters or receivers. In this work, we answer a fundamental question: given a set of positions we would like to localize, how should beacons be placed so as to minimize localization error? Specifically, we present an information theoretic method for optimally selecting an arrangement consisting of a few beacons from a large set of candidate positions. By formulating localization as maximum a posteriori (MAP) estimation, we can cast beacon arrangement as a submodular set function maximization problem. This approach is probabilistically rigorous, simple to implement, and extremely flexible. Furthermore, we prove that the submodular structure of our problem formulation ensures that a greedy algorithm for beacon arrangement has suboptimality guarantees. We compare our method with a number of benchmarks on simulated data and release an open source Python implementation of our algorithm and experiments.
- A. Raza, L. Lolic, S. Akhter, and M. Liut, “Comparing and Evaluating Indoor Positioning Techniques,” in 2021 International Conference on Indoor Positioning and Indoor Navigation (IPIN). Lloret de Mar, Spain: IEEE, Nov. 2021, pp. 1–8.
- A. Goudar, T. D. Barfoot, and A. P. Schoellig, “Continuous-Time Range-Only Pose Estimation,” in 2023 20th Conference on Robots and Vision (CRV). Montreal, QC, Canada: IEEE, Jun. 2023, pp. 29–36.
- A. Papalia, J. Morales, K. J. Doherty, D. M. Rosen, and J. J. Leonard, “SCORE: A Second-Order Conic Initialization for Range-Aided SLAM,” in 2023 IEEE International Conference on Robotics and Automation (ICRA). London, United Kingdom: IEEE, May 2023, pp. 10 637–10 644.
- F. Dumbgen, C. Holmes, and T. D. Barfoot, “Safe and Smooth: Certified Continuous-Time Range-Only Localization,” IEEE Robotics and Automation Letters, vol. 8, no. 2, pp. 1117–1124, Feb. 2023.
- N. Kayhani, A. Schoellig, and B. McCabe, “Perception-Aware Tag Placement Planning for Robust Localization of UAVs in Indoor Construction Environments,” Journal of Computing in Civil Engineering, vol. 37, no. 2, pp. 1–32, Mar. 2023.
- G. Kantor and S. Singh, “Preliminary results in range-only localization and mapping,” in Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292), vol. 2. Washington, DC, USA: IEEE, 2002, pp. 1818–1823.
- P. Newman and J. Leonard, “Pure range-only sub-sea SLAM,” in 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422). Taipei, Taiwan: IEEE, 2003, pp. 1921–1926.
- A. Goudar, F. Dümbgen, T. D. Barfoot, and A. P. Schoellig, “Optimal Initialization Strategies for Range-Only Trajectory Estimation,” IEEE Robotics and Automation Letters, pp. 1–8, 2024.
- A. Papalia, A. Fishberg, B. W. O’Neill, J. P. How, D. M. Rosen, and J. J. Leonard, “Certifiably Correct Range-Aided SLAM,” Sep. 2023.
- J. Wang, R. K. Ghosh, and S. K. Das, “A Survey on Sensor Localization,” Journal of Control Theory and Applications, vol. 8, no. 1, pp. 2–11, Feb. 2010.
- A. Simonetto and G. Leus, “Distributed Maximum Likelihood Sensor Network Localization,” IEEE Transactions on Signal Processing, vol. 62, no. 6, pp. 1424–1437, Mar. 2014.
- A. Krause and D. Golovin, “Submodular Function Maximization,” in Tractability, 1st ed., L. Bordeaux, Y. Hamadi, and P. Kohli, Eds. Cambridge University Press, Feb. 2014, pp. 71–104.
- L. Carlone and S. Karaman, “Attention and Anticipation in Fast Visual-Inertial Navigation,” IEEE Transactions on Robotics, vol. 35, no. 1, pp. 1–20, Feb. 2019.
- V. Tzoumas, A. Jadbabaie, and G. J. Pappas, “Sensor placement for optimal Kalman filtering: Fundamental limits, submodularity, and algorithms,” in 2016 American Control Conference (ACC). Boston, MA, USA: IEEE, Jul. 2016, pp. 191–196.
- A. Collin and A. T. Espinoza, “Resilient Sensor Architecture Design and Tradespace Analysis for Autonomous Vehicle Localization and Mapping,” arXiv preprint arXiv:1907.08541, no. arXiv:1907.08541, Jul. 2019.
- K. Khosoussi, M. Giamou, G. S. Sukhatme, S. Huang, G. Dissanayake, and J. P. How, “Reliable Graphs for SLAM,” The International Journal of Robotics Research, vol. 38, no. 2-3, pp. 260–298, Mar. 2019.
- Y. Tian, K. Khosoussi, M. Giamou, J. How, and J. Kelly, “Near-Optimal Budgeted Data Exchange for Distributed Loop Closure Detection,” in Robotics: Science and Systems XIV. Robotics: Science and Systems Foundation, Jun. 2018.
- P. Kaveti, M. Giamou, H. Singh, and D. M. Rosen, “OASIS: Optimal Arrangements for Sensing in SLAM,” Sep. 2023.
- Q. Huang, J. DeGol, V. Fragoso, S. N. Sinha, and J. J. Leonard, “Optimizing Fiducial Marker Placement for Improved Visual Localization,” IEEE Robotics and Automation Letters, vol. 8, no. 5, pp. 2756–2763, May 2023.
- Z. C. Andrews and D. T. Ngo, “New Wireless Beacon Deployment for Maximum Coverage Efficiency in Indoor Localization,” IEEE Sensors Letters, vol. 8, no. 2, pp. 1–4, Feb. 2024.
- N. Rajagopal, S. Chayapathy, B. Sinopoli, and A. Rowe, “Beacon placement for range-based indoor localization,” in 2016 International Conference on Indoor Positioning and Indoor Navigation (IPIN). Alcala de Henares, Spain: IEEE, Oct. 2016, pp. 1–8.
- A. Moragrega, P. Closas, and C. Ibars, “Supermodular game for energy efficient TOA-based positioning,” in 2012 IEEE 13th International Workshop on Signal Processing Advances in Wireless Communications (SPAWC). Cesme, Turkey: IEEE, Jun. 2012, pp. 35–39.
- H. Wang, N. Rajagopal, A. Rowe, B. Sinopoli, and J. Gao, “Efficient Beacon Placement Algorithms for Time-of-Flight Indoor Localization,” in Proceedings of the 27th ACM SIGSPATIAL International Conference on Advances in Geographic Information Systems. Chicago IL USA: ACM, Nov. 2019, pp. 119–128.
- Z. Wu, Z. Yao, and M. Lu, “Optimal Beacon Deployment for Positioning in Cluttered Indoor Environments,” IEEE Sensors Journal, vol. 23, no. 4, pp. 4256–4266, Feb. 2023.
- W. Zhao, A. Goudar, and A. P. Schoellig, “Finding the Right Place: Sensor Placement for UWB Time Difference of Arrival Localization in Cluttered Indoor Environments,” IEEE Robotics and Automation Letters, vol. 7, no. 3, pp. 6075–6082, Jul. 2022.
- I. Shames and T. H. Summers, “Rigid Network Design Via Submodular Set Function Optimization,” IEEE Transactions on Network Science and Engineering, vol. 2, no. 3, pp. 84–96, Jul. 2015.
- K. Chaloner and I. Verdinelli, “Bayesian Experimental Design: A Review,” Statistical Science, vol. 10, no. 3, pp. 273–304, 1995.
- M. Shamaiah, S. Banerjee, and H. Vikalo, “Greedy sensor selection: Leveraging submodularity,” in 49th IEEE Conference on Decision and Control (CDC). Atlanta, GA, USA: IEEE, Dec. 2010, pp. 2572–2577.
- N. Hansen, “The CMA evolution strategy: A tutorial,” CoRR, vol. abs/1604.00772, 2016. [Online]. Available: http://arxiv.org/abs/1604.00772
- CADENGINEER. Factory building layout plan and elevation cad template dwg. [Online]. Available: https://cadtemplates.org/factory-building-layout-plan-and-elevation-cad-template-dwg
- K. J. Doherty, D. M. Rosen, and J. J. Leonard, “Spectral Measurement Sparsification for Pose-Graph SLAM,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Kyoto, Japan: IEEE, Oct. 2022, pp. 01–08.
Collections
Sign up for free to add this paper to one or more collections.
Paper Prompts
Sign up for free to create and run prompts on this paper using GPT-5.