CN106990776A - 机器人归航定位方法与系统 - Google Patents
机器人归航定位方法与系统 Download PDFInfo
- Publication number
- CN106990776A CN106990776A CN201710108583.3A CN201710108583A CN106990776A CN 106990776 A CN106990776 A CN 106990776A CN 201710108583 A CN201710108583 A CN 201710108583A CN 106990776 A CN106990776 A CN 106990776A
- Authority
- CN
- China
- Prior art keywords
- robot
- mark
- home
- acquisition component
- described image
- 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 30
- 230000004807 localization Effects 0.000 title claims abstract description 18
- 238000004364 calculation method Methods 0.000 claims abstract description 19
- 238000000605 extraction Methods 0.000 claims abstract description 11
- 239000000284 extract Substances 0.000 claims abstract description 9
- 238000003384 imaging method Methods 0.000 claims description 15
- 238000013519 translation Methods 0.000 claims description 8
- 230000008569 process Effects 0.000 abstract description 12
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation 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
- G05D1/0251—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 extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Manipulator (AREA)
- Image Analysis (AREA)
Abstract
本发明提供一种机器人归航定位方法与系统,标定设置于机器人的图像采集组件,获取所述图像采集组件的标定参数,识别机器人归航点相对两侧至少2处标志物,提取标志物的关键点,根据标定参数以及提取的标志物的关键点,计算标志物与所述图像采集组件相对位置以及姿态,最终对机器人进行归航定位。整个过程中,采用图像处理方式,基于图像采集组件标定参数来计算标志物与图像采集组件位置以及姿态,最终实现对机器人归航的准确定位。
Description
技术领域
本发明涉及定位技术领域,特别是涉及机器人归航定位方法与系统。
背景技术
随着科学技术的发展,越来越多的机器人及其控制技术应用到实际生产生活中,给人们带来了巨大的便利。
目前,针对机器人归航定位已经成为机器人控制领域一个重要的研究方面。一般机器人定位方法主要分为绝对定位和相对定位两类。相对定位是通过测量机器人相对于初始位置的距离和方向来确定机器人的当前位置,通常也称之为航迹推演,缺点是漂移误差会随时间累积,不适于精确定位。绝对定位主要采用导航信标、主动或被动标识、地图匹配或卫星定位技术进行定位,定位精度较高,信标及标识的方式,简单便捷,故应用较多,其缺点是容易受光照影响。
发明内容
基于此,有必要针对可见一般机器人归航定位方法定位不准确的问题,提供一种定位准确的机器人归航定位方法与系统。
一种机器人归航定位方法,包括步骤:
标定设置于机器人的图像采集组件,并获取图像采集组件的标定参数,标定参数包括焦距、主点在成像平面的坐标、不同图像采集组件之间距离、不同图像采集组件的坐标以及不同图像采集组件的坐标与世界坐标系的平移与旋转量;
识别机器人归航点相对两侧至少2处标志物,提取识别的所述标志物上至少3个不共线关键点;
根据图像采集组件的标定参数以及提取的标志物的至少3个关键点,计算标志物与图像采集组件相对位置以及姿态;
根据标志物与图像采集组件相对位置以及姿态,对机器人进行归航定位。
一种机器人归航定位系统,包括:
标定模块,用于标定设置于机器人的图像采集组件,并获取图像采集组件的标定参数,标定参数包括焦距、主点在成像平面的坐标、不同图像采集组件之间距离、不同图像采集组件的坐标以及不同图像采集组件的坐标与世界坐标系的平移与旋转量;
识别模块,用于识别机器人归航点相对两侧至少2处标志物,提取识别的所述标志物上至少3个不共线关键点;
坐标计算模块,用于根据图像采集组件的标定参数以及提取的标志物的至少3个关键点,计算标志物与图像采集组件相对位置以及姿态;
归航模块,用于根据标志物与图像采集组件相对位置以及姿态,对机器人进行归航定位。
本发明机器人归航定位方法与系统,标定设置于机器人的图像采集组件,获取图像采集组件的标定参数,识别机器人归航点相对两侧至少2处标志物,提取标志物的关键点,根据标定参数以及提取的标志物的关键点,计算标志物与图像采集组件相对位置以及姿态,最终对机器人进行归航定位。整个过程中,采用图像处理方式,基于图像采集组件标定参数来计算标志物与图像采集组件位置以及姿态,最终实现对机器人归航的准确定位。
附图说明
图1为本发明机器人归航定位方法第一个实施例的流程示意图;
图2为相机小孔成像原理示意图;
图3为简化后的小孔成像模型示意图;
图4为空间点投影到图像平面示意图;
图5为多个标记物归航定位示意图;
图6为本发明机器人归航定位方法第二个实施例的流程示意图;
图7为本发明机器人归航定位系统其中一个实施例的结构示意图。
具体实施方式
如图1所示,一种机器人归航定位方法,包括步骤:
S200:标定设置于机器人的图像采集组件,并获取图像采集组件的标定参数,标定参数包括焦距、主点在成像平面的坐标、不同图像采集组件之间距离、不同图像采集组件的坐标以及不同图像采集组件的坐标与世界坐标系的平移与旋转量。
图像采集组件是预先设置于机器人上的,图像采集组件可以为摄像机、照相机等设备,对图像采集组件进行标定,获得其标定参数,标定参数包括内部参数和外部参数,内部参数可以理解图像采集组件的固有属性,具体包括图像采集组件的焦距,主点在成像平面的坐标等,其外部参数可以理解为不同图像采集组件之间关联的参数,具体包括不同图像采集组件之间距离、不同图像采集组件的坐标以及不同图像采集组件的坐标与世界坐标系的平移与旋转量。
在其中一个实施例中,标定设置于机器人的图像采集组件,并获取图像采集组件的标定参数的步骤包括:
步骤一:确定设置于机器人的图像采集组件。
图像采集组件是预先设置于机器人上的,其数量可以为多个,在这里先确定设置于机器人上图像采集组件的数量以及类型等。
步骤二:通过图像采集组件对标定板进行成像,获得图像。
利用图像采集组件(相机)对标定板成像,获得图像。具体来说,标定板可以是棋盘格,也可以是圆形或是其他形状。
步骤三:识别图像中特征点,获得图像采集组件的参数以及各图像采集组件之间位置关系。
通过图像采集组件(相机)拍摄的多幅图像,识别图像中特征点,具体来说,特征点包括角点或圆心等信息,基于这些信息获取图像采集组件的参数以及各图像采集组件之间位置关系。
步骤四:根据图像采集组件的参数以及各图像采集组件之间位置关系,计算图像采集组件的标定参数。
根据步骤三获取的图像采集组件的参数以及各图像采集组件之间位置关系,计算图像采集组件的标定参数。具体计算过程可以采用空间几何学进行计算处理。下面将着重介绍整个标定获取标定参数的过程。
图像采集组件(相机)的成像机理来自于小孔成像,如图2所示。物体在图像平面为倒立的像,因此有个负号,其公式如下。
实际使用中,通常使用另一种等价的数学模型,使得数学形式更加简单一点。交换针孔和图像平面的位置,将成像平面放到小孔的另一侧与原成像平面中心对称的位置,这个新的平面称为前端图像平面,它到小孔的距离仍保持为焦距的长度。与原模型的差别在于前端成像平面被认为是所有抵达投影中心的光线的一个切片,原先的小孔被理解成投影中心。如图3所示,图3为简化后的小孔成像模型。其对应的公式如下:
与前者相比,相当于少了一个负号。光轴与前端图像平面的交点被称为主点,前端图像平面到投影中心的距离为焦距f。摄像机的主点等价于成像的中心。然而,由于生产工艺的问题,感光芯片的中心通常不在光轴Zc上。因此,系统引入两个参数cx和cy以对光轴可能的偏移进行建模。
这里引入两个新的参数fx和fy,单位为像素,它们是不同的焦距,因为单个像素点在某些相机上并不是正方形的,sx≠sy,具体公式如下:
fx=f·sx
fy=f·sy
sx和sy是像素密度,单位是像素每米。sx和sy以及f它们是不能在实际标定过程中直接测量的,但组合量fx、fy是可以计算出来的。上式写成矩阵形式如下:
将三维空间中的点Q(X,Y,Z)映射到投影平面上点q坐标为(x,y),这称作投影变换,投影变换可以方便的用齐次坐标表示,齐次坐标就是把维数为n的空间上的点用(n+1)维向量表示。如二维空间的点(x,y)可以用三维向量(x,y,w)表示。w=0子集对应于无穷远处的平面,在此平面外(w≠0),总是可以同时除以w,以映射到熟悉的(x,y,1)空间;三维到二维的映射的公式如下:
在这里w=Z,同时除以Z,等式左边写成齐次坐标形式,公式如下:
这个3×3矩阵就是相机的内参数矩阵。
由于小孔不足以让更多的光线到达成像平面,因此使用透镜,但不可避免的带来了透镜镜头畸变的影响。它会导致图像径向和切向畸变,径向畸变主要来自于透镜形状,而切向畸变则来自于相机的组装过程。因此就需要研究镜头参数的影响,进行补偿,将这种失真的误差降到最小。空间点经过相机感光芯片,如图4所示,在相机的坐标系(Xc,Yc,Zc)和成像坐标系上都会有一个坐标值。总的来说,上述坐标转换过程具体为:世界坐标系(Xw,Yw,Zw)经过旋转与平移获得摄像机坐标系(Xc,Yc,Zc),再经过摄像机模型变换获得图像坐标(X,Y),再经过坐标原点变换获得图像像素坐标(u,v)。
S400:识别机器人归航点相对两侧至少2处标志物,提取识别的所述标志物上至少3个不共线关键点。
利用至少3个不共线角点的信息,就可以确定一个坐标系,继而可以获得关键点(标签)相对于机器人的位置及姿态以及关键点的ID、与图像采集组件距离信息。具体来说,标志物是预先设定于机器人归航点相对两侧,具体如图5所示,标志物数量为2个,其分别设置于归航点相对两侧(一左一右),在标志物一和标志物二上分别提取至少3个不共线关键点(图5中示意提取标识物一上3个不共线关键点)。
S600:根据图像采集组件的标定参数以及提取的标志物的至少3个关键点,计算标志物与图像采集组件相对位置以及姿态。
基于步骤S200的标定参数以及S400提取的标志物的至少3个关键点,考虑它们在空间中的相对位置来计算标志物与图像采集组件相对位置以及姿态。具体来说,如图5所示,通过识别两个或多个标志物,利用机器视觉算法提取标志物的至少3个关键点,再结合相机标定的参数,利用转换关系求得标志物在相机坐标系下的位置和姿态。其具体的计算过程可以基于空间几何学来进行计算角度以及距离等参数,在此不再赘述。
S800:根据标志物与图像采集组件相对位置以及姿态,对机器人进行归航定位。
基于S600获得的标志物与图像采集组件相对位置以及姿态,对机器人进行归航定位。具体来说,规划定位主要包括三大步骤,第一步是机器人旋转以使朝向归航点方向;第二步是沿朝向归航点方向的水平方向行驶至归航点水平坐标值对应位置;第三步是再次旋转面向归航点,并减速缓慢沿直线行驶至归航点。
更具体来说,在其中一个实施例中,至少2处标志物包括沿水平坐标轴正方向设置的第一标志物和第二标志物,如图6所示,步骤S800包括:
S820:根据第一标志物以及第二标志物与图像采集组件相对位置以及姿态,计算第一标志物与机器人的距离以及第二标志物与机器人的距离。
基于第一标志物以及第二标志物与图像采集组件相对位置以及姿态,采用空间几何学,可以计算出第一标志物与机器人的距离S1以及第二标志物与机器人的距离S2。
S840:当第一标志物与机器人的距离小于第二标志物与机器人的距离时,控制机器人顺时针旋转,当第一标志物与机器人的距离大于第二标志物与机器人的距离时,控制机器人逆时针旋转。
当第一标志物与机器人的距离S1小于第二标志物与机器人的距离S2,表明机器人更偏向于水平坐标轴反方向,其需要向坐标轴正方向移动,即此时控制机器人顺时针旋转。当当第一标志物与机器人的距离S1大于第二标志物与机器人的距离S2,表明机器人更偏向于水平坐标轴正方向,其需要向坐标轴反方向移动,即此时控制机器人顺时针旋转。
S860:待旋转完成时,控制机器人行驶至归航点。
当旋转完成时,机器人已经朝向缩小与归航点之间距离的方向,此时控制机器人行驶至归航点。非必要的,整个过程可以包括控制机器人旋转至水平方向,并沿水平方向行驶至归航点的坐标中水平方向对应的坐标点;再次控制机器人旋转至正面向归航点的方向,并沿当前方向减速行驶至归航点。
需要指出的是,可以任意设置第一标志物与第二标志物的位置,并基于上述相同的原理对距离以及旋转方向进行判断,最终控制机器人行驶至归航点。
继续以图5为例,更进一步说明整个旋转归航过程。如图5所示,在归航点相对两侧,沿水平坐标轴X轴方向依次设置有第一标志物和第二标志物。首先采用空间几何学,根据标志物与图像采集组件相对位置以及姿态计算机器人与第一标志物之间距离S1以及与第二标志物之间距离S2,当前S1小于S2,机器人需要顺时针旋转至与X轴正方向平行方向,沿当前X轴正方向平行方向行驶至归航点X轴坐标对应位置,再旋转至方面归航点方向(Y轴正方向),缓慢行驶至归航点。
本发明机器人归航定位方法,标定设置于机器人的图像采集组件,获取图像采集组件的标定参数,识别机器人归航点相对两侧至少2处标志物,提取标志物的关键点,根据标定参数以及提取的标志物的关键点,计算标志物与图像采集组件相对位置以及姿态,最终对机器人进行归航定位。整个过程中,采用图像处理方式,基于图像采集组件标定参数来计算标志物与图像采集组件位置以及姿态,最终实现对机器人归航的准确定位。
如图7所示,一种机器人归航定位系统,包括:
标定模块200,用于标定设置于机器人的图像采集组件,并获取图像采集组件的标定参数,标定参数包括焦距、主点在成像平面的坐标、不同图像采集组件之间距离、不同图像采集组件的坐标以及不同图像采集组件的坐标与世界坐标系的平移与旋转量。
识别模块400,用于识别机器人归航点相对两侧至少2处标志物,提取识别的所述标志物上至少3个不共线关键点。
坐标计算模块600,用于根据图像采集组件的标定参数以及提取的标志物的至少3个关键点,计算标志物与图像采集组件相对位置以及姿态。
归航模块800,用于根据标志物与图像采集组件相对位置以及姿态,对机器人进行归航定位。
本发明机器人归航定位系统,标定模块200标定设置于机器人的图像采集组件,获取图像采集组件的标定参数,识别模块400识别机器人归航点相对两侧至少2处标志物,提取标志物的关键点,坐标计算模块600根据标定参数以及提取的标志物的关键点,计算标志物与图像采集组件相对位置以及姿态,归航模块800对机器人进行归航定位。整个过程中,采用图像处理方式,基于图像采集组件标定参数来计算标志物与图像采集组件位置以及姿态,最终实现对机器人归航的准确定位。
在其中一个实施例中,标定模块200包括:
确定单元,用于确定设置于机器人的图像采集组件。
标定单元,用于通过图像采集组件对标定板进行成像,获得图像。
位置获取单元,用于识别图像中特征点,获得图像采集组件的参数以及各图像采集组件之间位置关系。
标定参数计算单元,用于根据图像采集组件的参数以及各图像采集组件之间位置关系,计算图像采集组件的标定参数。
在其中一个实施例中,识别模块400通过机器视觉算法提取识别的所述标志物上至少3个不共线关键点。
在其中一个实施例中,至少2处标志物包括沿水平坐标轴正方向设置的第一标志物和第二标志物,归航模块800包括:
距离计算单元,用于根据第一标志物以及第二标志物与图像采集组件相对位置以及姿态,计算第一标志物与机器人的距离以及第二标志物与机器人的距离。
旋转单元,用于当第一标志物与机器人的距离小于第二标志物与机器人的距离时,控制机器人顺时针旋转,当第一标志物与机器人的距离大于第二标志物与机器人的距离时,控制机器人逆时针旋转。
归航单元,用于当旋转完成时,控制机器人行驶至归航点。
在其中一个实施例中,归航单元还包括:
第一归航单元,用于控制机器人旋转至水平方向,并沿水平方向行驶至归航点的坐标中水平方向对应的坐标点。
第二归航单元,用于再次控制机器人旋转至正面向归航点的方向,并沿当前方向减速行驶至归航点。
以上实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种机器人归航定位方法,其特征在于,包括步骤:
标定设置于机器人的图像采集组件,并获取所述图像采集组件的标定参数,所述标定参数包括焦距、主点在成像平面的坐标、不同图像采集组件之间距离、不同图像采集组件的坐标以及所述不同图像采集组件的坐标与世界坐标系的平移与旋转量;
识别机器人归航点相对两侧至少2处标志物,提取识别的所述标志物上至少3个不共线关键点;
根据所述图像采集组件的标定参数以及提取的所述标志物的至少3个关键点,计算所述标志物与所述图像采集组件相对位置以及姿态;
根据所述标志物与所述图像采集组件相对位置以及姿态,对机器人进行归航定位。
2.根据权利要求1所述的机器人归航定位方法,其特征在于,所述标定设置于机器人的图像采集组件,并获取所述图像采集组件的标定参数的步骤包括:
确定设置于所述机器人的图像采集组件;
通过所述图像采集组件对标定板进行成像,获得图像;
识别所述图像中特征点,获得所述图像采集组件的参数以及各所述图像采集组件之间位置关系;
根据所述图像采集组件的参数以及各图像采集组件之间位置关系,计算所述图像采集组件的标定参数。
3.根据权利要求1所述的机器人归航定位方法,其特征在于,所述提取识别的所述标志物上至少3个不共线关键点的步骤包括:
通过机器视觉算法提取识别的所述标志物上至少3个不共线关键点。
4.根据权利要求1所述的机器人归航定位方法,其特征在于,所述至少2处标志物包括沿水平坐标轴正方向设置的第一标志物和第二标志物,所述根据所述标志物与所述图像采集组件相对位置以及姿态,对机器人进行归航定位的步骤包括:
根据所述第一标志物以及所述第二标志物与所述图像采集组件相对位置以及姿态,计算所述第一标志物与机器人的距离以及所述第二标志物与机器人的距离;
当所述第一标志物与机器人的距离小于所述第二标志物与机器人的距离时,控制机器人顺时针旋转,当所述第一标志物与机器人的距离大于所述第二标志物与机器人的距离时,控制机器人逆时针旋转;
待旋转完成时,控制机器人行驶至所述归航点。
5.根据权利要求4所述的机器人归航定位方法,其特征在于,所述待旋转完成时,控制机器人行驶至所述归航点的步骤包括:
控制所述机器人旋转至水平方向,并沿水平方向行驶至所述归航点的坐标中水平方向对应的坐标点;
再次控制所述机器人旋转至正面向所述归航点的方向,并沿当前方向减速行驶至所述归航点。
6.一种机器人归航定位系统,其特征在于,包括:
标定模块,用于标定设置于机器人的图像采集组件,并获取所述图像采集组件的标定参数,所述标定参数包括焦距、主点在成像平面的坐标、不同图像采集组件之间距离、不同图像采集组件的坐标以及所述不同图像采集组件的坐标与世界坐标系的平移与旋转量;
识别模块,用于识别机器人归航点相对两侧至少2处标志物,提取识别的所述标志物上至少3个不共线关键点;
坐标计算模块,用于根据所述图像采集组件的标定参数以及提取的所述标志物的至少3个关键点,计算所述标志物与所述图像采集组件相对位置以及姿态;
归航模块,用于根据所述标志物与所述图像采集组件相对位置以及姿态,对机器人进行归航定位。
7.根据权利要求6所述的机器人归航定位系统,其特征在于,所述标定模块包括:
确定单元,用于确定设置于所述机器人的图像采集组件;
标定单元,用于通过所述图像采集组件对标定板进行成像,获得图像;
位置获取单元,用于识别所述图像中特征点,获得所述图像采集组件的参数以及各所述图像采集组件之间位置关系;
标定参数计算单元,用于根据所述图像采集组件的参数以及各图像采集组件之间位置关系,计算所述图像采集组件的标定参数。
8.根据权利要求6所述的机器人归航定位系统,其特征在于,所述识别模块通过机器视觉算法提取识别的所述标志物上至少3个不共线关键点。
9.根据权利要求6所述的机器人归航定位系统,其特征在于,所述至少2处标志物包括沿水平坐标轴正方向设置的第一标志物和第二标志物,所述归航模块包括:
距离计算单元,用于根据所述第一标志物以及所述第二标志物与所述图像采集组件相对位置以及姿态,计算所述第一标志物与机器人的距离以及所述第二标志物与机器人的距离;
旋转单元,用于当所述第一标志物与机器人的距离小于所述第二标志物与机器人的距离时,控制机器人顺时针旋转,当所述第一标志物与机器人的距离大于所述第二标志物与机器人的距离时,控制机器人逆时针旋转;
归航单元,用于当旋转完成时,控制机器人行驶至所述归航点。
10.根据权利要求9所述的机器人归航定位系统,其特征在于,所述归航单元还包括:
第一归航单元,用于控制所述机器人旋转至水平方向,并沿水平方向行驶至所述归航点的坐标中水平方向对应的坐标点;
第二归航单元,用于再次控制所述机器人旋转至正面向所述归航点的方向,并沿当前方向减速行驶至所述归航点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710108583.3A CN106990776B (zh) | 2017-02-27 | 2017-02-27 | 机器人归航定位方法与系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710108583.3A CN106990776B (zh) | 2017-02-27 | 2017-02-27 | 机器人归航定位方法与系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106990776A true CN106990776A (zh) | 2017-07-28 |
CN106990776B CN106990776B (zh) | 2020-08-11 |
Family
ID=59412577
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710108583.3A Active CN106990776B (zh) | 2017-02-27 | 2017-02-27 | 机器人归航定位方法与系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106990776B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107907131A (zh) * | 2017-11-10 | 2018-04-13 | 珊口(上海)智能科技有限公司 | 定位系统、方法及所适用的机器人 |
CN108415413A (zh) * | 2018-03-28 | 2018-08-17 | 华南农业大学 | 一种基于圆形有用域的智能叉车局部避障路径规划方法 |
CN108491905A (zh) * | 2018-03-16 | 2018-09-04 | 浙江国自机器人技术有限公司 | 一种移动机器人定位方法、系统、介质及设备 |
CN109099915A (zh) * | 2018-06-27 | 2018-12-28 | 未来机器人(深圳)有限公司 | 移动机器人定位方法、装置、计算机设备和存储介质 |
CN109387187A (zh) * | 2017-08-02 | 2019-02-26 | 珊口(上海)智能科技有限公司 | 基于视觉特征点的扫地机定位方法、系统以及扫地机器人 |
CN111596257A (zh) * | 2020-07-22 | 2020-08-28 | 上海擎朗智能科技有限公司 | 一种机器人启动定位方法、装置、电子设备和存储介质 |
CN111750820A (zh) * | 2019-03-28 | 2020-10-09 | 财团法人工业技术研究院 | 影像定位方法及其系统 |
CN113295164A (zh) * | 2021-04-23 | 2021-08-24 | 四川腾盾科技有限公司 | 一种基于机场跑道的无人机视觉定位方法及装置 |
CN113433948A (zh) * | 2021-07-15 | 2021-09-24 | 大连海事大学 | 一种基于辅助向量校正的移动机器人连续视觉归航方法、存储介质及电子装置 |
CN114519739A (zh) * | 2022-04-21 | 2022-05-20 | 深圳史河机器人科技有限公司 | 一种基于识别装置的方向定位方法、装置及存储介质 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101452292A (zh) * | 2008-12-29 | 2009-06-10 | 天津理工大学 | 基于序列双色点阵式航标的鱼眼镜头全向视觉制导方法 |
CN101576384A (zh) * | 2009-06-18 | 2009-11-11 | 北京航空航天大学 | 一种基于视觉信息校正的室内移动机器人实时导航方法 |
CN102339062A (zh) * | 2011-07-11 | 2012-02-01 | 西北农林科技大学 | 基于dsp和双目视觉的微型农业机械导航与远程监控系统 |
CN103020957A (zh) * | 2012-11-20 | 2013-04-03 | 北京航空航天大学 | 移动机器人机载摄像机位置标定方法 |
CN103400392A (zh) * | 2013-08-19 | 2013-11-20 | 山东鲁能智能技术有限公司 | 基于变电站巡检机器人的双目视觉导航系统及方法 |
EP2849150A1 (en) * | 2013-09-17 | 2015-03-18 | Thomson Licensing | Method for capturing the 3D motion of an object, unmanned aerial vehicle and motion capture system |
CN105118055A (zh) * | 2015-08-11 | 2015-12-02 | 北京电影学院 | 摄影机定位修正标定方法及系统 |
CN105300375A (zh) * | 2015-09-29 | 2016-02-03 | 塔米智能科技(北京)有限公司 | 一种基于单视觉的机器人室内定位和导航方法 |
CN105486311A (zh) * | 2015-12-24 | 2016-04-13 | 青岛海通机器人系统有限公司 | 室内机器人定位导航方法及装置 |
WO2016057181A1 (en) * | 2014-10-10 | 2016-04-14 | Irobot Corporation | Mobile robot area cleaning |
CN106017458A (zh) * | 2016-05-18 | 2016-10-12 | 宁波华狮智能科技有限公司 | 移动机器人组合式导航方法及装置 |
CN106197427A (zh) * | 2016-07-04 | 2016-12-07 | 上海思依暄机器人科技股份有限公司 | 一种室内定位导航的方法、装置以及机器人 |
CN106444774A (zh) * | 2016-11-01 | 2017-02-22 | 西安理工大学 | 基于室内照明灯的移动机器人视觉导航方法 |
-
2017
- 2017-02-27 CN CN201710108583.3A patent/CN106990776B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101452292A (zh) * | 2008-12-29 | 2009-06-10 | 天津理工大学 | 基于序列双色点阵式航标的鱼眼镜头全向视觉制导方法 |
CN101576384A (zh) * | 2009-06-18 | 2009-11-11 | 北京航空航天大学 | 一种基于视觉信息校正的室内移动机器人实时导航方法 |
CN102339062A (zh) * | 2011-07-11 | 2012-02-01 | 西北农林科技大学 | 基于dsp和双目视觉的微型农业机械导航与远程监控系统 |
CN103020957A (zh) * | 2012-11-20 | 2013-04-03 | 北京航空航天大学 | 移动机器人机载摄像机位置标定方法 |
CN103400392A (zh) * | 2013-08-19 | 2013-11-20 | 山东鲁能智能技术有限公司 | 基于变电站巡检机器人的双目视觉导航系统及方法 |
EP2849150A1 (en) * | 2013-09-17 | 2015-03-18 | Thomson Licensing | Method for capturing the 3D motion of an object, unmanned aerial vehicle and motion capture system |
WO2016057181A1 (en) * | 2014-10-10 | 2016-04-14 | Irobot Corporation | Mobile robot area cleaning |
CN105118055A (zh) * | 2015-08-11 | 2015-12-02 | 北京电影学院 | 摄影机定位修正标定方法及系统 |
CN105300375A (zh) * | 2015-09-29 | 2016-02-03 | 塔米智能科技(北京)有限公司 | 一种基于单视觉的机器人室内定位和导航方法 |
CN105486311A (zh) * | 2015-12-24 | 2016-04-13 | 青岛海通机器人系统有限公司 | 室内机器人定位导航方法及装置 |
CN106017458A (zh) * | 2016-05-18 | 2016-10-12 | 宁波华狮智能科技有限公司 | 移动机器人组合式导航方法及装置 |
CN106197427A (zh) * | 2016-07-04 | 2016-12-07 | 上海思依暄机器人科技股份有限公司 | 一种室内定位导航的方法、装置以及机器人 |
CN106444774A (zh) * | 2016-11-01 | 2017-02-22 | 西安理工大学 | 基于室内照明灯的移动机器人视觉导航方法 |
Non-Patent Citations (2)
Title |
---|
KOWLOON,ETC: "Self-calibration of environmental camera for mobile robot navigation", 《ROBOTICS AND AUTONOMOUS SYSTEMS》 * |
成怡,等: "基于摄像机标定方法的无人机位置解算", 《天津工业大学学报》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109387187A (zh) * | 2017-08-02 | 2019-02-26 | 珊口(上海)智能科技有限公司 | 基于视觉特征点的扫地机定位方法、系统以及扫地机器人 |
CN109387187B (zh) * | 2017-08-02 | 2021-08-10 | 珊口(上海)智能科技有限公司 | 基于视觉特征点的扫地机定位方法、系统以及扫地机器人 |
CN107907131A (zh) * | 2017-11-10 | 2018-04-13 | 珊口(上海)智能科技有限公司 | 定位系统、方法及所适用的机器人 |
CN108491905A (zh) * | 2018-03-16 | 2018-09-04 | 浙江国自机器人技术有限公司 | 一种移动机器人定位方法、系统、介质及设备 |
CN108415413B (zh) * | 2018-03-28 | 2021-03-30 | 华南农业大学 | 一种基于圆形有用域的智能叉车局部避障路径规划方法 |
CN108415413A (zh) * | 2018-03-28 | 2018-08-17 | 华南农业大学 | 一种基于圆形有用域的智能叉车局部避障路径规划方法 |
WO2020000737A1 (zh) * | 2018-06-27 | 2020-01-02 | 未来机器人(深圳)有限公司 | 移动机器人定位方法、存储介质及计算机设备 |
CN109099915A (zh) * | 2018-06-27 | 2018-12-28 | 未来机器人(深圳)有限公司 | 移动机器人定位方法、装置、计算机设备和存储介质 |
CN111750820A (zh) * | 2019-03-28 | 2020-10-09 | 财团法人工业技术研究院 | 影像定位方法及其系统 |
CN111750820B (zh) * | 2019-03-28 | 2023-03-24 | 财团法人工业技术研究院 | 影像定位方法及其系统 |
CN111596257A (zh) * | 2020-07-22 | 2020-08-28 | 上海擎朗智能科技有限公司 | 一种机器人启动定位方法、装置、电子设备和存储介质 |
US11579613B2 (en) | 2020-07-22 | 2023-02-14 | Keenon Robotics Co., Ltd. | Method and apparatus for positioning a robot at start-up, electronic device and storage medium |
CN113295164A (zh) * | 2021-04-23 | 2021-08-24 | 四川腾盾科技有限公司 | 一种基于机场跑道的无人机视觉定位方法及装置 |
CN113433948A (zh) * | 2021-07-15 | 2021-09-24 | 大连海事大学 | 一种基于辅助向量校正的移动机器人连续视觉归航方法、存储介质及电子装置 |
CN113433948B (zh) * | 2021-07-15 | 2024-01-30 | 大连海事大学 | 一种基于辅助向量校正的移动机器人连续视觉归航方法、存储介质及电子装置 |
CN114519739A (zh) * | 2022-04-21 | 2022-05-20 | 深圳史河机器人科技有限公司 | 一种基于识别装置的方向定位方法、装置及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN106990776B (zh) | 2020-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106990776A (zh) | 机器人归航定位方法与系统 | |
CN103759669B (zh) | 一种大型零件的单目视觉测量方法 | |
CN102376089B (zh) | 一种标靶校正方法及系统 | |
CN107883870A (zh) | 基于双目视觉系统和激光跟踪仪测量系统的全局标定方法 | |
CN1847789B (zh) | 测量位置及姿态的方法和装置 | |
CN104517291B (zh) | 基于目标同轴圆特征的位姿测量方法 | |
CN108571971A (zh) | 一种agv视觉定位系统及方法 | |
CN102788559B (zh) | 一种宽视场结构光视觉测量系统及测量方法 | |
CN100562707C (zh) | 双目视觉转轴标定方法 | |
CN104613871B (zh) | 一种微透镜阵列和探测器耦合位置关系的标定方法 | |
CN104240262B (zh) | 一种用于摄影测量的相机外参数标定装置及标定方法 | |
CN105469389B (zh) | 一种用于视觉传感器标定的网格球靶标及相应标定方法 | |
CN103308028B (zh) | 三轴气浮台姿态角双目立体视觉测量装置及其测量方法 | |
CN106971408B (zh) | 一种基于时空转换思想的摄像机标定方法 | |
CN106017436A (zh) | 基于全站仪及摄影测量技术的bim增强现实放样系统 | |
CN105444696B (zh) | 一种基于透视投影直线测量模型的双目匹配方法及其应用 | |
CN104200086A (zh) | 宽基线可见光相机位姿估计方法 | |
CN103558850A (zh) | 一种激光视觉引导的焊接机器人全自动运动自标定方法 | |
CN106228538A (zh) | 基于logo的双目视觉室内定位方法 | |
CN105931222A (zh) | 用低精度二维平面靶标实现高精度相机标定的方法 | |
CN106504287B (zh) | 基于模板的单目视觉目标空间定位系统 | |
CN104240221B (zh) | 一种镜头相背双相机相对方位标定装置与方法 | |
CN108022267A (zh) | 一种摄像机标定装置及标定方法 | |
CN109827521A (zh) | 一种快速多线结构光视觉测量系统标定方法 | |
CN102914295A (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 | ||
CP01 | Change in the name or title of a patent holder |
Address after: 510070 15 building, 100 martyrs Road, Yuexiu District, Guangzhou, Guangdong. Patentee after: Institute of intelligent manufacturing, Guangdong Academy of Sciences Address before: 510070 15 building, 100 martyrs Road, Yuexiu District, Guangzhou, Guangdong. Patentee before: GUANGDONG INSTITUTE OF INTELLIGENT MANUFACTURING |
|
CP01 | Change in the name or title of a patent holder |