CN105955260A - 移动机器人位置感知方法和装置 - Google Patents
移动机器人位置感知方法和装置 Download PDFInfo
- Publication number
- CN105955260A CN105955260A CN201610286914.8A CN201610286914A CN105955260A CN 105955260 A CN105955260 A CN 105955260A CN 201610286914 A CN201610286914 A CN 201610286914A CN 105955260 A CN105955260 A CN 105955260A
- Authority
- CN
- China
- Prior art keywords
- camera
- coordinates
- label
- video camera
- coordinate
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000008447 perception Effects 0.000 title abstract description 6
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 claims abstract description 67
- 230000009466 transformation Effects 0.000 claims abstract description 66
- 238000003384 imaging method Methods 0.000 claims abstract description 51
- 239000000284 extract Substances 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 11
- 230000001149 cognitive effect Effects 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 7
- 230000004044 response Effects 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000002045 lasting effect Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000002411 adverse Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000002372 labelling Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 230000003137 locomotive effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000004899 motility Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Image Analysis (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种移动机器人位置感知方法和装置,所述方法包括:利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;所述摄像机置于移动机器人上;获取所述标签对应的空间坐标;提取所述标签在所述摄像机成像后对应的图像坐标,根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标;根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标。采用本方法能够准确、快速的确定移动机器人所在的位置。
Description
技术领域
本发明涉及移动机器人技术领域,特别是涉及一种移动机器人位置感知方法和装置。
背景技术
移动机器人是一种可以在复杂环境下工作,具有自行组织、自主运行、自主规划的智能机器人,融合了计算机技术、信息技术、通信技术、微电子技术和机器人技术等。移动机器人具有移动功能,在代替人从事危险、恶劣环境下作业和人所不及的环境作业方面,比一般机器人有更大的机动性、灵活性。为了更好的利用移动机器人,当移动机器人在三维空间中进行运动时,需要准确、快速的确定移动机器人所在的位置。因此,如何准确、快速的确定移动机器人所在的位置成为目前需要解决的一个技术问题。
发明内容
基于此,有必要针对上述技术问题,提供一种能够准确、快速的确定移动机器人所在的位置的移动机器人位置感知方法和装置。
一种移动机器人位置感知方法,所述方法包括:
利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;所述摄像机置于移动机器人上;
获取所述标签对应的空间坐标;
提取所述标签在所述摄像机成像后对应的图像坐标,根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标;
根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标。
在其中一个实施例中,在所述利用摄像机对移动机器人所在空间中物体上的标签进行成像之前,还包括:
利用摄像机对标定板进行成像;
获取标定板在多个位置对应的成像图像;
根据标定板在多个位置对应的成像图像计算出所述摄像机的参数以及摄像机之间的位置关系。
在其中一个实施例中,所述根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标包括:
获取摄像机投影中心的连线距离和摄像机的焦距;
根据所述标签对应的图像坐标与所述连线距离和所述焦距计算所述标签在摄像机坐标系中的摄像机坐标。
在其中一个实施例中,所述根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标包括:
根据所述标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系;
获取摄像机坐标系的摄像机坐标原点;
根据所述摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将所述摄像机坐标原点仿射变换至空间坐标系,得到所述移动机器人在三维空间中的坐标。
在其中一个实施例中,所述根据所述标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系包括:
提取所述标签对应的多个点;
获取所述多个点对应的空间坐标以及所述多个点被摄像机成像后在摄像机坐标系中的摄像机坐标;
根据所述空间坐标和所述摄像机坐标建立多个方程组;
通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵。
一种移动机器人位置感知装置,所述装置包括:
成像模块,用于利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;所述摄像机置于移动机器人上;
获取模块,用于获取所述标签对应的空间坐标;
坐标计算模块,用于提取所述标签在所述摄像机成像后对应的图像坐标,根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标;
仿射变换模块,用于根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标。
在其中一个实施例中,所述成像模块还用于利用摄像机对标定板进行成像;所述获取模块还用于获取标定板在多个位置对应的成像图像;
所述装置还包括:
标定模块,用于根据标定板在多个位置对应的成像图像计算出所述摄像机的参数以及摄像机之间的位置关系。
在其中一个实施例中,所述坐标计算模块还用于获取摄像机投影中心的连线距离和摄像机的焦距;根据所述标签对应的图像坐标与所述连线距离和所述焦距计算所述标签在摄像机坐标系中的摄像机坐标。
在其中一个实施例中,所述仿射变换模块还用于根据所述标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系;获取摄像机坐标系的摄像机坐标原点;根据所述摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将所述摄像机坐标原点仿射变换至空间坐标系,得到所述移动机器人在三维空间中的坐标。
在其中一个实施例中,所述仿射变换模块还用于提取所述标签对应的多个点;获取所述多个点对应的空间坐标以及所述多个点被摄像机成像后在摄像机坐标系中的摄像机坐标;根据所述空间坐标和所述摄像机坐标建立多个方程组;通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵。
上述移动机器人位置感知方法和装置,通过利用移动机器人配备的摄像机对所在三维空间中物体上的标签进行成像,获取标签对应的空间坐标。提取标签在摄像机成像后的图像坐标,根据图像坐标计算标签在摄像机坐标系中的摄像机坐标。根据摄像机坐标和空间坐标进行仿射变换,从而得到移动机器人在三维空间中的坐标。由于摄像机置于移动机器人上,在移动机器人移动时,摄像机坐标系能够随着移动机器人的移动而变化。由此通过摄像机对物体上的标签进行持续成像,从而能够准确、快速的确定移动机器人在三维空间中的位置。
附图说明
图1为一个实施例中移动机器人位置感知方法的流程图;
图2为一个实施例中移动机器人位置感知方法的应用示意图;
图3为一个实施例中双目立体视觉测量的示意图;
图4为一个实施例中移动机器人位置感知的结构示意图;
图5为又一个实施例中移动机器人位置感知的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
在一个实施例中,如图1所示,提供了一种移动机器人位置感知方法,方法包括:
步骤102,利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;摄像机置于移动机器人上。
步骤104,获取标签对应的空间坐标。
移动机器人上配备有摄像机。摄像机至少包括两个,摄像机可以是双目摄像机,也可以是多目摄像机。移动机器人置于三维空间中,例如,三维空间可以是客厅或卧室等。三维空间中的不同位置上可以摆放多个不同的物体。在物体的表面可以贴有标签。标签可以是二维码、电子标签或者产品标签等。标签中包括属性信息,其中属性信息包括物体的名称、标签所在位置等。优选的,标签所在位置可以是标签中多个点的空间坐标。由于标签所在位置可以是空间坐标,可以视为物体上所贴有的标签是位于一个空间坐标系定位好的三维空间中。因此,移动机器人所在的三维空间也是一个空间坐标系已知的三维空间。
当摄像机为双目摄像机时,采用双目立体视觉方法对双目摄像机进行标定。当摄像机为多目摄像机时,采用多目立体视觉方法对多目摄像机进行标定。在摄像机标定之后,利用摄像机对移动机器人所在三维空间中物体上的标签进行成像,得到标签图像。对标签图像进行识别,获取标签对应的空间坐标。其中,标签对应的空间坐标可以是标签中多个点的空间坐标。标签中的多个点可以是任意的点。优选的,标签中的多个点可以是标签的顶点。
步骤106,提取标签在摄像机成像后对应的图像坐标,根据图像坐标计算标签在摄像机坐标系中的摄像机坐标。
摄像机对标签成像得到的标签图像可以是成像平面。通过图像与处理可以得到标签在摄像机中的图像坐标。优选的,提取标签中的多个点在摄像机中的图像坐标。当摄像机为双目摄像机时,标签中的每个点在摄像机中的图像坐标有两个。双目摄像机可以包括第一摄像机和第二摄像机,标签中的每个点在摄像机中的图像坐标分别是该点在第一摄像机中的图像坐标和该点在第二摄像机中的图像坐标。当摄像机为多目摄像机时,标签中的每个点在摄像机种的图像坐标有多个。例如,多目摄像机包括第一摄像机、第二摄像机和第三摄像机,标签中的每个点在摄像机中的图像坐标分别是该点在第一摄像机中的图像坐标、该点在第二摄像机中的图像坐标以及该点在第二摄像机中的图像坐标。
摄像机具有对应的摄像机坐标系。摄像机坐标系的原点可以在其中一个摄像机镜头的光心处。获取摄像机投影中心的连线距离和摄像机的焦距;根据标签对应的图像坐标与连线距离和焦距计算标签在摄像机坐标系中的摄像机坐标。摄像机坐标系跟随移动机器人的移动而变化。在移动机器人移动的过程中,摄像机保持对所在三维空间中物体上的标签进行成像。
步骤108,根据摄像机坐标和空间坐标进行仿射变换,得到移动机器人在三维空间中的坐标。
根据标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系。获取摄像机坐标系的摄像机坐标原点,根据摄像机坐标原点和摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将摄像机坐标原点仿射变换至空间坐标系,得到移动机器人在三维空间中的坐标。
如图2所示,为移动机器人位置感知方法的应用示意图。移动机器人位于一个三维空间的房间中。房间中的物体上贴有二维码,二维码中包含了二维码图形的四个顶点的空间坐标和二维码所贴物体的信息。移动机器人顶端绑定有两个相对位置固定的摄像机,即双目摄像机。空间坐标系为坐标系xyz,是已知坐标系。摄像机坐标系为xcyczc,可以随着机器人的移动而变化。摄像机对二维码进行持续成像,获取二维码图形的四个顶点的空间坐标。提取四个顶点在摄像机成像后对应的图像坐标,根据图像坐标计算这四个顶点在摄像机坐标系中的摄像机坐标。根据摄像机坐标和空间坐标进行仿射变换,得到移动机器人在三维空间中的坐标。由于摄像机对二维码进行持续成像,因此移动机器人可以准确、快速的感知所在位置。根据二维码所贴物体的信息,还可以对移动机器人的运动路径及时进行避障。
本实施例中,通过利用移动机器人配备的摄像机对所在三维空间中物体上的标签进行成像,获取标签对应的空间坐标。提取标签在摄像机成像后的图像坐标,根据图像坐标计算标签在摄像机坐标系中的摄像机坐标。根据摄像机坐标和空间坐标进行仿射变换,从而得到移动机器人在三维空间中的坐标。由于摄像机置于移动机器人上,在移动机器人移动时,摄像机坐标系能够随着移动机器人的移动而变化。由此通过摄像机对物体上的标签进行持续成像,从而能够准确、快速的确定移动机器人在三维空间中的位置。
在一个实施例中,在利用摄像机对移动机器人所在三维空间中物体上的标签进行成像之前,还包括:利用摄像机对标定板进行成像;获取标定板在多个位置对应的成像;根据标定板在多个位置对应的成像计算出摄像机的参数以及摄像机之间的位置关系。
本实施例中,为了确保摄像机对移动机器人所在三维空间中物体上的标签进行有效成像,在摄像机对标签进行成像之前,需要对摄像机进行标定。对摄像机进行标定也就是需要标定出摄像机的内部参数、外部参数以及摄像机之间的相对位置关系。摄像机的内部参数包括焦距、投影中心和光心等。摄像机的外部参数包括摄像机与空间坐标系的夹角等。摄像机的外部参数以及摄像机之间的相对位置关系可以用旋转矩阵和平移向量来表示。利用摄像机对标定板进行成像,获取标定板在多个位置对应的成像图像,根据标定板在多个位置对应的成像图像计算出摄像机的内部参数、外部参数以及摄像机之间的相对位置关系。
以摄像机为双目摄像机为例进行说明。将标定板放置于合适位置,以使得标定板在第一摄像机和第二摄像机中能够完全成像。第一摄像机和第二摄像机获取标定板在多个位置时对应的成像图像。通过双目立体视觉标定算法即可标定出两个摄像机的内参数、外参数以及两个摄像机之间的相对位置关系。
在一个实施例中,根据图像坐标计算标签在摄像机坐标系中的摄像机坐标包括:获取摄像机投影中心的连线距离和摄像机的焦距;根据标签对应的图像坐标与连线距离和焦距计算标签在摄像机坐标系中的摄像机坐标。
本实施例中,在标定摄像机的内部参数、外部参数以及摄像机之间的相对位置关系之后,可以根据标签对应的图像坐标来计算标签在摄像机坐标系中的摄像机坐标。优选的,提取标签中一个或多个点,通过图像预处理计算出一个或多个点在摄像机中的图像坐标。根据一个或多个点的图像坐标计算该一个点或多个点在摄像机坐标系中的摄像机坐标。
以摄像机为双目摄像机为例,提取标签中的一个点P,通过图像预处理得到该点在第一摄像机中的图像坐标为(Row1,Col1),在第二摄像机中的图像坐标为(Row2,Col2)。通过双目立体视觉测量来计算该点在摄像机坐标系中的摄像机坐标。如图3所示,为双目立体视觉测量的示意图。其中,第一摄像机与第二摄像机投影中心的连线的距离即基线距为b,第一摄像机和第二摄像机的焦距分别为f。摄像机坐标系为xcyczc,其原点在第一摄像机镜头的光心处。第一图像为第一摄像机的成像平面,对应的坐标系为vu。第二图像为第而摄像机的成像平面。第一图像平面坐标系原点在摄像机光轴与第一成像平面的交点O1处,第二图像平面坐标系原点在摄像机光轴与第二成像平面的交点O2处。O1uv的v轴和u轴与和摄像机坐标系的xc轴和yc轴方向一致,以此能够简化计算过程。标签中的一个点P(x,y,z)在第一图像和第二图像中相应的图像坐标分别为P1(v1,u1)和P2(v2,u2)。假定第一图像和第二图像在同一个平面上,则点P的图像坐标中u1=u2。由相似三角形原理可得:
解方程组即可得到P点在摄像机坐标系中的坐标为:
在一个实施例中,根据摄像机坐标和空间坐标进行仿射变换,得到移动机器人在三维空间中的坐标包括:根据标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系;获取摄像机坐标系的摄像机坐标原点;根据摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将摄像机坐标原点仿射变换至空间坐标系,得到移动机器人在三维空间中的坐标。
本实施例中,摄像机坐标系到空间坐标系的仿射变换可以由仿射矩阵来表示。由于移动机器人所在的空间为三维空间,因此仿射变换的矩阵可以采用一个4×4的矩阵HomMat3D表示:
在一个实施例中,根据标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系包括:提取标签对应的多个点;获取多个点对应的空间坐标以及多个点被摄像机成像后在摄像机坐标系中的摄像机坐标;根据空间坐标和摄像机坐标建立多个方程组;通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵。
假设(xc,yc,zc)为摄像机坐标系中的某点,(Qx,Qy,Qz)为对应的空间坐标系中的点,则
提取标签对应的多个点,获取标签对应的多个点的空间坐标以及多个点被摄像机成像后在摄像机坐标系中的摄像机坐标。优选的,提取标签对应的多个顶点,获取多个顶点的空间坐标以及多个顶点在摄像机坐标系中的摄像机坐标。例如,提取标签的四个顶点,其中这四个顶点在空间坐标系中空间坐标分别为(xc1,yc1,zc1)、(xc2,yc2,zc2)、(xc3,yc3,zc3)和(xc4,yc4,zc4),这四个顶点在摄像机坐标系中的摄像机坐标分别为(Qx1,Qy1,Qz1)、(Qx2,Qy2,Qz2)、(Qx3,Qy3,Qz3)和(Qx4,Qy4,Qz4)根据以上关系建立三个四元一次方程组:
通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵从而求得仿射变换矩阵HomMat3D。
摄像机坐标系的坐标原点即为移动机器人在摄像机坐标系中的位置。获取摄像机坐标系的摄像机坐标原点,根据摄像机坐标系与空间坐标系之间的仿射变换矩阵进行仿射变换,将摄像机坐标原点仿射变换至空间坐标系,得到移动机器人在三维空间中的坐标。
在一个实施例中,如图4所示,提供了一种移动机器人位置感知装置,包括:成像模块402、获取模块404、坐标计算模块406和仿射变换模块408,其中:
成像模块402,用于利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;摄像机置于移动机器人上。
获取模块404,用于获取标签对应的空间坐标。
坐标计算模块406,用于提取标签在摄像机成像后对应的图像坐标,根据图像坐标计算标签在摄像机坐标系中的摄像机坐标。
仿射变换模块408,用于根据摄像机坐标和空间坐标进行仿射变换,得到移动机器人在三维空间中的坐标。
在一个实施例中,成像模块402还用于利用摄像机对标定板进行成像;获取模块还用于获取标定板在多个位置对应的成像图像;如图5所示,该装置还包括:标定模块410,用于根据标定板在多个位置对应的成像图像计算出摄像机的参数以及摄像机之间的位置关系。
在一个实施例中,坐标计算模块406还用于获取摄像机投影中心的连线距离和摄像机的焦距;根据标签对应的图像坐标与连线距离和焦距计算标签在摄像机坐标系中的摄像机坐标。
在一个实施例中,仿射变换模块408还用于根据标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系;获取摄像机坐标系的摄像机坐标原点;根据摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将摄像机坐标原点仿射变换至空间坐标系,得到移动机器人在三维空间中的坐标。
在一个实施例中,仿射变换模块408还用于提取标签对应的多个点;获取多个点对应的空间坐标以及多个点被摄像机成像后在摄像机坐标系中的摄像机坐标;根据空间坐标和摄像机坐标建立多个方程组;通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种移动机器人位置感知方法,所述方法包括:
利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;所述摄像机置于移动机器人上;
获取所述标签对应的空间坐标;
提取所述标签在所述摄像机成像后对应的图像坐标,根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标;
根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标。
2.根据权利要求1所述的方法,其特征在于,在所述利用摄像机对移动机器人所在空间中物体上的标签进行成像之前,还包括:
利用摄像机对标定板进行成像;
获取标定板在多个位置对应的成像图像;
根据标定板在多个位置对应的成像图像计算出所述摄像机的参数以及摄像机之间的位置关系。
3.根据权利要求2所述的方法,其特征在于,所述根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标包括:
获取摄像机投影中心的连线距离和摄像机的焦距;
根据所述标签对应的图像坐标与所述连线距离和所述焦距计算所述标签在摄像机坐标系中的摄像机坐标。
4.根据权利要求2所述的方法,其特征在于,所述根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标包括:
根据所述标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系;
获取摄像机坐标系的摄像机坐标原点;
根据所述摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将所述摄像机坐标原点仿射变换至空间坐标系,得到所述移动机器人在三维空间中的坐标。
5.根据权利要求4所述的方法,其特征在于,所述根据所述标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系包括:
提取所述标签对应的多个点;
获取所述多个点对应的空间坐标以及所述多个点被摄像机成像后在摄像机坐标系中的摄像机坐标;
根据所述空间坐标和所述摄像机坐标建立多个方程组;
通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵。
6.一种移动机器人位置感知装置,其特征在于,所述装置包括:
成像模块,用于利用摄像机对移动机器人所在三维空间中物体上的标签进行成像;所述摄像机置于移动机器人上;
获取模块,用于获取所述标签对应的空间坐标;
坐标计算模块,用于提取所述标签在所述摄像机成像后对应的图像坐标,根据所述图像坐标计算所述标签在摄像机坐标系中的摄像机坐标;
仿射变换模块,用于根据所述摄像机坐标和空间坐标进行仿射变换,得到所述移动机器人在三维空间中的坐标。
7.根据权利要求6所述的装置,其特征在于,所述成像模块还用于利用摄像机对标定板进行成像;所述获取模块还用于获取标定板在多个位置对应的成像图像;
所述装置还包括:
标定模块,用于根据标定板在多个位置对应的成像图像计算出所述摄像机的参数以及摄像机之间的位置关系。
8.根据权利要求7所述的装置,其特征在于,所述坐标计算模块还用于获取摄像机投影中心的连线距离和摄像机的焦距;根据所述标签对应的图像坐标与所述连线距离和所述焦距计算所述标签在摄像机坐标系中的摄像机坐标。
9.根据权利要求7所述的装置,其特征在于,所述仿射变换模块还用于根据所述标签对应的空间坐标与摄像机坐标计算摄像机坐标系与空间坐标系之间的仿射变换关系;获取摄像机坐标系的摄像机坐标原点;根据所述摄像机坐标系与空间坐标系之间的仿射变换关系进行仿射变换,将所述摄像机坐标原点仿射变换至空间坐标系,得到所述移动机器人在三维空间中的坐标。
10.根据权利要求9所述的装置,其特征在于,所述仿射变换模块还用于提取所述标签对应的多个点;获取所述多个点对应的空间坐标以及所述多个点被摄像机成像后在摄像机坐标系中的摄像机坐标;根据所述空间坐标和所述摄像机坐标建立多个方程组;通过求解多个方程组得到摄像机坐标系与空间坐标系之间的仿射变换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610286914.8A CN105955260B (zh) | 2016-05-03 | 2016-05-03 | 移动机器人位置感知方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610286914.8A CN105955260B (zh) | 2016-05-03 | 2016-05-03 | 移动机器人位置感知方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105955260A true CN105955260A (zh) | 2016-09-21 |
CN105955260B CN105955260B (zh) | 2019-05-17 |
Family
ID=56913424
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610286914.8A Active CN105955260B (zh) | 2016-05-03 | 2016-05-03 | 移动机器人位置感知方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105955260B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106643735A (zh) * | 2017-01-06 | 2017-05-10 | 中国人民解放军信息工程大学 | 一种室内定位方法、装置和移动终端 |
CN107728617A (zh) * | 2017-09-27 | 2018-02-23 | 速感科技(北京)有限公司 | 多目在线标定方法、可移动机器人及*** |
CN108648237A (zh) * | 2018-03-16 | 2018-10-12 | 中国科学院信息工程研究所 | 一种基于视觉的空间定位方法 |
CN109591007A (zh) * | 2017-09-30 | 2019-04-09 | 北京柏惠维康科技有限公司 | 一种机器人空间注册方法和装置 |
CN109685856A (zh) * | 2018-12-25 | 2019-04-26 | 上海联影智能医疗科技有限公司 | 医学扫描物体运动幅度计算方法、装置、设备和存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101026778A (zh) * | 2007-03-14 | 2007-08-29 | 北京理工大学 | Ccd摄像***的畸变测量校正方法和综合测试靶 |
CN101096101A (zh) * | 2006-06-26 | 2008-01-02 | 北京航空航天大学 | 机器人足目标定方法和标定装置 |
CN102735235A (zh) * | 2012-06-07 | 2012-10-17 | 无锡普智联科高新技术有限公司 | 基于二维码的室内移动机器人定位***和方法 |
CN202702247U (zh) * | 2012-07-31 | 2013-01-30 | 山东大学 | 用于室内移动机器人的快速精确定位*** |
CN103020957A (zh) * | 2012-11-20 | 2013-04-03 | 北京航空航天大学 | 移动机器人机载摄像机位置标定方法 |
CN104075688A (zh) * | 2013-03-29 | 2014-10-01 | 中原工学院 | 一种双目立体凝视监控***的测距方法 |
CN104121902A (zh) * | 2014-06-28 | 2014-10-29 | 福州大学 | 基于Xtion摄像机的室内机器人视觉里程计实现方法 |
-
2016
- 2016-05-03 CN CN201610286914.8A patent/CN105955260B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101096101A (zh) * | 2006-06-26 | 2008-01-02 | 北京航空航天大学 | 机器人足目标定方法和标定装置 |
CN101026778A (zh) * | 2007-03-14 | 2007-08-29 | 北京理工大学 | Ccd摄像***的畸变测量校正方法和综合测试靶 |
CN102735235A (zh) * | 2012-06-07 | 2012-10-17 | 无锡普智联科高新技术有限公司 | 基于二维码的室内移动机器人定位***和方法 |
CN202702247U (zh) * | 2012-07-31 | 2013-01-30 | 山东大学 | 用于室内移动机器人的快速精确定位*** |
CN103020957A (zh) * | 2012-11-20 | 2013-04-03 | 北京航空航天大学 | 移动机器人机载摄像机位置标定方法 |
CN104075688A (zh) * | 2013-03-29 | 2014-10-01 | 中原工学院 | 一种双目立体凝视监控***的测距方法 |
CN104121902A (zh) * | 2014-06-28 | 2014-10-29 | 福州大学 | 基于Xtion摄像机的室内机器人视觉里程计实现方法 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106643735A (zh) * | 2017-01-06 | 2017-05-10 | 中国人民解放军信息工程大学 | 一种室内定位方法、装置和移动终端 |
CN107728617A (zh) * | 2017-09-27 | 2018-02-23 | 速感科技(北京)有限公司 | 多目在线标定方法、可移动机器人及*** |
CN107728617B (zh) * | 2017-09-27 | 2021-07-06 | 速感科技(北京)有限公司 | 多目在线标定方法、可移动机器人及*** |
CN109591007A (zh) * | 2017-09-30 | 2019-04-09 | 北京柏惠维康科技有限公司 | 一种机器人空间注册方法和装置 |
CN109591007B (zh) * | 2017-09-30 | 2022-02-22 | 北京柏惠维康科技有限公司 | 一种机器人空间注册方法和装置 |
CN108648237A (zh) * | 2018-03-16 | 2018-10-12 | 中国科学院信息工程研究所 | 一种基于视觉的空间定位方法 |
CN108648237B (zh) * | 2018-03-16 | 2022-05-03 | 中国科学院信息工程研究所 | 一种基于视觉的空间定位方法 |
CN109685856A (zh) * | 2018-12-25 | 2019-04-26 | 上海联影智能医疗科技有限公司 | 医学扫描物体运动幅度计算方法、装置、设备和存储介质 |
US11055855B2 (en) | 2018-12-25 | 2021-07-06 | Shanghai United Imaging Intelligence Co., Ltd. | Method, apparatus, device, and storage medium for calculating motion amplitude of object in medical scanning |
Also Published As
Publication number | Publication date |
---|---|
CN105955260B (zh) | 2019-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105955260A (zh) | 移动机器人位置感知方法和装置 | |
CN102788559B (zh) | 一种宽视场结构光视觉测量***及测量方法 | |
CN105716542A (zh) | 一种基于柔性特征点的三维数据拼接方法 | |
CN102692214B (zh) | 一种狭窄空间双目视觉测量定位装置及方法 | |
CN103983186B (zh) | 双目视觉***校正方法及校正设备 | |
CN105469389B (zh) | 一种用于视觉传感器标定的网格球靶标及相应标定方法 | |
CN108288292A (zh) | 一种三维重建方法、装置及设备 | |
Kim et al. | Extrinsic calibration of a camera-LIDAR multi sensor system using a planar chessboard | |
CN106228538A (zh) | 基于logo的双目视觉室内定位方法 | |
CN105447856B (zh) | 基于机器人运动参数与特征向量的标记点匹配方法 | |
CN107687855A (zh) | 机器人定位方法、装置及机器人 | |
CN104766309A (zh) | 一种平面特征点导航定位方法与装置 | |
CN109559349A (zh) | 一种用于标定的方法和装置 | |
CN106600654A (zh) | 一种大视角的深度相机拼接装置及拼接方法 | |
ES2950961T3 (es) | Creación de variabilidad de datos de entrenamiento en aprendizaje automático para etiquetado de objetos a partir de imágenes | |
CN105701828A (zh) | 一种图像处理方法和装置 | |
KR102309608B1 (ko) | 라이다(Lidar)와 스테레오-카메라(Stereo-Camera) 간의 좌표계 정합 방법 | |
CN109407115A (zh) | 一种基于激光雷达的路面提取***及其提取方法 | |
CN108921889A (zh) | 一种基于扩增现实应用的室内三维定位方法 | |
CN110807431A (zh) | 对象定位方法、装置、电子设备及存储介质 | |
CN105825501B (zh) | 一种模型引导下的3d打印额面肿瘤治疗导板智能化质量检测方法 | |
CN107972027A (zh) | 机器人的定位方法和装置、机器人 | |
CN110009689A (zh) | 一种用于协作机器人位姿估计的图像数据集快速构建方法 | |
CN111996883A (zh) | 一种检测公路路面宽度的方法 | |
CN108010122B (zh) | 一种人体三维模型重建与测量的方法及*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |