CN116912325A - 基于标定治具的摄像头外参标定方法、芯片和机器人 - Google Patents
基于标定治具的摄像头外参标定方法、芯片和机器人 Download PDFInfo
- Publication number
- CN116912325A CN116912325A CN202310830908.4A CN202310830908A CN116912325A CN 116912325 A CN116912325 A CN 116912325A CN 202310830908 A CN202310830908 A CN 202310830908A CN 116912325 A CN116912325 A CN 116912325A
- Authority
- CN
- China
- Prior art keywords
- calibration
- robot
- camera
- jig
- plate
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000004422 calculation algorithm Methods 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000005457 optimization Methods 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 4
- 230000009286 beneficial effect Effects 0.000 description 4
- 239000000463 material Substances 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000012897 Levenberg–Marquardt algorithm Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000003238 somatosensory effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30244—Camera pose
Landscapes
- Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于标定治具的摄像头外参标定方法、芯片和机器人,包括:机器人预先获取标定治具的标定板相对于标定治具的中心点的位姿;机器人移动到标定治具中,然后通过摄像头获取标定治具的标定板的图像,并从标定板的图像中识别出标定点;机器人根据标定板的图像和标定治具的标定板相对于标定治具的中心点的位姿得到机器人的外参,不需要对标定治具进行设置,缩短机器人标定摄像头外参的时间,提高标定摄像头外参的效率。
Description
技术领域
本发明涉及机器人技术领域,具体涉及一种基于标定治具的摄像头外参标定方法、芯片和机器人。
背景技术
在计算机视觉和图形学领域,对于安防监控、互动体感游戏、自动驾驶、环境3D建模等应用场景,都需要对摄像头进行外参标定,从而实现真实物理空间与摄像头视野的位置关系映射。例如对于机器人来说,摄像头是机器人获取外部信息的重要设备,机器人为了获得基于自身坐标系的外部信息的准确位置,就需要对摄像头进行外参标定。目前,在采用相同的标定治具对不同的机器人的摄像头进行标定时,用户需要根据机器人的情况来调整标定治具,导致对机器人的标定需要耗费较多的时间。
发明内容
为解决上述问题,本发明提供了一种基于标定治具的摄像头外参标定方法、芯片和机器人。本发明的具体技术方案如下:
一种基于标定治具的摄像头外参标定方法,该外参标定方法包括以下步骤:S1:机器人预先获取标定治具的标定板相对于标定治具的中心点的位姿;S2:机器人移动到标定治具中,然后通过摄像头获取标定治具的标定板的图像,并从标定板的图像中识别出标定点;S3:机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿;S4:机器人通过标定治具的标定板相对于标定治具的中心点的位姿和摄像头相对于每块标定板的位姿,来标定摄像头的外参。
进一步地,步骤S1中,机器人预先获取标定治具的标定板相对于标定治具的中心点的位姿,包括以下步骤:机器人使标定板在摄像头的拍摄范围内,然后移动到不同的预设位置来获取若干张标定板的图像,并获取移动时的IMU数据;机器人从获取的标定板的图像中识别出标定点,然后根据识别出的标定点,采用非线性优化算法计算出在不同的预设位置摄像头相对于标定板的位姿;机器人根据IMU数据和在不同的预设位置摄像头相对于标定板的位姿,采用非线性优化算法计算出摄像头相对于机器人的中心点的位姿;机器人移动到由若干个标定板构成的标定治具中,然后将当前机器人的中心点所处的位置设置为标定治具的中心点;机器人使摄像头竖直向上,然后通过摄像头获取具有标定治具所有标定板的图像,并从标定板的图像中识别出标定点;机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿;机器人根据摄像头相对于每块标定板的位姿和摄像头相对于机器人的中心点的位姿,采用矩阵变换的方式获取标定治具的标定板相对于标定治具的中心点的位姿。
进一步地,步骤S2中,机器人移动到标定治具中,然后通过摄像头获取标定治具的标定板的图像,包括以下步骤:机器人移动到由若干个标定板构成的标定治具中,然后使机器人的中心点与标定治具的中心点重合;机器人使摄像头竖直向上,然后通过摄像头获取具有标定治具所有标定板的图像。
进一步地,步骤S2中,机器人从标定板的图像中识别出标定点,包括以下步骤:机器人检测标定板的图像中四边形的黑色区域;机器人按顺时针方向连接检测到的四边形的黑色区域;机器人获取四边形的黑色区域的内四边形;机器人通过角点检测将内四边形的四个端点作为标定板的标定点;其中,所述标定板为棋盘格标定板,所述内四边形的四条边分别与四边形的黑色区域相连。
进一步地,步骤S3中,机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿,包括以下步骤:机器人获取标定点在标定板的物理坐标系上的物理坐标和图像中的标定点在图像上的像素坐标;机器人根据每块标定板相对于机器人中心点的初始位姿和摄像头的初始内参,将该标定板上的标定点投影到标定板的图像中得到标定板的标定点的投影坐标;机器人根据欧氏距离公式计算标定板的标定点的投影坐标和与该标定点相对应的图像中的标定点的像素坐标之间的欧氏距离;机器人根据获取的欧氏距离通过高斯牛顿法的迭代公式来对摄像头的内参进行优化,得到最佳的摄像头内参和摄像头相对于每块标定板的位姿。
进一步地,机器人在通过高斯牛顿法的迭代公式来对摄像头的内参进行优化时,在计算过程中获取到最小的欧氏距离时,将最小的欧氏距离对应的每块标定板与机器人中心点的位姿和摄像头的内参,作为最佳的摄像头内参和摄像头相对于每块标定板的位姿。
进一步地,机器人获取标定点在标定板的物理坐标系上的物理坐标,包括以下步骤:机器人以每块标定板的左上角的角点为原点,标定板连接左上角的角点的两条边分别为X轴和Y轴,构建物理坐标系;机器人根据标定点在标定板上的位置,获取标定点在物理坐标系上的坐标。
进一步地,机器人通过标定治具的标定板相对于标定治具的中心点的位姿和摄像头相对于每块标定板的位姿,来标定摄像头的外参,包括以下步骤:机器人获取标定治具的标定板相对于标定治具的中心点的位姿的旋转矩阵;机器人获取摄像头相对于其中一块标定板的位姿的旋转矩阵;机器人对标定治具的标定板相对于标定治具的中心点的位姿的旋转矩阵和摄像头相对于其中一块标定板的位姿的旋转矩阵根据欧拉公式进行转换,得到摄像头的外参矩阵。
一种芯片,该芯片用于存储程序,该程序被配置为执行上述的基于标定治具的摄像头外参标定方法。
一种移动机器人,所述移动机器人包括主控芯片,所述主控芯片为上述的芯片。
与现有的技术相比,本发明的有益效果在于:本申请所述的机器人在标定摄像头前获取标定治具的标定板相对于标定治具的中心点的位姿,具有不同摄像头外参的机器人只要获取标定治具的标定板的图像后,就可以根据标定板的图像和标定治具的标定板相对于标定治具的中心点的位姿得到机器人的外参,不需要对标定治具进行设置,缩短机器人标定摄像头外参的时间,提高标定摄像头外参的效率。
附图说明
图1为本发明一种实施例中基于标定治具的摄像头外参标定方法的流程示意图。
具体实施方式
下面详细描述本发明的实施例,所述的实施例示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。
下面结合说明书的附图,通过对本发明的具体实施方式作进一步的描述,使本发明的技术方案及其有益效果更加清楚、明确。下面通过参考附图描述实施例是示例性的,旨在解释本发明,而不能理解为对本发明的限制。
如图1所示,一种基于标定治具的摄像头外参标定方法,该外参标定方法包括以下步骤:
S1:机器人在采用标定治具标定摄像头的外参时,先对标定治具进行校准,并在校准过程中获取标定治具的标定板相对于标定治具的中心点的位姿,然后将获取的标定治具的标定板相对于标定治具的中心点的位姿预先保存在需要进行摄像头外参标定的机器人中,然后不同摄像头外参的机器人就可以根据同一个标定治具的标定板相对于标定治具的中心点的位姿进行摄像头外参标定。S2:机器人移动到标定治具中,机器人通过摄像头获取标定治具的标定板的图像,然后从标定板的图像中识别出标定点。标定治具由若干块标定板构成,标定板的数量和尺寸根据机器人的需求来调整,不对标定板的数量和尺寸进行限定。标定板可以是棋盘格标定板、ArUco标定板(ArUco是一个根据预设黑白markers(二维码)来估计相机位姿的开源库)或ChArUco标定板(ChArUco标定板由棋盘格标定板和ArUco标定板组合得到)等,根据标定板的类型,标定点可以是角点、圆点或Charuco角等等。机器人可以通过角点检测算法从标定板的图像中识别出标定点。S3:机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿。标定板上的标定点为现实中标定治具中的标定板上的点,标定板上的标定点在标定板上的位置由标定板的类型和尺寸来确定,不同类型和尺寸的标定板的标定点在标定板上的位置都是不同的,用户可以在标定摄像头前通过辅助工具检测出来。图像中的标定点为标定板图像中识别出的标定点,图像中的标定点在图像上的位置为图像的像素坐标,根据机器人在图像中识别出标定点时,标定点所占据的像素点得到。S4:机器人通过标定治具的标定板相对于标定治具的中心点的位姿和摄像头相对于每块标定板的位姿,来标定摄像头的外参。摄像头的外参为摄像头相对于机器人中心点的位姿。其中,本申请文件中,机器人在确定所述的摄像头相对于每块标定板的位姿、标定治具的标定板相对于标定治具的中心点的位姿和摄像头相对于机器人中心点的位姿时,摄像头的正方向为摄像头向前拍摄的方向,机器人的正方向为机器人的前进方向,标定治具的标定板的正方向根据标定板的物理坐标系来决定。与现有的技术相比,本发明的有益效果在于:本申请所述的机器人在标定摄像头前获取标定治具的标定板相对于标定治具的中心点的位姿,具有不同摄像头外参的机器人只要获取标定治具的标定板的图像后,就可以根据标定板的图像和标定治具的标定板相对于标定治具的中心点的位姿得到机器人的外参,不需要对标定治具进行设置,缩短机器人标定摄像头外参的时间,提高标定摄像头外参的效率。
作为其中一种实施例,步骤S1中,机器人预先获取标定治具的标定板相对于标定治具的中心点的位姿,包括以下步骤:机器人使标定板在摄像头的拍摄范围内,然后机器人移动到不同的预设位置来获取若干张标定板的图像,并获取移动时的IMU数据。机器人从获取的标定板的图像中识别出标定点,然后根据识别出的标定点,采用非线性优化算法计算出在不同的预设位置摄像头相对于标定板的位姿。机器人根据IMU数据和在不同的预设位置摄像头相对于标定板的位姿,采用非线性优化算法计算出摄像头相对于机器人的中心点的位姿。机器人移动到由若干个标定板构成的标定治具中,然后将当前机器人的中心点所处的位置设置为标定治具的中心点,当标定治具的中心点设置完成后,标定治具用于标定其他机器人的摄像头时,标定治具的中心点不会改变。机器人使摄像头竖直向上,然后通过摄像头获取具有标定治具所有标定板的图像,并从标定板的图像中识别出标定点。机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿。机器人根据摄像头相对于每块标定板的位姿和摄像头相对于机器人的中心点的位姿,采用矩阵变换的方式获取标定治具的标定板相对于标定治具的中心点的位姿。机器人在摄像头标定前获取标定治具的标定板相对于标定治具的中心点的位姿,只要将不同的外参的机器人的中心点与标定治具的中心点重合,就可以通过标定治具的标定板相对于标定治具的中心点的位姿计算出机器人的外参,灵活性较高。
作为其中一种实施例,步骤S2中,机器人移动到标定治具中,然后通过摄像头获取标定治具的标定板的图像,包括以下步骤:机器人移动到由若干个标定板构成的标定治具中,然后使机器人的中心点与标定治具的中心点重合,机器人的中心点与标定治具的中心点重合可以是水平面上的重合。标定治具的标定板一般围绕机器人设置,机器人在获取标定板的图像时,机器人使摄像头竖直向上,然后通过摄像头获取具有标定治具所有标定板的图像,为了使摄像头能捕捉到所有的标定板,机器人可以通过自转使标定治具的所有标定板落在摄像头的视角范围中,如果有标定板没有落入摄像头的视角范围,可以将该标定板去除。在本申请文件中,机器人的中心点可以是机器人水平截面的中心点,而标定治具的中心点在机器人获取标定治具的标定板相对于标定治具的中心点的位姿时,通过机器人的中心点来设置,并且在设置后不进行改变,设置的时间为机器人开始标定工作前。本申请所述的机器人通过使摄像头竖直向上的方式来获取标定板的图像,有利于机器人获取具有标定治具所有标定板的图像,提高标定效率。
作为其中一种实施例,步骤S1中,机器人从标定板的图像中识别出标定点,包括以下步骤:机器人检测标定板的图像中四边形的黑色区域。机器人按顺时针方向连接检测到的四边形的黑色区域。机器人获取四边形的黑色区域的内四边形。机器人通过角点检测将内四边形的四个端点作为标定板的标定点。其中,所述标定板为棋盘格标定板,所述内四边形的四条边分别与四边形的黑色区域相连,即所述四边形的黑色区域为棋盘格的黑色四边形,所述四边形的黑色区域的内四边形为棋盘格的白色四边形,由四个黑色四边形围成。机器人先从棋盘格标定板中识别出内四边形,然后将内四边形的四个端点作为标定点,有效去除棋盘格中与棋盘格的四条边相连的标定点,提高标定结果的准确率。
作为其中一种实施例,步骤S3中,机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿,包括以下步骤:机器人获取标定点在标定板的物理坐标系上的物理坐标和图像中的标定点在图像上的像素坐标。机器人根据每块标定板相对于机器人中心点的初始位姿(可以手动测量标定板相对于机器人的中心点的距离计算出初始位姿)和摄像头的初始内参(从图像估算初始摄像头内参(或者从摄像头厂家获取)),将该标定板上的标定点投影到标定板的图像中得到标定板的标定点的投影坐标。机器人根据欧氏距离公式计算标定板的标定点的投影坐标和与该标定点相对应的图像中的标定点的像素坐标之间的欧氏距离。机器人根据获取的欧氏距离通过高斯牛顿法的迭代公式来对摄像头的内参进行优化,得到最佳的摄像头内参和摄像头相对于每块标定板的位姿。假设标定点在标定板的物理坐标系上的物理坐标为(x0,y0),根据投影坐标转换得到标定板的标定点的投影坐标(x1,y1),图像中的标定点在图像上的像素坐标为(x2,y2),根据标定板的标定点的投影坐标和与该标定点相对应的图像中的标定点的像素坐标之间的欧氏距离为d=sqrt((x1-x2)∧2-(y1-y2)∧2)。然后机器人根据高斯牛顿法的迭代公式来对摄像头的内参进行优化,θn+1=θn-(JTJ)∧-1*JTd;其中,θn+1为更新后的内参或外参,θn为更新前的内参或外参,d为计算得到的欧氏距离,J为雅克比矩阵。机器人还可以通过Levenberg-Marquardt算法(LM算法是使用最广泛的非线性最小二乘算法,中文为列文伯格-马夸尔特法。它是利用梯度求最大(小)值的算法。)来优化每块标定板与机器人中心点的位姿和摄像头的内参。机器人在获取每块标定板与机器人中心点的初始位姿和摄像头的初始内参后,通过高斯牛顿法不断迭代优化每块标定板与机器人中心点的位姿和摄像头的内参,使机器人获取到的每块标定板与机器人中心点的位姿和摄像头的内参为最优值,提高计算结果的准确率。
作为其中一种实施例,机器人获取标定板相对于机器人中心点的初始位姿,包括以下步骤:机器人过标定板的左上角的角点做垂直于标定板的垂线;机器人将垂直于标定板的垂线与机器人的前进方向之间的夹角作为标定板与机器人的夹角;机器人获取机器人的中心点与标定板的左上角的角点之间的距离;机器人根据标定板与机器人的夹角和机器人的中心点与标定板的左上角的角点之间的距离,组合得到标定板相对于机器人中心点的初始位姿。机器人以自身的中点作为机器人坐标系的原点,机器人前进方向作为机器人坐标系的X轴,机器人的轮轴线作为机器人坐标系的Y轴,构建机器人坐标系,机器人根据机器人将垂直于标定板的垂线与机器人的前进方向之间的夹角、标定板的左上角的角点之间的距离和标定板的左上角的高度,就可以换算出每个标定板相对于机器人中心点的初始位姿。机器人根据标定板与机器人的夹角和机器人的中心点与标定板的左上角的角点之间的距离来计算出标定板相对于机器人中心点的位姿,提高计算速度。
作为其中一种实施例,机器人在通过高斯牛顿法的迭代公式来对摄像头的内参进行优化时,在计算过程中获取到最小的欧氏距离时,将最小的欧氏距离对应的每块标定板与机器人中心点的位姿和摄像头的内参,作为最佳的摄像头内参和摄像头相对于每块标定板的位姿。本申请文件中所述的欧氏距离为标定板的标定点和图像中的标定点的重投影误差,通过获取重投影误差的最小值来获取最优的每块标定板与机器人中心点的位姿和摄像头的内参,实用性较高。
作为其中一种实施例,机器人获取标定点在标定板的物理坐标系上的物理坐标,包括以下步骤:机器人以每块标定板的左上角的角点为原点,标定板连接左上角的角点的两条边分别为X轴和Y轴,构建物理坐标系。机器人根据标定点在标定板上的位置,获取标定点在物理坐标系上的坐标。机器人分别根据标定板的边来构建物理坐标系,提高计算的准确度。
作为其中一种实施例,步骤S4中,机器人通过预设的标定板相对于机器人中心的位姿和摄像头相对于每块标定板的位姿,来标定摄像头的外参,包括以下步骤:机器人获取预设的标定板相对于机器人中心的位姿的旋转矩阵。机器人获取摄像头相对于其中一块标定板的位姿的旋转矩阵。机器人对预设的标定板相对于机器人中心的位姿的旋转矩阵和摄像头相对于其中一块标定板的位姿的旋转矩阵根据欧拉公式进行转换,得到摄像头的外参矩阵。机器人通过矩阵变换的方式来获取摄像头的外参,计算速度较快。
一种芯片,该芯片用于存储程序,该程序被配置为执行上述的基于标定治具的摄像头外参标定方法。
一种移动机器人,所述移动机器人包括主控芯片,所述主控芯片为上述的芯片。
与现有的技术相比,本发明的有益效果在于:本申请所述的机器人在标定摄像头前获取标定治具的标定板相对于标定治具的中心点的位姿,具有不同摄像头外参的机器人只要获取标定治具的标定板的图像后,就可以根据标定板的图像和标定治具的标定板相对于标定治具的中心点的位姿得到机器人的外参,不需要对标定治具进行设置,缩短机器人标定摄像头外参的时间,提高标定摄像头外参的效率。
在说明书的描述中,参考术语“合一个实施例”、“优选地”、“示例”、“具体示例”或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点,包含于本发明的至少一个实施例或示例中,在本说明书中对于上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或者示例中以合适方式结合。说明书的描述中连接的所述连接方式具有明显的效果和实用效力。
通过上述的结构和原理的描述,所属技术领域的技术人员应当理解,本发明不局限于上述的具体实施方式,在本发明基础上采用本领域公知技术的改进和替代均落在本发明的保护范围,应由各权利要求限定之。
Claims (10)
1.一种基于标定治具的摄像头外参标定方法,其特征在于,该外参标定方法包括以下步骤:
S1:机器人预先获取标定治具的标定板相对于标定治具的中心点的位姿;
S2:机器人移动到标定治具中,然后通过摄像头获取标定治具的标定板的图像,并从标定板的图像中识别出标定点;
S3:机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿;
S4:机器人通过标定治具的标定板相对于标定治具的中心点的位姿和摄像头相对于每块标定板的位姿,来标定摄像头的外参。
2.根据权利要求1所述的一种基于标定治具的摄像头外参标定方法,其特征在于,步骤S1中,机器人预先获取标定治具的标定板相对于标定治具的中心点的位姿,包括以下步骤:
机器人使标定板在摄像头的拍摄范围内,然后移动到不同的预设位置来获取若干张标定板的图像,并获取移动时的IMU数据;
机器人从获取的标定板的图像中识别出标定点,然后根据识别出的标定点,采用非线性优化算法计算出在不同的预设位置摄像头相对于标定板的位姿;
机器人根据IMU数据和在不同的预设位置摄像头相对于标定板的位姿,采用非线性优化算法计算出摄像头相对于机器人的中心点的位姿;
机器人移动到由若干个标定板构成的标定治具中,然后将当前机器人的中心点所处的位置设置为标定治具的中心点;
机器人使摄像头竖直向上,然后通过摄像头获取具有标定治具所有标定板的图像,并从标定板的图像中识别出标定点;
机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿;
机器人根据摄像头相对于每块标定板的位姿和摄像头相对于机器人的中心点的位姿,采用矩阵变换的方式获取标定治具的标定板相对于标定治具的中心点的位姿。
3.根据权利要求2所述的一种基于标定治具的摄像头外参标定方法,其特征在于,步骤S2中,机器人移动到标定治具中,然后通过摄像头获取标定治具的标定板的图像,包括以下步骤:机器人移动到由若干个标定板构成的标定治具中,然后使机器人的中心点与标定治具的中心点重合;
机器人使摄像头竖直向上,然后通过摄像头获取具有标定治具所有标定板的图像。
4.根据权利要求3所述的一种基于标定治具的摄像头外参标定方法,其特征在于,步骤S2中,机器人从标定板的图像中识别出标定点,包括以下步骤:
机器人检测标定板的图像中四边形的黑色区域;
机器人按顺时针方向连接检测到的四边形的黑色区域;
机器人获取四边形的黑色区域的内四边形;
机器人通过角点检测将内四边形的四个端点作为标定板的标定点;
其中,所述标定板为棋盘格标定板,所述内四边形的四条边分别与四边形的黑色区域相连。
5.根据权利要求4所述的一种基于标定治具的摄像头外参标定方法,其特征在于,步骤S3中,机器人根据标定板上的标定点在标定板上的位置和图像中的标定点在图像上的位置,来获取摄像头相对于每块标定板的位姿,包括以下步骤:
机器人获取标定点在标定板的物理坐标系上的物理坐标和图像中的标定点在图像上的像素坐标;
机器人根据每块标定板相对于机器人中心点的初始位姿和摄像头的初始内参,将该标定板上的标定点投影到标定板的图像中得到标定板的标定点的投影坐标;
机器人根据欧氏距离公式计算标定板的标定点的投影坐标和与该标定点相对应的图像中的标定点的像素坐标之间的欧氏距离;
机器人根据获取的欧氏距离通过高斯牛顿法的迭代公式来对摄像头的内参进行优化,得到最佳的摄像头内参和摄像头相对于每块标定板的位姿。
6.根据权利要求5所述的一种基于标定治具的摄像头外参标定方法,其特征在于,机器人在通过高斯牛顿法的迭代公式来对摄像头的内参进行优化时,在计算过程中获取到最小的欧氏距离时,将最小的欧氏距离对应的每块标定板与机器人中心点的位姿和摄像头的内参,作为最佳的摄像头内参和摄像头相对于每块标定板的位姿。
7.根据权利要求5所述的一种基于标定治具的摄像头外参标定方法,其特征在于,机器人获取标定点在标定板的物理坐标系上的物理坐标,包括以下步骤:
机器人以每块标定板的左上角的角点为原点,标定板连接左上角的角点的两条边分别为X轴和Y轴,构建物理坐标系;
机器人根据标定点在标定板上的位置,获取标定点在物理坐标系上的坐标。
8.根据权利要求5所述的一种基于标定治具的摄像头外参标定方法,其特征在于,机器人通过标定治具的标定板相对于标定治具的中心点的位姿和摄像头相对于每块标定板的位姿,来标定摄像头的外参,包括以下步骤:
机器人获取标定治具的标定板相对于标定治具的中心点的位姿的旋转矩阵;
机器人获取摄像头相对于其中一块标定板的位姿的旋转矩阵;
机器人对标定治具的标定板相对于标定治具的中心点的位姿的旋转矩阵和摄像头相对于其中一块标定板的位姿的旋转矩阵根据欧拉公式进行转换,得到摄像头的外参矩阵。
9.一种芯片,该芯片用于存储程序,其特征在于,该程序被配置为执行权利要求1至8任一项所述的基于标定治具的摄像头外参标定方法。
10.一种移动机器人,其特征在于,所述移动机器人包括主控芯片,所述主控芯片为权利要求9所述的芯片。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310830908.4A CN116912325A (zh) | 2023-07-07 | 2023-07-07 | 基于标定治具的摄像头外参标定方法、芯片和机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310830908.4A CN116912325A (zh) | 2023-07-07 | 2023-07-07 | 基于标定治具的摄像头外参标定方法、芯片和机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116912325A true CN116912325A (zh) | 2023-10-20 |
Family
ID=88367551
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310830908.4A Pending CN116912325A (zh) | 2023-07-07 | 2023-07-07 | 基于标定治具的摄像头外参标定方法、芯片和机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116912325A (zh) |
-
2023
- 2023-07-07 CN CN202310830908.4A patent/CN116912325A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11157766B2 (en) | Method, apparatus, device and medium for calibrating pose relationship between vehicle sensor and vehicle | |
CN108297096B (zh) | 校准装置、校准方法以及计算机能够读取的介质 | |
JP4191080B2 (ja) | 計測装置 | |
US8436904B2 (en) | Method and apparatus for calibrating video camera | |
CN109807885B (zh) | 一种机械手的视觉标定方法、装置及智能终端 | |
US7023473B2 (en) | Camera calibration device and method, and computer system | |
US20160214255A1 (en) | Method for calibrating an articulated end effector employing a remote digital camera | |
CN113379849B (zh) | 基于深度相机的机器人自主识别智能抓取方法及系统 | |
CN111612794A (zh) | 基于多2d视觉的零部件高精度三维位姿估计方法及系统 | |
CN110827361B (zh) | 基于全局标定架的相机组标定方法及装置 | |
KR102618285B1 (ko) | 카메라 자세 결정 방법 및 시스템 | |
US11548156B2 (en) | Device and method for calibrating coordinate system of 3D camera and robotic arm | |
JPWO2018043524A1 (ja) | ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法 | |
CN112233184B (zh) | 基于图像配准的激光雷达与相机标定参数校正方法及装置 | |
JP2022152845A (ja) | ロボット制御用のキャリブレーション装置 | |
US20210008724A1 (en) | Method and apparatus for managing robot system | |
CN114677429B (zh) | 一种机械手的定位方法、装置、计算机设备和存储介质 | |
CN116912325A (zh) | 基于标定治具的摄像头外参标定方法、芯片和机器人 | |
CN111098306A (zh) | 机器人的标定方法、装置、机器人和存储介质 | |
CN114792343B (zh) | 图像获取设备的标定方法、获取图像数据的方法、装置 | |
CN116934866A (zh) | 一种机器人的摄像头标定方法 | |
CN116934867A (zh) | 一种摄像头标定方法 | |
WO2021145280A1 (ja) | ロボットシステム | |
CN116912326A (zh) | 一种标定治具的校准方法、标定治具和系统 | |
JP2019095345A (ja) | 物体識別システム |
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 |