0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
会员中心
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

PnP几何结构和算法原理详解

3D视觉工坊 来源:3D视觉工坊 2022-12-22 09:25 次阅读

PnP(Perspective-n-Point)问题的几何结构如图1所示,给定3D点的坐标、对应2D点坐标以及内参矩阵,求解相机的位姿。

数学语言描述如下:

96fe07e6-8184-11ed-8abf-dac502259ad0.png

971505f4-8184-11ed-8abf-dac502259ad0.png

图1.PnP几何结构

1.直接线性变换法(Direct Linear Transform,DLT)

假设:摄像机已经校准过了。 已知:

973d066c-8184-11ed-8abf-dac502259ad0.png

求解相机的外参:R、t 透视投影模型为:

974a0d26-8184-11ed-8abf-dac502259ad0.png

每组3D-2D匹配点对应两个方程,一共有12个未知数,至少需要6组匹配点。 设有N组匹配点,则:

97761d6c-8184-11ed-8abf-dac502259ad0.png

上式写成矩阵形式: AF=0 当N=6时,可以直接求解线性方程组。

978c75b2-8184-11ed-8abf-dac502259ad0.png

因此, 旋转矩阵, 平移矩阵求得:

97a39972-8184-11ed-8abf-dac502259ad0.png

2.P3P

P3P问题是已知三个3D目标点与其2D投影之间的对应关系,来确定标定相机的位姿问题。

97b3aa9c-8184-11ed-8abf-dac502259ad0.png

97d3e15e-8184-11ed-8abf-dac502259ad0.png

图2.两点约束

97e9b40c-8184-11ed-8abf-dac502259ad0.png

97ff1bc6-8184-11ed-8abf-dac502259ad0.png

注:直接线性变换法,只考虑了线性意义下的最优解,没有考虑几何约束。而P3P考虑了三角约束,给出三角约束意义下的最优解

2.1 Zero Structure for the P3P Equation System

文章[1]:Complete Solution Classification for the Perspective-Three-Point Problem

981c18e8-8184-11ed-8abf-dac502259ad0.png

图3.三点约束 对于公式(16)的变量有一些真实的约束:

983d3b54-8184-11ed-8abf-dac502259ad0.png

985a44a6-8184-11ed-8abf-dac502259ad0.png

图4.三点约束--重定义边长 公式(17)消去C、v,得ES:

9872c990-8184-11ed-8abf-dac502259ad0.png

2.2 PST

文章[2]:A Stable Direct Solution of Perspective-Three-Point Problem 使用相似三角形,利用几何约束来减少未知参数的个数,把P3P方程组转化为四次方程,该称为透视相似三角形方法(Perspective Similar Triangle ,PST)。

(1)P3P问题转为PST问题

988dae36-8184-11ed-8abf-dac502259ad0.png

98a74238-8184-11ed-8abf-dac502259ad0.png

图5.P3P几何结构

(2)PST的求解

98d7b7d8-8184-11ed-8abf-dac502259ad0.png

98f1835c-8184-11ed-8abf-dac502259ad0.png

图6.PST几何结构 约束1:相似三角形对应边成比例

9910c0c8-8184-11ed-8abf-dac502259ad0.png

所以:

992b6144-8184-11ed-8abf-dac502259ad0.png

99509c84-8184-11ed-8abf-dac502259ad0.png

996f9b48-8184-11ed-8abf-dac502259ad0.png

9987af9e-8184-11ed-8abf-dac502259ad0.png

(3)PST多解和缺解问题

由PST(perspective similar Triangle)求解,可得方程组等效转换为四次多项式

99b5fdea-8184-11ed-8abf-dac502259ad0.png

多解问题: 由于存在多组解,相机位姿不能从3点集唯一确定的。解的个数直接对应于四次多项式实根的个数。要得到唯一的解,至少还应引入一点,构建2个三角形,进行求解。另一种方法是RANSAC算法,该算法将点集划分为3个点子集,检查这些子集的一致性。 RANSAC算法参考文献:Random Sample Consensus: A Paradigm for Model Fitting with Apphcatlons to Image Analysis and Automated Cartography 缺解问题:

