CN111060093B - 一种基于单折角板的移动机器人定位方法及系统 - Google Patents
一种基于单折角板的移动机器人定位方法及系统 Download PDFInfo
- Publication number
- CN111060093B CN111060093B CN201911408084.1A CN201911408084A CN111060093B CN 111060093 B CN111060093 B CN 111060093B CN 201911408084 A CN201911408084 A CN 201911408084A CN 111060093 B CN111060093 B CN 111060093B
- Authority
- CN
- China
- Prior art keywords
- angle
- folding plate
- line segments
- mobile robot
- plate
- 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.)
- Active
Links
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/20—Instruments for performing navigational calculations
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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/46—Indirect determination of position data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明适用于机器人定位技术领域,提供了一种单折角板的移动机器人定位方法及系统,该方法包括如下步骤:S1、提取激光雷达当前帧扫描数据中的折角板;S2、读取折角板在激光雷达坐标系中的位置,基于折角板在路标地图中的位置来计算移动机器人在路标地图中的位姿P(x,y,theta),(x,y)为移动机器人在路标地图中的位置,theta为移动机器人的偏航角;其中,折角板由两个呈一定角度的面板组成,折角板位置由两面板交线的投影点坐标及两面板的投影线段的单位矢量构成。仅基于激光雷达和折角板进行定位,不依赖其它传感器和安装环境,降低环境改装的成本,提高了定位精度和效率。
Description
技术领域
本发明属于机器人定位技术领域,提供了一种基于单折角板的移动机器人定位方法及系统。
背景技术
随着移动机器人在服务和仓储物流领域有着越来越广泛的应用,其自主定位导航技术也越发重要。现主要技术有二维码导航、磁导航、视觉SLAM和激光SLAM,因为激光SLAM不需要对环境进行大幅更改,受环境的影响比较小,所以激光SLAM在工业应用越来越广。然而激光SLAM存在一个问题,因为其导航地图的分辨率普遍在0.02m-0.05m之间,导致激光SLAM定位精度难以超过地图的分辨率精度。为了解决上述问题,现有的方案主要包含如下三种:1)视觉辅助精定位。使用单目、双目或深度相机对标记物体进行识别与定位,推算出机器人的坐标数据。2)多超声波传感器辅助精定位。通过在移动机器人的四个朝向上安装超声波传感器,通过超声波传感器测距形成定位坐标,定位精度可达厘米级。3)光电传感器辅助精定位。在机器人需要局部高精度定位的目标位置安装光电传感器,当检测到机器人到达目标位置时发送停止信号。
以上方法不仅让机器人多安装了其它传感器,提高了机器人的成本,还需要对环境中的标记物和安装的传感器进行精度标定,操作繁杂,影响工作效率,而且定位精度不高。
发明内容
本发明实施例提供一种基于单折角板的移动机器人定位方法,基于激光雷达和折角板进行定位,在不影响定位精度和效率的前提下,降低环境改装的成本。
本发明是这样实现的,一种单折角板的移动机器人定位方法,所述方法具体包括如下步骤:
S1、提取激光雷达当前帧扫描数据中的折角板;
S2、读取折角板在激光雷达坐标系中的位置,基于折角板在路标地图中的位置来计算移动机器人在路标地图中的位姿P(x,y,theta),(x,y)为移动机器人在路标地图中的位置,theta为移动机器人的偏航角;
其中,折角板由两个呈一定角度的面板组成,折角板位置由两面板交线的投影点坐标及两面板的投影线段的单位矢量构成。
进一步的,折角板的提取方法具体包括如下步骤:
S11、当前帧扫描数据从最小扫描角到最大扫描角顺序输出,依次顺序提取N条满足长度阈值的线段;
S12、遍历N条线段,计算任意相邻两条线段的长度L1、L2及两条线段的首尾距离Dist,将满足L1-L2小于阈值,且Dist小于预设阈值的两相邻线段点集执行步骤S13;
S13、计算两相邻线段间的夹角θ,并计算夹角θ与折角板实际夹角的差值,若该差值位于允许的偏差范围内,则认定该相邻线段即为折角板两面板的投影线段;
S14、计算第一条线段的剔除比例系数div,基于剔除比例系数div在第一点段的尾部来剔除属于第二线段的点集;
进一步的,所述线段提取方法具体如下:
S111、基于当前帧的前两点来计算线段L;
S112、检测下一个点到线段L的距离是否小于距离阈值T,若检测结果为是,执行步骤S113,若检测结果为否,则执行步骤S114;
S113、将下一个点放入线段的点集中,对点集进行线性最小二乘拟合,更新线段L,执行步骤S112;
S114、计算线段L的长度DL,若legth_min≤DL≤length_max,则更新线段L,将点集保存到线集合,将点集中最后一个点的后面两个点作为下一条线段的线段起点,并计算出下一条线段,执行步骤S112,直至遍历完当前帧扫描数据中的所有点。
进一步的,两相邻线段的夹角θ的计算方法具体如下:
进一步的,移动机器人的偏航角的计算具体如下:
进一步的,激光雷达在路标地图中的位置坐标Pg(x,y)计算公式具体如下:
Pg=p_m-R*p_l
其中,p_m为折角板在路标坐标系中的角点坐标,p_l为折角板在激光雷达坐标系中的角点坐标,R为旋转矩阵。
本发明是这样实现的,一种基于单折角板的移动机器人定位系统,所述系统包括:
设于定位区域的一个折角板,折角板垂直于地面设置,折角板由两个呈一定角度的面板组成;平行设于移动机器人前端的激光雷达,激光雷达与处理器连接,处理器与存储器连接,存储器中存储有路标地图,激光雷达扫描行驶区域的环境,将扫描到的环境数据发送至处理器,处理器基于权利要求1至6所述基于单折角板的移动机器人定位方法来对机动移动机器人进行定位。
本发明提供的基于单折角板的移动机器人定位方法具有如下有益技术效果:仅基于激光雷达和折角板进行定位,不依赖其它传感器和安装环境,降低环境改装的成本,提高了定位精度和效率。
附图说明
图1为本发明实施例提供的基于单折角板的移动机器人定位方法流程图;
图2为本发明实施例提供的折角板的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
图1为本发明实施例提供的基于单折角板的移动机器人定位方法流程图,该方法包括如下步骤:
S1、提取激光雷达当前帧扫描数据中的折角板,折角板的结构如图2所示,折角板的识别方法具体包括如下步骤:
S11、当前帧扫描数据从最小扫描角到最大扫描角顺序输出,依次顺序提取N条满足长度阈值的线段,线段提取方法具体如下:
S111、基于当前帧的前两点来计算线段L;
S112、检测下一个点到线段L的距离是否小于距离阈值T,若检测结果为是,执行步骤S113,若检测结果为否,则执行步骤S114;
S113、将下一个点放入线段的点集中,对点集进行线性最小二乘拟合,更新线段L,执行步骤S112;
S114、计算线段L的长度DL,若legth_min≤DL≤length_max,则更新线段L,将点集保存到线集合,将点集中最后一个点的后面两个点作为下一条线段的线段起点,并计算出下一条线段,执行步骤S112,直至遍历完当前帧扫描数据中的所有点,线集合中提取有N条满足线段长度阈值要求的线段点集,长度阈值的最小长度设为legth_min,长度阈值的最大长度设为length_max。
S12、遍历N条线段,计算任意相邻两条线段的长度及两条线段的首尾距离,两条线段的首尾距离是指第一条线段的尾部距第二条线段头部的距离Dist,将满足L1-L2小于阈值,Dist小于预设阈值的两相邻线段点集执行步骤S13,其中,L1、L2分别是指第一条线段和第二条线段的距离。
S13、计算两相邻线段的夹角θ,将夹角θ与折角板夹角的差值,若该差值位于允许的偏差范围,则认定该相邻线段即为折角板两面板的投影线段;
S14、计算第一条线段的剔除比例系数div,基于剔除比例系数div在第一点段的尾部来剔除属于第二线段的点集,并执行步骤S15;
筛选折角板的第一条线段的原始点集,将原本属于第二条线段的点集剔除,剔除比例系数div由折角板夹角θ和距离阈值T得出:
其中,a为折角板单面板在投影方向上的实际距离。
S15、对两相邻线段分别进行RANSAC内点提取,找到内点最多的两条直线,对内点进行直线拟合,形成折角板两面板的投影线段,计算折角板两面板投影线段的交点及折角板两面板投影线段的单位矢量折角板两面板投影线段的交点即折角板的角点坐标(x,y);
分别对两个线段点集进行RANSAC内点提取,具体设定了RANSAC直线内点判定阈值,设定迭代停止次数阈值,最终在线段原始点集中找到两点所在的直线内点数最多,保存内点点集,重新进行线性最小二乘拟合,得到折角板的两条高精度线段,计算两线段的交点和矢量,即是折角板的角点坐标(x,y)和折角板两面板投影线段的单位矢量和
S2、基于路标地图对提取到的折角板进行定位,获取移动机器人在路标地图中的位姿。
在本发明实施例中,在步骤S2之前还包括:构建路标地图,路标地图的构建方法具体如下:
移动机器人在激光SLAM过程中,当激光雷达识别到折角板并且识别次数达到预设的K次阈值,计算K次折角板角点全局坐标的均值μ和标准差σ,构建正态分布,留取偏差在2σ范围内的折角板角点坐标点集,计算该范围内折角板角点全局坐标和组成折角板线段的两个单位矢量的均值,最后保存结果为折角板角点坐标p2(x2,y2)和折角板两面板投影条线段的单位矢量和
路标地图中的折角板坐标是全局地图坐标系,而激光雷达实时提取的折角板位置是机器人坐标系的局部坐标。当两个坐标系中的折角板重合时,机器人坐标系的原点在全局地图中的坐标即是机器人的位置,其y轴正方向与全局地图坐标系的x轴正方向的夹角即是机器人的偏航角,基于折角板的定位方法具体包括如下步骤:
S1、读取折角板在激光雷达坐标系即局部坐标系中的位置,
S2、基于折角板在路标坐标系(全局坐标系)中的位置来计算移动机器人在路标坐标系(即全局坐标系)中的位置和偏航角,其计算方法具体如下:
折角板的位置由角点坐标p1(x1,y1)及折角板两面板投影线段的单位矢量和组成;折角板在激光雷达坐标系中的角点坐标为p1(x1,y1),折角板两面板投影线段在激光雷达坐标系中的单位矢量和折角板在路标坐标系中的角点坐标为p2(x2,y2),折角板两面板投影线段在路标坐标系中的单位矢量和
此theta即为激光雷达或机器人逆时针旋转的偏航角,机器人的全局坐标计算方法具体如下:
已知雷达旋转角theta、当前折角板的角点局部坐标p_l和全局地图中折角板角点的坐标p_m,将theta转化为旋转矩阵R,由以下公式计算得到当前激光雷达在全局地图中的位置坐标Pg(x,y)的计算公式具体如下:
Pg=p_m-R*p_l
最终得到当前激光雷达或者机器人在全局地图中的位姿P(x,y,theta)。
本发明还提供一种基于单折角板的移动机器人定位系统,该系统包括:
设于定位区域的一个折角板,折角板垂直于地面设置,平行设于移动机器人前端的激光雷达,激光雷达与处理器连接,处理器与存储器连接,存储器中存储有路标地图,激光雷达扫描行驶区域的环境,将扫描到的环境数据发送至处理器,处理器基于扫描数据中的折角板来对机动移动机器人进行定位。
本发明提供的基于单折角板的移动机器人定位方法具有如下有益技术效果:仅基于激光雷达和折角板进行定位,不依赖其它传感器和安装环境,降低环境改装的成本,提高了定位精度和效率。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种单折角板的移动机器人定位方法,其特征在于,所述方法具体包括如下步骤:
S1、提取激光雷达当前帧扫描数据中的折角板;
S2、读取折角板在激光雷达坐标系中的位置,基于折角板在激光雷达坐标系中的位置及其在路标地图中的位置来计算移动机器人在路标地图中的位姿P(x,y,theta),(x,y)为移动机器人在路标地图中的位置,theta为移动机器人的偏航角;
其中,折角板由两个呈一定角度的面板组成,折角板位置由两面板投影线段的交点坐标及两面板的投影线段的单位矢量构成,折角板两面板投影线段的交点即折角板的角点坐标,折角板垂直于地面设置;
移动机器人的偏航角的计算具体如下:
激光雷达在路标地图中的位置坐标Pg(x′,y′)计算公式具体如下:
Pg=p_m-R*p_l
其中,p_m为折角板在路标坐标系中的角点坐标,p_l为折角板在激光雷达坐标系中的角点坐标,R为由theta转化得到的旋转矩阵,最终得到机器人在路标地图中的位姿P(x,y,theta);
折角板的提取方法具体包括如下步骤:
S11、当前帧扫描数据从最小扫描角到最大扫描角顺序输出,依次顺序提取N条满足长度阈值的线段;
S12、遍历N条线段,计算任意相邻两条线段的长度L1、L2及两条线段的首尾距离Dist,将满足L1-L2小于阈值,且Dist小于预设阈值的两相邻线段点集执行步骤S13;
S13、计算两相邻线段的夹角θ,并计算夹角θ与折角板实际夹角的差值,若该差值位于允许的偏差范围内,则认定该两相邻线段即为折角板两面板的投影线段;
S14、计算第一条线段的剔除比例系数div,基于剔除比例系数div在第一条线段的尾部来剔除属于第二条线段的点集;
筛选折角板的第一条线段的原始点集,将原本属于第二条线段的点集剔除,剔除比例系数div由夹角θ和距离阈值T得出:
其中,a为折角板单面板在投影方向上的实际距离;
2.如权利要求1所述单折角板的移动机器人定位方法,其特征在于,所述线段提取方法具体如下:
S111、基于当前帧的前两点来计算线段L;
S112、检测下一个点到线段L的距离是否小于距离阈值T,若检测结果为是,执行步骤S113,若检测结果为否,则执行步骤S114;
S113、将下一个点放入线段的点集中,对点集进行线性最小二乘拟合,更新线段L,执行步骤S112;
S114、计算线段L的长度DL,若legth_min≤DL≤length_max,则更新线段L,将点集保存到线集合,基于点集中最后一个点的后面两个点计算出下一条线段,执行步骤S112,直至遍历完当前帧扫描数据中的所有点。
4.一种基于单折角板的移动机器人定位系统,其特征在于,所述系统包括:
设于定位区域的一个折角板,折角板垂直于地面设置,折角板由两个呈一定角度的面板组成;
平行设于移动机器人前端的激光雷达,激光雷达与处理器连接,处理器与存储器连接,存储器中存储有路标地图,激光雷达扫描行驶区域的环境,将扫描到的环境数据发送至处理器,处理器基于权利要求1至3任一项所述基于单折角板的移动机器人定位方法来对机动移动机器人进行定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911408084.1A CN111060093B (zh) | 2019-12-31 | 2019-12-31 | 一种基于单折角板的移动机器人定位方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911408084.1A CN111060093B (zh) | 2019-12-31 | 2019-12-31 | 一种基于单折角板的移动机器人定位方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111060093A CN111060093A (zh) | 2020-04-24 |
CN111060093B true CN111060093B (zh) | 2021-07-30 |
Family
ID=70305397
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911408084.1A Active CN111060093B (zh) | 2019-12-31 | 2019-12-31 | 一种基于单折角板的移动机器人定位方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111060093B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103777192A (zh) * | 2012-10-24 | 2014-05-07 | 中国人民解放军第二炮兵工程学院 | 一种基于激光传感器的直线特征提取方法 |
CN103837869A (zh) * | 2014-02-26 | 2014-06-04 | 北京工业大学 | 基于向量关系的单线激光雷达和ccd相机标定方法 |
CN103941264A (zh) * | 2014-03-26 | 2014-07-23 | 南京航空航天大学 | 一种室内未知环境下使用激光雷达定位方法 |
CN105987697A (zh) * | 2016-04-26 | 2016-10-05 | 重庆大学 | 一种直角弯下Mecanum轮式AGV导航定位方法及系统 |
CN106969768A (zh) * | 2017-04-22 | 2017-07-21 | 深圳力子机器人有限公司 | 一种无轨导航agv的精确定位及停车方法 |
CN109000649A (zh) * | 2018-05-29 | 2018-12-14 | 重庆大学 | 一种基于直角弯道特征的全方位移动机器人位姿校准方法 |
-
2019
- 2019-12-31 CN CN201911408084.1A patent/CN111060093B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103777192A (zh) * | 2012-10-24 | 2014-05-07 | 中国人民解放军第二炮兵工程学院 | 一种基于激光传感器的直线特征提取方法 |
CN103837869A (zh) * | 2014-02-26 | 2014-06-04 | 北京工业大学 | 基于向量关系的单线激光雷达和ccd相机标定方法 |
CN103941264A (zh) * | 2014-03-26 | 2014-07-23 | 南京航空航天大学 | 一种室内未知环境下使用激光雷达定位方法 |
CN105987697A (zh) * | 2016-04-26 | 2016-10-05 | 重庆大学 | 一种直角弯下Mecanum轮式AGV导航定位方法及系统 |
CN106969768A (zh) * | 2017-04-22 | 2017-07-21 | 深圳力子机器人有限公司 | 一种无轨导航agv的精确定位及停车方法 |
CN109000649A (zh) * | 2018-05-29 | 2018-12-14 | 重庆大学 | 一种基于直角弯道特征的全方位移动机器人位姿校准方法 |
Non-Patent Citations (2)
Title |
---|
"A Novel 2D Laser Scan Matching Algorithm for Mobile Robots Based on Hybrid Features";Jian Wen 等,;《Proceedings of The 2018 IEEE International Conference on Real-time Computing and Robotics》;20180805;366-371页 * |
"基于激光雷达的AGV定位技术研究";孙仲旭,;《中国优秀硕士学位论文全文数据库 信息科技辑》;20210115(第01期);1-82页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111060093A (zh) | 2020-04-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109143207B (zh) | 激光雷达内参精度验证方法、装置、设备及介质 | |
CN111060888B (zh) | 一种融合icp和似然域模型的移动机器人重定位方法 | |
CN110530372B (zh) | 定位方法、路径确定方法、装置、机器人及存储介质 | |
CN112346463B (zh) | 一种基于速度采样的无人车路径规划方法 | |
CN112819903A (zh) | 基于l型标定板的相机和激光雷达联合标定的方法 | |
EP3620811B1 (en) | Method for determining the position of a vehicle | |
CN110108269A (zh) | 基于多传感器数据融合的agv定位方法 | |
CN112464812A (zh) | 一种基于车辆的凹陷类障碍物检测方法 | |
CN113706702A (zh) | 矿区三维地图构建系统和方法 | |
EP3674661A1 (en) | Locating method and device, storage medium, and electronic device | |
US11629963B2 (en) | Efficient map matching method for autonomous driving and apparatus thereof | |
KR102490521B1 (ko) | 라이다 좌표계와 카메라 좌표계의 벡터 정합을 통한 자동 캘리브레이션 방법 | |
CN113971697A (zh) | 一种空地协同车辆定位定向方法 | |
CN111060093B (zh) | 一种基于单折角板的移动机器人定位方法及系统 | |
CN113296120A (zh) | 一种障碍物检测方法及终端 | |
CN111142117B (zh) | 融合折角板和占据栅格的混合导航地图构建方法及系统 | |
CN117029870A (zh) | 一种基于路面点云的激光里程计 | |
CN113554705B (zh) | 一种变化场景下的激光雷达鲁棒定位方法 | |
Oniga et al. | A fast ransac based approach for computing the orientation of obstacles in traffic scenes | |
CN115792912A (zh) | 一种弱观测条件下基于视觉与毫米波雷达融合的水面无人艇环境感知方法及系统 | |
CN115456898A (zh) | 停车场的建图方法、装置、车辆及存储介质 | |
CN115239822A (zh) | 分体式飞行车辆多模块间实时视觉识别定位方法及系统 | |
Pishehvari et al. | Robust range-doppler registration with hd maps | |
KR102568111B1 (ko) | 도로 경계 추출 장치 및 방법 | |
Li et al. | Environment mapping and vehicle localization with a high-resolution radar prototype |
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 |