CN106950572A - 一种自动引导车定位方法及装置 - Google Patents
一种自动引导车定位方法及装置 Download PDFInfo
- Publication number
- CN106950572A CN106950572A CN201710191491.6A CN201710191491A CN106950572A CN 106950572 A CN106950572 A CN 106950572A CN 201710191491 A CN201710191491 A CN 201710191491A CN 106950572 A CN106950572 A CN 106950572A
- Authority
- CN
- China
- Prior art keywords
- information
- geographic coordinate
- reflecting plate
- coordinate information
- guide vehicle
- 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 31
- 230000004807 localization Effects 0.000 title claims abstract description 13
- 230000005540 biological transmission Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 8
- 238000009826 distribution Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000005457 optimization Methods 0.000 description 3
- 239000004020 conductor Substances 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000012797 qualification Methods 0.000 description 1
- 238000002310 reflectometry Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 210000001138 tear Anatomy 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明实施例公开了一种自动引导车定位方法及装置。该方法包括:获取激光雷达扫描的第一数量的反射板的距离信息及角度信息;在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,所述第二数量小于等于所述第一数量;根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息。本发明实施例通过利用在自动引导车上安装激光雷达的方式,利用激光雷达扫描到的反射板的距离信息、角度信息及地理坐标信息确定自动引导车的地理坐标信息,可以实现对自动引导车的实时位置的计算,具有较高的定位精度。
Description
技术领域
本发明实施例涉及定位技术,尤其涉及一种自动引导车定位方法及装置。
背景技术
自动引导车(Automated Guided Vehicles)是一种安装了自动引导装置、无需人工操作就能够按照指定路径行进的一种自动化设备,该装置可以用于自动货物装卸和搬运。经过几十年的发展,全世界自动引导车的保有量已达到16000套以上,国内也有越来越多的厂家开始投入到自动引导车的研发和制造中。而对于自动引导车而言,最为关键的技术是实现自动引导,而自动引导的基础是自动引导车定位。
目前自动引导车定位的主要方式有基于电磁定位、基于视觉定位以及基于激光定位等方式。其中,基于电磁定位是将金属导线事先埋入预定的位置,自动引导车行驶过程中识别特定的电磁信号来进行定位,但是其定位限定在金属导线铺设的位置,路径难以发生改变。基于视觉定位是用摄像头采集周围区域的图像,例如采集二维码,通过图像识别及处理得到周围环境的信息,确定所处位置。这种方法中二维码易发生磨损,影响定位。而且这种方法尚处于研究阶段,暂时没实现市场化。如何准确地实现自动引导车的定位,依然是值得研究的课题。
发明内容
本发明实施例提供一种自动引导车定位方法及装置,以实现对自动引导车的准确定位。
第一方面,本发明实施例提供了一种自动引导车定位方法,该方法包括:
获取激光雷达扫描的第一数量的反射板的距离信息及角度信息;
在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,所述第二数量小于等于所述第一数量;
根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息。
进一步的,在获取激光雷达扫描的第一数量的反射板的距离信息及角度信息之前,还包括:
获取区域内每个反射板对应的距离信息和角度信息;
根据所述每个反射板对应的距离信息和角度信息,以及所述自动引导车的至少一个移动信息计算所述每个反射板的地理坐标信息;
将所述每个地理坐标信息进行存储,得到所述区域的地理坐标系地图。
进一步的,所述根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息,包括:
根据所述自动引导车的位置信息,从所述第一数量的反射板中选取至少两组反射板,每组反射板包括至少三个目标反射板;
根据每组反射板中所述目标反射板对应的距离信息、角度信息及地理坐标信息确定所述每组反射板对应的自动引导车的地理坐标信息,得到所述至少两组反射板对应的至少两个目标地理坐标信息;
对所述至少两个目标地理坐标信息进行加权计算,得到自动引导车的地理坐标信息。
进一步的,所述在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,包括:
在地理坐标系地图中读取所述第一数量的反射板中选取至少三个反射板作为目标反射板;
读取所述至少三个目标反射板的地理坐标信息;
相应的,所述根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息,包括:
根据所述至少三个目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的第一参考地理坐标信息;
根据所述第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息,其中,所述其余反射板是指所述第一数量的反射板中除所述三个反射板外的其他反射板;
获取所述其余反射板的预设地理坐标信息;
当所述第二参考地理坐标信息与所述预设地理坐标信息之间的差值小于预设阈值时,将所述第一参考地理坐标信息确定为所述自动引导车的地理坐标信息。
进一步的,还包括:
所述自动引导车接收遥控器发送的移动指令并按照所述移动指令中携带的移动信息进行移动,所述移动信息包括所述自动引导车移动的角速度及线速度。
第二方面,本发明实施例还提供了一种自动引导车定位装置,该装置包括:
信息获取模块,用于获取激光雷达扫描的第一数量的反射板的距离信息及角度信息;
坐标信息获取模块,用于在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,所述第二数量小于等于所述第一数量;
信息确定模块,用于根据所述目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的地理坐标信息。
进一步的,还包括地图建立模块,具体用于:
在获取激光雷达扫描的第一数量的反射板的距离信息及角度信息之前,获取区域内每个反射板对应的距离信息和角度信息;
根据所述每个反射板对应的距离信息和角度信息,以及所述自动引导车的至少一个移动信息计算所述每个反射板的地理坐标信息;
将所述每个地理坐标信息进行存储,得到所述区域的地理坐标系地图。
进一步的,所述信息确定模块,具体用于:
根据所述自动引导车的位置信息,从所述第一数量的反射板中选取至少两组反射板,每组反射板包括至少三个目标反射板;
根据每组反射板中所述目标反射板对应的距离信息、角度信息及地理坐标信息确定所述每组反射板对应的自动引导车的地理坐标信息,得到所述至少两组反射板对应的至少两个目标地理坐标信息;
对所述至少两个目标地理坐标信息进行加权计算,得到自动引导车的地理坐标信息。
进一步的,所述坐标信息获取模块具体用于:
在地理坐标系地图中读取所述第一数量的反射板中选取至少三个反射板作为目标反射板;
读取所述至少三个目标反射板的地理坐标信息;
相应的,所述信息确定模块具体用于:
根据所述至少三个目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的第一参考地理坐标信息;
根据所述第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息,其中,所述其余反射板是指所述第一数量的反射板中除所述三个反射板外的其他反射板;
获取所述其余反射板的预设地理坐标信息;
当所述第二参考地理坐标信息与所述预设地理坐标信息之间的差值小于预设阈值时,将所述第一参考地理坐标信息确定为所述自动引导车的地理坐标信息。
进一步的,还包括:所述自动引导车接收遥控器发送的移动指令并按照所述移动指令中携带的移动信息进行移动,所述移动信息包括所述自动引导车移动的角速度及线速度。
本发明实施例通过利用在自动引导车上安装激光雷达的方式,利用激光雷达扫描到的反射板的距离信息、角度信息及地理坐标信息确定自动引导车的地理坐标信息,可以实现对自动引导车的实时位置的计算,具有较高的定位精度。
附图说明
图1a为本发明实施例一提供的一种自动引导车定位方法的流程图;
图1b是本发明实施例一提供的一种激光雷达与自动引导车安装示意图;
图1c是本发明实施例一提供的反射板分布示意图;
图1d是本发明实施例一提供的一种自动引导车地理坐标信息计算方式示意图;
图1e是本发明实施例一提供的一种坐标信息示意图;
图2是本发明实施例二提供的一种自动引导车定位方法的流程图;
图3是本发明实施例三提供的一种自动引导车定位方法的流程图;
图4是本发明实施例四提供的一种自动引导车定位装置结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
实施例一
图1a为本发明实施例一提供的一种自动引导车定位方法的流程图,本实施例可适用于利用激光雷达对自动引导车进行定位的情况,该方法具体包括如下步骤:
S110、获取激光雷达扫描的第一数量的反射板的距离信息及角度信息。
其中,工作在红外和可见光波段的,以激光为工作光束的雷达称为激光雷达,激光雷达可以采用多种类型的,示例性地,本发明实施例中可以采用基于飞行时间原理的激光雷达,能够获得更加精准的距离和角度信息,提供高质量的原始数据。激光雷达主要包含激光雷达传感器和定位模块两部分。其中,定位模块作为本发明实施例的核心模块,是整个发明实施例中承担解析自动引导车下发的指令、执行相应的操作以及反馈相应的信息的功能。图1b是本发明实施例一提供的一种激光雷达与自动引导车安装示意图,如图1b所示,可将激光雷达安装在自动引导车上,利用反射板的信息确定自动引导车的信息。可利用激光雷达进行扫描,可根据反射率判断反射板所在的位置,图1b中亮度较高的激光光束则代表的是由反射板反射造成的,而亮度较低、光束较窄的光束则是区域内其他物体反射造成的。第一数量为激光扫描范围内反射板的数量,例如可以是5个。反射板的距离信息及角度信息可以通过读取雷达检测的数据进行获得。示例性地,图1c是本发明实施例一提供的反射板分布示意图,如图1c所示,激光雷达当前扫描范围内包含5个反射板10,可获取反射板的距离信息和角度信息。
S120、在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息。
其中,所述第二数量小于等于所述第一数量。
其中,地理坐标系地图可以是在对自动引导车进行定位之前建立的地理坐标系地图,也可以是根据测量反射板在区域内的位置确定的地理坐标系地图。该区域可以为厂房等。从激光雷达扫描到的第一数量的反射板中选取第二数量的目标反射板,第二数量小于等于所述第一数量,第二数量不小于3个。例如,第一数量可以为5个,第二数量可以为3个,读取所述3个反射板的地理坐标信息。
S130、根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息。
其中,可以根据第二数量的目标反射板确定自动引导车在区域范围内的地理坐标信息。示例性地,假设第二数量为3,图1d是本发明实施例一提供的一种自动引导车地理坐标信息计算方式示意图,其中,(x1,y1)、(x2,y2)及(x3,y3)是3个反射板的地理坐标信息,d1、d2及d3是激光雷达与反射板之间的距离,可通过反射板的距离信息及角度信息计算得到。根据几何关系,可以得到以下公式:
通过上述公式计算所得到的(x,y)便是自动引导车的地理坐标信息。
本实施例的技术方案,通过利用在自动引导车上安装激光雷达的方式,利用激光雷达扫描到的反射板的距离信息、角度信息及地理坐标信息确定自动引导车的地理坐标信息,可以实现对自动引导车的实时位置的计算,具有较高的定位精度。
在上述技术方案的基础上,在获取激光雷达扫描的第一数量的反射板的距离信息及角度信息之前,还包括:
获取区域内每个反射板对应的距离信息和角度信息;
根据所述每个反射板对应的距离信息和角度信息,以及所述自动引导车的至少一个移动信息计算所述每个反射板的地理坐标信息;
优选的,所述自动引导车接收遥控器发送的移动指令并按照所述移动指令中携带的移动信息进行移动,所述移动信息包括所述自动引导车移动的角速度及线速度。
将所述每个地理坐标信息进行存储,得到所述区域的地理坐标系地图。
其中,建立地理坐标系地图的过程可以相当于建立地图过程,可以称为MAP过程,MAP功能是自动引导车定位系统中的一个重要功能,可以在多种情况下执行该功能,例如可以是在首次进入该区域时,或当反射板位置发生变化或反射板发生替换时,利用激光雷达采集的数据计算各个反射板的地理坐标信息,作为对自动引导车定位时的参考。具体过程可以是:将装有激光雷达的自动引导车驶入区域内,将自动引导车首次当前位置作为坐标原点(0,0),每进行一次移动,激光雷达位于当前位置时,360度的旋转范围内,获取可以扫描到的反射板的距离信息和角度信息。优选地,自动引导车可以接收遥控器发送的移动指令,移动信息可以包括自动引导车的角速度和线速度,可以控制自动引导车以某速度向某方向进行移动。最终获取区域内所有反射板对应的距离信息和角度信息,并利用自动引导车的移动信息确定自动引导车确定的当前位置信息,进而获得反射板的地理坐标信息。图1e是本发明实施例一提供的一种坐标信息示意图,如图1e所示,(X,Y,phi)为自动引导车在地理坐标系中的位置,(r,theta)为雷达扫描到反射板的距离信息和角度信息,(x,y)为(r,theta)解算到雷达坐标系下的反射板的位置。通过以下坐标变换可以求得反射板在地理坐标系中的位置。
Xw=X+xcos(phi)-ysin(phi)
Yw=Y+xsin(phi)+ycos(phi)
在建立地理坐标地图时,根据已知(X,Y,phi)可以计算出反射板的地理坐标信息(Xw,Yw)。将所有反射板的地理坐标信息进行存储,得到地理坐标地图。在对自动引导车定位之前对反射板地理坐标信息进行计算,作为自动引导车坐标信息确定的基础,便于实现更加准确地获得定位信息。
实施例二
图2是本发明实施例二提供的一种自动引导车定位方法的流程图,本发明实施例是在上述实施例的基础上进行优化,对“根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息”进行了进一步优化,该方法具体包括以下步骤:
S210、获取激光雷达扫描的第一数量的反射板的距离信息及角度信息。
S220、在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息。
S230、根据所述自动引导车的位置信息,从所述第一数量的反射板中选取至少两组反射板,每组反射板包括至少三个目标反射板。
其中,对进行反射板进行分组,每组至少包括三个目标反射板。示例性地,自动引导车当前位置,激光雷达扫描到的反射板的数量为5,可以将5个反射板任意组合,每个反射板均能重复选择,每3个反射板构成一组,进行自动引导车的地理坐标信息的确定。
S240、根据每组反射板中所述目标反射板对应的距离信息、角度信息及地理坐标信息确定所述每组反射板对应的自动引导车的地理坐标信息,得到所述至少两组反射板对应的至少两个目标地理坐标信息。
其中,可以针对每组计算自动引导车的地理坐标信息,可以得知,得到自动引导车的目标地理坐标信息的个数与分组的个数相同。
S250、对所述至少两个目标地理坐标信息进行加权计算,得到自动引导车的地理坐标信息。
其中,将计算得到的所有目标地理坐标信息进行加权计算,每个目标地理坐标信息的权重可根据实际情况进行设定,例如可以考虑计算目标地理坐标信息时选取的反射板的位置进行设定,例如由于距离近时,激光雷达的测量数据会更加准确,因此可以将离自动引导车位置较近的反射板组设定较大的权重,离自动引导车位置较远的反射板组设定较小的权重。也可以采用求平均值的方式进行计算,最终得到自动引导车的地理坐标信息。
本发明实施例通过将反射板进行分组的方式,对每组进行自动引导车的目标地理坐标信息的确定,再对目标地理坐标信息进行加权计算,确定自动引导车的地理坐标信息,综合考虑激光雷达扫描范围内的反射板位置信息,采用加权的方式使自动引导车的地理坐标信息结果更加精准。
实施例三
图3是本发明实施例三提供的一种自动引导车定位方法的流程图,本发明实施例是在上述实施例的基础上进行了进一步优化,对“在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息”以及“所述根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息”进行了进一步优化,该方法具体包括以下步骤:
S310、获取激光雷达扫描的第一数量的反射板的距离信息及角度信息。
S320、在地理坐标系地图中读取所述第一数量的反射板中选取至少三个反射板作为目标反射板。
S330、读取所述至少三个目标反射板的地理坐标信息。
S340、根据所述至少三个目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的第一参考地理坐标信息。
其中,利用第一数量的反射板中选取的至少三个确定一个自动引导车的第一参考地理坐标信息,示例性地,第一数量可以是5个,从5个反射板中选取3个作为目标反射板,从5个反射板中任意选取3个进行自动引导车的定位计算,得到第一参考地理坐标信息。优选地,选取目标反射板时可以考虑选取距离自动引导车较近的反射板,或者是分布较好的反射板。
S350、根据所述第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息。
其中,所述其余反射板是指所述第一数量的反射板中除所述三个反射板外的其他反射板。
S360、获取所述其余反射板的预设地理坐标信息。
S370、当所述第二参考地理坐标信息与所述预设地理坐标信息之间的差值小于预设阈值时,将所述第一参考地理坐标信息确定为所述自动引导车的地理坐标信息。
其中,根据已计算好的第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息,示例性地,通过5个反射板中的3个反射板距离信息、角度信息及地理坐标信息确定了自动引导车的第一参考地理坐标信息。若计算准确,则可其余的反射板的位置都应该与预设信息相符。因此,再利用第一参考地理坐标信息确定另外两个反射板的第二参考地理坐标信息。反射板的预设地理坐标信息可以从地理坐标系地图中读取,预设阈值可以由实际需求进行确定,设定时可以考虑激光雷达的扫描精度等因素。当第二参考地理坐标信息与预设地理坐标信息之间的差值小于预设阈值时,则可以说明第二参考地理坐标信息与预设地理坐标信息较接近,说明前述计算的地理参考坐标信息准确度较高,则将第一参考地理坐标信息确定为自动引导车的地理坐标信息。若差值大于预设阈值时,可另外选取3个反射板进行计算,重复上述过程,若计算结果中,差值小于预设阈值的次数超过预设次数时,也可以确定计算准确,则可采用几次计算结果的加权计算确定最终的地理参考坐标信息,可以将差值大于预设阈值的计算结果附以较小的权重,增加计算结果的准确性。
本发明实施例采用激光雷达扫描到的第一数量中的至少三个反射板的信息计算自动引导车的地理坐标信息,再利用其余反射板对计算结果进行验证,增加计算结果的准确性,使自动引导车的定位计算更加准确。
实施例四
图4是本发明实施例四提供的一种自动引导车定位装置结构示意图,该装置包括信息获取模块410、坐标信息获取模块420及信息确定模块430:
信息获取模块410,用于获取激光雷达扫描的第一数量的反射板的距离信息及角度信息;
坐标信息获取模块420,用于在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,所述第二数量小于等于所述第一数量;
信息确定模块430,用于根据所述目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的地理坐标信息。
进一步的,还包括地图建立模块,具体用于:
在获取激光雷达扫描的第一数量的反射板的距离信息及角度信息之前,获取区域内每个反射板对应的距离信息和角度信息;
根据所述每个反射板对应的距离信息和角度信息,以及所述自动引导车的至少一个移动信息计算所述每个反射板的地理坐标信息;
将所述每个地理坐标信息进行存储,得到所述区域的地理坐标系地图。
进一步的,所述信息确定模块430,具体用于:
根据所述自动引导车的位置信息,从所述第一数量的反射板中选取至少两组反射板,每组反射板包括至少三个目标反射板;
根据每组反射板中所述目标反射板对应的距离信息、角度信息及地理坐标信息确定所述每组反射板对应的自动引导车的地理坐标信息,得到所述至少两组反射板对应的至少两个目标地理坐标信息;
对所述至少两个目标地理坐标信息进行加权计算,得到自动引导车的地理坐标信息。
进一步的,所述坐标信息获取模块420具体用于:
在地理坐标系地图中读取所述第一数量的反射板中选取至少三个反射板作为目标反射板;
读取所述至少三个目标反射板的地理坐标信息;
相应的,所述信息确定模块430具体用于:
根据所述至少三个目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的第一参考地理坐标信息;
根据所述第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息,其中,所述其余反射板是指所述第一数量的反射板中除所述三个反射板外的其他反射板;
获取所述其余反射板的预设地理坐标信息;
当所述第二参考地理坐标信息与所述预设地理坐标信息之间的差值小于预设阈值时,将所述第一参考地理坐标信息确定为所述自动引导车的地理坐标信息。
进一步的,还包括:所述自动引导车接收遥控器发送的移动指令并按照所述移动指令中携带的移动信息进行移动,所述移动信息包括所述自动引导车移动的角速度及线速度。
上述自动引导车定位装置可执行本发明任意实施例所提供的自动引导车定位方法,具备执行方法相应的功能模块和有益效果。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。
Claims (10)
1.一种自动引导车定位方法,其特征在于,包括:
获取激光雷达扫描的第一数量的反射板的距离信息及角度信息;
在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,所述第二数量小于等于所述第一数量;
根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息。
2.根据权利要求1所述的方法,其特征在于,在获取激光雷达扫描的第一数量的反射板的距离信息及角度信息之前,还包括:
获取区域内每个反射板对应的距离信息和角度信息;
根据所述每个反射板对应的距离信息和角度信息,以及所述自动引导车的至少一个移动信息计算所述每个反射板的地理坐标信息;
将所述每个地理坐标信息进行存储,得到所述区域的地理坐标系地图。
3.根据权利要求1或2所述的方法,其特征在于,所述根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息,包括:
根据所述自动引导车的位置信息,从所述第一数量的反射板中选取至少两组反射板,每组反射板包括至少三个目标反射板;
根据每组反射板中所述目标反射板对应的距离信息、角度信息及地理坐标信息确定所述每组反射板对应的自动引导车的地理坐标信息,得到所述至少两组反射板对应的至少两个目标地理坐标信息;
对所述至少两个目标地理坐标信息进行加权计算,得到自动引导车的地理坐标信息。
4.根据权利要求1或2所述的方法,其特征在于,所述在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,包括:
在地理坐标系地图中读取所述第一数量的反射板中选取至少三个反射板作为目标反射板;
读取所述至少三个目标反射板的地理坐标信息;
相应的,所述根据所述目标反射板对应的距离信息、角度信息及地理坐标信息,确定自动引导车的地理坐标信息,包括:
根据所述至少三个目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的第一参考地理坐标信息;
根据所述第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息,其中,所述其余反射板是指所述第一数量的反射板中除所述三个反射板外的其他反射板;
获取所述其余反射板的预设地理坐标信息;
当所述第二参考地理坐标信息与所述预设地理坐标信息之间的差值小于预设阈值时,将所述第一参考地理坐标信息确定为所述自动引导车的地理坐标信息。
5.根据权利要求2所述的方法,其特征在于,还包括:
所述自动引导车接收遥控器发送的移动指令并按照所述移动指令中携带的移动信息进行移动,所述移动信息包括所述自动引导车移动的角速度及线速度。
6.一种自动引导车定位装置,其特征在于,包括:
信息获取模块,用于获取激光雷达扫描的第一数量的反射板的距离信息及角度信息;
坐标信息获取模块,用于在地理坐标系地图中读取所述第一数量的反射板中的第二数量的目标反射板的地理坐标信息,所述第二数量小于等于所述第一数量;
信息确定模块,用于根据所述目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的地理坐标信息。
7.根据权利要求6所述的装置,其特征在于,还包括地图建立模块,具体用于:
在获取激光雷达扫描的第一数量的反射板的距离信息及角度信息之前,获取区域内每个反射板对应的距离信息和角度信息;
根据所述每个反射板对应的距离信息和角度信息,以及所述自动引导车的至少一个移动信息计算所述每个反射板的地理坐标信息;
将所述每个地理坐标信息进行存储,得到所述区域的地理坐标系地图。
8.根据权利要求6或7所述的装置,其特征在于,所述信息确定模块,具体用于:
根据所述自动引导车的位置信息,从所述第一数量的反射板中选取至少两组反射板,每组反射板包括至少三个目标反射板;
根据每组反射板中所述目标反射板对应的距离信息、角度信息及地理坐标信息确定所述每组反射板对应的自动引导车的地理坐标信息,得到所述至少两组反射板对应的至少两个目标地理坐标信息;
对所述至少两个目标地理坐标信息进行加权计算,得到自动引导车的地理坐标信息。
9.根据权利要求6或7所述的装置,其特征在于,所述坐标信息获取模块具体用于:
在地理坐标系地图中读取所述第一数量的反射板中选取至少三个反射板作为目标反射板;
读取所述至少三个目标反射板的地理坐标信息;
相应的,所述信息确定模块具体用于:
根据所述至少三个目标反射板的距离信息、角度信息及地理坐标信息确定自动引导车的第一参考地理坐标信息;
根据所述第一参考地理坐标信息确定其余反射板的第二参考地理坐标信息,其中,所述其余反射板是指所述第一数量的反射板中除所述三个反射板外的其他反射板;
获取所述其余反射板的预设地理坐标信息;
当所述第二参考地理坐标信息与所述预设地理坐标信息之间的差值小于预设阈值时,将所述第一参考地理坐标信息确定为所述自动引导车的地理坐标信息。
10.根据权利要求7所述的装置,其特征在于,还包括:所述自动引导车接收遥控器发送的移动指令并按照所述移动指令中携带的移动信息进行移动,所述移动信息包括所述自动引导车移动的角速度及线速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710191491.6A CN106950572B (zh) | 2017-03-28 | 2017-03-28 | 一种自动引导车定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710191491.6A CN106950572B (zh) | 2017-03-28 | 2017-03-28 | 一种自动引导车定位方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106950572A true CN106950572A (zh) | 2017-07-14 |
CN106950572B CN106950572B (zh) | 2020-09-01 |
Family
ID=59473981
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710191491.6A Active CN106950572B (zh) | 2017-03-28 | 2017-03-28 | 一种自动引导车定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106950572B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107817803A (zh) * | 2017-11-14 | 2018-03-20 | 上海诺力智能科技有限公司 | 一种适用于agv的二次精确定位的控制系统及其控制方法 |
CN107885223A (zh) * | 2017-10-31 | 2018-04-06 | 武汉大学 | 基于激光的无人机回收引导系统 |
CN108562908A (zh) * | 2017-12-21 | 2018-09-21 | 合肥中导机器人科技有限公司 | 激光导航混合定位方法、机器人导航方法及激光导航系统 |
CN108773433A (zh) * | 2018-06-05 | 2018-11-09 | 广州市远能物流自动化设备科技有限公司 | 一种基于agv小车的对接定位校准方法及agv小车 |
CN108801653A (zh) * | 2018-06-25 | 2018-11-13 | 工业和信息化部计算机与微电子发展研究中心(中国软件评测中心) | 搬运小车的测评工具和搬运小车的测评方法 |
CN109358616A (zh) * | 2018-09-12 | 2019-02-19 | 黄海宁 | 一种对自动导航物体位置坐标及方向偏差的校正方法 |
CN109725324A (zh) * | 2018-12-19 | 2019-05-07 | 北京测威科技有限公司 | 一种利用激光雷达实现平面内坐标定位的方法 |
WO2019104773A1 (zh) * | 2017-11-30 | 2019-06-06 | 歌尔科技有限公司 | 定位方法、定位地图构建方法及机器人 |
CN109959937A (zh) * | 2019-03-12 | 2019-07-02 | 广州高新兴机器人有限公司 | 长廊环境基于激光雷达的定位方法、存储介质及电子设备 |
CN110068830A (zh) * | 2019-03-27 | 2019-07-30 | 东软睿驰汽车技术(沈阳)有限公司 | 一种车辆定位的方法及装置 |
CN110395335A (zh) * | 2019-07-31 | 2019-11-01 | 深圳布科思科技有限公司 | 无人搬运车 |
CN110716205A (zh) * | 2019-10-18 | 2020-01-21 | 鱼越号机器人科技(上海)有限公司 | 基于反光板的定位方法及机器人、计算机可读存储介质 |
CN111137327A (zh) * | 2020-01-21 | 2020-05-12 | 中国铁道科学研究院集团有限公司电子计算技术研究所 | 轨道车辆定位方法及系统 |
CN111176299A (zh) * | 2020-01-22 | 2020-05-19 | 广州富港万嘉智能科技有限公司 | 车辆位置调整方法、计算机可读存储介质、agv控制系统及agv小车 |
CN112462331A (zh) * | 2020-11-06 | 2021-03-09 | 三一海洋重工有限公司 | 定位装置和定位方法 |
CN113759377A (zh) * | 2021-08-26 | 2021-12-07 | 追觅创新科技(苏州)有限公司 | 自移动设备定位方法、装置、存储介质、设备及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1247149A (zh) * | 1998-08-06 | 2000-03-15 | 村田机械株式会社 | 无人搬运车系统 |
CN103646446A (zh) * | 2013-12-20 | 2014-03-19 | 徐州徐工施维英机械有限公司 | 用于监控车辆行驶的方法、记录仪、系统及混凝土搅拌车 |
US20140129027A1 (en) * | 2012-11-02 | 2014-05-08 | Irobot Corporation | Simultaneous Localization And Mapping For A Mobile Robot |
CN104102222A (zh) * | 2014-07-31 | 2014-10-15 | 广州大学 | 一种agv精确定位的方法 |
CN105928505A (zh) * | 2016-04-19 | 2016-09-07 | 深圳市神州云海智能科技有限公司 | 移动机器人的位姿确定方法和设备 |
JP2016218504A (ja) * | 2015-05-14 | 2016-12-22 | 株式会社リコー | 移動装置及び移動システム |
-
2017
- 2017-03-28 CN CN201710191491.6A patent/CN106950572B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1247149A (zh) * | 1998-08-06 | 2000-03-15 | 村田机械株式会社 | 无人搬运车系统 |
US20140129027A1 (en) * | 2012-11-02 | 2014-05-08 | Irobot Corporation | Simultaneous Localization And Mapping For A Mobile Robot |
CN103646446A (zh) * | 2013-12-20 | 2014-03-19 | 徐州徐工施维英机械有限公司 | 用于监控车辆行驶的方法、记录仪、系统及混凝土搅拌车 |
CN104102222A (zh) * | 2014-07-31 | 2014-10-15 | 广州大学 | 一种agv精确定位的方法 |
JP2016218504A (ja) * | 2015-05-14 | 2016-12-22 | 株式会社リコー | 移動装置及び移動システム |
CN105928505A (zh) * | 2016-04-19 | 2016-09-07 | 深圳市神州云海智能科技有限公司 | 移动机器人的位姿确定方法和设备 |
Non-Patent Citations (2)
Title |
---|
宋英博 等: ""自动引导车定位方法研究"", 《计算机仿真》 * |
张浩: ""基于激光雷达的移动机器人定位方法研究"", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107885223B (zh) * | 2017-10-31 | 2020-02-14 | 武汉大学 | 基于激光的无人机回收引导系统 |
CN107885223A (zh) * | 2017-10-31 | 2018-04-06 | 武汉大学 | 基于激光的无人机回收引导系统 |
CN107817803A (zh) * | 2017-11-14 | 2018-03-20 | 上海诺力智能科技有限公司 | 一种适用于agv的二次精确定位的控制系统及其控制方法 |
WO2019104773A1 (zh) * | 2017-11-30 | 2019-06-06 | 歌尔科技有限公司 | 定位方法、定位地图构建方法及机器人 |
CN108562908A (zh) * | 2017-12-21 | 2018-09-21 | 合肥中导机器人科技有限公司 | 激光导航混合定位方法、机器人导航方法及激光导航系统 |
CN108773433A (zh) * | 2018-06-05 | 2018-11-09 | 广州市远能物流自动化设备科技有限公司 | 一种基于agv小车的对接定位校准方法及agv小车 |
CN108801653A (zh) * | 2018-06-25 | 2018-11-13 | 工业和信息化部计算机与微电子发展研究中心(中国软件评测中心) | 搬运小车的测评工具和搬运小车的测评方法 |
CN109358616A (zh) * | 2018-09-12 | 2019-02-19 | 黄海宁 | 一种对自动导航物体位置坐标及方向偏差的校正方法 |
CN109725324B (zh) * | 2018-12-19 | 2020-08-04 | 北京测威科技有限公司 | 一种利用激光雷达实现平面内坐标定位的方法 |
CN109725324A (zh) * | 2018-12-19 | 2019-05-07 | 北京测威科技有限公司 | 一种利用激光雷达实现平面内坐标定位的方法 |
CN109959937A (zh) * | 2019-03-12 | 2019-07-02 | 广州高新兴机器人有限公司 | 长廊环境基于激光雷达的定位方法、存储介质及电子设备 |
CN109959937B (zh) * | 2019-03-12 | 2021-07-27 | 广州高新兴机器人有限公司 | 长廊环境基于激光雷达的定位方法、存储介质及电子设备 |
CN110068830A (zh) * | 2019-03-27 | 2019-07-30 | 东软睿驰汽车技术(沈阳)有限公司 | 一种车辆定位的方法及装置 |
CN110395335A (zh) * | 2019-07-31 | 2019-11-01 | 深圳布科思科技有限公司 | 无人搬运车 |
CN110716205A (zh) * | 2019-10-18 | 2020-01-21 | 鱼越号机器人科技(上海)有限公司 | 基于反光板的定位方法及机器人、计算机可读存储介质 |
CN111137327A (zh) * | 2020-01-21 | 2020-05-12 | 中国铁道科学研究院集团有限公司电子计算技术研究所 | 轨道车辆定位方法及系统 |
CN111137327B (zh) * | 2020-01-21 | 2022-02-18 | 中国铁道科学研究院集团有限公司电子计算技术研究所 | 轨道车辆定位方法及系统 |
CN111176299A (zh) * | 2020-01-22 | 2020-05-19 | 广州富港万嘉智能科技有限公司 | 车辆位置调整方法、计算机可读存储介质、agv控制系统及agv小车 |
CN112462331A (zh) * | 2020-11-06 | 2021-03-09 | 三一海洋重工有限公司 | 定位装置和定位方法 |
CN112462331B (zh) * | 2020-11-06 | 2023-09-05 | 三一海洋重工有限公司 | 定位装置和定位方法 |
CN113759377A (zh) * | 2021-08-26 | 2021-12-07 | 追觅创新科技(苏州)有限公司 | 自移动设备定位方法、装置、存储介质、设备及系统 |
CN113759377B (zh) * | 2021-08-26 | 2023-09-01 | 追觅创新科技(苏州)有限公司 | 自移动设备定位方法、装置、存储介质、设备及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN106950572B (zh) | 2020-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106950572A (zh) | 一种自动引导车定位方法及装置 | |
CN110174093B (zh) | 定位方法、装置、设备和计算机可读存储介质 | |
CN110008851B (zh) | 一种车道线检测的方法及设备 | |
CN105512646B (zh) | 一种数据处理方法、装置及终端 | |
CN109840448A (zh) | 用于无人驾驶车辆的信息输出方法和装置 | |
CN109490825B (zh) | 定位导航方法、装置、设备、系统及存储介质 | |
JP3345113B2 (ja) | 目標物認識方法及び標的同定方法 | |
US8665263B2 (en) | Aerial image generating apparatus, aerial image generating method, and storage medium having aerial image generating program stored therein | |
CN109931939A (zh) | 车辆的定位方法、装置、设备及计算机可读存储介质 | |
CN101952688A (zh) | 用于与传感器检测到的对象进行地图匹配的方法 | |
CN110501018A (zh) | 一种服务于高精度地图生产的交通标志牌信息采集方法 | |
US11231285B2 (en) | Map information system | |
AU2007355942A2 (en) | Arrangement and method for providing a three dimensional map representation of an area | |
CN109740584B (zh) | 基于深度学习的自动泊车停车位检测方法 | |
CN110889380B (zh) | 一种舰船识别方法、装置及计算机存储介质 | |
CN110203192A (zh) | 定位技术选择 | |
AU2008365306A1 (en) | System and method for mixing a scene with a virtual scenario | |
KR102480972B1 (ko) | 고정밀지도생성장치 및 고정밀지도생성방법 | |
CN101620672B (zh) | 一种利用立体地标定位识别地面立体建筑物的方法 | |
CN109583312A (zh) | 车道线识别方法、装置、设备及存储介质 | |
JP2022129175A (ja) | 車両評価方法及び車両評価装置 | |
EP2955541A1 (en) | Locating parts with electromagnetic identification (emid) tags for contextual visualization | |
CN114119682A (zh) | 一种激光点云和图像配准方法及配准系统 | |
CN111862208B (zh) | 一种基于屏幕光通信的车辆定位方法、装置及服务器 | |
KR102105590B1 (ko) | 저가 상용 gnss의 측위 정확도 개선 시스템 및 방법 |
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 |