CN112330756B - 一种相机标定方法、装置、智能车辆和存储介质 - Google Patents

一种相机标定方法、装置、智能车辆和存储介质 Download PDF

Info

Publication number
CN112330756B
CN112330756B CN202110000597.XA CN202110000597A CN112330756B CN 112330756 B CN112330756 B CN 112330756B CN 202110000597 A CN202110000597 A CN 202110000597A CN 112330756 B CN112330756 B CN 112330756B
Authority
CN
China
Prior art keywords
camera
radar
rotation
sequence
translation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110000597.XA
Other languages
English (en)
Other versions
CN112330756A (zh
Inventor
汪丹
许全优
徐伟健
范国泽
闵锐
莫耀凯
王劲
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianyi Transportation Technology Co.,Ltd.
Original Assignee
Ciic Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Ciic Technology Co ltd filed Critical Ciic Technology Co ltd
Priority to CN202110000597.XA priority Critical patent/CN112330756B/zh
Publication of CN112330756A publication Critical patent/CN112330756A/zh
Application granted granted Critical
Publication of CN112330756B publication Critical patent/CN112330756B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/80Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Studio Devices (AREA)

Abstract

本发明实施例公开了一种相机标定方法、装置、智能车辆和存储介质;可对获取的初始相机位姿变换序列和初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列,再根据第一关联关系,确定第一旋转外参,根据雷达位姿变换序列、相机位姿变换序列、目标相机的尺度因子、第二关联关系和第一旋转外参,确定第二旋转外参、尺度因子和平移参数,根据尺度因子修正相机位姿变换序列,得到修正后相机位姿变换序列,根据雷达位姿变换序列、修正后相机位姿变换序列、第一关联关系和第二关联关系重新计算,得到目标旋转参数和目标平移参数;由此,在相机标定时可以不使用标定板实现相机标定,提升了标定的准确率。

Description

一种相机标定方法、装置、智能车辆和存储介质
技术领域
本发明涉及无人驾驶技术领域,具体涉及一种相机标定方法、装置、智能车辆和存储介质。
背景技术
无人驾驶技术通常包括环境感知、行为决策、运动控制、车辆定位等技术,这些技术需要融合无人驾驶车辆的车载相机和雷达采集到的数据信息来实现,为了对相机采集的数据进行准确的分析,一般需要对相机进行标定,确定其相机参数如相机外参。
目前,在联合雷达获取的数据进行相机标定时,一般需要借助标定板,通过雷达在标定板上扫描到的激光点和与相机拍摄的图像对应的像素点进行匹配,构建重投影误差方程,估计相机的外参信息。这种方式需要手动选取标定板所对应的激光点区域,所以标定相机得到的相机外参会受到人为因素的影响。
发明内容
本发明实施例提供一种相机标定方法、装置、智能车辆和存储介质,可以在无需标定板的情况下确定相机的外参信息,减少了人为因素对标定结果的影响,有利于提升相机外参的准确度。
本发明实施例提供一种相机标定方法,包括:
获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参;
根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数;
根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
相应的,本发明实施例还提供一种相机标定装置,该相机标定装置包括:
序列获取单元,用于获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
时间同步单元,用于对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
第一参数确定单元,用于根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参;
第二参数确定单元,用于根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数;
序列修正单元,用于根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
外参修正单元,用于根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
在一个可选的示例中,所述初始相机位姿变换序列中还包括所述目标相机的旋转变换信息和平移变换信息对应的时间信息,所述初始雷达位姿变换序列中还包括所述目标雷达的旋转变换信息和平移变换信息对应的时间信息;
对应的,所述时间同步单元,用于分别计算所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟;
基于所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟,对所述初始相机位姿序列和所述初始雷达位姿序列的时间信息进行调整;
根据调整后的时间信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行插值计算,得到相机位姿变换序列和雷达位姿变换序列,所述相机位姿变换序列和雷达位姿变换序列中相同序列位置对应的时间信息相同。
在一个可选的示例中,所述时间同步单元包括插值计算子单元,所述插值计算子单元,用于根据调整后的时间信息,确定所述初始相机位姿变换序列中的相机插值点时间信息和所述初始雷达位姿变换序列中的雷达插值点时间信息;
根据所述初始相机位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述相机插值点时间信息对应的旋转变换信息和平移变换信息,按照所述相机插值点时间信息的顺序排列对应的旋转变换信息和平移变换信息,得到相机位姿变换序列;
根据所述初始雷达位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述雷达插值点时间信息对应的旋转变换信息和平移变换信息,按照所述雷达插值点时间信息的顺序排列对应的旋转变换信息和平移变换信息,得到雷达位姿变换序列。
在一个可选的示例中,所述第一关联关系包括所述雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积相等;
对应的,所述第一参数确定单元,用于根据第一关联关系构建雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积之间的第一等式,将所述第一等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到旋转残差关系式;
将所述旋转参数中的所述第二旋转外参作为定量,根据所述旋转残差关系式进行残差计算,得到所述旋转参数中所述目标相机的第一旋转外参。
在一个可选的示例中,所述第二关联关系包括所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积,和所述平移参数之间的差值,等于尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,与所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值;
对应的,所述第二参数确定单元,用于根据所述第二关联关系构建所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积和所述平移参数之间的差值,与尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,和所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值之间的第二等式,将所述第二等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到平移残差关系式;
根据所述平移残差关系式以及确定出的所述第一旋转外参进行残差计算,得到所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数。
在一个可选的示例中,在所述外参修正单元根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数后,相机标定装置还包括参数优化单元,用于根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述旋转残差关系式进行计算,得到旋转残差;
根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述平移残差关系进行计算,得到平移残差;
根据所述旋转残差和所述平移残差,优化所述旋转参数和平移参数对应的矩阵,得到优化后的旋转参数和平移参数。
在一个可选的示例中,所述初始相机位姿变换序列通过相机采集到的图像数据得到,所述初始雷达位姿变换序列通过雷达采集到的点云数据得到;
对应的,所述外参修正单元包括外参修正子单元和外参误差确定单元,所述外参修正子单元,用于根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参;
根据所述第一修正旋转外参、所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第二关联关系,得到修正后旋转参数中的第二修正旋转外参、修正后尺度因子以及修正后平移参数;
所述外参误差确定单元,用于根据所述修正后旋转参数、修正后尺度因子以及修正后平移参数,在所述相机采集到的图像数据和所述雷达采集到的点云数据之间进行投影转换,基于投影转换得到的信息确定投影误差;
当所述投影误差小于预设的投影误差阈值时,将所述修正后旋转参数作为目标旋转参数,将所述修正后平移参数作为目标平移参数;
当所述投影误差不小于所述投影误差阈值时,对所述修正后相机位姿变换序列进行修正,得到新的修正后相机位姿序列,基于新的修正后相机位姿序列重新执行根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参的步骤。
相应的,本发明实施例还提供一种智能车辆,包括处理器、存储器、目标相机以及目标雷达,所述处理器用于执行所述存储器中存储的计算机程序时,实现本发明实施例所提供的任意一种所述的相机标定方法中的步骤。
此外,本发明实施例还提供一种存储介质,所述存储介质有多条指令,所述指令适于处理器进行加载,以执行本发明实施例所提供的任一种相机标定方法中的步骤。
采用本发明实施例的方案,可以获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,该目标相机和目标雷达相对位置不变,该初始相机位姿变换序列包括该目标相机在相机坐标系中的旋转变换信息和平移变换信息,该初始雷达位姿变换序列包括该目标雷达在雷达坐标系中的旋转变换信息和平移变换信息,对该初始相机位姿变换序列和该初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列,根据该相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定该旋转参数中该目标相机的第一旋转外参,根据该雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、该相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的该第一旋转外参,确定该旋转参数中的第二旋转外参、该尺度因子、以及该平移参数,根据该旋转参数和该尺度因子修正该相机位姿变换序列,得到修正后相机位姿变换序列,根据该雷达位姿变换序列、该修正后相机位姿变换序列以及该第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数;由于在本实施例中,相对位置保持不变的目标相机和目标雷达之间,存在第一关联关系和第二关联关系,可以基于时间同步处理后得到的相机位姿变换序列和雷达位姿变换序列中的旋转变换信息和平移变换信息,计算出相机的旋转参数和平移参数,所以在进行相机标定时,可以不使用标定板,就能达到很好的标定效果,提升了标定的准确率,有利于节约人力资源。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的相机标定方法的场景示意图;
图2是本发明实施例提供的相机标定方法的流程示意图;
图3是本发明实施例提供的相机标定方法的另一流程示意图;
图4是本发明实施例提供的相机标定装置的结构示意图;
图5是本发明实施例提供的电子设备的结构示意图;
图6是本发明实施例提供的智能车辆的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供一种相机标定方法、装置、智能车辆和存储介质。具体地,本发明实施例提供适用于相机标定装置的相机标定方法,该相机标定装置可以集成在电子设备中。
该电子设备可以为终端等设备,例如智能车辆、智能手机、智能手表、平板电脑、笔记本电脑等,其中,智能车辆是一个集环境感知、规划决策以及多等级辅助驾驶等功能于一体的综合***,它集中运用了计算机、现代传感、信息融合、通讯、人工智能及自动控制等技术,是典型的高新技术综合体。目前对智能车辆的研究主要致力于提高汽车的安全性、舒适性,以及提供优良的人车交互界面,该智能车辆可以是无人驾驶汽车,无人驾驶汽车是智能汽车的一种,也称为轮式移动机器人,主要依靠车内的以计算机***为主的智能驾驶仪来实现无人驾驶的目的,所谓无人驾驶,可以通过利用车载传感器来感知车辆周围环境,并根据智能车辆获得的道路、车辆位置和障碍物信息,控制车辆的转向和车辆的速度,从而使车辆能够安全、可靠地在道路上行驶。
该电子设备还可以为服务器等设备,该服务器可以是独立的物理服务器,也可以是多个物理服务器构成的服务器集群或者分布式***,还可以是提供云服务、云数据库、云计算、云函数、云存储、网络服务、云通信、中间件服务、域名服务、安全服务、CDN、以及大数据和人工智能平台等基础云计算服务的云服务器,但并不局限于此。
本发明实施例的相机标定方法,可以由服务器实现,也可以由终端和服务器共同实现。
下面以终端和服务器共同实现该相机标定方法为例,对该方法进行说明,其中,终端可以包括运动设备如智能车辆等。
如图1所示,本发明实施例提供的相机标定***包括运动设备10和服务器20等;运动设备10与服务器20之间可以通过网络连接,比如,通过有线或无线网络连接等,其中,运动设备10可以作为装载有目标相机和目标雷达的终端存在。
运动设备10,可以接收装载在运动设备10上的目标相机采集到的图像数据和装载在运动设备10上的目标雷达采集到的点云数据。
运动设备10接收到所述图像数据和点云数据后,可以直接将所述图像数据和点云数据发送到服务器20,也可以将所述图像数据和点云数据存储在运动设备10的存储空间中,当接收到服务器20发送的数据获取请求时,再将所述图像数据和点云数据发送到服务器20。
服务器20接收到运动设备10发送的所述图像数据和点云数据后,可以根据所述图像数据和点云数据获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列,根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参,根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数,根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列,根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
在得到目标旋转参数和目标平移参数后,服务器20可以继续根据目标旋转参数和目标平移参数继续进行运动设备10的位姿估计等操作,也可以将目标旋转参数和目标平移参数发送给运动设备10,以使得运动设备10根据目标旋转参数和目标平移参数做进一步的处理。
以下分别进行详细说明。需要说明的是,以下实施例的描述顺序不作为对实施例优选顺序的限定。
本发明实施例将从相机标定装置的角度进行描述,该相机标定装置具体可以集成在服务器或终端中。
如图2所示,本实施例的相机标定方法的具体流程可以如下:
201、获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息。
需要说明的是,本实施例中的目标相机包括但不限于普通相机、摄像机等图像获取设备,目标雷达包括但不限于毫米波雷达、激光雷达等探测设备。
其中,所述目标相机和目标雷达相对位置不变,可以理解为在初始相机位姿变换序列和初始雷达位姿变换序列的获取时长内,目标相机和目标雷达保持一个相对静止的状态,如目标相机和目标雷达之间的相对距离不变,目标相机和目标雷达的相对距离,可以基于目标相机和目标雷达上特定的点计算,该特定的点的位置不限,例如,相对距离为目标相机的镜头中心点到雷达重心的距离,可以理解的是,若相机自身发生转动,则镜头中心也会发生变化,会导致相对距离变换,所以本实施中目标相机和目标雷达的相对位置不变,其实也限定了在初始相机位姿变换序列和初始雷达位姿变换序列的获取时长内,相机和雷达各自不进行独立运动。
例如,在一个示例中,目标相机和目标雷达可以同时设置在智能车辆上,并在智能车辆上为目标相机和目标雷达各设置一个固定装置,目标相机和目标雷达可以通过固定装置固定在智能车辆上,目标相机和目标雷达自身是可以活动的,如发生转动,但是在进行相机标定时,可以保持相对静止。
其中,初始相机位姿变换序列可以由目标相机采集的图像数据得到的,可以包括目标相机在相邻时刻之间的位姿变换信息。初始雷达位姿变换序列可以由目标雷达采集的点云数据得到的,可以包括目标雷达在相邻时刻之间的位姿变换信息。
本实施例中,相机位姿表示目标相机在相机坐标系中的位置和姿态,雷达位姿表示目标雷达在雷达坐标系中的位置和姿态。
例如,一个示例中,该初始相机位姿变换序列可以为
Figure 789194DEST_PATH_IMAGE001
的形 式,其中,
Figure 321806DEST_PATH_IMAGE002
,可以是根据目标相机采集到的图像数据确定出的目标相机 在1,2,3,……,
Figure 848603DEST_PATH_IMAGE003
时刻,于相机坐标系中的位姿状态信息,本实施例中,位姿状态信息可以 包括目标相机在相机坐标系中的位置信息和姿态信息。
可以从初始相机位姿变换序列的位姿状态信息确定出目标相机在相邻时刻之间的位姿变换信息,所述位姿变换信息包括旋转变换信息和平移变换信息。
例如,另一个示例中,该初始相机位姿变换序列也可以为
Figure 517482DEST_PATH_IMAGE004
,其中,
Figure 979687DEST_PATH_IMAGE005
可以是根据目标相机采集 到的图像数据确定出的目标相机在相邻时刻之间的位姿变换信息,比如
Figure 999595DEST_PATH_IMAGE006
表示根据 第
Figure 815236DEST_PATH_IMAGE007
-1个采集时刻与第
Figure 604200DEST_PATH_IMAGE008
个采集时刻的相机位姿状态信息确定的第
Figure 34045DEST_PATH_IMAGE007
-1个采集时刻与第
Figure 213353DEST_PATH_IMAGE008
个采集时刻之间目标相机的位姿变换信息。
其中,旋转变换信息指的是用于反映目标相机在相机坐标系中的姿态变化的信息,一个示例中,旋转变换信息可以是相机坐标系中目标相机在相邻采集时刻之间的姿态变化信息。
其中,平移变换信息指的是用于反映目标相机在相机坐标系中的位置变化的信息,一个示例中,平移变换信息可以是相机坐标系中目标相机在相邻采集时刻之间的位置变化信息。
可以理解的是,初始相机位姿变换序列需要经过对目标相机采集的图像数据进行处理得到,在一个示例中,步骤“获取目标相机的初始相机位姿变换序列”,具体可以包括:
获取目标相机采集到的图像数据,所述图像数据中包括至少两张图像,以及每张图像的采集时间戳;
对各图像进行特征点检测,得到各图像的特征点;
在图像之间进行特征点匹配,确定具有相同特征点的目标图像;
根据所述目标图像和所述目标图像的采集时间戳,得到图像序列;
对该图像序列进行相机位姿提取操作,得到初始相机位姿变换序列。
在这个示例中,每张图像的采集时间戳包括用来确定每张图像的采集时间的时间标识,需要依据该采集时间戳对目标图像进行处理,生成图像序列。
其中,特征点表示在目标相机采集到的图像数据中,具有特征性质的点,能够在其他含有相同场景或目标的相似图像中以一种相同的或至少非常相似的不变形式表示图像或目标。可以理解的是,特征点可以不仅仅是一个点,它还可以包括一系列局部的信息。甚至很多情况下,它本身就是具有面积的一小块区域。
其中,步骤“对所述图像数据进行特征点检测,得到每组所述图像数据中的特征点”中,可以采用特征点提取((Features from Accelerated Segment Test,FAST)算法、加速稳健特征( Speeded Up Robust Features,Surf)算法等等任一能提取图像数据中的特征点的方式实现。
可以理解的是,初始雷达位姿变换序列需要经过对目标雷达采集的点云数据进行处理得到,在一个示例中,步骤“获取目标雷达的初始雷达位姿变换序列”,具体可以包括:
获取目标雷达采集到的多个点云数据,以及每个点云数据的采集时间戳;
对所述点云数据进行点云配准处理,得到配准点云数据集合,配准点云数据集合中的任一点云数据与其他点云数据之间都是配准成功的关系;
根据所述配准点云数据集合中的点云数据和该点云数据的采集时间戳,得到初始雷达位姿变换序列。
本实施例中,点云数据是指在雷达坐标系中的一组向量的集合。
在这个示例中,每个点云数据的采集时间戳可以包括用来确定每个点云数据的采集时间的时间标识,需要依据该采集时间戳对点云配准后的点云数据进行处理,生成初始雷达位姿变换序列。
其中,步骤“对所述点云数据进行点云配准处理,得到配准点云数据”中,可以通过迭代最近点配准(Iterative Closest Point Alignment, ICP)配准或者正态分布变换(Normal Distribution Transform,NDT)实现。其中,ICP算法是激光同步定位与建图(simultaneous localization and mapping,SLAM)点云匹配的常用算法, 其本质上是基于最小二乘法的最优配准方法, 即认为距离最近的两个点为同一个, 重复进行选择对应关系点对,计算最优刚体变换这一过程,直到满足正确配准的收敛精度要求。
可以理解的是,在对点云数据进行点云配准处理之前,也可以对点云数据进行点云滤波等处理,原始采集的点云数据往往包含大量散列点、孤立点,可以通过点云滤波等处理,保留有效的点云数据,减轻计算压力。
202、对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列。
在一个示例中,所述初始相机位姿变换序列中还包括所述目标相机的旋转变换信息和平移变换信息对应的时间信息,所述初始雷达位姿变换序列中还包括所述目标雷达的旋转变换信息和平移变换信息对应的时间信息。
本实施例中的时间同步处理的作用是,使得处理得到的相机位姿变换序列和雷达位姿变换序列中相同序列位置对应的时间信息相同,其中,时间同步处理采用的具体方案不限,例如时间同步处理可以是基于插值方法实现的。
所述对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列,包括:
分别计算所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟;
基于所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟,对所述初始相机位姿序列和所述初始雷达位姿序列的时间信息进行调整;
根据调整后的时间信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行插值计算,得到相机位姿变换序列和雷达位姿变换序列,所述相机位姿变换序列和雷达位姿变换序列中相同序列位置对应的时间信息相同。
其中,时间延迟是由于目标相机和目标雷达之间由于采集帧率不同、数据传输速率不同等问题产生的在时间信息上的差值。
其中,相同序列位置对应的时间信息相同指的是,将目标相机的旋转变换信息和 平移变换信息按时间顺序写入相机位姿变换序列,将目标雷达的旋转变换信息和平移变换 信息按时间顺序写入雷达位姿变换序列后,相机位姿变换序列和雷达位姿变换序列中同一 次序的旋转变换信息和平移变换信息对应的时间信息相同。例如,在相机位姿变换序列第
Figure 19635DEST_PATH_IMAGE007
位的旋转变换信息和平移变换信息对应的时间信息,与雷达位姿变换序列第
Figure 991002DEST_PATH_IMAGE007
位的旋 转变换信息和平移变换信息对应的时间信息相同。
可以理解的是,需要先根据目标相机和目标雷达之间的采集帧率、数据传输速率等信息对相机位姿时间信息和雷达位姿时间信息进行处理,消除它们的时间延迟。
在消除时间延迟后,可以对初始相机位姿变换序列和所述初始雷达位姿变换序列进行进一步的处理,以使得所述初始相机位姿变换序列和所述初始雷达位姿变换序列同步,即,得到相机位姿变换序列和雷达位姿变换序列。
在一个示例中,所述根据同步后的所述雷达位姿时间信息和所述相机位姿时间信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行插值计算,得到相机位姿变换序列和雷达位姿变换序列,包括:
确定所述初始相机位姿变换序列中的相机插值点时间信息和所述初始雷达位姿变换序列中的雷达插值点时间信息;
根据所述初始相机位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述相机插值点时间信息对应的旋转变换信息和平移变换信息,得到相机位姿变换序列;
根据所述初始雷达位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述雷达插值点时间信息对应的旋转变换信息和平移变换信息,得到雷达位姿变换序列。
其中,插值计算可以通过多种方法实现,例如,在初始相机位姿变换序列中,选择在相机插值点时间信息之前和之后的一组或多组的时间信息对应的旋转变换信息和平移变换信息,通过求取平均值的方式进行插值计算。也可以在初始相机位姿变换序列中选择在相机插值点时间信息之前和之后的多组的时间信息对应的旋转变换信息和平移变换信息,求取模拟曲线,再在模拟曲线上,选择相机插值点时间信息对应的旋转变换信息和平移变换信息,实现插值计算。也可以根据实际需求,采用计算量更大的反距离加权法、趋势面光滑差值法等进行插值计算。
在另一个示例中,在步骤202中,也可以只对初始相机位姿变换序列或者初始雷达位姿变换序列进行插值处理。例如:
将所述初始雷达位姿变换序列作为雷达位姿变换序列;
确定所述雷达位姿变换序列中目标雷达的旋转变换信息和平移变换信息对应的时间信息;
基于所述目标雷达的旋转变换信息和平移变换信息对应的时间信息,确定所述初始相机位姿变换序列中对应的相机插值点时间信息;
根据所述初始相机位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述相机插值点时间信息对应的旋转变换信息和平移变换信息,得到相机位姿变换序列。
203、根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参。
其中,旋转参数,可以使得相机坐标系根据旋转参数绕自身原点进行旋转后,坐标轴的方向与雷达坐标系中坐标轴的方向一致。
其中,第一关联关系包括所述雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积相等。
例如,第一关联关系可以为如下公式所示的形式:
Figure 591748DEST_PATH_IMAGE009
其中,
Figure 523932DEST_PATH_IMAGE010
表示从雷达位姿变换序列中获取的目标雷达在雷达坐标系中第
Figure 602746DEST_PATH_IMAGE011
时刻和第
Figure 444931DEST_PATH_IMAGE011
+1时刻之间(第一时间信息)的旋转变换信息,
Figure 216578DEST_PATH_IMAGE012
表示相机坐标系到雷 达坐标系的旋转参数,
Figure 636058DEST_PATH_IMAGE013
表示从相机位姿变换序列中获取的目标相机在相机坐标 系中第
Figure 784143DEST_PATH_IMAGE011
时刻和第
Figure 464523DEST_PATH_IMAGE011
+1时刻之间(第一时间信息)的旋转变换信息。
Figure 672650DEST_PATH_IMAGE014
Figure 313847DEST_PATH_IMAGE015
的乘积表示的是:目标相机在雷达坐标系中第
Figure 44DEST_PATH_IMAGE011
时刻和第
Figure 548312DEST_PATH_IMAGE011
+1时刻之间的旋转变换信息。
在这个示例中,所述旋转变换信息可以表现为矩阵的形式,通过所述旋转参数,可以将目标相机在相机坐标系中的旋转变换信息,变换为目标相机在雷达坐标系中的旋转变换信息。
为了实现对旋转参数的精确计算,提高旋转参数的准确性,本实施例中,可以将相机坐标系相较于雷达坐标系的旋转参数,表示成绕雷达坐标系的三个坐标轴ZYX分解得到的旋转子参数的连成形式。如下公式所示:
Figure 661762DEST_PATH_IMAGE016
其中,
Figure 790255DEST_PATH_IMAGE017
表示相机坐标系原点与雷达坐标系中的z轴之间的旋转子参数,
Figure 280142DEST_PATH_IMAGE018
表示相机坐标系原点与雷达坐标系中的y轴之间的旋转子参数,
Figure 935114DEST_PATH_IMAGE019
表示相 机坐标系原点与雷达坐标系的x轴之间的旋转子参数。
Figure 219465DEST_PATH_IMAGE020
Figure 897571DEST_PATH_IMAGE021
Figure 863253DEST_PATH_IMAGE022
可以是矩 阵。
其中,雷达坐标系的设置方式不限,本实施例对此没有任何限制。
其中,旋转参数中的第一旋转外参指的是旋转子参数
Figure 310415DEST_PATH_IMAGE023
Figure 844295DEST_PATH_IMAGE024
,第二旋 转外参指的是旋转子参数
Figure 9697DEST_PATH_IMAGE025
其中,
Figure 575808DEST_PATH_IMAGE026
指的是相机外参中的roll角(翻滚角),
Figure 815159DEST_PATH_IMAGE027
指的是相机外参中 的pitch角(俯仰角),
Figure 706892DEST_PATH_IMAGE028
指的是相机外参中的yaw角(偏航角)。
在一个示例中,所述根据目标相机和目标雷达在各自的坐标系中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参,包括:
根据第一关联关系构建雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积之间的第一等式,将所述第一等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到旋转残差关系式;
将所述旋转参数中的所述第二旋转外参作为定量,根据所述旋转残差关系式进行残差计算,得到所述旋转参数中所述目标相机的第一旋转外参。
在一个示例中,旋转残差关系式可以表示为如下公式的形式:
Figure 421907DEST_PATH_IMAGE029
其中,
Figure 791709DEST_PATH_IMAGE030
表示预设的残差,可以代替所述目标侧的数值。在根据所述旋转残差关 系式进行残差计算时,可以通过最小化所述旋转残差,求解出与最小化的旋转残差对应所 述旋转参数中的第一旋转外参。
204、根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数。
其中,平移参数,可以使得相机坐标系按照平移参数平移后,相机坐标系的原点和雷达坐标系的原点重合。
其中,尺度因子为真实空间中物体和相机之间的距离与目标相机焦距的比值。
其中,所述第二关联关系包括所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积,和所述平移参数之间的差值,等于尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,与所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值。
例如,第二关联关系可以为如下公式的形式:
Figure 151146DEST_PATH_IMAGE031
其中,
Figure 213780DEST_PATH_IMAGE032
表示平移参数,
Figure 901244DEST_PATH_IMAGE033
表示尺度因子,
Figure 340316DEST_PATH_IMAGE034
表示从相机位姿变换 序列中提取的目标相机在相机坐标系中,第
Figure 554259DEST_PATH_IMAGE011
时刻和第
Figure 522215DEST_PATH_IMAGE011
+1时刻之间(第二时间信息)的平 移变换信息,
Figure 883927DEST_PATH_IMAGE035
表示从雷达位姿变换序列中提取的目标雷达在雷达坐标系中的第
Figure 657848DEST_PATH_IMAGE036
时刻和第
Figure 54194DEST_PATH_IMAGE036
+1时刻之间的平移变换信息。在理想状态下,
Figure 396314DEST_PATH_IMAGE033
可以为1。
在一个示例中,所述根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数,包括:
根据所述第二关联关系构建所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积和所述平移参数之间的差值,与尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,和所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值之间的第二等式,将所述第二等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到平移残差关系式;
根据所述平移残差关系式以及确定出的所述第一旋转外参进行残差计算,得到所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数。
其中,所述第二等式可以为如下公式的形式:
Figure 245321DEST_PATH_IMAGE037
其中,I3为对第二关联关系中的
Figure 495037DEST_PATH_IMAGE038
进行公因式提取后的单位矩阵。
在一个示例中,平移残差关系式可以表示为如下公式的形式:
Figure 558939DEST_PATH_IMAGE039
其中,
Figure 134277DEST_PATH_IMAGE040
表示预设的残差,可以代替所述目标侧的数值。在根据所述平移残差关 系式以及确定出的所述第一平移外参进行残差计算时,可以通过最小化所述平移残差,求 解出与最小化的平移残差对应的所述旋转参数中的第二旋转外参、所述尺度因子、以及所 述平移参数。其中,
Figure 408263DEST_PATH_IMAGE041
Figure 727249DEST_PATH_IMAGE042
不同。
205、根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列。
其中,所述根据所述尺度因子修正所述相机位姿变换序列,具体可以为:根据计算得到的尺度因子,对所述相机位姿变换序列中目标相机在相机坐标系中的旋转变换信息和平移变换信息进行修改。在步骤206中,根据修正后相机位姿变换序列重新计算旋转参数和平移参数,可以提升目标旋转外参和目标平移外参的准确性。
206、根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
在实际应用过程中,随着相机和雷达等传感器的不断改进,相机采集图像数据和雷达采集点云数据的过程中,噪声等因素的影响越来越小,可以在获取到图像数据和点云数据后,不进行去噪等操作,而是通过在计算得到旋转参数和平移参数后,进行优化计算,消除噪声的影响。
在一个示例中,步骤206之后,还包括:
根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述旋转残差关系式进行计算,得到旋转残差;
根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述平移残差关系进行计算,得到平移残差;
根据所述旋转残差和所述平移残差,优化所述旋转参数和平移参数对应的矩阵,得到优化后的旋转参数和平移参数。
其中,步骤“根据所述旋转残差和所述平移残差,优化所述旋转参数和平移参数对应的矩阵,得到优化后的旋转参数和平移参数”具体可以通过如下的公式实现:
Figure 894925DEST_PATH_IMAGE043
其中,
Figure 641164DEST_PATH_IMAGE044
可以表示旋转参数和平移参数对应的矩阵,可选的
Figure 136868DEST_PATH_IMAGE045
可以是旋转参数和平移参数对应的矩阵拼接得到。
Figure 993965DEST_PATH_IMAGE046
表示相机位姿变换序 列和雷达位姿变换序列中的第
Figure 953831DEST_PATH_IMAGE046
个时刻,
Figure 681091DEST_PATH_IMAGE046
的最小值为1,最大值小于相机位姿变换序列 和雷达位姿变换序列中的时刻的数量;
Figure 991987DEST_PATH_IMAGE047
表示相机位姿变换序列和雷达位姿变换序列中 的第
Figure 590458DEST_PATH_IMAGE047
个时刻,
Figure 404830DEST_PATH_IMAGE047
的最小值为2,最大值为相机位姿变换序列和雷达位姿变换序列中的 时刻的数量;
Figure 820768DEST_PATH_IMAGE048
表示先求第
Figure 353381DEST_PATH_IMAGE046
Figure 489964DEST_PATH_IMAGE049
的模,再对该模进行平方求值。
可以理解的是,为了保证目标旋转参数和目标平移参数的准确性,在计算出旋转外参和平移外参后,应当对旋转外参和平移外参进行检验,确定计算得到的旋转外参和平移外参可以作为目标旋转参数和目标平移参数。
在一个示例中,所述初始相机位姿变换序列通过相机采集到的图像数据得到,所述初始雷达位姿变换序列通过雷达采集到的点云数据得到;
所述根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数,包括:
根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参;
根据所述第一修正旋转外参、所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第二关联关系,得到修正后旋转参数中的第二修正旋转外参、修正后尺度因子以及修正后平移参数;
根据所述修正后旋转参数、修正后尺度因子以及修正后平移参数,在所述相机采集到的图像数据和所述雷达采集到的点云数据之间进行投影转换,基于投影转换得到的信息确定投影误差;
当所述投影误差小于预设的投影误差阈值时,将所述修正后旋转参数作为目标旋转参数,将所述修正后平移参数作为目标平移参数;
当所述投影误差不小于所述投影误差阈值时,对所述修正后相机位姿变换序列进行修正,得到新的修正后相机位姿序列,基于新的修正后相机位姿序列重新执行根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参的步骤。
其中,投影误差阈值为预设的用于判断投影误差是否满足需求的参数值,开发人员可以根据实际情况对投影误差阈值进行设置,如开发人员希望投影误差小于99%时,可以将投影误差阈值设置为99%等。当投影误差值小于投影误差阈值时,可以认为得到的修正后旋转参数和修正后平移参数能够满足需要,将所述修正后旋转参数作为目标旋转参数,将所述修正后平移参数作为目标平移参数。
由上可知,采用本发明实施例的方案,可以获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,该目标相机和目标雷达相对位置不变,该初始相机位姿变换序列包括该目标相机在相机坐标系中的旋转变换信息和平移变换信息,该初始雷达位姿变换序列包括该目标雷达在雷达坐标系中的旋转变换信息和平移变换信息,对该初始相机位姿变换序列和该初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列,根据该相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定该旋转参数中该目标相机的第一旋转外参,根据该雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、该相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的该第一旋转外参,确定该旋转参数中的第二旋转外参、该尺度因子、以及该平移参数,根据该旋转参数和该尺度因子修正该相机位姿变换序列,得到修正后相机位姿变换序列,根据该雷达位姿变换序列、该修正后相机位姿变换序列以及该第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数;由于在本实施例中,相对位置保持不变的目标相机和目标雷达之间,存在第一关联关系和第二关联关系,可以基于时间同步处理后得到的相机位姿变换序列和雷达位姿变换序列中的旋转变换信息和平移变换信息,计算出相机的旋转参数和平移参数,所以在进行相机标定时,可以不使用标定板,就能达到很好的标定效果,提升了标定的准确率,有利于节约人力资源。
根据前面实施例所描述的方法,以下将举例作进一步详细说明。
在本实施例中,将结合图1的***,以相机标定装置集成在智能车辆中进行说明,智能车辆上装载有目标相机和目标雷达。
如图3所示,本实施例的相机标定方法,具体流程可以如下:
301、目标相机采集图像数据并发送给智能车辆,目标雷达采集点云数据并发送给智能车辆。
其中,目标相机和目标雷达可以随着智能车辆的运动而运动,但是目标相机和目标雷达保持相对位置不变。
302、智能车辆接收目标相机采集的图像数据和目标雷达采集的点云数据。
其中,智能车辆在接收到图像数据和点云数据后,可以先对图像数据和点云数据进行去噪处理,去除图像数据和点云数据中由于相机和雷达的抖动等因素产生的噪声点。
303、智能车辆根据所述图像数据和点云数据获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息。
在一个实施例中,初始相机位姿变换序列是由目标相机采集的图像数据进行图像特征点匹配得到的,可以包括目标相机在相邻时刻之间的位姿变换信息。初始雷达位姿变换序列是由目标雷达采集的点云数据进行点云配准得到的,可以包括目标雷达在相邻时刻之间的位姿变换信息。
304、智能车辆对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列。
在一个示例中,步骤304包括:
分别计算所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟;
基于所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟,对所述初始相机位姿序列和所述初始雷达位姿序列的时间信息进行调整;
确定所述初始相机位姿变换序列中的相机插值点时间信息和所述初始雷达位姿变换序列中的雷达插值点时间信息;
根据所述初始相机位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述相机插值点时间信息对应的旋转变换信息和平移变换信息,得到相机位姿变换序列;
根据所述初始雷达位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述雷达插值点时间信息对应的旋转变换信息和平移变换信息,得到雷达位姿变换序列。
305、智能车辆根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参。
其中,旋转参数,可以使得相机坐标系根据旋转参数绕自身原点进行旋转后,坐标轴的方向与雷达坐标系中坐标轴的方向一致。
306、智能车辆根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数。
其中,平移参数为可以使得相机坐标系按照平移参数平移后,相机坐标系的原点和雷达坐标系的原点重合的参数。尺度因子为真实空间中物体和相机之间的距离与目标相机焦距的比值。
307、智能车辆根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列。
其中,所述根据所述尺度因子修正所述相机位姿变换序列表示,根据计算得到的尺度因子,对所述相机位姿变换序列中目标相机在相机坐标系中的旋转变换信息和平移变换信息进行修改,以提升目标旋转外参和目标平移外参的准确性。
308、智能车辆根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
可选的,步骤308具体可以包括:根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参;
根据所述第一修正旋转外参、所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第二关联关系,得到修正后旋转参数中的第二修正旋转外参、修正后尺度因子以及修正后平移参数;
根据所述修正后旋转参数、修正后尺度因子以及修正后平移参数,在所述相机采集到的图像数据和所述雷达采集到的点云数据之间进行投影转换,基于投影转换得到的信息确定投影误差;
当所述投影误差小于预设的投影误差阈值时,将所述修正后旋转参数作为目标旋转参数,将所述修正后平移参数作为目标平移参数;
当所述投影误差不小于所述投影误差阈值时,对所述修正后相机位姿变换序列进行修正,得到新的修正后相机位姿序列,基于新的修正后相机位姿序列重新执行根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参的步骤。
309、智能车辆根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述旋转残差关系式进行计算,得到旋转残差,对所述平移残差关系进行计算,得到平移残差。
310、智能车辆根据所述旋转残差和所述平移残差,优化所述旋转参数和平移参数对应的矩阵,得到优化后的旋转参数和平移参数。
在一个示例中,步骤310具体可以通过如下的公式实现:
Figure 424422DEST_PATH_IMAGE050
其中,
Figure 761994DEST_PATH_IMAGE051
表示旋转参数和平移参数共同构成的矩阵。
由上可知,采用本实施例在进行相机标定时,可以不使用标定板,就能达到很好的标定效果,提升了标定的准确率,有利于节约人力资源。
为了更好地实施以上方法,相应的,本发明实施例还提供一种用户互动内容管理装置。
参考图4,该装置包括:
序列获取单元401,用于获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
时间同步单元402,用于对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
第一参数确定单元403,用于根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参;
第二参数确定单元404,用于根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数;
序列修正单元405,用于根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
外参修正单元406,用于根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
在一个可选的示例中,所述初始相机位姿变换序列中还包括所述目标相机的旋转变换信息和平移变换信息对应的时间信息,所述初始雷达位姿变换序列中还包括所述目标雷达的旋转变换信息和平移变换信息对应的时间信息;
对应的,所述时间同步单元402,用于分别计算所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟;
基于所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟,对所述初始相机位姿序列和所述初始雷达位姿序列的时间信息进行调整;
根据调整后的时间信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行插值计算,得到相机位姿变换序列和雷达位姿变换序列,所述相机位姿变换序列和雷达位姿变换序列中相同序列位置对应的时间信息相同。
在一个可选的示例中,所述时间同步单元402包括插值计算子单元407,所述插值计算子单元,用于根据调整后的时间信息,确定所述初始相机位姿变换序列中的相机插值点时间信息和所述初始雷达位姿变换序列中的雷达插值点时间信息;
根据所述初始相机位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述相机插值点时间信息对应的旋转变换信息和平移变换信息,按照所述相机插值点时间信息的顺序排列对应的旋转变换信息和平移变换信息,得到相机位姿变换序列;
根据所述初始雷达位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述雷达插值点时间信息对应的旋转变换信息和平移变换信息,按照所述雷达插值点时间信息的顺序排列对应的旋转变换信息和平移变换信息,得到雷达位姿变换序列。
在一个可选的示例中,所述第一关联关系包括所述雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积相等;
对应的,所述第一参数确定单元403,用于根据第一关联关系构建雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积之间的第一等式,将所述第一等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到旋转残差关系式;
将所述旋转参数中的所述第二旋转外参作为定量,根据所述旋转残差关系式进行残差计算,得到所述旋转参数中所述目标相机的第一旋转外参。
在一个可选的示例中,所述第二关联关系包括所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积,和所述平移参数之间的差值,等于尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,与所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值;
对应的,所述第二参数确定单元404,用于根据所述第二关联关系构建所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积和所述平移参数之间的差值,与尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,和所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值之间的第二等式,将所述第二等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到平移残差关系式;
根据所述平移残差关系式以及确定出的所述第一旋转外参进行残差计算,得到所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数。
在一个可选的示例中,在所述外参修正单元406根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数后,相机标定装置还包括参数优化单元,用于根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述旋转残差关系式进行计算,得到旋转残差;
根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述平移残差关系进行计算,得到平移残差;
根据所述旋转残差和所述平移残差,优化所述旋转参数和平移参数对应的矩阵,得到优化后的旋转参数和平移参数。
在一个可选的示例中,所述初始相机位姿变换序列通过相机采集到的图像数据得到,所述初始雷达位姿变换序列通过雷达采集到的点云数据得到;
对应的,所述外参修正单元406包括外参修正子单元408和外参误差确定单元409,所述外参修正子单元408,用于根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参;
根据所述第一修正旋转外参、所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第二关联关系,得到修正后旋转参数中的第二修正旋转外参、修正后尺度因子以及修正后平移参数;
所述外参误差确定单元409,用于根据所述修正后旋转参数、修正后尺度因子以及修正后平移参数,在所述相机采集到的图像数据和所述雷达采集到的点云数据之间进行投影转换,基于投影转换得到的信息确定投影误差;
当所述投影误差小于预设的投影误差阈值时,将所述修正后旋转参数作为目标旋转参数,将所述修正后平移参数作为目标平移参数;
当所述投影误差不小于所述投影误差阈值时,对所述修正后相机位姿变换序列进行修正,得到新的修正后相机位姿序列,基于新的修正后相机位姿序列重新执行根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参的步骤。
由上可知,采用本发明实施例的装置,基于位置相对不变的相机和雷达之间存在的第一关联关系和第二关联关系,在进行相机标定时,可以不使用标定板,就能达到很好的标定效果,提升了标定的准确率,有利于节约人力资源。
相应的,本发明实施例还提供一种电子设备,如图5所示,该电子设备可以包括射频(RF,Radio Frequency)电路501、包括有一个或一个以上计算机可读存储介质的存储器502、输入单元503、显示单元504、传感器505、音频电路506、无线保真(WiFi,WirelessFidelity)模块507、包括有一个或者一个以上处理核心的处理器508、以及电源509等部件。本领域技术人员可以理解,图5中示出的电子设备结构并不构成对电子设备的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。其中:
RF电路501可用于收发信息或通话过程中,信号的接收和发送,特别地,将基站的下行信息接收后,交由一个或者一个以上处理器508处理;另外,将涉及上行的数据发送给基站。通常,RF电路501包括但不限于天线、至少一个放大器、调谐器、一个或多个振荡器、用户身份模块(SIM, Subscriber Identity Module)卡、收发信机、耦合器、低噪声放大器(LNA,Low Noise Amplifier)、双工器等。此外,RF电路501还可以通过无线通信与网络和其他设备通信。所述无线通信可以使用任一通信标准或协议,包括但不限于全球移动通讯***(GSM,Global System of Mobile communication)、通用分组无线服务(GPRS ,GeneralPacket Radio Service)、码分多址(CDMA,Code Division Multiple Access)、宽带码分多址(WCDMA,Wideband Code Division Multiple Access)、长期演进(LTE,Long TermEvolution)、电子邮件、短消息服务(SMS,Short Messaging Service)等。
存储器502可用于存储软件程序以及模块,处理器508通过运行存储在存储器502的软件程序以及模块,从而执行各种功能应用以及数据处理。存储器502可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作***、至少一个功能所需的应用程序(比如声音播放功能、图像播放功能等)等;存储数据区可存储根据电子设备的使用所创建的数据(比如音频数据、电话本等)等。此外,存储器502可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。相应地,存储器502还可以包括存储器控制器,以提供处理器508和输入单元503对存储器502的访问。
输入单元503可用于接收输入的数字或字符信息,以及产生与用户设置以及功能控制有关的键盘、鼠标、操作杆、光学或者轨迹球信号输入。具体地,在一个具体的实施例中,输入单元503可包括触敏表面以及其他输入设备。触敏表面,也称为触摸显示屏或者触控板,可收集用户在其上或附近的触摸操作(比如用户使用手指、触笔等任何适合的物体或附件在触敏表面上或在触敏表面附近的操作),并根据预先设定的程式驱动相应的连接装置。可选的,触敏表面可包括触摸检测装置和触摸控制器两个部分。其中,触摸检测装置检测用户的触摸方位,并检测触摸操作带来的信号,将信号传送给触摸控制器;触摸控制器从触摸检测装置上接收触摸信息,并将它转换成触点坐标,再送给处理器508,并能接收处理器508发来的命令并加以执行。此外,可以采用电阻式、电容式、红外线以及表面声波等多种类型实现触敏表面。除了触敏表面,输入单元503还可以包括其他输入设备。具体地,其他输入设备可以包括但不限于物理键盘、功能键(比如音量控制按键、开关按键等)、轨迹球、鼠标、操作杆等中的一种或多种。
显示单元504可用于显示由用户输入的信息或提供给用户的信息以及电子设备的各种图形用户接口,这些图形用户接口可以由图形、文本、图标、视频和其任意组合来构成。显示单元504可包括显示面板,可选的,可以采用液晶显示器(LCD,Liquid CrystalDisplay)、有机发光二极管(OLED,Organic Light-Emitting Diode)等形式来配置显示面板。进一步的,触敏表面可覆盖显示面板,当触敏表面检测到在其上或附近的触摸操作后,传送给处理器508以确定触摸事件的类型,随后处理器508根据触摸事件的类型在显示面板上提供相应的视觉输出。虽然在图5中,触敏表面与显示面板是作为两个独立的部件来实现输入和输入功能,但是在某些实施例中,可以将触敏表面与显示面板集成而实现输入和输出功能。
电子设备还可包括至少一种传感器505,比如光传感器、运动传感器以及其他传感器。具体地,光传感器可包括环境光传感器及接近传感器,其中,环境光传感器可根据环境光线的明暗来调节显示面板的亮度,接近传感器可在电子设备移动到耳边时,关闭显示面板和/或背光。作为运动传感器的一种,重力加速度传感器可检测各个方向上(一般为三轴)加速度的大小,静止时可检测出重力的大小及方向,可用于识别手机姿态的应用(比如横竖屏切换、相关游戏、磁力计姿态校准)、振动识别相关功能(比如计步器、敲击)等; 至于电子设备还可配置的陀螺仪、气压计、湿度计、温度计、红外线传感器等其他传感器,在此不再赘述。
音频电路506中的扬声器、传声器可提供用户与电子设备之间的音频接口。音频电路506可将接收到的音频数据转换后的电信号,传输到扬声器,由扬声器转换为声音信号输出;另一方面,传声器将收集的声音信号转换为电信号,由音频电路506接收后转换为音频数据,再将音频数据输出处理器508处理后,经RF电路501以发送给比如另一电子设备,或者将音频数据输出至存储器502以便进一步处理。音频电路506还可能包括耳塞插孔,以提供外设耳机与电子设备的通信。
WiFi属于短距离无线传输技术,电子设备通过WiFi模块507可以帮助用户收发电子邮件、浏览网页和访问流式媒体等,它为用户提供了无线的宽带互联网访问。虽然图5示出了WiFi模块507,但是可以理解的是,其并不属于电子设备的必须构成,完全可以根据需要在不改变发明的本质的范围内而省略。
处理器508是电子设备的控制中心,利用各种接口和线路连接整个手机的各个部分,通过运行或执行存储在存储器502内的软件程序和/或模块,以及调用存储在存储器502内的数据,执行电子设备的各种功能和处理数据,从而对手机进行整体监控。可选的,处理器508可包括一个或多个处理核心;优选的,处理器508可集成应用处理器和调制解调处理器,其中,应用处理器主要处理操作***、用户界面和应用程序等,调制解调处理器主要处理无线通信。可以理解的是,上述调制解调处理器也可以不集成到处理器508中。
电子设备还包括给各个部件供电的电源509(比如电池),优选的,电源可以通过电源管理***与处理器508逻辑相连,从而通过电源管理***实现管理充电、放电、以及功耗管理等功能。电源509还可以包括一个或一个以上的直流或交流电源、再充电***、电源故障检测电路、电源转换器或者逆变器、电源状态指示器等任意组件。
尽管未示出,电子设备还可以包括摄像头、蓝牙模块等,在此不再赘述。具体在本实施例中,电子设备中的处理器508会按照如下的指令,将一个或一个以上的应用程序的进程对应的可执行文件加载到存储器502中,并由处理器508来运行存储在存储器502中的应用程序,从而实现各种功能:
获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参;
根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数;
根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
本领域普通技术人员可以理解,上述实施例的各种方法中的全部或部分步骤可以通过指令来完成,或通过指令控制相关的硬件来完成,该指令可以存储于一计算机可读存储介质中,并由处理器进行加载和执行。
为此,本发明实施例提供一种存储介质,其中存储有多条指令,该指令能够被处理器进行加载,以执行本发明实施例所提供的任一种相机标定方法中的步骤。例如,该指令可以执行如下步骤:
获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参;
根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数;
根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
以上各个操作的具体实施可参见前面的实施例,在此不再赘述。
其中,该存储介质可以包括:只读存储器(ROM,Read Only Memory)、随机存取记忆体(RAM,Random Access Memory)、磁盘或光盘等。
由于该存储介质中所存储的指令,可以执行本发明实施例所提供的任一种相机标定方法中的步骤,因此,可以实现本发明实施例所提供的任一种相机标定方法所能实现的有益效果,详见前面的实施例,在此不再赘述。
根据本申请的一个方面,还提供了一种计算机程序产品或计算机程序,该计算机程序产品或计算机程序包括计算机指令,该计算机指令存储在计算机可读存储介质中。计算机设备的处理器从计算机可读存储介质读取该计算机指令,处理器执行该计算机指令,使得该计算机设备执行上述实施例中的各种可选实现方式中提供的方法。
本发明实施例还提供一种智能车辆,如图6所示,其示出了本发明实施例所涉及的智能车辆的结构示意图,具体来讲:
该智能车辆可以包括车辆主体601、感知设备602、执行设备603和车载处理设备604,本领域技术人员可以理解,图6中示出的电子设备结构并不构成对智能车辆的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。其中:
车辆主体601是智能车辆的车身结构,可以包括车架、车门、车身和内部的座椅等硬件结构。
感知设备602是智能车辆的感知结构,用于感知所述智能车辆的内部状态信息,以及所述外部驾驶环境中的环境信息。具体可以包括车轮速计、定位计、胎压计、目标雷达、目标相机等设备。
执行设备603是智能车辆用于执行行驶功能的结构,执行设备可以包括发动机、动力电池、变速箱、传动结构等动力设备,还可以包括显示屏、音响等展示设备,还可以包括方向盘等转向设备,以及轮胎等设备。
车载处理设备604是所述智能车辆的“大脑”,集成有用于控制车辆速度、方向、加速度转向等的车辆运行参数的控制装置、用于监控所述无人驾驶车辆行驶状态的车辆行驶安全监控装置、用于分析感知设备感知到的信息的信息获取装置、用于规划车辆行驶路线的规划装置等。
执行设备、感知设备和车载处理设备都装载在车辆主体上,车载处理设备与所述执行设备和所述感知设备通过总线相连,以使所述车载处理设备可以执行本申请实施例所提供的任一种相机标定方法中的步骤,因此,可以实现本申请实施例所提供的任一种相机标定方法所能实现的有益效果,例如,该车载处理设备可以执行如下步骤:
获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系,确定所述旋转参数中所述目标相机的第一旋转外参;
根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子、以及所述平移参数;
根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
以上各个操作的具体实施可参见前面的实施例,在此不再赘述。
以上对本发明实施例所提供的一种相机标定方法、装置、电子设备和存储介质进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。

Claims (10)

1.一种相机标定方法,其特征在于,包括:
获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系
Figure 889769DEST_PATH_IMAGE002
,确定所述旋转参数中所述目标相机的第一旋转外参,其中,
Figure 704010DEST_PATH_IMAGE004
表示从所述雷达位姿变换序列中获取的所述目标雷达在所述雷达坐标系中第
Figure 618877DEST_PATH_IMAGE006
时刻和第
Figure 218485DEST_PATH_IMAGE008
+1时刻之间的所述旋转变换信息,
Figure 91763DEST_PATH_IMAGE010
表示所述相机坐标系到所述雷达坐标系的旋转参数,
Figure 862142DEST_PATH_IMAGE012
表示从所述相机位姿变换序列中获取的所述目标相机在所述相机坐标系中第
Figure 315120DEST_PATH_IMAGE014
时刻和第
Figure 769235DEST_PATH_IMAGE008
+1时刻之间的所述旋转变换信息;
根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系
Figure 62682DEST_PATH_IMAGE016
,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子以及所述平移参数,其中,
Figure 602248DEST_PATH_IMAGE018
表示所述平移参数,
Figure 124496DEST_PATH_IMAGE020
表示所述尺度因子,
Figure 433118DEST_PATH_IMAGE022
表示从所述相机位姿变换序列中提取的所述目标相机在所述相机坐标系中第
Figure 631887DEST_PATH_IMAGE024
时刻和第
Figure 658749DEST_PATH_IMAGE008
+1时刻之间的所述平移变换信息,
Figure 984688DEST_PATH_IMAGE026
表示从所述雷达位姿变换序列中提取的所述目标雷达在所述雷达坐标系中的第
Figure 147816DEST_PATH_IMAGE028
时刻和第
Figure 251907DEST_PATH_IMAGE030
+1时刻之间的所述平移变换信息;
根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
2.根据权利要求1所述的方法,其特征在于,所述初始相机位姿变换序列中还包括所述目标相机的旋转变换信息和平移变换信息对应的时间信息,所述初始雷达位姿变换序列中还包括所述目标雷达的旋转变换信息和平移变换信息对应的时间信息;
所述对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列,包括:
分别计算所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟;
基于所述初始相机位姿序列和所述初始雷达位姿序列的时间延迟,对所述初始相机位姿序列和所述初始雷达位姿序列的时间信息进行调整;
根据调整后的时间信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行插值计算,得到相机位姿变换序列和雷达位姿变换序列,所述相机位姿变换序列和雷达位姿变换序列中相同序列位置对应的时间信息相同。
3.根据权利要求2所述的方法,其特征在于,所述根据调整后的时间信息,对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行插值计算,得到相机位姿变换序列和雷达位姿变换序列,包括:
根据调整后的时间信息,确定所述初始相机位姿变换序列中的相机插值点时间信息和所述初始雷达位姿变换序列中的雷达插值点时间信息;
根据所述初始相机位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述相机插值点时间信息对应的旋转变换信息和平移变换信息,按照所述相机插值点时间信息的顺序排列对应的旋转变换信息和平移变换信息,得到相机位姿变换序列;
根据所述初始雷达位姿变换序列中的旋转变换信息和平移变换信息,通过插值计算得到所述雷达插值点时间信息对应的旋转变换信息和平移变换信息,按照所述雷达插值点时间信息的顺序排列对应的旋转变换信息和平移变换信息,得到雷达位姿变换序列。
4.根据权利要求1所述的方法,其特征在于,所述第一关联关系包括所述雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积相等;
所述根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系
Figure 234906DEST_PATH_IMAGE002
,确定所述旋转参数中所述目标相机的第一旋转外参,包括:
根据第一关联关系构建雷达位姿变换序列中第一时间信息对应的旋转变换信息与所述旋转参数的乘积,和所述旋转参数与所述相机位姿变换序列中所述第一时间信息对应的旋转变换信息的乘积之间的第一等式,将所述第一等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到旋转残差关系式;
将所述旋转参数中的所述第二旋转外参作为定量,根据所述旋转残差关系式进行残差计算,得到所述旋转参数中所述目标相机的第一旋转外参。
5.根据权利要求4所述的方法,其特征在于,所述第二关联关系包括所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积,和所述平移参数之间的差值,等于尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,与所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值;
所述根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系
Figure 98957DEST_PATH_IMAGE016
,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子以及所述平移参数,包括:
根据所述第二关联关系构建所述雷达位姿变换序列中第二时间信息对应的旋转变换信息与所述平移参数的乘积和所述平移参数之间的差值,与尺度因子、所述旋转参数以及所述相机位姿变换序列中所述第二时间信息对应的平移变换信息的乘积,和所述雷达位姿变换序列中第二时间信息对应的平移变换信息之间的差值之间的第二等式,将所述第二等式的目标侧的所有计算项移到另一侧,之后以预设残差代替所述目标侧的数值,得到平移残差关系式;
根据所述平移残差关系式以及确定出的所述第一旋转外参进行残差计算,得到所述旋转参数中的第二旋转外参、所述尺度因子以及所述平移参数。
6.根据权利要求5所述的方法,其特征在于,所述根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数之后,还包括:
根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述旋转残差关系式进行计算,得到旋转残差;
根据所述目标旋转参数、所述目标平移参数、所述雷达位姿变换序列和所述修正后相机位姿变换序列,对所述平移残差关系进行计算,得到平移残差;
根据所述旋转残差和所述平移残差,优化所述旋转参数和平移参数对应的矩阵,得到优化后的旋转参数和平移参数。
7.根据权利要求1所述的方法,其特征在于,所述初始相机位姿变换序列通过相机采集到的图像数据得到,所述初始雷达位姿变换序列通过雷达采集到的点云数据得到;
所述根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数,包括:
根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参;
根据所述第一修正旋转外参、所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第二关联关系,得到修正后旋转参数中的第二修正旋转外参、修正后尺度因子以及修正后平移参数;
根据所述修正后旋转参数、修正后尺度因子以及修正后平移参数,在所述相机采集到的图像数据和所述雷达采集到的点云数据之间进行投影转换,基于投影转换得到的信息确定投影误差;
当所述投影误差小于预设的投影误差阈值时,将所述修正后旋转参数作为目标旋转参数,将所述修正后平移参数作为目标平移参数;
当所述投影误差不小于所述投影误差阈值时,对所述修正后相机位姿变换序列进行修正,得到新的修正后相机位姿序列,基于新的修正后相机位姿序列重新执行根据所述修正后相机位姿变换序列、所述雷达位姿变换序列以及所述第一关联关系,得到修正后旋转参数中的第一修正旋转外参的步骤。
8.一种相机标定装置,其特征在于,包括:
序列获取单元,用于获取目标相机的初始相机位姿变换序列,获取目标雷达的初始雷达位姿变换序列,其中,所述目标相机和目标雷达相对位置不变,所述初始相机位姿变换序列包括所述目标相机在相机坐标系中的旋转变换信息和平移变换信息,所述初始雷达位姿变换序列包括所述目标雷达在雷达坐标系中的旋转变换信息和平移变换信息;
时间同步单元,用于对所述初始相机位姿变换序列和所述初始雷达位姿变换序列进行时间同步处理,得到相机位姿变换序列和雷达位姿变换序列;
第一参数确定单元,用于根据所述相机位姿变换序列和雷达位姿变换序列中的旋转变换信息,与相机坐标系转换为雷达坐标系所需的旋转参数之间满足的第一关联关系
Figure 365859DEST_PATH_IMAGE002
,确定所述旋转参数中所述目标相机的第一旋转外参,其中,
Figure 188322DEST_PATH_IMAGE004
表示从所述雷达位姿变换序列中获取的所述目标雷达在所述雷达坐标系中第
Figure 189776DEST_PATH_IMAGE032
时刻和第
Figure 591938DEST_PATH_IMAGE034
+1时刻之间的所述旋转变换信息,
Figure 995238DEST_PATH_IMAGE010
表示所述相机坐标系到所述雷达坐标系的旋转参数,
Figure 723023DEST_PATH_IMAGE012
表示从所述相机位姿变换序列中获取的所述目标相机在所述相机坐标系中第
Figure DEST_PATH_IMAGE036
时刻和第
Figure 398723DEST_PATH_IMAGE032
+1时刻之间的所述旋转变换信息;
第二参数确定单元,用于根据所述雷达位姿变换序列中的旋转变换信息和平移变换信息、目标相机的尺度因子、所述相机位姿变换序列中的平移变换信息、相机坐标系转换为雷达坐标系所需的旋转参数和平移参数之间满足的第二关联关系
Figure 135735DEST_PATH_IMAGE016
,以及确定出的所述第一旋转外参,确定所述旋转参数中的第二旋转外参、所述尺度因子以及所述平移参数,其中,
Figure 127962DEST_PATH_IMAGE018
表示所述平移参数,
Figure 26648DEST_PATH_IMAGE020
表示所述尺度因子,
Figure 251962DEST_PATH_IMAGE022
表示从所述相机位姿变换序列中提取的所述目标相机在所述相机坐标系中第
Figure DEST_PATH_IMAGE038
时刻和第
Figure DEST_PATH_IMAGE040
+1时刻之间的所述平移变换信息,
Figure 730348DEST_PATH_IMAGE026
表示从所述雷达位姿变换序列中提取的所述目标雷达在所述雷达坐标系中的第
Figure DEST_PATH_IMAGE042
时刻和第
Figure DEST_PATH_IMAGE044
+1时刻之间的所述平移变换信息;
序列修正单元,用于根据所述尺度因子修正所述相机位姿变换序列,得到修正后相机位姿变换序列;
外参修正单元,用于根据所述雷达位姿变换序列、所述修正后相机位姿变换序列以及所述第一关联关系和第二关联关系重新计算旋转参数和平移参数,得到目标旋转参数和目标平移参数。
9.一种智能车辆,其特征在于,所述智能车辆包括处理器、存储器和如权利要求1至7任意一项所述目标相机以及目标雷达,所述处理器用于执行所述存储器中存储的计算机程序时,实现如权利要求1至7任意一项所述的相机标定方法。
10.一种存储介质,其特征在于,所述存储介质存储有多条指令,所述指令适于处理器进行加载,以执行权利要求1至7任一项所述的相机标定方法中的步骤。
CN202110000597.XA 2021-01-04 2021-01-04 一种相机标定方法、装置、智能车辆和存储介质 Active CN112330756B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110000597.XA CN112330756B (zh) 2021-01-04 2021-01-04 一种相机标定方法、装置、智能车辆和存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110000597.XA CN112330756B (zh) 2021-01-04 2021-01-04 一种相机标定方法、装置、智能车辆和存储介质

Publications (2)

Publication Number Publication Date
CN112330756A CN112330756A (zh) 2021-02-05
CN112330756B true CN112330756B (zh) 2021-03-23

Family

ID=74302386

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110000597.XA Active CN112330756B (zh) 2021-01-04 2021-01-04 一种相机标定方法、装置、智能车辆和存储介质

Country Status (1)

Country Link
CN (1) CN112330756B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113724303B (zh) * 2021-09-07 2024-05-10 广州文远知行科技有限公司 点云与图像匹配方法、装置、电子设备和存储介质
CN114387347B (zh) * 2021-10-26 2023-09-19 浙江视觉智能创新中心有限公司 确定外参标定的方法、装置、电子设备及介质
CN114037814B (zh) * 2021-11-11 2022-12-23 北京百度网讯科技有限公司 数据处理方法、装置、电子设备和介质
CN114049404B (zh) * 2022-01-12 2022-04-05 深圳佑驾创新科技有限公司 一种车内相机外参标定方法及装置
CN114782556B (zh) * 2022-06-20 2022-09-09 季华实验室 相机与激光雷达的配准方法、***及存储介质

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101882313B (zh) * 2010-07-14 2011-12-21 中国人民解放军国防科学技术大学 单线激光雷达与ccd相机之间相互关系的标定方法
CN105976353B (zh) * 2016-04-14 2020-01-24 南京理工大学 基于模型和点云全局匹配的空间非合作目标位姿估计方法
CN106997614B (zh) * 2017-03-17 2021-07-20 浙江光珀智能科技有限公司 一种基于深度相机的大规模场景3d建模方法及其装置
CN110456330B (zh) * 2019-08-27 2021-07-09 中国人民解放军国防科技大学 一种相机与激光雷达之间外参无目标自动标定方法及***

Also Published As

Publication number Publication date
CN112330756A (zh) 2021-02-05

Similar Documents

Publication Publication Date Title
CN112330756B (zh) 一种相机标定方法、装置、智能车辆和存储介质
CN107038681B (zh) 图像虚化方法、装置、计算机可读存储介质和计算机设备
CN104954631B (zh) 一种视频处理方法、装置和***
CN109165606B (zh) 一种车辆信息的获取方法、装置以及存储介质
US10410650B2 (en) Method for locating sound emitting position and terminal device
US10893209B2 (en) Photographing direction deviation detection method, apparatus, device, and storage medium
US11131557B2 (en) Full-vision navigation and positioning method, intelligent terminal and storage device
CN112489121A (zh) 视频融合方法、装置、设备、及存储介质
EP3416130B1 (en) Method, device and nonvolatile computer-readable medium for image composition
CN111652942B (zh) 摄像模组的标定方法、第一电子设备和第二电子设备
CN114612531B (zh) 一种图像处理方法、装置、电子设备及存储介质
JP7472281B2 (ja) 電子機器及びフォーカス方法
CN116594028B (zh) 对齐参数的验证方法、装置、存储介质及电子设备
CN108494946B (zh) 移动终端中电子罗盘的校正方法与装置
CN113780291B (zh) 一种图像处理方法、装置、电子设备及存储介质
CN113469923B (zh) 一种图像处理方法、装置、电子设备及存储介质
CN108871356B (zh) 一种行车导航方法、移动终端
CN110933305B (zh) 电子设备及对焦方法
CN109785226B (zh) 一种图像处理方法、装置及终端设备
CN110706158A (zh) 图像处理方法、图像处理装置及终端设备
CN110047076B (zh) 一种图像信息的处理方法、装置及存储介质
CN113347710B (zh) 一种定位方法和相关装置
CN118115544A (zh) 一种基于前视单目摄像头的车辆运动状态确定方法和装置
CN114630049A (zh) 图像补偿方法、移动终端以及图像补偿装置
CN117922673A (zh) 线控转向齿条力确定方法、***、装置及存储介质

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20211209

Address after: 215000 room 808, 8 / F, building 9a, launch area of Yangtze River Delta International R & D community, No. 286, qinglonggang Road, high speed rail new town, Xiangcheng District, Suzhou City, Jiangsu Province

Patentee after: Tianyi Transportation Technology Co.,Ltd.

Address before: 2nd floor, building A3, Hongfeng science and Technology Park, Nanjing Economic and Technological Development Zone, Nanjing, Jiangsu Province 210033

Patentee before: CIIC Technology Co.,Ltd.

EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20210205

Assignee: Zhongzhixing (Shanghai) Transportation Technology Co.,Ltd.

Assignor: Tianyi Transportation Technology Co.,Ltd.

Contract record no.: X2022980005387

Denomination of invention: Camera calibration method, device, intelligent vehicle and storage medium

Granted publication date: 20210323

License type: Common License

Record date: 20220518

EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20210205

Assignee: CIIC Technology Co.,Ltd.

Assignor: Tianyi Transportation Technology Co.,Ltd.

Contract record no.: X2022980005922

Denomination of invention: Camera calibration method, device, intelligent vehicle and storage medium

Granted publication date: 20210323

License type: Common License

Record date: 20220524