This paper presents a fault-tolerant method for pose estimation of space objects using 3-D vision data by integration of a Kalman filter (KF) and an Iterative Closest Point (ICP) algorithm in a closed-loop configuration. The initial guess for the internal ICP iteration is provided by state estimate propagation of the Kalman filer. The Kalman filter is capable of not only estimating the target's states, but also its inertial parameters. This allows the motion of target to be predictable as soon as the filter converges. Consequently, the ICP can maintain pose tracking over a wider range of velocity due to increased precision of ICP initialization. Furthermore, incorporation of the target's dynamics model in the estimation process allows the estimator continuously provide pose estimation even when the sensor temporally loses its signal namely due to obstruction. The capabilities of the pose estimation methodology is demonstrated by a ground testbed for Automated Rendezvous & Docking (AR&D). In this experiment, Neptec's Laser Camera System (LCS) is used for real-time scanning of a satellite model attached to a manipulator arm, which is driven by a simulator according to orbital and attitude dynamics. The results showed that robust tracking of the free-floating tumbling satellite can be achieved only if the Kalman filter and ICP are in closed-loop configuration.
Surface registration involving the estimation of a rigid transformation (pose) which aligns a model provided as a triangulated mesh with a set of discrete points (range data) sampled from the actual object is a core task in computer vision. This paper refines and explores the previously introduced notion of Continuum Shape Constraint Analysis (CSCA) which allows the assessment of object shape towards predicting the performance of surface registration algorithms. Conceived for computer-vision assisted spacecraft rendezvous analysis, the approach was developed for blanket or localized scanning by LIDAR or similar range-finding scanner that samples non-specific points from the object across an area. Based on the use of Iterative Closest-Point Algorithm (ICP) for pose estimation, CSCA is applied to a surface-based self-registration cost function which takes into account the direction from which the surface is scanned. The continuum nature of the CSCA formulation generates a registration cost matrix and any derived metrics as pure shape properties of the object. For the context of directional scanning as considered in the paper, these properties also become functions of viewing direction and is directly applicable to the best view problem for LIDAR/ICP pose estimation. This paper introduces the Expectivity Index and uses it to illustrate the ability of the CSCA approach to identify productive views via the expected stability of the global minimum solution. Also demonstrated through the examples, CSCA can be used to produce visual maps of geometric constraint that facilitate human interpretation of the information about the shape. Like the ICP algorithm it supports, the CSCA approach processes shape information without the need for specific feature identification and is applicable to any type of object.
Keywords: Shape analysis; pose estimation; best view; computer vision. 45 Int. J. Shape Model. 2009.15:45-76. Downloaded from www.worldscientific.com by UTRECHT UNIVERSITY on 03/15/15. For personal use only.
scite is a Brooklyn-based organization that helps researchers better discover and understand research articles through Smart Citations–citations that display the context of the citation and describe whether the article provides supporting or contrasting evidence. scite is used by students and researchers from around the world and is funded in part by the National Science Foundation and the National Institute on Drug Abuse of the National Institutes of Health.