In this paper, a recursive smoothing spline approach for contour reconstruction is studied and evaluated. Periodic smoothing splines are used by a robot to approximate the contour of encountered obstacles in the environment. The splines are generated through minimizing a cost function subject to constraints imposed by a linear control system and accuracy is improved iteratively using a recursive spline algorithm. The filtering effect of the smoothing splines allows for usage of noisy sensor data and the method is robust with respect to odometry drift. The algorithm is extensively evaluated in simulations for various contours and in experiments using a SICK laser scanner mounted on a PowerBot from ActivMedia Robotics.Keywords: mapping, optimal control, recursive smoothing splines, implementation
D.1 IntroductionToday robots are expected to operate in at least partially unknown, open-ended environments, detecting and moving around obstacles, building maps of the environment and localizing their position. The area of autonomous mapping has during the past few years matured and there has been a significant amount of work reported using both visual and laser sensors, [8], [26]. However, most methods are still concerned with detecting and maintaining a dense set of discrete features of the environment that are suitable for navigation and localization without retrieving any specific knowledge about the detailed shape of the encountered objects.In this paper, we consider the problem of estimating representations of objects using a type of continuous closed curves, the recursive periodic smoothing splines. The splines are retrieved from noisy measurements of the true contour. Intended applications include mapping, identification and path planning. It is well known that interpolating splines from noisy measurement data will give a poor result, as the resulting curve will go through every measurement point. Data smoothing has been a classical problem in system and control history [1], [13], [18]. The theory of regular smoothing splines is thoroughly treated in [29] and [30]. It has been further shown in [35] that control theoretic smoothing splines, where the curve is found through minimizing a cost function, act as filters and are better suited for noisy measurements. It is also noted in [27] that smoothing 89