CN111307168A - Agv建图方法和定位方法及系统 - Google Patents
Agv建图方法和定位方法及系统 Download PDFInfo
- Publication number
- CN111307168A CN111307168A CN202010197464.1A CN202010197464A CN111307168A CN 111307168 A CN111307168 A CN 111307168A CN 202010197464 A CN202010197464 A CN 202010197464A CN 111307168 A CN111307168 A CN 111307168A
- Authority
- CN
- China
- Prior art keywords
- agv
- reflectors
- coordinate
- reflector
- coordinates
- 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 69
- 238000013507 mapping Methods 0.000 claims description 13
- 238000012935 Averaging Methods 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 8
- 238000004590 computer program Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000002349 favourable effect Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000001914 filtration Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- 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
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种AGV建图方法和定位方法及系统，包括：设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。本发明有利于减小定位误差，提高定位精度。
Description
技术领域
本发明涉及自动控制的技术领域，尤其是指一种AGV建图方法和定位方法及系统。
背景技术
AGV(Automated Guided Vehicle的缩写,自动导引运输车)车辆可用的定位导航方式有：无反射板激光、有反射板激光、二维码、色带、磁条、3D相机、IMU惯性导航、视觉导航等。其中IMU(Inertial Measurement Unit惯性测量单元)惯性导航与无反射板激光定位采用滤波算法融合，无需切换。在其它定位方式组合使用时，一般采用将一种定位方式作为主要定位手段，其它定位方式作为辅助定位手段，相互切换使用。有反射板激光定位主要用在局部定位要求较高的情景下，与无反射板激光定位相互配合使用。但是采用上述方式对AGV车辆导航过程中，定位误差大，导致定位精度低。
发明内容
为此，本发明所要解决的技术问题在于克服现有技术中定位误差大，导致定位精度低的问题，从而提供一种定位误差小，且有利于提高定位精度的AGV建图方法和定位方法及系统。
为解决上述技术问题，本发明的一种AGV建图方法，包括如下步骤：设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。
在本发明的一个实施例中，将所述AGV所在位置设置为坐标原点的方法为：以当前AGV车体坐标系为固定坐标系，读取激光传感器的数据，计算所述反光板的个数及坐标，根据所述反光板的个数及坐标确定所述AGV车体的原始坐标，将所述AGV车体的原始坐标作为坐标原点。
在本发明的一个实施例中，计算所述反光板坐标的方法为：：若所述反光板的个数不大于所述第一设定数量，则不能将所述AGV所在位置设置为坐标原点，继续观测直至观测到的反光板数目大于所述第一设定数量；若所述反光板的个数大于所述第一设定数量，则记录观察次数及坐标，若观察次数大于预设值，则对同一反光板的所有记录坐标取平均值，，记作反光板坐标。
在本发明的一个实施例中，与所述地图中已经保存的反光板进行匹配的方法为：在所述AGV行驶过程中，若观测到的反光板数目大于所述第一设定数量，读取激光传感器数据，利用里程计算出所述AGV在所述固定坐标系下的第一坐标，并确认所述反光板相对所述AGV车体的第二坐标，计算所述反光板在所述固定坐标系下的第三坐标，将所述反光板在所述固定坐标系下的第三坐标与所述地图中存在的反光板的原始坐标进行匹配，直至所述反光板全部匹配。
在本发明的一个实施例中，确认所述反光板相对所述AGV车体的第二坐标的方法为：激光传感器多次观察反光板位置，记录观察次数及坐标，若观察次数大于第一预设值，则对同一反光板的所有记录坐标取平均值，记作反光板相对所述AGV车体的第二坐标。
在本发明的一个实施例中，将所述反光板在所述固定坐标系下的第三坐标与所述地图中存在的反光板的原始坐标进行匹配时，若各坐标的差值不在设定第一阈值内，则所述AGV车体继续行驶；若各坐标的差值在设定第一阈值内，则认为匹配成功，确认所述反光板的坐标，利用所述反光板的坐标对所述AGV车体进行定位，确认所述AGV车体的坐标，根据所述AGV车体的坐标确认未匹配的反光板在所述固定坐标系下的位置，并将其添加到所述地图中，直至所述反光板全部匹配。
在本发明的一个实施例中，所述反光板全部匹配完成后，建图完成，形成新地图。
本发明还提供了一种AGV定位方法，包括上述任意一项所述的建图方法，且在建图的过程中形成新地图后，在所述新地图中，所述AGV车体行驶过程时继续观测所述反光板，若观测到的反光板数目小于第二设定数量，则所述AGV车体继续行驶；若观测到的反光板数目不小于所述第二设定数量，则通过所述反光板的最终坐标对所述AGV进行定位。
在本发明的一个实施例中，所述AGV车体行驶过程中观测所述反光板，读取激光传感器的数据，计算所述反光板的个数及坐标，利用里程计算出所述AGV车体在所述固定坐标系下的第四坐标，确认所述反光板相对所述AGV车体的第五坐标，计算所述反光板在所述固定坐标系下的第六坐标，将所述反光板在所述固定坐标系下的第六坐标与所述新地图中存在的反光板中的坐标进行匹配，最终确认所述AGV车体的最终坐标。
在本发明的一个实施例中，确认所述反光板相对所述AGV车体的第五坐标的方法为：激光传感器多次观察反光板位置，记录观察次数及坐标，若观察次数大于第二预设值，则对同一反光板的所有记录坐标取平均值，记作反光板相对所述AGV车体的第五坐标。
在本发明的一个实施例中，将所述反光板在所述固定坐标系下的第六坐标与所述新地图中存在的反光板中的坐标进行匹配时，若各坐标差值在设定第二阈值内，则确认所述反光板的最终坐标，利用所述反光板的最终坐标对所述AGV车体进行定位，若各坐标差值不在设定所述第二阈值内，则所述AGV继续行驶。
本发明还提供了一种AGV系统，包括：设置模块，用于设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；匹配模块，用于在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。
本发明的上述技术方案相比现有技术具有以下优点：
本发明所述的AGV建图方法和定位方法及系统，设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点，从而有利于对AGV车体进行原始定位；在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图，从而有利于减少定位误差。
附图说明
为了使本发明的内容更容易被清楚的理解，下面根据本发明的具体实施例并结合附图，对本发明作进一步详细的说明，其中
图1是本发明AGV建图方法的流程图；
图2是本发明建图时的详细流程图；
图3是本发明定位时的详细流程图。
具体实施方式
实施例一
如图1所示，本实施例提供一种AGV建图方法，包括步骤S1：设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；步骤S2：在所述AGV移动到新位置后，判断观测到的反光板数目是否大于第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。
本实施例所述AGV建图方法，所述步骤S1，设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点，从而有利于对AGV车体进行原始定位；所述步骤S2中，在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图，从而有利于减少定位误差，提高定位精度。
所述步骤S1中，将所述AGV所在位置设置为坐标原点的方法为：以当前AGV车体坐标系为固定坐标系，读取激光传感器的数据，计算所述反光板的个数及坐标，根据所述反光板的个数及坐标确定所述AGV车体的原始坐标，将所述AGV车体的原始坐标作为坐标原点，从而有利于再确定出所述AGV车体所在的位置后，对所述AGV车体进行原始定位。其中，计算所述反光板坐标的方法为：若所述反光板的个数不大于所述第一设定数量，则不能将所述AGV所在位置设置为坐标原点，继续观测直至观测到的反光板数目大于所述第一设定数量；若所述反光板的个数大于所述第一设定数量，则记录观察次数及坐标，若观察次数大于预设值，则对同一反光板的所有记录坐标取平均值，并确定所述AGV车体的原始坐标，从而实现了对所述AGV车体的原始定位。
如图2所示，所述步骤S2中，与所述地图中已经保存的反光板进行匹配的方法为：在所述AGV行驶过程中，若观测到的反光板数目大于所述第一设定数量，读取激光传感器数据，利用里程计算出所述AGV在所述固定坐标系下的第一坐标，具体地，利用里程计可以粗略算出所述AGV在所述固定坐标系下的第一坐标，并确认所述反光板相对所述AGV车体的第二坐标，计算所述反光板在所述固定坐标系下的第三坐标，将所述反光板在所述固定坐标系下的第三坐标与所述地图中存在的反光板的原始坐标进行匹配，直至所述反光板全部匹配，从而有利于形成新地图，减少定位误差。
确认所述反光板相对所述AGV车体的第二坐标的方法为：激光传感器多次观察反光板位置，记录观察次数及坐标，若观察次数大于第一预设值，则对同一反光板的所有记录坐标取平均值，记作反光板相对所述AGV车体的第二坐标。
另外，将所述反光板在所述固定坐标系下的第三坐标与所述地图中存在的反光板的原始坐标进行匹配时，若各坐标的差值不在设定第一阈值内，则所述AGV车体继续行驶；若各坐标的差值在设定第一阈值内，则认为匹配成功，确认所述反光板的坐标，利用所述反光板的坐标对所述AGV车体进行定位，确认所述AGV车体的坐标，根据所述AGV车体的坐标确认未匹配的反光板在所述固定坐标系下的位置，并将其添加到所述地图中，直至所述反光板全部匹配，从而可以最大程度上减小定位误差。所述反光板全部匹配完成后，建图完成，形成新地图。
实施例二
如图3所示，本实施例提供一种AGV定位方法，包括实施例一所述的建图方法，且在建图的过程中形成新地图后，在所述新地图中，所述AGV车体行驶过程时继续观测所述反光板，若观测到的反光板数目小于第二设定数量，则所述AGV车体继续行驶；若观测到的反光板数目不小于所述第二设定数量，则通过所述反光板的最终坐标对所述AGV进行定位。
本实施例所述AGV定位方法，在实施例一所述的建图方法中形成新地图后，在所述新地图中，所述AGV车体行驶过程时继续观测所述反光板，若观测到的反光板数目小于第二设定数量，则所述AGV车体继续行驶；若观测到的反光板数目不小于所述第二设定数量，则通过所述反光板的最终坐标对所述AGV进行定位，不但方法简单，而且减小了定位误差，提高了定位精度。
具体地，所述AGV车体行驶过程中观测所述反光板，读取激光传感器的数据，计算所述反光板的个数及坐标，利用里程计粗略算出所述AGV车体在所述固定坐标系下的第四坐标，具体地，利用里程计可以粗略算出所述AGV车体在所述固定坐标系下的第四坐标，确认所述反光板相对所述AGV车体的第五坐标，计算所述反光板在所述固定坐标系下的第六坐标，将所述反光板在所述固定坐标系下的第六坐标与所述新地图中存在的反光板中的坐标进行匹配，最终确认所述AGV车体的坐标，从而减小了定位误差，提高了定位精度。
确认所述反光板相对所述AGV车体的第五坐标的方法为：激光传感器多次观察反光板位置，记录观察次数及坐标，若观察次数大于第二预设值，则对同一反光板的所有记录坐标取平均值，记作反光板相对所述AGV车体的第五坐标。
另外，将所述反光板在所述固定坐标系下的第六坐标与所述新地图中存在的反光板中的坐标进行匹配时，若各坐标差值在设定第二阈值内，则确认所述反光板的最终坐标，利用所述反光板的最终坐标对所述AGV车体进行定位，不但方法简单，而且定位精度高。另外，将所述反光板在所述固定坐标系下的坐标与所述新地图中存在的反光板中的坐标进行匹配时，若各坐标差值不在设定所述第二阈值内，则所述AGV继续行驶。
所述反光板的最终坐标对所述AGV车体进行定位时，利用多边定位算法对所述AGV进行定位。
所述第一设定数量至少为两个以上；所述第二设定数量也至少为两个以上；所述第一阈值与所述第二阈值是经验值，其数值可以相同也可以不同。本实施例中，所述第一设定数量和所述第二设定数量的数量相同均为3个，因此有利于通过三边定位算法对AGV进行定位。
实施例三
基于同一发明构思，本实施例提供了第一种AGV系统，其解决问题的原理与所述AGV建图方法类似，重复之处不再赘述。
本实施例提供一种AGV系统，包括：
设置模块，用于设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；
匹配模块，用于在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。
实施例四
基于同一发明构思，本实施例提供了第二种AGV系统，其解决问题的原理与所述AGV定位方法类似，重复之处不再赘述。
本实施例提供一种AGV系统，包括：
设置模块，用于设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；
匹配模块，用于在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图；
定位模块，用于在所述新地图中，所述AGV车体行驶过程时继续观测所述反光板，若观测到的反光板数目小于第二设定数量，则所述AGV车体继续行驶；若观测到的反光板数目不小于所述第二设定数量，则通过所述反光板的最终坐标对所述AGV进行定位。
本领域内的技术人员应明白，本申请的实施例可提供为方法、系统、或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
显然，上述实施例仅仅是为清楚地说明所作的举例，并非对实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引伸出的显而易见的变化或变动仍处于本发明创造的保护范围之中。
Claims (12)
1.一种AGV建图方法，其特征在于，包括如下步骤：
步骤S1：设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；
步骤S2：在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。
2.根据权利要求1所述的AGV建图方法，其特征在于：将所述AGV所在位置设置为坐标原点的方法为：以当前AGV车体坐标系为固定坐标系，读取激光传感器的数据，计算所述反光板的个数及坐标，根据所述反光板的个数及坐标确定所述AGV车体的原始坐标，将所述AGV车体的原始坐标作为坐标原点。
3.根据权利要求2所述的AGV建图方法，其特征在于：计算所述反光板坐标的方法为：若所述反光板的个数不大于所述第一设定数量，则不能将所述AGV所在位置设置为坐标原点，继续观测直至观测到的反光板数目大于所述第一设定数量；若所述反光板的个数大于所述第一设定数量，则记录观察次数及坐标，若观察次数大于预设值，则对同一反光板的所有记录坐标取平均值，记作反光板坐标。
4.根据权利要求1所述的AGV建图方法，其特征在于：与所述地图中已经保存的反光板进行匹配的方法为：在所述AGV行驶过程中，若观测到的反光板数目大于所述第一设定数量，读取激光传感器数据，利用里程计算出所述AGV在所述固定坐标系下的第一坐标，并确认所述反光板相对所述AGV车体的第二坐标，计算所述反光板在所述固定坐标系下的第三坐标，将所述反光板在所述固定坐标系下的第三坐标与所述地图中存在的反光板的原始坐标进行匹配，直至所述反光板全部匹配。
5.根据权利要求4所述的AGV建图方法，其特征在于：确认所述反光板相对所述AGV车体的第二坐标的方法为：激光传感器多次观察反光板位置，记录观察次数及坐标，若观察次数大于第一预设值，则对同一反光板的所有记录坐标取平均值，记作反光板相对所述AGV车体的第二坐标。
6.根据权利要求4所述的AGV建图方法，其特征在于：将所述反光板在所述固定坐标系下的第三坐标与所述地图中存在的反光板的原始坐标进行匹配时，若各坐标的差值不在设定第一阈值内，则所述AGV车体继续行驶；若各坐标的差值在设定第一阈值内，则认为匹配成功，确认所述反光板的坐标，利用所述反光板的坐标对所述AGV车体进行定位，确认所述AGV车体的坐标，根据所述AGV车体的坐标确认未匹配的反光板在所述固定坐标系下的位置，并将其添加到所述地图中，直至所述反光板全部匹配。
7.根据权利要求6所述的AGV建图方法，其特征在于：所述反光板全部匹配完成后，建图完成，形成新地图。
8.一种AGV定位方法，其特征在于：包括权利要求1-7中任意一项所述的建图方法，且在建图的过程中形成新地图后，在所述新地图中，所述AGV车体行驶过程时继续观测所述反光板，若观测到的反光板数目小于第二设定数量，则所述AGV车体继续行驶；若观测到的反光板数目不小于所述第二设定数量，则通过所述反光板的最终坐标对所述AGV进行定位。
9.根据权利要求8所述的AGV定位方法，其特征在于：所述AGV车体行驶过程中观测所述反光板，读取激光传感器的数据，计算所述反光板的个数及坐标，利用里程计算出所述AGV车体在所述固定坐标系下的第四坐标，确认所述反光板相对所述AGV车体的第五坐标，计算所述反光板在所述固定坐标系下的第六坐标，将所述反光板在所述固定坐标系下的第六坐标与所述新地图中存在的反光板中的坐标进行匹配，最终确认所述AGV车体的最终坐标。
10.根据权利要求9所述的AGV定位方法，其特征在于：确认所述反光板相对所述AGV车体的第五坐标的方法为：激光传感器多次观察反光板位置，记录观察次数及坐标，若观察次数大于第二预设值，则对同一反光板的所有记录坐标取平均值，记作反光板相对所述AGV车体的第五坐标。
11.根据权利要求8所述的AGV定位方法，其特征在于：将所述反光板在所述固定坐标系下的第六坐标与所述新地图中存在的反光板中的坐标进行匹配时，若各坐标差值在设定第二阈值内，则确认所述反光板的最终坐标，利用所述反光板的最终坐标对所述AGV车体进行定位，若各坐标差值不在设定所述第二阈值内，则所述AGV继续行驶。
12.一种AGV系统，其特征在于，包括：
设置模块，用于设置固定坐标系坐标原点，记录当前里程计信息，其中所述AGV观测到第一设定数量的反光板后，将所述AGV所在位置设置为坐标原点；
匹配模块，用于在所述AGV移动到新位置后，判断观测到的反光板数目是否大于所述第一设定数量，若不大于，则所述AGV继续移动；若大于，则与所述地图中已经保存的反光板进行匹配，若匹配数量大于等于第一设定数量，则利用匹配到的反光板对所述AGV进行定位，并计算出未匹配的反光板在固定坐标系下的位置，并将其添加到所述地图中，形成新地图。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010197464.1A CN111307168A (zh) | 2020-03-19 | 2020-03-19 | Agv建图方法和定位方法及系统 |
| PCT/CN2020/131105 WO2021184814A1 (zh) | 2020-03-19 | 2020-11-24 | Agv建图方法和定位方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010197464.1A CN111307168A (zh) | 2020-03-19 | 2020-03-19 | Agv建图方法和定位方法及系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN111307168A true CN111307168A (zh) | 2020-06-19 |
Family
ID=71158864
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010197464.1A Pending CN111307168A (zh) | 2020-03-19 | 2020-03-19 | Agv建图方法和定位方法及系统 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN111307168A (zh) |
| WO (1) | WO2021184814A1 (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112327312A (zh) * | 2020-10-28 | 2021-02-05 | 上海高仙自动化科技发展有限公司 | 一种车辆位姿确定方法、装置、车辆及存储介质 |
| WO2021184814A1 (zh) * | 2020-03-19 | 2021-09-23 | 苏州艾吉威机器人有限公司 | Agv建图方法和定位方法及系统 |
| CN113984065A (zh) * | 2021-10-27 | 2022-01-28 | 山东亚历山大智能科技有限公司 | 一种用于室内机器人的反光板地图生成方法及系统 |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20140172293A1 (en) * | 2012-12-17 | 2014-06-19 | Industrial Technology Research Institute | Map matching device, system and method |
| WO2015120813A1 (zh) * | 2014-02-13 | 2015-08-20 | 苏州工业园区艾吉威自动化设备有限公司 | 无反射板激光自主导航agv小车及其导航方法 |
| WO2017028653A1 (zh) * | 2015-08-14 | 2017-02-23 | 北京进化者机器人科技有限公司 | 一种移动机器人室内自建地图的方法和系统 |
| CN107421518A (zh) * | 2017-07-29 | 2017-12-01 | 深圳力子机器人有限公司 | 一种无轨导航agv自动进出货车方法 |
| CN108195377A (zh) * | 2017-12-22 | 2018-06-22 | 广东嘉腾机器人自动化有限公司 | 一种基于三角形周长匹配的反光板匹配算法 |
| CN108562908A (zh) * | 2017-12-21 | 2018-09-21 | 合肥中导机器人科技有限公司 | 激光导航混合定位方法、机器人导航方法及激光导航系统 |
| CN109613548A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
| CN109613547A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的占据栅格地图构建方法 |
| CN109613550A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的激光雷达地图构建及定位方法 |
| CN109885049A (zh) * | 2019-02-12 | 2019-06-14 | 北京航空航天大学 | 一种基于航位推算的激光导引agv自动建图和路径匹配方法 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2013122466A (ja) * | 2013-02-08 | 2013-06-20 | Denso Corp | レーダ装置 |
| CN106843222A (zh) * | 2017-03-13 | 2017-06-13 | 苏州艾吉威机器人有限公司 | 一种局部铺反射板的激光导航agv系统 |
| CN106969768B (zh) * | 2017-04-22 | 2020-08-11 | 深圳力子机器人有限公司 | 一种无轨导航agv的精确定位及停车方法 |
| CN107817500B (zh) * | 2017-07-28 | 2020-07-07 | 浙江工业大学 | 一种模块化舞台激光定位方法 |
| CN111307168A (zh) * | 2020-03-19 | 2020-06-19 | 苏州艾吉威机器人有限公司 | Agv建图方法和定位方法及系统 |
-
2020
- 2020-03-19 CN CN202010197464.1A patent/CN111307168A/zh active Pending
- 2020-11-24 WO PCT/CN2020/131105 patent/WO2021184814A1/zh active Application Filing
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20140172293A1 (en) * | 2012-12-17 | 2014-06-19 | Industrial Technology Research Institute | Map matching device, system and method |
| WO2015120813A1 (zh) * | 2014-02-13 | 2015-08-20 | 苏州工业园区艾吉威自动化设备有限公司 | 无反射板激光自主导航agv小车及其导航方法 |
| WO2017028653A1 (zh) * | 2015-08-14 | 2017-02-23 | 北京进化者机器人科技有限公司 | 一种移动机器人室内自建地图的方法和系统 |
| CN107421518A (zh) * | 2017-07-29 | 2017-12-01 | 深圳力子机器人有限公司 | 一种无轨导航agv自动进出货车方法 |
| CN108562908A (zh) * | 2017-12-21 | 2018-09-21 | 合肥中导机器人科技有限公司 | 激光导航混合定位方法、机器人导航方法及激光导航系统 |
| CN108195377A (zh) * | 2017-12-22 | 2018-06-22 | 广东嘉腾机器人自动化有限公司 | 一种基于三角形周长匹配的反光板匹配算法 |
| CN109613548A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
| CN109613547A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的占据栅格地图构建方法 |
| CN109613550A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的激光雷达地图构建及定位方法 |
| CN109885049A (zh) * | 2019-02-12 | 2019-06-14 | 北京航空航天大学 | 一种基于航位推算的激光导引agv自动建图和路径匹配方法 |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2021184814A1 (zh) * | 2020-03-19 | 2021-09-23 | 苏州艾吉威机器人有限公司 | Agv建图方法和定位方法及系统 |
| CN112327312A (zh) * | 2020-10-28 | 2021-02-05 | 上海高仙自动化科技发展有限公司 | 一种车辆位姿确定方法、装置、车辆及存储介质 |
| CN113984065A (zh) * | 2021-10-27 | 2022-01-28 | 山东亚历山大智能科技有限公司 | 一种用于室内机器人的反光板地图生成方法及系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2021184814A1 (zh) | 2021-09-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111307168A (zh) | Agv建图方法和定位方法及系统 | |
| CN110687539B (zh) | 一种车位检测方法、装置、介质和设备 | |
| CN102713987B (zh) | 道路信息检测装置以及车辆行驶控制装置 | |
| CN103162691B (zh) | 显示系统、显示方法 | |
| CN106608261B (zh) | 控制行驶车辆之间的距离的车辆和方法 | |
| US20200191942A1 (en) | Apparatus and method for tracking target vehicle and vehicle including the same | |
| CN105806353A (zh) | 自动驾驶装置 | |
| CN112046481B (zh) | 自动驾驶装置和方法 | |
| CN113460086B (zh) | 自动驾驶进入匝道的控制系统、方法、车辆及存储介质 | |
| CN114690765A (zh) | 矿卡自适应挡墙卸载停靠方法、装置、系统及计算机设备 | |
| US20220256082A1 (en) | Traveling environment recognition apparatus | |
| CN115900730A (zh) | 一种自动驾驶车辆三维点云定位方法、装置及存储介质 | |
| CN113465615B (zh) | 车道线的生成方法及相关装置 | |
| CN110083158B (zh) | 一种确定局部规划路径的方法和设备 | |
| CN116279428A (zh) | 一种自动泊车停车避障的方法及系统 | |
| CN114559941B (zh) | 车辆弯道行驶预警方法、系统、装置和计算机可读介质 | |
| CN116071714A (zh) | 车道偏离检测方法、系统、电子设备及可读存储介质 | |
| JP2017090339A (ja) | 位置記録装置 | |
| CN113375656B (zh) | 定位方法和设备 | |
| US20230373526A1 (en) | Driving assistance control device and driving assistance control method | |
| CN114964287A (zh) | 车道定位方法、计算机设备、计算机可读存储介质及车辆 | |
| CN113724390A (zh) | 匝道生成方法及装置 | |
| CN113386771A (zh) | 道路模型的生成方法及设备 | |
| CN112092800A (zh) | 一种自动泊车时的方向盘转角优化方法及系统 | |
| WO2019176197A1 (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 | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200619 |