Fast Free Floor Detection for Range Cameras

Izaak Van Crombrugge, Luc Mertens, Rudi Penne


A robust and fast free floor detection algorithm is indispensable in autonomous or assisted navigation as it labels the drivable surface and marks obstacles. In this paper we propose a simple and fast method to segment the free floor surface in range camera data by calculating the Euclidean distance between every measured point of the point cloud and the ground plane. This method is accurate for planar motion, i.e. as long as the camera stays at a fixed height and angle above the ground plane. This is most often the case in driving mobile platforms in an indoor environment. Given this condition, the ground plane stays invariant in camera coordinates. Obstacles as low as 40mm are reliably detected. The detection works correct even when ’multipath’ errors are present, a typical phenomenon of distance overestimation in corners when using time-of-flight range cameras. To demonstrate the application of our segmentation method, we implemented it to create a simple but accurate navigation map.


  1. Aggarwal, S., Namboodiri, A. M., and Jawahar, C. V. (2014). Estimating Floor Regions in Cluttered Indoor Scenes from First Person Camera View. In 2014 22nd International Conference on Pattern Recognition (ICPR), pages 4275-4280.
  2. Fischler, M. A. and Bolles, R. C. (1981). Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography. Communications of the ACM, 24(6):381-395.
  3. Holz, D., Holzer, S., Rusu, R. B., and Behnke, S. (2012). Real-Time Plane Segmentation Using RGB-D Cameras, pages 306-317. Springer Berlin Heidelberg.
  4. Holz, D., Schnabel, R., Droeschel, D., Stückler, J., and Behnke, S. (2011). Towards Semantic Scene Analysis with Time-of-Flight Cameras, pages 121-132. Springer Berlin Heidelberg, Berlin, Heidelberg.
  5. Kircali, D. and Tek, F. B. (2014). Ground Plane Detection Using an RGB-D Sensor. In Information Sciences and Systems 2014, pages 69-77.
  6. Li, Y. and Birchfield, S. T. (2010). Image-Based Segmentation of Indoor Corridor Floors for a Mobile Robot. In IEEE/RSJ 2010 International Conference on Intelligent Robots and Systems (IROS 2010), pages 837- 843.
  7. Liang, B. and Pears, N. (2002). Ground plane segmentation from multiple visual cues. In Second Internation Conference on Image and Graphics, Pts 1 and 2, volume 4875 of Proceedings of the Society of Photo-Optical Instrumentation Engineers (SPIE), pages 822-829.
  8. Lin, C.-H. and Song, K.-T. (2015). Robust ground plane region detection using multiple visual cues for obstacle avoidance of a mobile robot. ROBOTICA, 33(2):436- 450.
  9. Pears, N. and Liang, B. (2001). Ground plane segmentation for mobile robot visual navigation. In IROS 2001: Proceedings of the 2001 IEEE/RJS International Conference on Intelligent Robots and Systems, Vols 1-4: Expanding the Societal Role of Robotics in the Next Millennium, pages 1513-1518.
  10. Penne, R., Mertens, L., and Ribbens, B. (2013). Planar Segmentation by Time-of-Flight Cameras. In Advanced Concepts for Intelligent Vision Systems, ACIVS 2013, volume 8192 of Lecture Notes in Computer Science, pages 286-297.
  11. Pham, H.-H., Le, T.-L., and Vuillerme, N. (2016). RealTime Obstacle Detection System in Indoor Environment for the Visually Impaired Using Microsoft Kinect Sensor. Journal of Sensors.
  12. Poppinga, J., Vaskevicius, N., Birk, A., and Pathak, K. (2008). Fast Plane Detection and Polygonalization in Noisy 3D Range Images. In 2008 IEEE/RSJ International Conference on Robots and Intelligent Systems, Vols 1-3, Conference Proceedings, pages 3378-3383.
  13. Qian, X. and Ye, C. (2014). NCC-RANSAC: A Fast Plane Extraction Method for 3-D Range Data Segmentation. IEEE Transactions on Cybernetics, 44(12):2771- 2783.
  14. Rohmer, E., Singh, S. P., and Freese, M. (2013). V-rep: A versatile and scalable robot simulation framework. In 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems, pages 1321-1326. IEEE.
  15. Schwarz, L. A., Mateus, D., Lallemand, J., and Navab, N. (2011). Tracking planes with time of flight cameras and j-linkage. In Applications of Computer Vision (WACV), 2011 IEEE Workshop on, pages 664-671.
  16. Torr, P. H. and Zisserman, A. (2000). Mlesac: A new robust estimator with application to estimating image geometry. Computer Vision and Image Understanding, 78(1):138-156.
  17. Ye, C. and Hegde, G. M. (2015). Plane Segmentation of 3D Time-of-Flight Camera's Range Data by Normalized Cuts for Navigating a Tracked Robot. International Journal of Intelligent Control and Systems, 20(1):9- 15.

Paper Citation

in Harvard Style

Van Crombrugge I., Mertens L. and Penne R. (2017). Fast Free Floor Detection for Range Cameras . In Proceedings of the 12th International Joint Conference on Computer Vision, Imaging and Computer Graphics Theory and Applications - Volume 4: VISAPP, (VISIGRAPP 2017) ISBN 978-989-758-225-7, pages 509-516. DOI: 10.5220/0006133505090516

in Bibtex Style

author={Izaak Van Crombrugge and Luc Mertens and Rudi Penne},
title={Fast Free Floor Detection for Range Cameras},
booktitle={Proceedings of the 12th International Joint Conference on Computer Vision, Imaging and Computer Graphics Theory and Applications - Volume 4: VISAPP, (VISIGRAPP 2017)},

in EndNote Style

JO - Proceedings of the 12th International Joint Conference on Computer Vision, Imaging and Computer Graphics Theory and Applications - Volume 4: VISAPP, (VISIGRAPP 2017)
TI - Fast Free Floor Detection for Range Cameras
SN - 978-989-758-225-7
AU - Van Crombrugge I.
AU - Mertens L.
AU - Penne R.
PY - 2017
SP - 509
EP - 516
DO - 10.5220/0006133505090516