99ce46a2-8184-11ed-8abf-dac502259ad0.png

缺解问题是由P3P的固有结构决定的,其他P3P方法,如迭代解法、几何解法和分类法,也有同样的问题。

99eda6a0-8184-11ed-8abf-dac502259ad0.png

9a0e8af0-8184-11ed-8abf-dac502259ad0.png

3.RPnP

文章[3]:A Robust O(n) Solution to the Perspective-n-Point Problem

9a2136b4-8184-11ed-8abf-dac502259ad0.png

下面来看一下,如何建立新的正交坐标系,以及如何求解正交坐标系到相机坐标系之间[R T]。

3.1确定旋转轴

9a490f72-8184-11ed-8abf-dac502259ad0.png

9a6d1462-8184-11ed-8abf-dac502259ad0.png

当确定旋转轴时,只需求解剩余的旋转和三个平移参数,减少了未知变量的数量,来提高方程组的数值精度。

3.2求解旋转角和平移矢量的方程

相机坐标系与新坐标系绕之间的旋转矩阵:

9a8b3d34-8184-11ed-8abf-dac502259ad0.png

9ab752a2-8184-11ed-8abf-dac502259ad0.png

其中,

9acebf00-8184-11ed-8abf-dac502259ad0.png

3.3获取相机的位姿

9afb3db4-8184-11ed-8abf-dac502259ad0.png

再获取到相机坐标系与新坐标系绕之间的旋转和平移矩阵,进而可直接相机坐标系与世界坐标系绕之间旋转和平移矩阵,即相机的位姿。

审核编辑:郭婷

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 相机
    +关注

    关注

    4

    文章

    1336

    浏览量

    53430
  • pnp
    pnp
    +关注

    关注

    11

    文章

    295

    浏览量

    51647

原文标题:一文详解PnP算法原理

文章出处:【微信号:3D视觉工坊,微信公众号:3D视觉工坊】欢迎添加关注!文章转载请注明出处。

