A Conic Transformation Approach for Solving the Perspective-Three-Point Problem
Haidong Wu Snehal Bhayani Janne Heikkilä · 2025
Read A Conic Transformation Approach for Solving the Perspective-Three-Point Problem by Haidong Wu Snehal Bhayani Janne Heikkilä (2025) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2504-01620.txt.
Introduction
Haidong Wu, Snehal Bhayani, and Janne Heikkilä speed up a camera geometry task in this 2025 paper. The perspective-three-point problem finds a camera's position from three known landmarks. Robots and augmented reality systems solve it many times per second. Standard solvers intersect two curves and work through heavy algebra.
Their trick reshapes the coordinate system so one curve becomes a standard parabola. That change lets one unknown be written directly in terms of the other. The needed arithmetic drops, and only real answers need checking. Wide tests showed faster solving with stability matching the best current methods. Small speed gains matter when the solver runs inside a live tracking loop.
Catalog record
| CREATOR | Haidong Wu Snehal Bhayani Janne Heikkilä |
|---|---|
| YEAR | 2025 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 41 KB |
| VERSION | 1.0 |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2504-01620
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
A Conic Transformation Approach for Solving the Perspective-Three-Point Problem Haidong Wu Snehal Bhayani Janne Heikkilä Abstract We propose a conic transformation method to solve the Perspective-Three-Point (P3P) problem. In contrast to the current state-of-the-art solvers, which formulate the P3P problem by intersecting two conics and constructing a degenerate conic to find the intersection, our approach builds upon a new formulation based on a transformation that maps the two conics to a new coordinate system, where one of the conics becomes a standard parabola in a canonical form. This enables expressing one variable in terms of the other variable, and as a consequence, substantially simplifies the problem of finding the conic intersection. Moreover, the polynomial coefficients are fast to compute, and we only need to determine the real-valued intersection points, which avoids the requirement of using computationally expensive complex arithmetic. While the current state-of-the-art methods reduce the conic intersection problem to solving a univariate cubic equation, our approach, despite resulting in a quartic equation, is still faster thanks to this new simplified formulation. Extensive evaluations demonstrate that our method achieves higher speed while maintaining robustness and stability comparable to state-of-the-art methods. 1 Introduction The Perspective-Three-Point (P3P) problem ( Fig. 1 ) is a fundamental problem in geometric computer vision, which involves recovering the relative pose (including rotation and translation) between the camera and world coordinate systems from three pairs of 3D points and their corresponding 2D projections on the image plane. Solutions to this problem are widely applied in fields such as augmented reality [ 15 ] , visual SLAM [ 18 ] , photogrammetry [ 22 ] , and robotics [ 1 ] . The P3P problem has a long history of development. In 1841, Grunert [ 9 ] first demonstrated that the P3P problem can yield up to four feasible solutions. Since then, numerous methods have been introduced, with a selection [ 9 , 5 , 17 , 6 , 13 , 8 ] , reviewed and compared by Haralick et al. [ 10 ] in terms of numerical accuracy. Gao et al. [ 7 ] applied Wu-Ritt’s zero decomposition algorithm [ 21 ] to achieve the first complete triangular decomposition of the P3P equation system, resulting in the first fully analytical solution to the P3P problem. Kneip et al. [ 12 ] and Masselli and Zell [ 16 ] introduced a novel approach to solving the P3P problem by directly computing the absolute position and orientation of the camera, avoiding the computation of features’ distances. Ke et al. [ 11 ] directly determined the camera’s orientation by applying geometric constraints to construct a system of trigonometric equations. Banno [ 2 ] proposed a method to represent the rotation matrix as a function of the distances and Nakano et al. [ 19 ] extended this approach with a simplified derivation that can be expressed in closed form. These methods [ 7 , 12 , 11 , 2 , 19 ] reduce the P3P problem to solving a quartic equation. Additionally, the P3P problem has also been simplified to solving a cubic equation in some approaches. Persson and Nordberg [ 20 ] proposed a method for solving the P3P problem by finding the single real root of a cubic equation, demonstrating significant effectiveness. Ding et al. [ 4 ] formulated the P3P problem as finding the intersection of two conics and solved it by determining the single real root of a cubic equation to construct a degenerate conic represented by two lines. To the best of our knowledge, the solver by Ding et al. [ 4 ] achieves better numerical stability and higher speed compared to previous works. In this paper, we address the P3P problem by deriving and solving a quartic equation. Following a similar strategy as in [ 4 , 20 ] , we first formulate the P3P problem as finding the intersections of two conics. Specifically, the contributions are: 1. We propose a conic transformation that maps the two conics to a new coordinate system, where one of the conics becomes a standard parabola in a canonical form. The intersection of two conics in the new coordinate system is determined by the roots of a quartic equation, with coefficients that can be easily computed. 2. We propose a strategy to reduce the computational cost by determining the real transformation matrix and solving for the real roots of the quartic equation. 3. Extensive experiments demonstrate that our method achieves superior speed compared to state-of-the-art methods while maintaining comparable numerical stability and accuracy. 2 Problem Figure 1 : The perspective-three-point problem For a pinhole camera model, consider three 3D points \mathbf{X}_{i}=\left(x_{i},y_{i},z_{i}\right),i\in\{1,2,3\} in the world coordinate system, as shown in the Fig. 1 . Their projection points on the normalized image plane are represented as \mathbf{y}_{i}=\left(u_{i},v_{i},1\right),i\in\{1,2,3\} . The coordinates of \mathbf{y}_{i} , after being normalized to have a unit norm, are represented as \mathbf{m}_{i}\in\mathbb{R}^{3} , with \left|\mathbf{m}_{i}\right|=1,i\in\{1,2,3\} . The rigid transformation between these corresponding sets of points, \mathbf{X}_{i} and \mathbf{m}_{i} , are as follows: \displaystyle d_{i}\mathbf{m}_{i}=\mathbf{R}\mathbf{X}_{i}+\mathbf{t}, (1) where d_{i}\in\mathbb{R}^{+},d_{i}=\left|\mathbf{O}_{c}\mathbf{X}_{i}\right|,i\in\{1,2,3\} , a positive real number, represents the distance from the 3D point \mathbf{X}_{i} to the camera center \mathbf{O}_{c} ; \mathbf{R}\in SO(3) represents the rotation; and \mathbf{t}\in\mathbb{R}^{3} represents the translation, \mathbf{R} and \mathbf{t} together define the pose of the camera. Following a similar strategy as in [ 4 , 20 ] , we first derive the equations to formulate the P3P problem as finding the intersection of two conics. Before recovering \mathbf{R} and \mathbf{t} , we first calculate d_{i} by taking pairwise differences of the three equations in ( 1 ) and then square both sides of each resulting equation to eliminate \mathbf{R} and \mathbf{t} . Consequently, we derive the following equations: \displaystyle d_{i}\mathbf{m}_{i}-d_{j}\mathbf{m}_{j}=\mathbf{R}\mathbf{X}_{i}-\mathbf{R}\mathbf{X}_{j},\Rightarrow (2) \displaystyle\left|d_{i}\mathbf{m}_{i}-d_{j}\mathbf{m}_{j}\right|^{2}=\left|\mathbf{R}\mathbf{X}_{i}-\mathbf{R}\mathbf{X}_{j}\right|^{2},\Rightarrow \displaystyle d_{i}^{2}-2d_{i}d_{j}\mathbf{m}_{i}^{\top}\mathbf{m}_{j}+d_{j}^{2}=\left|\mathbf{X}_{i}-\mathbf{X}_{j}\right|^{2}, where \left|\mathbf{m}_{i}\right|=1 , which implies that \mathbf{m}_{i}^{T}\mathbf{m}_{i}=1 . Similarly, for \mathbf{m}_{j} , it is also confirmed that \mathbf{m}_{j}^{T}\mathbf{m}_{j}=1 . We can express the three equations in ( 2 ) as: \displaystyle d_{1}^{2}-2d_{1}d_{2}\mathbf{m}_{1}^{\top}\mathbf{m}_{2}+d_{2}^{2}=\left|\mathbf{X}_{1}-\mathbf{X}_{2}\right|^{2}, (3) \displaystyle d_{1}^{2}-2d_{1}d_{3}\mathbf{m}_{1}^{\top}\mathbf{m}_{3}+d_{3}^{2}=\left|\mathbf{X}_{1}-\mathbf{X}_{3}\right|^{2}, \displaystyle d_{2}^{2}-2d_{2}d_{3}\mathbf{m}_{2}^{\top}\mathbf{m}_{3}+d_{3}^{2}=\left|\mathbf{X}_{2}-\mathbf{X}_{3}\right|^{2}. We solve the above system of equations by the following change of variables: \displaystyle x=d_{1}/d_{3},\ y=d_{2}/d_{3}, (4) where d_{1} , d_{2} , and d_{3} are positive real numbers, making x and y positive real values. We then replace d_{1} , d_{2} , and d_{3} in ( 3 ) with x and y by dividing the first two equations by the third equation, which yields two quadratic equations in the variables x and y : \displaystyle x^{2}-2m_{12}xy+(1-a)y^{2}+2am_{23}y-a \displaystyle=0, (5) \displaystyle x^{2}-by^{2}-2m_{13}x+2bm_{23}y+1-b \displaystyle=0, (6) where \displaystyle a=\left|\mathbf{X}_{1}-\mathbf{X}_{2}\right|^{2}/\left|\mathbf{X}_{2}-\mathbf{X}_{3}\right|^{2}, (7) \displaystyle b=\left|\mathbf{X}_{1}-\mathbf{X}_{3}\right|^{2}/\left|\mathbf{X}_{2}-\mathbf{X}_{3}\right|^{2}, \displaystyle m_{12}=\mathbf{m}_{1}^{\top}\mathbf{m}_{2},m_{13}=\mathbf{m}_{1}^{\top}\mathbf{m}_{3},m_{23}=\mathbf{m}_{2}^{\top}\mathbf{m}_{3}. Our next step is to find the positive real solutions of the two quadratic equations, which correspond to the intersection points of two conics in the positive real domain. These solutions will subsequently be used to determine the values of d_{i} . Once the values of d_{i} have been obtained, we will proceed to compute the rotation matrix \mathbf{R} and the translation vector \mathbf{t} . 3 Our method Using homogeneous coordinates, the two quadratic equations ( 5 ) and ( 6 ) can be reformulated as the following matrix representations \displaystyle{{\mathbf{x}}^{T}}{\mathbf{C}_{1}\mathbf{x}}=0, (8) \displaystyle{{\mathbf{x}}^{T}}{\mathbf{C}_{2}\mathbf{x}}=0, (9) where \mathbf{x}=\left[\begin{array}[]{@{}c@{}}x,y,1\end{array}\right]^{T} , and the matrices \mathbf{C}_{1} and \mathbf{C}_{2} are defined as \displaystyle\mathbf{C}_{1}\propto\left[\begin{array}[]{@{}ccc@{}}1&-m_{12}&0\\ -m_{12}&1-a&am_{23}\\ 0&am_{23}&-a\end{array}\right], (10) \displaystyle\mathbf{C}_{2}\propto\left[\begin{array}[]{@{}ccc@{}}1&0&-m_{13}\\ 0&-b&bm_{23}\\ -m_{13}&bm_{23}&1-b\end{array}\right]. We follow a similar