Fast Iterative Closest Point framework for 3D LIDAR data in intelligent vehicle

Nearest neighbor search is a fundamental problem in computer vision and machine learning. The straightforward solution, linear scan, is both computationally and memory intensive in large scale high-dimensional cases, hence is not preferable in practice. Therefore, there have been a lot of interests in algorithms that perform approximate nearest neighbor (ANN) search. In this paper, we propose a novel addition-based vector quantization algorithm, Asymmetric Mapping Quantization (AMQ), to efficiently conduct ANN search. Unlike existing addition-based quantization methods that suffer from handling the problem caused by the norm of database vector, we map the query vector and database vector using different mapping functions to transform the computation of L-2 distance to inner product similarity, thus do not need to evaluate the norm of database vector. Moreover, we further propose Distributed Asymmetric Mapping Quantization (DAMQ) to enable AMQ to work on very large dataset by distributed learning. Extensive experiments on approximate nearest neighbor search and image retrieval validate the merits of the proposed AMQ and DAMQ.

The iterative closest point (ICP) algorithm is widely used in three-dimensional (3D) point cloud registration, and it is very stable and robust. However, its biggest drawback is being easily trapped in a local optimal solution, which results in the incorrect registration result. Currently, there is neither a clear effective range to define whether the ICP algorithm will fall into a local optimum nor a study providing a comprehensive evaluation of the ICP algorithm. In this paper, we take the overlap ratio, angle, distance, and noise as the influencing factors of ICP and evaluate the validity, robustness, accuracy, and efficiency of point-to-point and point-to-plane ICP by using four datasets. We first analyze the effective ranges of the two ICP algorithms with respect to overlap ratio, angle, and distance and then propose a universal effective range for the three factors. Next, the effect of Gaussian noise on the validity and accuracy of two ICPs is evaluated. We also analyze the factors influencing ICP accuracy and explain their changing rules. We finally study the effect of different parameters on the efficiency. All results are compared by using point-to-point and point-to-plane ICP algorithms. The results show that the overlap ratio has no effect on validity, but it has a significant influence on accuracy. The angle has a great impact on the validity and efficiency of ICP but has no effect on accuracy. The distance only affects validity, has a limited effect on efficiency and no effect on accuracy. Meanwhile, Gaussian noise has a little effect on the validity. In addition, the general effective range of point-to-point ICP is larger than that of point-to-plane ICP, but the point-to-plane ICP algorithm presents a better efficiency. The point-to-point ICP is more robust to Gaussian noise with respect to validity, while the point-to-plane is more resistant in terms of accuracy.

Differential LiDAR (Light Detection and Ranging) from repeated surveys has recently emerged as an effective tool to measure three-dimensional (3D) change for applications, such as quantifying slip and spatially distributed warping associated with earthquake ruptures, and examining the spatial distribution of beach erosion after hurricane impact. Currently, the primary method for determining 3D change from LiDAR is through the use of the iterative closest point (ICP) algorithm and its variants. However, all current studies using ICP have assumed that all LiDAR points in the compared point clouds have uniform accuracy. This assumption is simplistic given that the error for each LiDAR point is variable, and dependent upon time varying factors such as target range, angle of incidence, and aircraft trajectory accuracy. Therefore, to rigorously determine spatial change, it would be ideal to model the random error for every LiDAR observation in the differential point cloud, and use these error estimates as apriori weights in the ICP algorithm. To test this approach, we implemented a rigorous LiDAR observation error propagation method to generate estimated random error for each point in a LiDAR point cloud, and then determine 3D displacements between two point clouds using an anisotropic weighted ICP (A-ICP) algorithm. The algorithm was evaluated by qualitatively and quantitatively comparing point clouds with synthetic fault ruptures between a uniform weight and anistropically weighted ICP algorithm. Then post-earthquake slip is estimated for the 2010 El Mayor-Cucapah Earthquake (EMC), using pre- and post-event LiDAR. Based on the analysis, Moving Window A-ICP is able to better estimate the synthetic surface ruptures, and provides a smoother estimate of actual displacement for the EMC earthquake.

