CN111142117A - 融合折角板及占据栅格的混合导航地图构建方法及*** - Google Patents
融合折角板及占据栅格的混合导航地图构建方法及*** Download PDFInfo
- Publication number
- CN111142117A CN111142117A CN201911403235.4A CN201911403235A CN111142117A CN 111142117 A CN111142117 A CN 111142117A CN 201911403235 A CN201911403235 A CN 201911403235A CN 111142117 A CN111142117 A CN 111142117A
- Authority
- CN
- China
- Prior art keywords
- map
- corner
- grid
- laser radar
- line segment
- 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
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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- 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
-
- 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/50—Systems of measurement based on relative movement of target
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明适用于地图构建技术领域,提供了一种融合折角板与占据栅格的混合导航地图构建方法,具体如下:S1、检测当前帧中是否存在折角板,若检测结果为是,执行步骤S2,若检测结果为否,执行步骤S3;S2、基于折角板来计算激光雷达当前在地图坐标系中的位姿,并基于激光雷达当前在地图坐标系中的位姿来更新栅格地图及折角板地图;S3、将当前帧的扫描数据与栅格地图进行匹配,获取激光雷达的当前在地图坐标系中位姿,并基于激光雷达在地图坐标系中的位姿来更新栅格地图。在需要精确定位的区域利用折角板构建精度较高的地图,便于获取高精度的位姿信息,在不方便布设折角板或者不需要精定位的区域构建栅格地图,基于栅格地图进行定位,普适性更强。
Description
技术领域
本发明属于地图构建技术领域,提供了一种融合折角板及占据栅格的混合导航地图构建方法及***。
背景技术
随着社会的发展和技术的进步,移动机器人越来越深的介入到人类的日常生活中,例如家庭中的清洁机器人、工厂中的搬运机器人以及餐馆中的送餐机器人等。移动机器人想要实现上述功能必须准确的知道自身所在的位置,即实时定位。而移动机器人实时定位的先决条件是建立地图,这是机器人导航和其它智能行为的关键。激光雷达传感器因为测量精度高、不受光照条件影响等优点,被广泛的应用于移动机器人定位导航中。基于激光雷达的定位导航方法可以分为基于反光标识的定位导航方法和基于轮廓的定位导航方法,其中基于反光标识的激光雷达定位导航方法有着精度高、稳定性好等优点,但是有些场景可能会不方便布设反光标识,此外大量布设反光标识会增加成本。
发明内容
本发明实施例提供一种融合折角板及占据栅格的混合导航地图构建方法,在不方便布置反光标识的区域构建栅格地图,基于栅格地图进行定位,增加普适性。
本发明是这样实现的,一种融合折角板与占据栅格的混合导航地图构建方法,其特征在于,所述方法包括如下步骤:
S1、检测当前帧中是否存在折角板,若检测结果为是,执行步骤S2,若检测结果为否,则执行步骤S3;
S2、基于折角板来计算激光雷达当前在地图坐标系中的位姿,并基于激光雷达当前在地图坐标系中的位姿来更新栅格地图及折角板地图;
S3、将当前帧的扫描数据与栅格地图进行匹配,获取激光雷达的当前在地图坐标系中位姿,并基于激光雷达在地图坐标系中的位姿来更新栅格地图。
进一步的,折角板的检测方法具有包括如下步骤:
S11、当前帧扫描数据从最小扫描角到最大扫描角顺序输出,依次顺序提取 N条满足长度阈值的线段:
S12、遍历N条线段,计算任意相邻两条线段的长度及两条线段的首尾距离,两条线段的首尾距离是指第一条线段的尾部距第二条线段头部的距离Dist,将满足L1-L2小于阈值,Dist小于预设阈值的两相邻线段点集执行步骤S13,其中,L1、L2分别是指第一条线段和第二条线段的距离。
S13、计算两相邻线段的夹角θ,及夹角θ与折角板夹角的差值,若该差值位于允许的偏差范围,则认定该相邻线段即为折角板两面板的投影线段;
S14、计算各折角板中第一条线段的剔除比例系数div,基于剔除比例系数 div在第一点段的尾部来剔除属于第二线段的点集,并执行步骤S15;
S15、对各折角板的两相邻线段分别进行RANSAC内点提取,找到内点最多的两条直线,对内点进行直线拟合,形成折角板两面板的投影线段,计算各折角板两面板投影线段的交点p′(x′,y′)及折角板两面板投影线段的矢量 v1′(x1′,y1′),v2′(x2′,y2′)。
进一步的,所述S11中的线段提取方法具体如下
S111、基于当前帧的前两点来计算线段L;
S112、检测下一个点到线段L的距离是否小于距离阈值T,若检测结果为是,执行步骤S113,若检测结果为否,则执行步骤S114;
S113、将下一个点放入线段的点集中,对点集进行线性最小二乘拟合,更新线段L,执行步骤S112;
S114、计算线段L的长度DL,若legth_min≤DL≤length_max,则更新线段 L,将点集保存到线集合,将点集中最后一个点的后面两个点作为下一条线段的线段起点,并计算线段L,执行步骤S112,直至遍历完当前帧扫描数据中的所有点。
进一步的,步骤S2中激光雷达当前在地图坐标系中的位姿计算方法具体如下:
S21、在指定距离内提取距激光雷达最近的未被标记的折角板 b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′)),将已提取的折角板b′进行标记,其中,p′(x′,y′) 是折角板b′两单平面交线的二维投影点,v1′(x1′,y1′),v2′(x2′,y2′)分别为折角板的两单平面的二维投影;
S22、基于激光雷达上一帧中的位姿将折角板b′的交线投影点p′(x′,y′)投影到栅格地图中,并在栅格地图中提取距离交线投影点p′(x′,y′)距离最近的折角板 b(p(x,y),v1(x1,y1),v2(x2,y2)),若交线投影点p′(x′,y′)距p(x,y)的距离小于距离阈值,则折角板b即为折角板b′在栅格地图中的坐标,即折角板b′为已知折角板,若交线投影点p′(x′,y′)距p(x,y)的距离大于距离阈值,则折角板b′为未知折角板,返回步骤S21;
S23、当前帧中折角板b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′))的位置及在栅格地图中的匹配折角板b(p(x,y),v1(x1,y1),v2(x2,y2))的位置来计算机器人当前在地图坐标系中的位姿。
进一步的,折角板地图的更新方法具体如下:
基于激光雷达当前在地图坐标系中的位姿计算激光雷达当前相对于地图坐标系的旋转矩阵R和平移向量T;
基于激光雷达当前相对于地图坐标系的旋转矩阵R和平移向量T来计算未知折角板在激光雷达坐标系中的坐标,并更新折角板地图。
进一步的,栅格地图的更新方法具体如下:
计算占据更新栅格及自由更栅格的栅格占据概率,并更新栅格地图。
本发明是这样实现的,一种基于折角板及占据栅格的混合导航地图构建***,所述***包括:
设于精确定位的行驶区域的折角板,折角板是由两个呈一定角度的平面构成,折角板垂直于地面布置,
设于平设于移动机器上的激光雷达,激光雷达与处理器连接,激光雷达采集行驶区域内的环境数据,并将扫描数据发送至处理器,处理器基于上述融合折角板与占据栅格的混合导航地图构建方法来构建栅格地图或折角板地图;处理器中存储有行驶区域的环境数据。
本发明提供的融合折角板与占据栅格的混合导航地图构建方法:在需要精确定位的区域利用折角板构建精度较高的地图,便于获取高精度的位姿信息,在不方便布设折角板的区域或者不需要精定位的区域构建栅格地图,可以基于栅格地图进行定位,普适性更强。
附图说明
图1为本发明实施例提供的融合折角板和占据栅格的混合导航地图构建方法流程图
图2为本发明实施例提供的折角板的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
图1为本发明实施例提供的融合折角板和占据栅格的混合导航地图构建方法流程图,该方法包括如下步骤:
S1、检测当前帧中是否存在折角板,若检测结果为是,执行步骤S2,若检测结果为否,则执行步骤S3;
在本发明实施例中,折角板是由两个呈一定角度的单平面构成,折角板的结构示意图如图2所示,折角板的检测方法具有包括如下步骤:
S11、当前帧扫描数据从最小扫描角到最大扫描角顺序输出,依次顺序提取 N条满足长度阈值的线段,线段提取方法具体如下:
S111、基于当前帧的前两点来计算线段L;
S112、检测下一个点到线段L的距离是否小于距离阈值T,若检测结果为是,执行步骤S113,若检测结果为否,则执行步骤S114;
S113、将下一个点放入线段的点集中,对点集进行线性最小二乘拟合,更新线段L,执行步骤S112;
S114、计算线段L的长度DL,若legth_min≤DL≤length_max,则更新线段 L,将点集保存到线集合,将点集中最后一个点的后面两个点作为下一条线段的线段起点,并计算线段L,执行步骤S112,直至遍历完当前帧扫描数据中的所有点,线集合中提取有N条满足线段长度阈值要求的线段点集,长度阈值的最小长度设为legth_min,长度阈值的最大长度设为length_max。
212、遍历N条线段,计算任意相邻两条线段的长度及两条线段的首尾距离,两条线段的首尾距离是指第一条线段的尾部距第二条线段头部的距离Dist,将满足L1-L2小于阈值,Dist小于预设阈值的两相邻线段点集执行步骤S213,其中,L1、L2分别是指第一条线段和第二条线段的距离。
S13、计算两相邻线段的夹角θ,及夹角θ与折角板夹角的差值,若该差值位于允许的偏差范围,则认定该相邻线段即为折角板两面板的投影线段;
S14、计算各折角板中第一条线段的剔除比例系数div,基于剔除比例系数div在第一点段的尾部来剔除属于第二线段的点集,并执行步骤S15;
筛选折角板的第一条线段的原始点集,将原本属于第二条线段的点集剔除,剔除比例系数div由折角板夹角θ和距离阈值T得出:
其中,a为折角板单面板在投影方向上的实际距离。
S15、对各折角板的两相邻线段分别进行RANSAC内点提取,找到内点最多的两条直线,对内点进行直线拟合,形成折角板两面板的投影线段,计算各折角板两面板投影线段的交点p′(x′,y′)及折角板两面板投影线段的矢量 v1′(x1′,y1′),v2′(x2′,y2′);
分别对两个线段点集进行RANSAC内点提取,具体设定了RANSAC直线内点判定阈值,设定迭代停止次数阈值,最终在线段原始点集中找到两点所在的直线内点数最多,保存内点点集,重新进行线性最小二乘拟合,得到折角板的两条高精度线段,计算两线段的交点和矢量,折角板两面板投影线段的交点 p′(x′,y′)及折角板两面板投影线段的矢量v1′(x1′,y1′),v2′(x2′,y2′)。
S2、基于折角板来计算激光雷达当前在地图坐标系中的位姿,并基于激光雷达当前在地图坐标系中的位姿来更新栅格地图及折角板地图;
在本发明实施例中,激光雷达当前在地图坐标系中的位姿计算方法具体如下:
S21、在指定距离内提取距激光雷达最近的未被标记的折角板 b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′)),将已提取的折角板b′进行标记,其中,p′(x′,y′) 是折角板b′两单平面交线的二维投影点,v1′(x1′,y1′),v2′(x2′,y2′)分别为折角板的两单平面的二维投影;
S22、基于激光雷达上一帧中的位姿将折角板b′的交线投影点p′(x′,y′)投影到栅格地图中,并在栅格地图中提取距离交线投影点p′(x′,y′)距离最近的折角板b(p(x,y),v1(x1,y1),v2(x2,y2)),若交线投影点p′(x′,y′)距p(x,y)的距离小于距离阈值,则折角板b即为折角板b′在栅格地图中的坐标,即折角板b′为已知折角板,执行步骤S23,若交线投影点p′(x′,y′)距p(x,y)的距离大于距离阈值,则折角板 b′为未知折角板,即在栅格地图中不存在与之匹配的折角板,返回步骤S21;
在本发明实施例中,地图坐标系包括了栅格地图及直角板地图,已经纳入地图坐标系的折角板称为已知折角板,未纳入地图坐标系的折角板称为未知折角板,混合地图的构建过程就是将未知折角板不断纳入地图坐标系。
S23、当前帧中折角板b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′))的位置及在栅格地图中的匹配折角板b(p(x,y),v1(x1,y1),v2(x2,y2))的位置来计算机器人当前在地图坐标系中的位姿,即激光雷达当前在地图坐标系中的位姿P(x,y,θ),其计算公式具体如下:
其中,R、T分别为地图坐标系到雷达坐标系的旋转矩阵和平移向量,基于R、T计算得到机器人的位姿P(x,y,θ):
pos=-R-1*T
θ=arctan(R1,0/R0,0)
其中,R1,0/R0,0为旋转矩阵R第二行第一列除以旋转矩阵第一行第一列,pos 为移动机器人位置坐标,θ为移动机器人的姿态角,移动机器人的位置坐标及姿态角即构成为机器人的位姿。
基于激光雷达当前在地图坐标系中的位姿来计算未知折角板在地图坐标系中的坐标,其计算方法具体如下:
基于激光雷达当前在地图坐标系中的位姿计算激光雷达相对于地图坐标系的旋转矩阵R和平移向量T;
假定未知折角板在激光雷达坐标系中的坐标b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′)),则未知折角板在地图坐标 b(p(x,y),v1(x1,y1),v2(x2,y2))计算方法如下:
为了提高折角板位置计算的精确性,可以取50次计算的坐标平均值作为最终的折角板坐标。
基于激光雷达当前在地图坐标***中的位姿来更新栅格地图,其更新方法具体如下:
已知一个光束的起点和终点k是光束经过的栅格的数量,可以利用优势对数积分法对光束经过栅格的概率进行更新。对所在的栅格进行占据更新,对从到所经过的栅格进行自由更新。设置自由更新的值oddsFree=0.4,占据更新的值oddsOcc=0.6。
S25、计算占据更新栅格及自由更栅格的栅格占据概率,并更新栅格地图。
假定更新前的栅格占据概率为p,则更新前栅格的odds值为odds=log(p/(1-p)),若当前栅格是进行自由更新,则令odds=odds+oddsFree,若当前栅格是进行占据更新,令odds=odds+oddsOcc,更新后,栅格的占据概率为 p=exp(odds)/(exp(odds)+1)。
S3、基于扫描数据与栅格地图的匹配来获取激光雷达的当前在地图坐标系中位姿,并基于激光雷达在地图坐标系中的位姿来更新栅格地图。
根据激光雷达上一时刻的位姿,将每一个扫描点映射到栅格地图上,基于所有的扫描点在栅格地图的,可以构造如下的目标函数:
Si(ξ)表示将t时刻第i个激光点变换到栅格地图坐标系下,M(Si(ξ))表示第 i个激光点在栅格地图上的位置被占据的概率,这样就把位姿计算变换成最小二乘求解问题;利用双线性差值计算M(Si(ξ)),并对M(Si(ξ))求偏导,将位姿计算的最小二乘求解转换为迭代的位姿增量计算的问题,基于位姿增量来确定激光雷达当前帧在栅格地图中的定位。
基于激光雷达当前在地图坐标系中位姿来更新栅格地图:
已知一个光束的起点和终点k是光束经过的栅格的数量,可以利用优势对数积分法对光束经过栅格的概率进行更新。对所在的栅格进行占据更新,对从到所经过的栅格进行自由更新。设置自由更新的值oddsFree=0.4,占据更新的值oddsOcc=0.6。
S32、计算占据更新栅格及自由更栅格的栅格占据概率,并更新栅格地图。
假定更新前的栅格占据概率为p,则更新前栅格的odds值为 odds=log(p/(1-p)),若当前栅格是进行自由更新,则令odds=odds+oddsFree,若当前栅格是进行占据更新,令odds=odds+oddsOcc,更新后,栅格的占据概率为 p=exp(odds)/(exp(odds)+1)。
本发明还提供了一种基于折角板及占据栅格的混合导航地图构建***,该***包括:
设于精确定位的行驶区域的折角板,折角板是由两个呈一定角度的平面构成,折角板垂直于地面布置,设于平设于移动机器上的激光雷达,激光雷达与处理器连接,激光雷达采集行驶区域内的环境数据,并将扫描数据发送至处理器,处理器基于上述融合折角板与占据栅格的混合导航地图构建方法来构建栅格地图或折角板地图;处理器中存储有行驶区域的环境数据。
本发明提供的融合折角板与占据栅格的混合导航地图构建方法:在需要精确定位的区域利用折角板构建精度较高的地图,便于获取高精度的位姿信息,在不方便布设折角板的区域或者不需要精定位的区域构建栅格地图,可以基于栅格地图进行定位,普适性更强。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种融合折角板与占据栅格的混合导航地图构建方法,其特征在于,所述方法包括如下步骤:
S1、检测当前帧中是否存在折角板,若检测结果为是,执行步骤S2,若检测结果为否,则执行步骤S3;
S2、基于折角板来计算激光雷达当前在地图坐标系中的位姿,并基于激光雷达当前在地图坐标系中的位姿来更新栅格地图及折角板地图;
S3、将当前帧的扫描数据与栅格地图进行匹配,获取激光雷达的当前在地图坐标系中位姿,并基于激光雷达在地图坐标系中的位姿来更新栅格地图。
2.如权利要求1所述融合折角板与占据栅格的混合导航地图构建方法,其特征在于,折角板的检测方法具有包括如下步骤:
S11、当前帧扫描数据从最小扫描角到最大扫描角顺序输出,依次顺序提取N条满足长度阈值的线段:
S12、遍历N条线段,计算任意相邻两条线段的长度及两条线段的首尾距离,两条线段的首尾距离是指第一条线段的尾部距第二条线段头部的距离Dist,将满足L1-L2小于阈值,Dist小于预设阈值的两相邻线段点集执行步骤S13,其中,L1、L2分别是指第一条线段和第二条线段的距离。
S13、计算两相邻线段的夹角θ,及夹角θ与折角板夹角的差值,若该差值位于允许的偏差范围,则认定该相邻线段即为折角板两面板的投影线段;
S14、计算各折角板中第一条线段的剔除比例系数div,基于剔除比例系数div在第一点段的尾部来剔除属于第二线段的点集,并执行步骤S15;
S15、对各折角板的两相邻线段分别进行RANSAC内点提取,找到内点最多的两条直线,对内点进行直线拟合,形成折角板两面板的投影线段,计算各折角板两面板投影线段的交点p′(x′,y′)及折角板两面板投影线段的矢量v1′(x1′,y1′),v2′(x2′,y2′)。
3.如权利要求2所述融合折角板与占据栅格的混合导航地图构建方法,其特征在于,所述S11中的线段提取方法具体如下
S111、基于当前帧的前两点来计算线段L;
S112、检测下一个点到线段L的距离是否小于距离阈值T,若检测结果为是,执行步骤S113,若检测结果为否,则执行步骤S114;
S113、将下一个点放入线段的点集中,对点集进行线性最小二乘拟合,更新线段L,执行步骤S112;
S114、计算线段L的长度DL,若legth_min≤DL≤length_max,则更新线段L,将点集保存到线集合,将点集中最后一个点的后面两个点作为下一条线段的线段起点,并计算线段L,执行步骤S112,直至遍历完当前帧扫描数据中的所有点。
4.如权利要求1至3任一权利要求所述融合折角板与占据栅格的混合导航地图构建方法,其特征在于,步骤S2中激光雷达当前在地图坐标系中的位姿计算方法具体如下:
S21、在指定距离内提取距激光雷达最近的未被标记的折角板b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′)),将已提取的折角板b′进行标记,其中,p′(x′,y′)是折角板b′两单平面交线的二维投影点,v1′(x1′,y1′),v2′(x2′,y2′)分别为折角板的两单平面的二维投影;
S22、基于激光雷达上一帧中的位姿将折角板b′的交线投影点p′(x′,y′)投影到栅格地图中,并在栅格地图中提取距离交线投影点p′(x′,y′)距离最近的折角板b(p(x,y),v1(x1,y1),v2(x2,y2)),若交线投影点p′(x′,y′)距p(x,y)的距离小于距离阈值,则折角板b即为折角板b′在栅格地图中的坐标,即折角板b′为已知折角板,若交线投影点p′(x′,y′)距p(x,y)的距离大于距离阈值,则折角板b′为未知折角板,返回步骤S21;
S23、当前帧中折角板b′(p′(x′,y′),v1′(x1′,y1′),v2′(x2′,y2′))的位置及在栅格地图中的匹配折角板b(p(x,y),v1(x1,y1),v2(x2,y2))的位置来计算机器人当前在地图坐标系中的位姿。
5.如权利要求4所述融合折角板与占据栅格的混合导航地图构建方法,其特征在于,折角板地图的更新方法具体如下:
基于激光雷达当前在地图坐标系中的位姿计算激光雷达当前相对于地图坐标系的旋转矩阵R和平移向量T;
基于激光雷达当前相对于地图坐标系的旋转矩阵R和平移向量T来计算未知折角板在激光雷达坐标系中的坐标,并更新折角板地图。
7.一种基于折角板及占据栅格的混合导航地图构建***,其特征在于,所述***包括:
设于精确定位的行驶区域的折角板,折角板是由两个呈一定角度的平面构成,折角板垂直于地面布置,
设于平设于移动机器上的激光雷达,激光雷达与处理器连接,激光雷达采集行驶区域内的环境数据,并将扫描数据发送至处理器,处理器基于权利要求1至权利要求6任一权利要求所述的融合折角板与占据栅格的混合导航地图构建方法来构建栅格地图或折角板地图;处理器中存储有行驶区域的环境数据。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911403235.4A CN111142117B (zh) | 2019-12-31 | 2019-12-31 | 融合折角板和占据栅格的混合导航地图构建方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911403235.4A CN111142117B (zh) | 2019-12-31 | 2019-12-31 | 融合折角板和占据栅格的混合导航地图构建方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111142117A true CN111142117A (zh) | 2020-05-12 |
CN111142117B CN111142117B (zh) | 2021-11-05 |
Family
ID=70522353
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911403235.4A Active CN111142117B (zh) | 2019-12-31 | 2019-12-31 | 融合折角板和占据栅格的混合导航地图构建方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111142117B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112543938A (zh) * | 2020-09-29 | 2021-03-23 | 华为技术有限公司 | 占据栅格地图的生成方法和装置 |
CN115561730A (zh) * | 2022-11-11 | 2023-01-03 | 湖北工业大学 | 基于激光雷达特征识别的定位导航方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170001311A1 (en) * | 2015-07-01 | 2017-01-05 | Irobot Corporation | Robot navigational sensor system |
CN106969768A (zh) * | 2017-04-22 | 2017-07-21 | 深圳力子机器人有限公司 | 一种无轨导航agv的精确定位及停车方法 |
CN109000649A (zh) * | 2018-05-29 | 2018-12-14 | 重庆大学 | 一种基于直角弯道特征的全方位移动机器人位姿校准方法 |
CN109613547A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的占据栅格地图构建方法 |
CN109631919A (zh) * | 2018-12-28 | 2019-04-16 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光板和占据栅格的混合导航地图构建方法 |
CN110361010A (zh) * | 2019-08-13 | 2019-10-22 | 中山大学 | 一种基于占据栅格地图且结合imu的移动机器人定位方法 |
US20190323843A1 (en) * | 2018-07-04 | 2019-10-24 | Baidu Online Network Technology (Beijing) Co., Ltd. | Method for generating a high precision map, apparatus and storage medium |
-
2019
- 2019-12-31 CN CN201911403235.4A patent/CN111142117B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170001311A1 (en) * | 2015-07-01 | 2017-01-05 | Irobot Corporation | Robot navigational sensor system |
CN106969768A (zh) * | 2017-04-22 | 2017-07-21 | 深圳力子机器人有限公司 | 一种无轨导航agv的精确定位及停车方法 |
CN109000649A (zh) * | 2018-05-29 | 2018-12-14 | 重庆大学 | 一种基于直角弯道特征的全方位移动机器人位姿校准方法 |
US20190323843A1 (en) * | 2018-07-04 | 2019-10-24 | Baidu Online Network Technology (Beijing) Co., Ltd. | Method for generating a high precision map, apparatus and storage medium |
CN109613547A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于反光板的占据栅格地图构建方法 |
CN109631919A (zh) * | 2018-12-28 | 2019-04-16 | 芜湖哈特机器人产业技术研究院有限公司 | 一种融合反光板和占据栅格的混合导航地图构建方法 |
CN110361010A (zh) * | 2019-08-13 | 2019-10-22 | 中山大学 | 一种基于占据栅格地图且结合imu的移动机器人定位方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112543938A (zh) * | 2020-09-29 | 2021-03-23 | 华为技术有限公司 | 占据栅格地图的生成方法和装置 |
CN112543938B (zh) * | 2020-09-29 | 2022-02-08 | 华为技术有限公司 | 占据栅格地图的生成方法和装置 |
CN115561730A (zh) * | 2022-11-11 | 2023-01-03 | 湖北工业大学 | 基于激光雷达特征识别的定位导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111142117B (zh) | 2021-11-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109631919B (zh) | 一种融合反光板和占据栅格的混合导航地图构建方法 | |
CN109613547B (zh) | 一种基于反光板的占据栅格地图构建方法 | |
CN108012325B (zh) | 一种基于uwb和双目视觉的导航定位方法 | |
CN109613550B (zh) | 一种基于反光板的激光雷达地图构建及定位方法 | |
CN109725327B (zh) | 一种多机构建地图的方法及*** | |
CN108571971B (zh) | 一种agv视觉定位***及方法 | |
CN112764053B (zh) | 一种融合定位方法、装置、设备和计算机可读存储介质 | |
CN109613548B (zh) | 一种基于图优化的激光雷达路标地图构建方法 | |
CN108180917B (zh) | 一种基于位姿图优化的顶标地图构建方法 | |
Yagi et al. | Map-based navigation for a mobile robot with omnidirectional image sensor COPIS | |
CN103913162B (zh) | 增强的移动平台定位 | |
WO2012043045A1 (ja) | 画像処理装置及びそれを用いた撮像装置 | |
CN109613549B (zh) | 一种基于卡尔曼过滤的激光雷达定位方法 | |
CN103499337B (zh) | 一种基于立式标靶的车载单目摄像头测距测高装置 | |
CN110243380A (zh) | 一种基于多传感器数据与角度特征识别的地图匹配方法 | |
CN104914865A (zh) | 变电站巡检机器人定位导航***及方法 | |
Bosse | ATLAS: a framework for large scale automated mapping and localization | |
CN111142117B (zh) | 融合折角板和占据栅格的混合导航地图构建方法及*** | |
KR20070120949A (ko) | 다차원 에비던스 그리드 및 그를 적용한 시스템 및 방법 | |
CN114332360A (zh) | 一种协同三维建图方法及*** | |
CN111260751B (zh) | 基于多传感器移动机器人的建图方法 | |
WO2021254019A1 (zh) | 协同构建点云地图的方法、设备和*** | |
CN113743171A (zh) | 目标检测方法及装置 | |
CN111273304A (zh) | 一种融合反光柱的自然定位方法及*** | |
CN108051007A (zh) | 基于超声波组网和立体视觉的agv导航定位方法 |
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 |