利索能及
我要发布
收藏
专利号: 202011195953X
申请人: 杭州海康威视数字技术股份有限公司
专利类型:发明专利
专利状态:已下证
更新日期:2026-08-04
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种相机外参标定方法,其特征在于,应用于相机外参标定系统中的处理机设备,所述相机外参标定系统还包括定位设备及至少三个参考点,所述方法包括:获取各所述参考点在世界坐标系下的坐标,得到各所述参考点的第一世界坐标;

获取由所述定位设备采集的待标定相机在世界坐标系中的位置,根据所述待标定相机在世界坐标系中的位置确定所述待标定相机的光心在世界坐标系下的坐标,得到第二世界坐标;

获取所述待标定相机在所述第二世界坐标位置处采集的目标图像,其中,所述目标图像中包括各所述参考点;

根据所述第二世界坐标及各所述第一世界坐标,分别确定从所述待标定相机的光心到各所述参考点的向量,得到各第一参考射线向量;

针对每一参考点,根据该参考点在所述目标图像中的坐标以及相机测角函数,确定该参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的水平偏转角及垂直偏转角;

针对每一参考点,根据该参考点对应的水平偏转角及垂直偏转角,确定在所述相机坐标系下从所述待标定相机的光心指向该参考点的方向向量,得到该参考点对应的第二参考射线向量;

根据各所述第二参考射线向量,确定各所述第二参考射线向量与所述待标定相机的光轴方向向量的夹角;

根据各所述夹角及各所述第一参考射线向量,确定世界坐标系下所述待标定相机的光轴方向向量;

根据所述光轴方向向量、至少一参考点的第一世界坐标及在所述目标图像中的坐标,确定所述待标定相机的旋转矩阵及平移矩阵,从而完成所述待标定相机外参的标定,其中,所述相机的外参包括所述旋转矩阵及所述平移矩阵;

其中相机测角函数为:

θv为第k个参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的水平偏转角,θh为第k个参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的垂直偏转角,Γ()为相机测角函数,H及W为相机分辨率, 为水平视场角, 为垂直视场角, 为主点像素坐标,(ui,vj)为Pk对应的像素坐标,Pk为第k个参考点,其中,所述主点像素为所述待标定相机的光心对应的像素;OCPk为待标定相机的光心到第k个参考点的向量。

2.根据权利要求1所述的方法,其特征在于,所述定位设备为超宽带UWB定位设备,所述UWB定位设备包括定位基站及相机标签,所述相机标签设置在所述待标定相机上,所述待标定相机在世界坐标系中的位置通过所述定位基站测量所述相机标签得到。

3.根据权利要求2所述的方法,其特征在于,所述参考点为具备预设视觉特征的参考点标签,所述参考点标签用于与所述定位设备的定位基站进行测距得到所述参考点在世界坐标系下的坐标;所述获取各所述参考点在世界坐标系下的坐标,得到各所述参考点的第一世界坐标,包括:获取由所述定位基站测量的各所述参考点在世界坐标系下的坐标,得到各所述参考点的第一世界坐标。

4.根据权利要求1所述的方法,其特征在于,所述根据所述光轴方向向量、至少一参考点的第一世界坐标及在所述目标图像中的坐标,确定所述待标定相机的旋转矩阵及平移矩阵,从而完成所述待标定相机外参的标定,包括:根据所述第二世界坐标,对所述世界坐标系进行平移,使得所述世界坐标系的原点与所述待标定相机的光心重合,得到所述待标定相机的惯性坐标系及平移矩阵;

根据所述光轴方向向量,确定所述待标定相机在所述待标定相机的惯性坐标系下的偏航角及俯仰角;

根据至少一参考点在所述目标图像中的坐标及第一世界坐标、所述偏航角、所述俯仰角、所述待标定相机的内参、所述平移矩阵,确定所述待标定相机的翻滚角,从而完成所述待标定相机外参的标定,其中,所述旋转矩阵由所述偏航角、所述俯仰角及所述翻滚角表示。

5.一种相机外参标定系统,其特征在于,所述系统包括:

定位设备、处理机设备及至少三个参考点;

所述定位设备用于获取待标定相机在世界坐标系中的位置;

所述处理机设备用于获取各所述参考点在世界坐标系下的坐标,得到各所述参考点的第一世界坐标;获取由所述定位设备采集的待标定相机在世界坐标系中的位置,根据所述待标定相机在世界坐标系中的位置确定所述待标定相机的光心在世界坐标系下的坐标,得到第二世界坐标;获取所述待标定相机在所述第二世界坐标位置处采集的目标图像,其中,所述目标图像中包括各所述参考点;根据所述第二世界坐标及各所述第一世界坐标,分别确定从所述待标定相机的光心到各所述参考点的向量,得到各第一参考射线向量;针对每一参考点,根据该参考点在所述目标图像中的坐标以及相机测角函数,确定该参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的水平偏转角及垂直偏转角;针对每一参考点,根据该参考点对应的水平偏转角及垂直偏转角,确定在所述相机坐标系下从所述待标定相机的光心指向该参考点的方向向量,得到该参考点对应的第二参考射线向量;根据各所述第二参考射线向量,确定各所述第二参考射线向量与所述待标定相机的光轴方向向量的夹角;根据各所述夹角及各所述第一参考射线向量,确定世界坐标系下所述待标定相机的光轴方向向量;根据所述光轴方向向量、至少一参考点的第一世界坐标及在所述目标图像中的坐标,确定所述待标定相机的旋转矩阵及平移矩阵,从而完成所述待标定相机外参的标定,其中,所述相机的外参包括所述旋转矩阵及所述平移矩阵,其中相机测角函数为: θv为第k个参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的水平偏转角,θh为第k个参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的垂直偏转角,Γ()为相机测角函数,H及W为相机分辨率, 为水平视场角, 为垂直视场角, 为主点像素坐标,(ui,vj)为Pk对应的像素坐标,Pk为第k个参考点,其中,所述主点像素为所述待标定相机的光心对应的像素;OCPk为待标定相机的光心到第k个参考点的向量。