Bin picking is an important task in smart manufacturing and intelligent robotics. For a robot to pick or grip an object with a human-like gripping action, it needs to know the accurate 3D pose of the object. In this paper, we propose a method for estimating the 3D pose of a small ring-shaped object using infrared and depth images generated by a depth camera. The proposed method consists of two algorithm modules, the first to recognize an object in a 2D infrared image and the second to estimate the 3D pose by applying the ICP (iterative closest point) algorithm to 3D depth data. In the first module, we propose a method to generate a three-channel integrated image with features from the depth and infrared images. Next, we introduce a method for training an object detector based on deep-learning. Because the bin-picking test object in this paper is small and ring-shaped, it is difficult to detect and find 3D poses of individual objects when many such objects are piled up. We solved this problem with a depth-based filtering method. Using the filtered image, each object region is separated by the deep learning approach. In the second module, the ICP algorithm is employed to estimate the 3D pose of the ring object. We match a 3D reference model of the object and the real object using the point-to-point ICP algorithm. Performance of the proposed method is evaluated by using two different types of depth camera in the experiments.

A bounded iterative closest point method for minimally invasive registration of the femur

Affine iterative closest point algorithm for point set registration

Nearest neighbor search algorithms have been successful in finding practically useful solutions to computationally difficult problems. In the nearest neighbor search problem, the brute force approach is often more efficient than other algorithms for high-dimensional spaces. A special case exists for objects represented as sparse vectors, where algorithms take advantage of the fact that an object has a zero value for most features. In general, since exact nearest neighbor search methods suffer from the “curse of dimensionality,” many practitioners use approximate nearest neighbor search algorithms when faced with high dimensionality or large datasets. To a reasonable degree, it is known that relying on approximate nearest neighbors leads to some error in the solutions to the underlying data mining problems the neighbors are used to solve. However, no one has attempted to quantify this error or provide practitioners with guidance in choosing appropriate search methods for their task. In this thesis, we conduct several experiments on recommender systems with a goal to find the degree to which approximate nearest neighbor algorithms are subject to these types of error propagation problems. Additionally, we provide persuasive evidence on the trade-off between search performance and analytics effectiveness. Our experimental evaluation demonstrates that a state-of-the-art approximate nearest neighbor search method (L2KNNGApprox) is not an effective solution in most cases. When tuned to achieve high search recall (80% or higher), it provides a fairly competitive recommendation performance compared to an efficient exact search method but offers no advantage in terms of efficiency (0.1x—1.5x speedup). Low search recall (<60%) leads to poor recommendation performance. Finally, medium recall values (60%—80%) lead to reasonable recommendation performance but are hard to achieve and offer only a modest gain in efficiency (1.5x—2.3x).

The accuracy of the iterative closest point (ICP) algorithm, which is widely employed in image registration, depends on the complexity of the shape of the object under registration. Objects with complex features yield higher reliability in estimating registration parameters. For objects with rotation symmetry, a cylinder for example, rotation along the center axis can not be distinguished. We derive the sensitivity of the rotation error of the ICP algorithm from the curvature of the error function near the minimum error position. We approximate the defined error function to a second order polynomial and show that the coefficient of the second-order term is related to the reliability of the estimated rotation angle. Also the coefficient is related to the shape of the object. In the known correspondence case, the reliability can be expressed by the second moment of the input image. Finally, we apply the sensitivity formula to a simple synthetic object and ellipses, and verify that the predicted orientation variance of the ICP algorithm is in good agreement with computer simulations.

Image registration is an important problem and a fundamental task for understanding the internal organ or internal structure of human body, analyzing the temporal change from the image sets which is obtained different time series in computer vision and image processing field. Especially, CT and MR imaging of the head for diagnosis and surgical planning indicate that physicians and surgeons gain important information from these modalities. In radiotherapy planning, manual registration techniques are performed on MR and CT images of the brain. In general, physicians segment the volumes of interest (VOIs) from each set of slices on the MR and CT images manually. However, manual registration of the object area may require several hours for analysis based on anatomical knowledge. In this paper, to register two images which are obtained from different modalities we develop a new method for automatic registration of the head CT and MR images by using ICP (iterative closest point) algorithm in several extracted data and maximization of mutual information. One of the benefits of using the ICP algorithm is that computational costs can be reduced on the registration. The primary objective of this study is to increase the registration accuracy and reduce the computational processing time. The technique was applied to five real image sets which are obtained from the two different modalities and the satisfactory results are obtained. Some experimental results are shown with discussion.

