CN115220012A - 一种基于反光板定位方法 - Google Patents
一种基于反光板定位方法 Download PDFInfo
- Publication number
- CN115220012A CN115220012A CN202211143296.3A CN202211143296A CN115220012A CN 115220012 A CN115220012 A CN 115220012A CN 202211143296 A CN202211143296 A CN 202211143296A CN 115220012 A CN115220012 A CN 115220012A
- Authority
- CN
- China
- Prior art keywords
- reflector
- pose
- coordinate system
- robot
- radar
- 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 17
- 238000012935 Averaging Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 27
- 239000013598 vector Substances 0.000 claims description 18
- 238000002310 reflectometry Methods 0.000 claims description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 235000020004 porter Nutrition 0.000 description 1
- 102000012498 secondary active transmembrane transporter activity proteins Human genes 0.000 description 1
- 108040003878 secondary active transmembrane transporter activity proteins Proteins 0.000 description 1
Images
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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4802—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于反光板定位方法,包括以下步骤:S1:进入反光板扫描区域,激光雷达扫描高反物体,得到激光数据;S2:扫描到的激光数据,提取激光点云,算出反光板上的点数n;S3:根据反光板质心位置,与雷达坐标系的反光板对应,并与标定好的反光板进行匹配,若匹配成功,则匹配成功的反光板记为一个集合;S4:根据匹配好的反光板,计算机器人的位姿;S5:计算出的机器人位姿,求平均值,得到当前机器人位姿,进行发布。激光雷达对扫描区域进行扫描,得出反光板质心位置,并进行匹配得出机器人的位姿,再其求平均值,从而能够适应高动态区域,并提高定位的精度与稳定性,同时鲁棒性较高。
Description
技术领域
本发明涉及定位技术领域,特别是一种基于反光板定位方法。
背景技术
随着中国经济的快速发展,agv搬运车越来越频繁使用于工厂各个角落,但是agv的工作环境是高动态变化的,有很多人与货物,包括其他机械设备经常变化,造成传统的slam定位不能适用于这种高动态环境。
发明内容
本发明的目的在于克服现有技术的缺点,提供一种基于反光板定位方法。
本发明的目的通过以下技术方案来实现:一种基于反光板定位方法,包括以下步骤:
S1:进入反光板扫描区域,激光雷达扫描到高反物体,得到激光数据;
S2:根据扫描到的激光数据,提取激光点云,从而计算出反光板上的点数n,
S3:根据反光板质心位置,与雷达坐标系的反光板对应,并与标定好的反光板进行匹配,若匹配成功,则匹配成功的反光板记为一个集合mapsets;
S4:根据匹配好的反光板,按两两一组,计算机器人的位姿;
S5:根据计算出的机器人位姿,将其求平均值,得到当前机器人位姿,并进行发布。
优选的,S1中,若未进入反光板扫描区域,会在进入反光板扫描区域之前有一个初始位姿,若已经进入反光板扫描区域,则用上一帧求取的位姿作为初始位姿,根据初始位姿与激光里程计求出这一时刻的预估位姿,根据反光板质心位置集合sets,从当前集合中取出一个反光板数据,求取每个反光板的当前反光板在世界坐标下的预估位置,并与雷达坐标系的反光板对应。
优选的,计算机器人位姿的步骤如下:
A1:匹配好的反光板,按两个反光板形成一个组合,分成若干组;
本发明具有以下优点:本发明通过激光雷达对扫描区域进行扫描,从而得出反光板质心位置,并进行匹配得出机器人的位姿,再其求平均值,从而能够适应高动态区域,并提高定位的精度与稳定性,同时鲁棒性较高。
附图说明
图1 为定位方法逻辑流程的结构示意图。
具体实施方式
为使本发明实施方式的目的、技术方案和优点更加清楚,下面将结合本发明实施方式中的附图,对本发明实施方式中的技术方案进行清楚、完整地描述,显然,所描述的实施方式是本发明一部分实施方式,而不是全部的实施方式。通常在此处附图中描述和示出的本发明实施方式的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本发明的实施方式的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施方式。基于本发明中的实施方式,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施方式,都属于本发明保护的范围。
需要说明的是,在不冲突的情况下,本发明中的实施方式及实施方式中的特征可以相互组合。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,或者是该发明产品使用时惯常摆放的方位或位置关系,或者是本领域技术人员惯常理解的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
在本发明的描述中,还需要说明的是,除非另有明确的规定和限定,术语“设置”、“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
在本实施例中,如图1所示,一种基于反光板定位方法,包括以下步骤:
S1:进入反光板扫描区域,激光雷达扫描到高反物体,得到激光数据;
S2:根据扫描到的激光数据,提取激光点云,从而计算出反光板上的点数n,
S3:根据反光板质心位置,与雷达坐标系的反光板对应,并与标定好的反光板进行匹配,若匹配成功,则匹配成功的反光板记为一个集合mapsets;
S4:根据匹配好的反光板,按两两一组,计算机器人的位姿;优选的,通过马氏距离进行匹配。
S5:根据计算出的机器人位姿,将其求平均值,得到当前机器人位姿,并进行发布。通过激光雷达对扫描区域进行扫描,从而得出反光板质心位置,并进行匹配得出机器人的位姿,再其求平均值,从而能够适应高动态区域,并提高定位的精度与稳定性,同时鲁棒性较高。
再进一步的,S1中,若未进入反光板扫描区域,会在进入反光板扫描区域之前有一个初始位姿,若已经进入反光板扫描区域,则用上一帧求取的位姿作为初始位姿,根据初始位姿与激光里程计求出这一时刻的预估位姿,根据反光板质心位置集合sets,从当前集合中取出一个反光板数据,求取每个反光板的当前反光板在世界坐标下的预估位置,并与雷达坐标系的反光板对应。
在本实施例中,计算机器人位姿的步骤如下:
A1:匹配好的反光板,按两个反光板形成一个组合,分成若干组;
尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
5.根据权利要求4所述的一种基于反光板定位方法,其特征在于:计算机器人位姿的步骤如下:
A1:匹配好的反光板,按两个反光板形成一个组合,分成若干组;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211143296.3A CN115220012A (zh) | 2022-09-20 | 2022-09-20 | 一种基于反光板定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211143296.3A CN115220012A (zh) | 2022-09-20 | 2022-09-20 | 一种基于反光板定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115220012A true CN115220012A (zh) | 2022-10-21 |
Family
ID=83617865
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211143296.3A Pending CN115220012A (zh) | 2022-09-20 | 2022-09-20 | 一种基于反光板定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115220012A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115575963A (zh) * | 2022-12-07 | 2023-01-06 | 成都睿芯行科技有限公司 | 一种基于反光板与slam融合的定位方法 |
CN115586511A (zh) * | 2022-11-25 | 2023-01-10 | 唐山百川工业服务有限公司 | 一种基于阵列立柱的激光雷达二维定位方法 |
CN115656965A (zh) * | 2022-12-09 | 2023-01-31 | 成都睿芯行科技有限公司 | 一种基于已知地图和定位标定反光板地图方法 |
CN118192392A (zh) * | 2024-05-16 | 2024-06-14 | 成都睿芯行科技有限公司 | 一种双车联动控制方法 |
Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104729500A (zh) * | 2015-02-15 | 2015-06-24 | 南京航空航天大学 | 一种激光导航agv的全局定位方法 |
CN107289946A (zh) * | 2017-07-13 | 2017-10-24 | 浙江科钛机器人股份有限公司 | 一种基于双反光板的高精度激光定位与导航方法 |
CN108775864A (zh) * | 2018-04-10 | 2018-11-09 | 深圳普智联科机器人技术有限公司 | 一种基于反光板的激光标定系统及标定方法 |
CN109613548A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
CN109613549A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于卡尔曼过滤的激光雷达定位方法 |
CN109613550A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的激光雷达地图构建及定位方法 |
CN109631919A (zh) * | 2018-12-28 | 2019-04-16 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光板和占据栅格的混合导航地图构建方法 |
CN110221603A (zh) * | 2019-05-13 | 2019-09-10 | 浙江大学 | 一种基于激光雷达多帧点云融合的远距离障碍物检测方法 |
CN110530368A (zh) * | 2019-08-22 | 2019-12-03 | 浙江大华技术股份有限公司 | 一种机器人定位方法及设备 |
CN110596716A (zh) * | 2019-10-11 | 2019-12-20 | 劢微机器人科技(深圳)有限公司 | 一种agv激光雷达定位系统及方法 |
CN111045017A (zh) * | 2019-12-20 | 2020-04-21 | 成都理工大学 | 一种激光和视觉融合的巡检机器人变电站地图构建方法 |
CN111307147A (zh) * | 2020-03-06 | 2020-06-19 | 同济人工智能研究院(苏州)有限公司 | 一种融合定位反光板与激光特征的agv高精度定位方法 |
CN111505606A (zh) * | 2020-04-14 | 2020-08-07 | 武汉大学 | 多相机与激光雷达系统相对位姿检校方法及装置 |
CN111722202A (zh) * | 2020-08-05 | 2020-09-29 | 湖北工业大学 | 一种基于回波强度的反光板位置拟合方法及系统 |
CN112066982A (zh) * | 2020-09-07 | 2020-12-11 | 成都睿芯行科技有限公司 | 一种在高动态环境下的工业移动机器人定位方法 |
CN112130166A (zh) * | 2020-09-04 | 2020-12-25 | 江苏智库智能科技有限公司 | 基于反光板网络的agv定位方法及装置 |
CN112285725A (zh) * | 2020-10-10 | 2021-01-29 | 杭州电子科技大学 | 一种基于激光雷达的单移动机器人室内定位方法 |
CN112710312A (zh) * | 2020-12-24 | 2021-04-27 | 哈尔滨工业大学芜湖机器人产业技术研究院 | 融合距离残差和概率残差的激光slam前端匹配方法 |
CN112815944A (zh) * | 2020-12-31 | 2021-05-18 | 深圳易行机器人有限公司 | 一种基于边角联合特征结构体的激光反射板定位方法 |
CN113671511A (zh) * | 2021-07-30 | 2021-11-19 | 南京航空航天大学 | 一种面向区域场景的激光雷达高精度定位方法 |
CN113670332A (zh) * | 2021-07-23 | 2021-11-19 | 石家庄辰宙智能装备有限公司 | 用于获得agv车载定位传感器安装位姿的标定方法 |
CN114296097A (zh) * | 2021-12-30 | 2022-04-08 | 哈尔滨工业大学芜湖机器人产业技术研究院 | 基于GNSS和LiDAR的SLAM导航方法及系统 |
CN114779264A (zh) * | 2022-03-15 | 2022-07-22 | 南京航空航天大学 | 一种基于icp和kd树的激光雷达定位方法 |
-
2022
- 2022-09-20 CN CN202211143296.3A patent/CN115220012A/zh active Pending
Patent Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104729500A (zh) * | 2015-02-15 | 2015-06-24 | 南京航空航天大学 | 一种激光导航agv的全局定位方法 |
CN107289946A (zh) * | 2017-07-13 | 2017-10-24 | 浙江科钛机器人股份有限公司 | 一种基于双反光板的高精度激光定位与导航方法 |
CN108775864A (zh) * | 2018-04-10 | 2018-11-09 | 深圳普智联科机器人技术有限公司 | 一种基于反光板的激光标定系统及标定方法 |
CN109613548A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
CN109613549A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于卡尔曼过滤的激光雷达定位方法 |
CN109613550A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的激光雷达地图构建及定位方法 |
CN109631919A (zh) * | 2018-12-28 | 2019-04-16 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光板和占据栅格的混合导航地图构建方法 |
CN110221603A (zh) * | 2019-05-13 | 2019-09-10 | 浙江大学 | 一种基于激光雷达多帧点云融合的远距离障碍物检测方法 |
CN110530368A (zh) * | 2019-08-22 | 2019-12-03 | 浙江大华技术股份有限公司 | 一种机器人定位方法及设备 |
CN110596716A (zh) * | 2019-10-11 | 2019-12-20 | 劢微机器人科技(深圳)有限公司 | 一种agv激光雷达定位系统及方法 |
CN111045017A (zh) * | 2019-12-20 | 2020-04-21 | 成都理工大学 | 一种激光和视觉融合的巡检机器人变电站地图构建方法 |
CN111307147A (zh) * | 2020-03-06 | 2020-06-19 | 同济人工智能研究院(苏州)有限公司 | 一种融合定位反光板与激光特征的agv高精度定位方法 |
CN111505606A (zh) * | 2020-04-14 | 2020-08-07 | 武汉大学 | 多相机与激光雷达系统相对位姿检校方法及装置 |
CN111722202A (zh) * | 2020-08-05 | 2020-09-29 | 湖北工业大学 | 一种基于回波强度的反光板位置拟合方法及系统 |
CN112130166A (zh) * | 2020-09-04 | 2020-12-25 | 江苏智库智能科技有限公司 | 基于反光板网络的agv定位方法及装置 |
CN112066982A (zh) * | 2020-09-07 | 2020-12-11 | 成都睿芯行科技有限公司 | 一种在高动态环境下的工业移动机器人定位方法 |
CN112285725A (zh) * | 2020-10-10 | 2021-01-29 | 杭州电子科技大学 | 一种基于激光雷达的单移动机器人室内定位方法 |
CN112710312A (zh) * | 2020-12-24 | 2021-04-27 | 哈尔滨工业大学芜湖机器人产业技术研究院 | 融合距离残差和概率残差的激光slam前端匹配方法 |
CN112815944A (zh) * | 2020-12-31 | 2021-05-18 | 深圳易行机器人有限公司 | 一种基于边角联合特征结构体的激光反射板定位方法 |
CN113670332A (zh) * | 2021-07-23 | 2021-11-19 | 石家庄辰宙智能装备有限公司 | 用于获得agv车载定位传感器安装位姿的标定方法 |
CN113671511A (zh) * | 2021-07-30 | 2021-11-19 | 南京航空航天大学 | 一种面向区域场景的激光雷达高精度定位方法 |
CN114296097A (zh) * | 2021-12-30 | 2022-04-08 | 哈尔滨工业大学芜湖机器人产业技术研究院 | 基于GNSS和LiDAR的SLAM导航方法及系统 |
CN114779264A (zh) * | 2022-03-15 | 2022-07-22 | 南京航空航天大学 | 一种基于icp和kd树的激光雷达定位方法 |
Non-Patent Citations (4)
Title |
---|
刘文涛: ""AGV激光导航中反射板布设研究"", 《激光与红外》 * |
吴卫国: ""基于激光雷达和反光板的重载AGV定位方法研究"", 《工程机械》 * |
徐京邦: "基于激光反射板的激光导航AGV定位与地图构建方法研究"", 《中国优秀硕士学位论文全文数据库》 * |
杨志江等: "激光导航AGV的反光板匹配技术研究", 《自动化应用》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115586511A (zh) * | 2022-11-25 | 2023-01-10 | 唐山百川工业服务有限公司 | 一种基于阵列立柱的激光雷达二维定位方法 |
CN115575963A (zh) * | 2022-12-07 | 2023-01-06 | 成都睿芯行科技有限公司 | 一种基于反光板与slam融合的定位方法 |
CN115656965A (zh) * | 2022-12-09 | 2023-01-31 | 成都睿芯行科技有限公司 | 一种基于已知地图和定位标定反光板地图方法 |
CN118192392A (zh) * | 2024-05-16 | 2024-06-14 | 成都睿芯行科技有限公司 | 一种双车联动控制方法 |
CN118192392B (zh) * | 2024-05-16 | 2024-07-16 | 成都睿芯行科技有限公司 | 一种双车联动控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115220012A (zh) | 一种基于反光板定位方法 | |
CN110244284B (zh) | 一种用于多线激光雷达和gps\ins标定的标定板及其方法 | |
CN112070770B (zh) | 一种高精度三维地图与二维栅格地图同步构建方法 | |
CN110873883B (zh) | 融合激光雷达和imu的定位方法、介质、终端和装置 | |
CN111765882B (zh) | 激光雷达定位方法及其相关装置 | |
CN111123242B (zh) | 一种基于激光雷达和相机的联合标定方法及计算机可读存储介质 | |
US11783507B2 (en) | Camera calibration apparatus and operating method | |
CN111273312B (zh) | 一种智能车辆定位与回环检测方法 | |
CN111678516B (zh) | 一种基于激光雷达的有界区域快速全局定位方法 | |
Zhou et al. | Review on millimeter-wave radar and camera fusion technology | |
CN112785653B (zh) | 车载相机姿态角标定方法 | |
CN110533726B (zh) | 一种激光雷达场景三维姿态点法向量估计修正方法 | |
CN113111513B (zh) | 传感器配置方案确定方法、装置、计算机设备及存储介质 | |
CN110187337B (zh) | 一种基于ls和neu-ecef时空配准的高机动目标跟踪方法及系统 | |
CN110910389B (zh) | 一种基于图描述子的激光slam回环检测系统及方法 | |
CN113028990B (zh) | 一种基于加权最小二乘的激光跟踪姿态测量系统及方法 | |
CN116449392A (zh) | 一种地图构建方法、装置、计算机设备及存储介质 | |
CN115267747A (zh) | 一种稀疏激光雷达与可见光/红外成像系统的标定方法 | |
Morris et al. | A view-dependent adaptive matched filter for ladar-based vehicle tracking | |
CN114935748B (zh) | 一种基于检测物体的大基线多激光雷达标定的方法及系统 | |
CN115100287B (zh) | 外参标定方法及机器人 | |
US8798957B2 (en) | Method for the computer-aided calculation of the movement of an object using sensor data | |
CN114152937B (zh) | 一种旋转激光雷达的外参标定方法 | |
CN116400349A (zh) | 一种低分辨率毫米波雷达与光学相机的标定方法 | |
CN116045965A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20221021 |
|
RJ01 | Rejection of invention patent application after publication |