Home

Caltech
Center for Neuromorphic Systems Engineering

Home
Research
News
People

[back]

Weighted Feature matching Algorithms for Mobile Robot Displacement Estimation
Dr. Joel W. Burdick, Dr. Stergios Roumeliotis, Kristo Kriechbaum, Sam Pfister

Abstract. Sensor based motion planning is an integral part of mobile robotics. It incorporates sensor information, reflecting the current state of the environment, into a robot's planning process, as opposed to classical planning , where full knowledge of the world's geometry is assumed to be known prior to the planning event. Sensor based planning is important because: (1) the robot often has no a priori knowledge of the world; (2) the robot may have only a coarse knowledge of the world because of limited memory; (3) the world model is bound to contain inaccuracies which can be overcome with sensor based planning strategies; and (4) the world is subject to unexpected occurrences or rapidly changing situations.

Motivation. There already exists a large number of classical path planning methods. However, many of these techniques are not amenable to sensor based interpretation. It is not possible to simply add a step to acquire sensory information, and then construct a plan from the acquired model using a classical technique, since the robot needs a path planning strategy in the first place to acquire the world model.

The first principal problem in sensor based motion planning is the find-goal problem. In this problem, the robot seeks to use its on-board sensors to find a collision free path from its current configuration to a goal configuration. In the first variation of the find goal problem, which we term the absolute find-goal problem, the absolute coordinates of the goal configuration are assumed to be known. A second variation on this problem is described below.

The second principal problem in sensor based motion planning is sensor-based exploration, in which a robot is not directed to seek a particular goal in an unknown environment, but is instead directed to explore the apriori unknown environment in such a way as to see all potentially important features. The exploration problem can be motivated by the following application. Imagine that a robot is to explore the interior of a collapsed building, which has crumbled due to an earthquake, in order to search for human survivors. It is clearly impossible to have knowledge of the building's interior geometry prior to the exploration. Thus, the robot must be able to see, with its on-board sensors, all points in the building's interior while following its exploration path. In this way, no potential survivors will be missed by the exploring robot. Algorithms that solve the find-goal problem are not useful for exploration because the location of the ``goal'' (a human survivor in our example) is not known. A second variation on the find-goal problem that is motivated by this scenario and which is an intermediary between the find-goal and exploration problems is the recognizable find-goal problem. In this case, the absolute coordinate of the goal are not known, but it is assumed that the robot can recognize the goal if it becomes with in line of sight. The aim of the recognizable find-goal problem is to explore an unknown environment so as to find a recognizable goal. If the goal is reached before the entire environment is searched, then the search procedure is terminated.

Research. A robot's ability to determine and maintain knowledge of its absolute position is a basic requirement for long term autonomous navigation and operation. Consequently, the subjects of localization and mapping have received considerable attention. Two-dimensional range finders, such as laser range finders or rings of ultrasonic range sensors, are commonly used as a part of many mobile robot localization and mapping procedures. We developed a weighted range sensor matching algorithm to estimate a robot's displacement between the confgurations where range scans are taken. Our algorithm takes into account several important physical phenomena that affect range sensing accuracy, and that have been neglected in prior work. Our experiments show that our algorithm is not only efficient, but more accurate than non-weighted matching methods. Our weighted scan matching algorithms can subsequently form the basis of map making and localization algorithms.

Achievements.

Figure 1. We implemented our weighted scanmatching algorithm on a Nomad 200 mobile robot and a Sick LMS-200 laser range finder as shown in Figure 1. We apply a rigorous model of the sensor error characteristics to weight the comparisons between corresponding points in two laser scans. We then combine these weighted point comparisons to solve for an overall displacement estimate between the scans. Figure 2 shows two scans taken from different poses overlayed in the same reference frame after running our algorithm. The measurement covariances in red show the orientation of the weighting on selected points.



Figure 2

 


Figure 3. shows a five-step robot path superimposed on the acquired range data. Figure 4 plots the total cumulative position estimation error for odometry, an alternate unweighted scanmatch algorithm, and our weighted algorithm. These results suggest a vast improvement in localization over odometry alone and a significant improvement over similar unweighted scanmatching algorithms.

Publications.
Weighted Range Sensor Matching Algorithms for Mobile Robot Displacement Estimation S.T. Pfister, K.L. Kreichbaum, S.I. Roumeliotis, and J.W. Burdick ( submitted ) 2002 IEEE Int. Conf. on Robotics and Automation A g'zipped Postscript version of the paper (207K).



top