Shape registration plays an important role in applications such as 3D object modeling or object recognition. The iterative closest point (ICP) algorithm is widely used for the registration of geometric data. One of its main drawback is its time complexity O(N2), quadratic with the shape size N, which implies long processing time, especially when using high resolution data. Several methods were proposed to accelerate the process. One of the most effective one uses a tree search (k-D tree) to establish closest point relationships and reduces the complexity to O(N logN). This paper reviews several of the existing methods and proposes and analyses a new, even less complex ICP algorithm, that uses a heuristic approach to find the closest points. Based on a local search it permits to reduce the complexity to O(N) and to greatly accelerate the process. A comprehensive analysis and a comparison of the considered algorithm with a tree search method are presented.

The problem of aligning of 3D point data is the known registration task. The most popular registration algorithm is the Iterative Closest Point (ICP) algorithm. The traditional ICP algorithm is a fast and accurate approach for rigid registration between two point clouds but it is unable to handle affine case. Recently, extension of the ICP algorithm for composition of scaling, rotation, and translation is proposed. A generalized ICP version for an arbitrary affine transformation is also suggested. In this paper, a new iterative algorithm for registration of point clouds based on the point-to-plane ICP algorithm with affine transformations is proposed. At each iteration, a closed-form solution to the affine transformation is derived. This approach allows us to get a precise solution for transformations such as rotation, translation, and scaling. With the help of computer simulation, the proposed algorithm is compared with common registration algorithms.

The traditional affine iterative closest point (ICP) algorithm is fast and accurate for affine registration between two point sets, but it is easy to fall into local minimum. This paper proposes a robust Affine ICP algorithm based on corner points. First, an objective function is established under the guidance of corner points, where the corner points as the shape control point guides the affine registration of 2D point sets. Then, at each step of the algorithm, the affine transformation obtained by the last iterative step is used to establish the correspondence of these two point sets. Next, the new affine transformation is solved by using the objective function under the guidance of the corner points. Experimental results demonstrate that the robustness and convergence of our algorithm are greatly improved compared with the traditional affine registration algorithm.

Exploiting lower bounds to accelerate approximate nearest neighbor search on high-dimensional data

This paper presents a fast Nearest Neighbor Search (NNS) algorithm for geometric data sets, based on a modified k-d tree using the cache technique. First, the tree-based search process of our algorithm starts from an appropriate (cached) leaf node, not from the root node. Initial search space is restricted within small limit around the leaf node and the recursive depth-first tentative search is excluded. Therefore, the length of the node traversal path can be shortened. Second, we developed several techniques of what and how information is cached and reused. The indexing sequence of data can be good information, as well as the data itself. Generally speaking, data are stored in consecutive order. So the indexing data can be similar to (i) the previous indexing data , (ii) the same indexing data in another data set, and (iii) even the NNS result of the previous iteration in the Iterative Closest Point algorithm. Furthermore, we introduce a new method to apply the proposed search algorithm to even randomly sequenced data. We evaluated the algorithm with three kinds of data set (LIDAR, Kinect, and randomly generated data), and the results show that the proposed algorithm is about five times faster than the conventional approximated NNS algorithm using k-d tree.

Airborne light detection and ranging (LiDAR) data are increasingly used in various fields such as topographic mapping, urban planning, and emergency management. A necessary processing step in the application of airborne LiDAR data is the elimination of mismatch errors. This paper proposes a new method for airborne LiDAR strip adjustment based on point clouds with planar neighborhoods; this method is intended to eliminate errors in airborne LiDAR point clouds. Initially, standard pre-processing tasks such as denoising, ground separation, and resampling are performed on the airborne LiDAR point clouds. Subsequently, this paper introduces a unique approach to extract point clouds with planar neighborhoods which is designed to enhance the registration accuracy of the iterative closest point (ICP) algorithm within the context of airborne LiDAR point clouds. Following the registration of the point clouds using the ICP algorithm, tie points are extracted via a point-to-plane projection method. Finally, a strip adjustment calculation is executed using the extracted tie points, in accordance with the strip adjustment equation for airborne LiDAR point clouds that was derived in this study. Three sets of airborne LiDAR point cloud data were utilized in the experiment outlined in this paper. The results indicate that the proposed strip adjustment method can effectively eliminate mismatch errors in airborne LiDAR point clouds, achieving a registration accuracy and absolute accuracy of 0.05 m. Furthermore, this method’s processing efficiency was more than five times higher than that of traditional methods such as ICP and LS3D.