A closed form solution for estimating the accuracy of pose transformation of depth camera is proposed. In general, relative pose is represented by 6 DoF (degree of freedom) vector T=[x, y, z, α, β, γ]. The covariance matrix of T is used to measure the accuracy of the relative pose. An implicit function from the three dimensional point pairs to the relative pose is defined, and then implicit theorem is employed to compute the partial derivatives of the function with respect to such point pairs, after that the covariance matrix is computed from both the changing trend of the implicit function and the measuring error of depth camera. In order to compute covariance matrix accurately, 3D point pairs must be correctly matched, so an effective algorithm is also proposed to match 3D point pairs given the relative pose. This algorithm makes full use of the advantageous property of depth camera that both depth information and intensity information are returned after one exposure. At last, the effectiveness of the method for estimating the accuracy is validated based on both random synthetic and real data sets.
[1] Belter D, Skrzypczynski P. Rough terrain mapping and classification for foothold selection in a walking robot[J]. Journal of Field Robot, 2011, 28(4): 497-528. [2] Przemyslaw L, Dawid R, Piotr S. Terrain map building for a walking robot equipped with an active 2D range sensor[J]. Journal of Automation, Mobile Robotics & Intelligent Systems, 2011, 5(3): 67-78.[3] Clemente L A, Davison A J, Reid I D, et al. Mapping large loops with a single hand-held camera[C]//Robotics: Science and Systems Conference. Atlanta, USA: MIT Press, 2007: 1-8.[4] Stelzer A, Hirschmueller H, Goerner M. Stereo-vision-based navigation of a six-legged walking robot in unknown rough terrain[J]. International Journal of Robotics Research, 2012, 31(4suppl.): 381-402.[5] Konolige K, Agrawal M, Bolles R C, et al. Outdoor mapping and navigation using stereovision[M]//Springer Transactions in Advanced Robotics, vol.39. Berlin, Germany: Springer-Verlag, 2008: 179-190.[6] May S, Droschel D, Holz D, et al. Three-dimensional mapping with time-of-flight cameras[J]. Journal of Field Robotics, 2009, 26(11/12): 934-965.[7] Henry P, Krainin M, Herbst E, et al. RGB-D mapping: Using Kinect-style depth cameras for dense 3D modeling of indoor environments[J]. International Journal of Robotics Research, 2012, 31(5): 647-663. [8] Foix S, Alenya G, Andrade-Cetto J, et al. Object modeling using a ToF camera under an uncertainty reduction approach[C]//IEEE International Conference of Robotics and Automation. Piscataway, USA: IEEE, 2010: 1306-1312.[9] Horn B K P. Closed-form solution of absolute orientation using unit quaternion[J]. Journal of the Optical Society of America: A, 1987, 4(4): 629-642. [10] Besl P J, McKay N D. A method for registration of 3-D shapes[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 1992, 14(2): 239-256. [11] Censi A. An accurate closed-form estimate of ICP's covariance[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2007: 3167-3172. [12] Bengtsson O, Baerveldt A D. Robot localization based on scanmatching-estimating the covariance matrix for the IDC algorithm[J]. Robotics and Autonomous Systems, 2003, 44(1): 29-40. [13] Biber P, Strasser W. The normal distributions transform: A new approach to laser scan matching[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems, vol.3. Piscataway, USA: IEEE, 2003: 2743-2748. [14] Nieto J, Bailey T, Nebot E. Scan-SLAM: Combining EKFSLAM and scan correlation[C]//Springer Transactions in Advanced Robotics, vol.25. Berlin, Germany: Springer-Verlag, 2006: 167-178. [15] Lowe D. Distinctive image features from scale-invariant keypoints[J]. International Journal of Computer Vision, 2004, 60(2): 91-110. [16] MoréJ J. The Levenberg-Marquardt algorithm: Implementation and theory[M]//Numerical analysis. Berlin, Germany: Springer-Verlag, 1978: 105-116. [17] 蔡自兴.机器人学[M].北京:清华大学出版社,2000.Cai Z X. Robotics[M]. Beijing: Qinghua University Press, 2000. [18] Gamini D M W M, et al. A solution to the simultaneous localization and map building (SLAM) problem[J]. IEEE Transactions on Robotics and Automation, 2001, 17(3): 229-241. [19] Viorela I, Porta J M, Andrade-Cetto J. Information-based compact pose SLAM[J]. IEEE Transactions on Robotics, 2010, 26(1): 78-93.