6.根据权利要求5所述的系统,其特征在于,所述定位设备为UWB定位设备,所述UWB定位设备包括定位基站及相机标签,所述相机标签设置在所述待标定相机上,所述定位基站用于测量所述相机标签在世界坐标系中的位置,从而得到所述待标定相机在世界坐标系中的位置。

7.根据权利要求6所述的系统,其特征在于,所述参考点为具备预设视觉特征的参考点标签,所述参考点标签用于与所述定位设备的定位基站进行测距得到所述参考点在世界坐标系下的坐标;所述定位基站还用于:测量各所述参考点在世界坐标系下的坐标,得到各所述参考点的第一世界坐标。

8.根据权利要求5所述的系统,其特征在于,所述处理机设备具体用于:根据所述第二世界坐标,对所述世界坐标系进行平移,使得所述世界坐标系的原点与所述待标定相机的光心重合,得到所述待标定相机的惯性坐标系及平移矩阵;根据所述光轴方向向量,确定所述待标定相机在所述待标定相机的惯性坐标系下的偏航角及俯仰角;根据至少一参考点在所述目标图像中的坐标及第一世界坐标、所述偏航角、所述俯仰角、所述待标定相机的内参、所述平移矩阵,确定所述待标定相机的翻滚角,从而完成所述待标定相机外参的标定,其中,所述旋转矩阵由所述偏航角、所述俯仰角及所述翻滚角表示。

9.一种相机外参标定装置,其特征在于,应用于相机外参标定系统中的处理机设备,所述相机外参标定系统还包括定位设备及至少三个参考点,所述装置包括:第一世界坐标获取模块,用于获取各所述参考点在世界坐标系下的坐标,得到各所述参考点的第一世界坐标;

第二世界坐标获取模块,用于获取由所述定位设备采集的待标定相机在世界坐标系中的位置,根据所述待标定相机在世界坐标系中的位置确定所述待标定相机的光心在世界坐标系下的坐标,得到第二世界坐标;

目标图像获取模块,用于获取所述待标定相机在所述第二世界坐标位置处采集的目标图像,其中,所述目标图像中包括各所述参考点;

相机外参获取模块,用于根据各所述参考点在所述目标图像中的坐标、所述第二世界坐标及各所述第一世界坐标,确定所述待标定相机的旋转矩阵及平移矩阵,从而完成所述待标定相机外参的标定,其中,所述相机的外参包括所述旋转矩阵及所述平移矩阵;

所述相机外参获取模块,包括:

参考向量确定子模块,用于根据所述第二世界坐标及各所述第一世界坐标,分别确定从所述待标定相机的光心到各所述参考点的向量,得到各第一参考射线向量;

光轴向量确定子模块,用于根据各所述参考点在所述目标图像中的坐标及各所述第一参考射线向量,确定所述待标定相机的光轴方向向量;

相机外参确定子模块,用于根据所述光轴方向向量、至少一参考点的第一世界坐标及在所述目标图像中的坐标,确定所述待标定相机的旋转矩阵及平移矩阵,从而完成所述待标定相机外参的标定;

所述光轴向量确定子模块,包括:

偏转角确定单元,用于针对每一参考点,根据该参考点在所述目标图像中的坐标以及相机测角函数,确定该参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的水平偏转角及垂直偏转角;其中相机测角函数为:θv为第k个参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的水平偏转角,θh为第k个参考点对应的第一参考射线向量与所述待标定相机的光轴方向向量的垂直偏转角,Γ()为相机测角函数,H及W为相机分辨率, 为水平视场角, 为垂直视场角,为主点像素坐标,(ui,vj)为Pk对应的像素坐标,Pk为第k个参考点,其中,所述主点像素为所述待标定相机的光心对应的像素;OCPk为待标定相机的光心到第k个参考点的向量;

光轴向量确定单元,用于根据各所述水平偏转角、各所述垂直偏转角及各所述第一参考射线向量,确定所述待标定相机的光轴方向向量;

所述光轴向量确定单元,具体用于:针对每一参考点,根据该参考点对应的水平偏转角及垂直偏转角,确定在所述相机坐标系下从所述待标定相机的光心指向该参考点的方向向量,得到该参考点对应的第二参考射线向量;根据各所述第二参考射线向量,确定各所述第二参考射线向量与所述待标定相机的光轴方向向量的夹角;根据各所述夹角及各所述第一参考射线向量,确定世界坐标系下所述待标定相机的光轴方向向量。