A Convex and Global Solution for the P$n$P Problem in 2D Forward-Looking Sonar
Fuente:
arXiv
Gespeichert in:
| Hauptverfasser: | , , , , , , , |
|---|---|
| Format: | Preprint |
| Veröffentlicht: |
2025
|
| Schlagworte: | |
| Online-Zugang: | |
| Tags: |
Tag hinzufügen
Keine Tags, Fügen Sie den ersten Tag hinzu!
|
| _version_ | 1866917981753180160 |
|---|---|
| author | Su, Jiayi Qian, Jingyu Yang, Liuqing Yuan, Yufan Fu, Yanbing Wu, Jie Wei, Yan Qu, Fengzhong |
| author_facet | Su, Jiayi Qian, Jingyu Yang, Liuqing Yuan, Yufan Fu, Yanbing Wu, Jie Wei, Yan Qu, Fengzhong |
| contents | The perspective-$n$-point (P$n$P) problem is important for robotic pose estimation. It is well studied for optical cameras, but research is lacking for 2D forward-looking sonar (FLS) in underwater scenarios due to the vastly different imaging principles. In this paper, we demonstrate that, despite the nonlinearity inherent in sonar image formation, the P$n$P problem for 2D FLS can still be effectively addressed within a point-to-line (PtL) 3D registration paradigm through orthographic approximation. The registration is then resolved by a duality-based optimal solver, ensuring the global optimality. For coplanar cases, a null space analysis is conducted to retrieve the solutions from the dual formulation, enabling the methods to be applied to more general cases. Extensive simulations have been conducted to systematically evaluate the performance under different settings. Compared to non-reprojection-optimized state-of-the-art (SOTA) methods, the proposed approach achieves significantly higher precision. When both methods are optimized, ours demonstrates comparable or slightly superior precision. |
| format | Preprint |
| id |
arxiv_https___arxiv_org_abs_2504_04445 |
| institution | arXiv |
| publishDate | 2025 |
| record_format | arxiv |
| spellingShingle | A Convex and Global Solution for the P$n$P Problem in 2D Forward-Looking Sonar Su, Jiayi Qian, Jingyu Yang, Liuqing Yuan, Yufan Fu, Yanbing Wu, Jie Wei, Yan Qu, Fengzhong Robotics The perspective-$n$-point (P$n$P) problem is important for robotic pose estimation. It is well studied for optical cameras, but research is lacking for 2D forward-looking sonar (FLS) in underwater scenarios due to the vastly different imaging principles. In this paper, we demonstrate that, despite the nonlinearity inherent in sonar image formation, the P$n$P problem for 2D FLS can still be effectively addressed within a point-to-line (PtL) 3D registration paradigm through orthographic approximation. The registration is then resolved by a duality-based optimal solver, ensuring the global optimality. For coplanar cases, a null space analysis is conducted to retrieve the solutions from the dual formulation, enabling the methods to be applied to more general cases. Extensive simulations have been conducted to systematically evaluate the performance under different settings. Compared to non-reprojection-optimized state-of-the-art (SOTA) methods, the proposed approach achieves significantly higher precision. When both methods are optimized, ours demonstrates comparable or slightly superior precision. |
| title | A Convex and Global Solution for the P$n$P Problem in 2D Forward-Looking Sonar |
| topic | Robotics |
| url | https://arxiv.org/abs/2504.04445 |