A scan restoration method for robust polar scan matching in dynamic environments

Embed Size (px)

Text of A scan restoration method for robust polar scan matching in dynamic environments

  • This article was downloaded by: [University of Kent]On: 10 November 2014, At: 14:01Publisher: Taylor & FrancisInforma Ltd Registered in England and Wales Registered Number: 1072954 Registered office: Mortimer House,37-41 Mortimer Street, London W1T 3JH, UK

    Advanced RoboticsPublication details, including instructions for authors and subscription information:http://www.tandfonline.com/loi/tadr20

    A scan restoration method for robust polar scanmatching in dynamic environmentsSeung-Hee Lee a , Heon-Cheol Lee & Beom-Hee Leea Department of Electrical and Computer Engineering , Seoul National University , 1Gwanak-ro, Gwanak-gu , Seoul , 151-742 , KoreaPublished online: 01 May 2013.

    To cite this article: Seung-Hee Lee , Heon-Cheol Lee & Beom-Hee Lee (2013) A scan restoration method for robust polar scanmatching in dynamic environments, Advanced Robotics, 27:11, 877-891, DOI: 10.1080/01691864.2013.791741

    To link to this article: http://dx.doi.org/10.1080/01691864.2013.791741


    Taylor & Francis makes every effort to ensure the accuracy of all the information (the Content) containedin the publications on our platform. However, Taylor & Francis, our agents, and our licensors make norepresentations or warranties whatsoever as to the accuracy, completeness, or suitability for any purpose of theContent. Any opinions and views expressed in this publication are the opinions and views of the authors, andare not the views of or endorsed by Taylor & Francis. The accuracy of the Content should not be relied upon andshould be independently verified with primary sources of information. Taylor and Francis shall not be liable forany losses, actions, claims, proceedings, demands, costs, expenses, damages, and other liabilities whatsoeveror howsoever caused arising directly or indirectly in connection with, in relation to or arising out of the use ofthe Content.

    This article may be used for research, teaching, and private study purposes. Any substantial or systematicreproduction, redistribution, reselling, loan, sub-licensing, systematic supply, or distribution in anyform to anyone is expressly forbidden. Terms & Conditions of access and use can be found at http://www.tandfonline.com/page/terms-and-conditions



    A scan restoration method for robust polar scan matching in dynamic environments

    Seung-Hee Lee, Heon-Cheol Lee* and Beom-Hee Lee

    Department of Electrical and Computer Engineering, Seoul National University, 1 Gwanak-ro, Gwanak-gu, Seoul 151-742, Korea

    (Received 13 June 2012; accepted 18 August 2012)

    This paper addresses the problem of scan matching which is highly indispensable for mobile robot systems based onrange sensors. Recently, polar scan matching (PSM) has been used in solving the problem because it is accurate and fastenough to be performed in real time. However, the performance of PSM degenerates when the portion of scan data fromdynamic objects is excessively large. This paper proposes a scan restoration method to overcome this problem andimprove the performance of PSM in dynamic environments. The proposed method restores the scan data from dynamicobjects to appropriate scan data from static objects. First, whole scan data is segmented and classified as static anddynamic objects. Next, curvature functions are extracted from the classified segments and smoothed by interpolating thesegments indicating dynamic obstacles. PSM with the proposed method was tested and evaluated in various real dynamicenvironments, which reveals that the proposed method can improve the performance of PSM in dynamic environments.

    Keywords: polar scan matching; curvature function; interpolation; scan restoration method

    1. Introduction

    Laser scan matching is a key technique for the localiza-tion of mobile robots by matching two laser scan dataobtained from a mobile robot with a laser range finder(LRF). The basic concept of laser scan matchinginvolves estimating the differences in mobile robot posesbetween two times when two laser scan data wereobtained. There are three categories of laser scan match-ing techniques according to the concept of data associa-tion. First, point-to-point matching is a methodology thatfinds corresponding points between two laser scan dataand matches scan data with these points. One such tech-nique is called iterative closest point (ICP),[1] whichiteratively finds corresponding points of laser scan databy searching the minimum Euclidean distance betweenthe scan points of another laser scan data. Similarly, Luet al. [2] suggested another way called iterative matchingrange point (IMRP) that finds the corresponding pointsby introducing a matching range based on the LaserRange Finder (LRF) coordinate system at a certain time.They also proposed iterative dual correspondence (IDC)which simultaneously uses both ICP and IMRP. Otherscan matching techniques are based on point-to-featurematching. Here the features indicate lines, curves, orrange extrema that are extracted from scan data. Cox [3]proposed one of the point-to-feature scan matching tech-niques that extracts features by calculating the Gaussianmean and variance of each scan point that belongs to the

    grid map segments. Cox then matched the scan pointswith the extracted features. Finally, a feature-to-featurematching technique matches the features extracted fromtwo scan data.[4] Weiss et al. [5] proposed the histo-grams of scan data as the features. They suggested away to match two scan data by calculating the phase thatmaximizes a cross-correlation between two histograms.

    Generally, the conventional point-to-feature or fea-ture-to-feature laser scan matching techniques are notappropriate to be used in real-time localization of amobile robot because they have to compare all of thepre-learned features with the scan data in every matchingprocess, causing a heavy computational load. Point-to-point scan matching techniques should be used in thiscase. Diosi et al. [6,7] proposed another point-to-pointscan matching technique, polar scan matching (PSM),which matches the range values of LRF bearingsbetween two scan data in the polar coordinate systeminstead of finding corresponding scan points in the Carte-sian coordinate system. PSM projects one scan data toanother scan data and resamples the projected scan datato rearrange the scan points in the same LRF bearings.The computational load of PSM is much less than thatof ICP or IDC. Also, as previously shown,[6,7] PSMcan reject occlusions by segmenting the scan data.

    Although PSM can perform scan matching despiteocclusion, it fails to perform matching when there aremore than two dynamic obstacles, a problem that causes

    *Corresponding author. Email: restore98@snu.ac.kr

    Advanced Robotics, 2013Vol. 27, No. 11, 877891, http://dx.doi.org/10.1080/01691864.2013.791741

    2013 Taylor & Francis and The Robotics Society of Japan




    by [



    ity o

    f K


    at 1





    r 20


  • the limitation of robots not being able to appropriatelyperform tasks in dynamic environments. In the future,such robots will coexist with people and other robots, sothe robotics technologies that are working robustly indynamic environments should be developed. This paperproposes an approach that can overcome this limitation,called the scan restoration method, which makes scanpoints that indicate dynamic obstacles or occlusions tobe restored to nearby static obstacles like walls or corri-dors. This method segments the scan data not just bycalculating the Euclidean distance between two scanpoints suggested in PSM but by considering the nearbyenvironmental structure and noise of the LRF using anadaptive breakpoint detector (ABD).[8] After segmenta-tion, restoration targets are chosen by some standards forselection, and curvature functions of scan data are thenextracted based on the Cartesian coordinate system.[9]Curvature functions can be considered as scan data fea-tures, and Nunez et al. [10] suggested a feature-to-featurescan matching algorithm using curvature functions asfeatures. In the proposed method, the curvature values ofthe restoration target are interpolated using nearby curva-ture values of two non-restoration targets. All segmentsof the scan data indicating dynamic obstacles arerestored to static environments using the above pro-cesses, and PSM can perform scan matching robustly inthe dynamic environment using these restored scan data.The main idea of the scan restoration method was origi-nated by Gil et al. [11], who suggested a way to restorethe original shape of a noisy object using curvatureflows. Similarly, scan restoration method considers thelaser scan data as objects that must be restored, andregards dynamic obstacles or occlusions as the noisesources that scatter the original data. Experiments invarious real dynamic environments have shown that theproposed method restored the scan points, indicating sta-tic environments that were hidden by dynamic obstacles,and PSM using these restored scan data estimated thepose difference correctly. Also, the proposed method wasverified as being much faster than the PSM scan match-ing processes.

    This paper is organized as follows. The erroneousscan matching result of PSM in the dynamic environmentis described with an example in Section 2. In Section 3,the way to implement the proposed method is summa-rized. The experimental results are shown in Section 4.And finally, the conclusions a