An iterative convergence algorithm for single/multi ground plane detection and angle estimation with RGB-D camera

In this paper, we propose an innovative algorithm for detecting single or multiple ground planes and estimating the orientation of the ground plane with a RGB-D camera. In our algorithm, we use Kernel Density Estimator for selecting the ground plane reliably under a given tilt angle. Camera tilt angle is estimated with probability theory and then used as a feedback to improve the accuracy of detection. Our algorithm is evaluated on several challenging data set and is shown to hold great superiority and effectiveness.