On the use of IMUs in the PnP problem

In this paper the problem of estimating the relative orientation and position between a camera and an object is investigated. It is assumed that both the camera and the object are provided with an Inertial Measurement Unit (IMU) capable of measuring their attitude with respect to the gravity and the earth magnetic vectors. Furthermore, the object is assumed to contain a feature of n points, the position of which is known in the object coordinate frame. An algorithm is proposed, which uses the image provided by the camera and the information provided by the IMUs, to solve the PnP problem, i.e., to estimate the relative pose of the object in the camera reference frame. Two special cases will be studied. The first is the case where all the attitude information given by the IMU is used. In the second case only the measurements provided by inclinometers are used, neglecting those coming from the magnetometers, because they are usually quite noisy. The effectiveness of the proposed algorithms is tested either by numerical simulations and by experimental tests with cameras.

[1]  V. Lepetit,et al.  EPnP: An Accurate O(n) Solution to the PnP Problem , 2009, International Journal of Computer Vision.

[2]  Radu Horaud,et al.  An analytic solution for the perspective 4-point problem , 1989, Proceedings CVPR '89: IEEE Computer Society Conference on Computer Vision and Pattern Recognition.

[3]  Gregory D. Hager,et al.  Fast and Globally Convergent Pose Estimation from Video Images , 2000, IEEE Trans. Pattern Anal. Mach. Intell..

[4]  Toyoaki Nishida,et al.  Evaluation of a method to solve the perspective-two-point problem using a three-axis orientation sensor , 2008, 2008 8th IEEE International Conference on Computer and Information Technology.

[5]  Emanuele Garone,et al.  P3P and P2P problems with known camera and object vertical directions , 2013, 21st Mediterranean Conference on Control and Automation.

[6]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[7]  De Xu,et al.  Human behavior imitation for a robot to play table tennis , 2012, 2012 24th Chinese Control and Decision Conference (CCDC).

[8]  Mongi A. Abidi,et al.  A New Efficient and Direct Solution for Pose Estimation Using Quadrangular Targets: Algorithm and Evaluation , 1995, IEEE Trans. Pattern Anal. Mach. Intell..

[9]  Zuzana Kukelova,et al.  Closed-Form Solutions to Minimal Absolute Pose Problems with Known Vertical Direction , 2010, ACCV.

[10]  Wen-Yan Chang,et al.  On pose recovery for generalized visual sensors , 2004, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[11]  Joseph S.-C. Yuan.  A general photogrammetric method for determining object position and orientation , 1989, IEEE Trans. Robotics Autom..

[12]  Jeffrey C. Lagarias,et al.  Convergence Properties of the Nelder-Mead Simplex Method in Low Dimensions , 1998, SIAM J. Optim..

[13]  De Xu,et al.  High precision pose measurement for humanoid robot based on PnP and OI algorithms , 2010, 2010 IEEE International Conference on Robotics and Biomimetics.

[14]  Peter I. Corke,et al.  Robotics, Vision and Control - Fundamental Algorithms in MATLAB® , 2011, Springer Tracts in Advanced Robotics.

[15]  Long Quan,et al.  Linear N-Point Camera Pose Determination , 1999, IEEE Trans. Pattern Anal. Mach. Intell..

[16]  Emanuele Garone,et al.  On the use of the inclinometers in the PnP problem , 2013, 2013 European Control Conference (ECC).