收藏 人收藏

    评论

    相关推荐

    npn和pnp的判断方法

    在电子电路中,晶体管是一种基本的放大或开关元件。双极型晶体管(BJT)是其中一种常见的类型,它由两个PN结组成,分为NPN和PNP两种类型。 1. 结构和工作原理 在开始判断之前,了解NPN和PNP
    的头像 发表于 10-21 09:20 167次阅读

    PNP传感器的功能和结构

    PNP传感器作为一种基于PN结(由P型半导体和N型半导体组成的结构)的传感器,在工业自动化控制、环境监测、安全监控等多个领域发挥着重要作用。以下将详细阐述PNP传感器的功能和结构,以满
    的头像 发表于 09-13 17:39 410次阅读

    PNP传感器在汽车领域有哪些应用

    PNP传感器是一种基于半导体材料PN结构的电路元件,能够检测物体的存在或运动状态,并将检测到的信号转换为电信号输出给控制器或处理器。在工业自动化、机器人、汽车、家电等领域中,PNP传感器因其高灵敏度、快速响应和高精度等优点而得到
    的头像 发表于 09-13 17:23 360次阅读

    pnp传感器怎么接继电器

    PNP传感器接继电器的方式,主要涉及到PNP传感器的工作原理和继电器的控制功能。以下是一个详细的步骤说明: 一、PNP传感器工作原理 PNP传感器是一种基于半导体材料的PN
    的头像 发表于 09-05 15:25 395次阅读

    二线磁性开关是NpN还是pNp

    二线磁性开关是一种常见的电子元件,广泛应用于各种电子设备中。它主要通过检测磁场的变化来实现对电路的控制。在二线磁性开关中,有两种常见的结构:NPN型和PNP型。 一、二线磁性开关的结构 NPN型二线
    的头像 发表于 08-26 14:30 1306次阅读

    神经网络算法结构有哪些类型

    神经网络算法是深度学习的基础,它们在许多领域都有广泛的应用,如图像识别、自然语言处理、语音识别等。神经网络的结构有很多种类型,每种类型都有其独特的特点和应用场景。以下是对神经网络算法结构
    的头像 发表于 07-03 09:50 367次阅读

    PNP晶体管符号和结构 晶体管测试仪电路图

    PNP晶体管是一种双极性晶体管,用于电子电路中放大、开关和控制电流的器件。与NPN晶体管相对应,PNP晶体管的结构特点在于其三个不同的半导体区域:正极(P型)、负极(N型)、正极(P型)。这种
    的头像 发表于 07-01 17:45 1758次阅读
    <b class='flag-5'>PNP</b>晶体管符号和<b class='flag-5'>结构</b> 晶体管测试仪电路图

    PNP晶体管的工作原理和结构特性

    PNP晶体管是一种三极管,是现代电子技术中不可或缺的电子元件。它由三个半导体区域——两个P型半导体夹着一个N型半导体构成,这种特殊的结构赋予了PNP晶体管独特的电学特性。本文将详细探讨PNP
    的头像 发表于 05-22 16:11 2951次阅读

    接近开关pnp和npn的区别

    接近开关pnp和npn的区别 开关是电子电路中常见的元件,用于控制电流的传递。其中,PNP和NPN开关是最常见的开关类型之一,它们在结构、工作原理和应用方面有一些明显的区别。在本文中,将详尽、详实
    的头像 发表于 01-04 10:25 4959次阅读

    详解从均值滤波到非局部均值滤波算法的原理及实现方式

    将再啰嗦一次,详解从均值滤波到非局部均值滤波算法的原理及实现方式。 细数主要的2D降噪算法,如下图所示,从最基本的均值滤波到相对最好的BM3D降噪,本文将尽量用最同属的语言,详解这些
    的头像 发表于 12-19 16:30 1063次阅读
    <b class='flag-5'>详解</b>从均值滤波到非局部均值滤波<b class='flag-5'>算法</b>的原理及实现方式

    pnp共射极放大电路输出反向吗

    PNP共射极放大电路的输出是反向 的 。 首先,我们要了解PNP共射极放大电路的基本结构和工作原理。PNP共射极放大电路是三极管的一种工作方式,其
    的头像 发表于 12-13 15:12 2747次阅读

    npn和pnp有什么区别?npn和pnp三极管的应用

    的区别在于半导体层的排列和电流的方向。 1.基本结构: NPN晶体管:在NPN晶体管中,有两个P型半导体层夹在中心N型半导体层之间。中间的N型层充当基极,而外部的P型层充当发射极和集电极区域。 PNP晶体管:在PNP晶体管中,有
    的头像 发表于 12-09 15:55 4344次阅读

    详解高密 PCB走线布线的垂直导电结构 (VeCS)

    详解高密 PCB走线布线的垂直导电结构 (VeCS)
    的头像 发表于 11-28 17:00 1476次阅读
    <b class='flag-5'>详解</b>高密 PCB走线布线的垂直导电<b class='flag-5'>结构</b> (VeCS)

    IGBT中的若干PN结—PNP结构(2)

    IGBT中存在如图所示的两个寄生BJT,BJT_1为NPN型,BJT_2为PNP型,我们来看看这两个寄生BJT的电流增益有多大。
    的头像 发表于 11-28 16:58 858次阅读
    IGBT中的若干PN结—<b class='flag-5'>PNP</b><b class='flag-5'>结构</b>(2)

    PID算法详解及实例分析

    PID算法详解及实例分析#include using namespace std;struct _pid{   float SetSpeed; //定义设定值   float ActualSpeed
    发表于 11-09 16:33 1次下载