CN112066989A - 基于激光slam的室内agv自动导航系统及导航方法 - Google Patents
基于激光slam的室内agv自动导航系统及导航方法 Download PDFInfo
- Publication number
- CN112066989A CN112066989A CN202010838354.9A CN202010838354A CN112066989A CN 112066989 A CN112066989 A CN 112066989A CN 202010838354 A CN202010838354 A CN 202010838354A CN 112066989 A CN112066989 A CN 112066989A
- Authority
- CN
- China
- Prior art keywords
- agv
- waypoint
- information
- current
- upper computer
- 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
- 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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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
- 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/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于激光SLAM的室内AGV自动导航系统及导航方法,涉及移动机器人自动导航技术领域。室内AGV自动导航系统包括上位机、下位机、地面监控计算机、驱动模块、激光雷达、惯性测量单元和编码器。上位机通过激光雷达所采集的障碍物位置信息和下位机传递的AGV的加速度信息、AGV的角速度信息、AGV的速度信息、AGV循转角度信息和AGV行驶里程信息,按照激光SLAM建图程序来构建二维栅格地图,然后通过无线WIFI接收地面监控计算机分配的任务在已建立的地图上进行全局路径规划。本发明利用了ROS的分布式框架和开源代码,能够实现AGV室内自主导航。
Description
技术领域
本发明涉及移动机器人自动导航技术领域,具体涉及一种基于激光SLAM的室内AGV自动导航系统及导航方法。
背景技术
伴随着“中国制造2025”和工业4.0的到来,传统制造业生产方式发生巨大的变革。物流业作为制造业的重要组成部分,其运行效率对制造业有着重要的影响,应用AGV来实现生产和搬运功能的集成化和自动化,能够有效提升物流行业的运行效率,进而促进制造业的发展。
自动导航技术是AGV的核心技术之一,也是困扰着AGV应用于工业领域的重要限制因素。目前的AGV自动导航系统往往面临着自主能力差,易受环境影响的难题。而激光SLAM(simultaneous localization and mapping)是一种同时定位和建图的技术,不依赖于环境信息。AGV通过激光SLAM就可以在在未知环境里利用激光雷达采集的障碍物位置信息以及编码器采集的AGV速度信息、AGV行驶里程信息和AGV循转角度信息就可以对进行建图,然后在已建立的地图上进行路径规划,最后通过运动控制就可以实现AGV的自动导航。
目前自动导航AGV已成为移动机器人自动导航技术领域的研究热点,并出现了大量设计方案,比如由中国发明申请专利《磁导航AGV控制系统》(CN109839906 A)可知在地面上铺设磁带就可以实现磁导航AGV的自动导引,但是磁导航AGV只能沿磁带行走;又如中国发明申请专利公开说明书CN 207742338U于2018年8月17日公开的《激光导航系统》,激光导航AGV在行驶路线上安装位置精确的反射板,激光导航AGV的车载激光传感器会在行走时发出激光束,激光束被多组反射板反射回来,接收器接收反射回来的激光并记录其角度值,通过结合反射板位置分析计算后,可以计算出激光导航AGV的准确坐标。
通过以上分析我们可以得出以下几点:
1)磁导航AGV自主性差且易受环境影响,磁导航AGV只能沿磁带行走,无法实时更改任务,易受磁性物质干扰。磁带铺设在地面上,也容易受到损毁,需定期维护。
2)激光导引AGV同样面临着易受环境影响的缺点,由于激光导引AGV需要安装位置精确的反射板,因此激光导引AGV不适用于狭窄的走廊。并且当环境中的光线比较复杂时也不利于激光导引AGV的定位。
3)基于激光SLAM的自动导航AGV首先不依赖于环境信息,能够利用传感器数据构建未知环境的地图,因此并不受未知环境的影响;其次通过局部路径规划可以动态的躲避障碍物。
发明内容
针对上述问题,本发明的目的在于提供一种基于激光SLAM的室内AGV自动导航系统及导航方法,即首先建立未知环境的地图,然后在已建立好的地图上实现AGV的自动导航与避障。
为了实现上述目的,本发明采用以下技术方案:
一种基于激光SLAM的室内AGV自动导航系统,包括激光雷达、惯性测量单元、编码器、驱动模块、下位机、上位机和监控终端;
所述激光雷达与上位机通过串口单向连接,激光雷达采集障碍物位置信息,并将障碍物位置信息传递给上位机;
所述惯性测量单元与下位机通过IIC接口单向连接,惯性测量单元采集AGV加速度信息和AGV角速度信息,并将AGV加速度信息和AGV角速度信息传递给下位机;
所述编码器与下位机通过GPI0接口单向连接,编码器采集AGV线速度信息、AGV行驶里程信息和AGV循转角度信息,并将AGV线速度信息、AGV行驶里程信息和AGV循转角度信息传递给下位机;
所述下位机与上位机通过串口双向连接,所述下位机通过IO线与驱动模块单向连接,所述上位机与监控终端通过无线WIFI实现通讯连接;
所述下位机将接收到的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息传递给上位机,并接收上位机发布的全局路径R,下位机再将驱动指令发送给驱动模块,驱动模块控制AGV按照全局路径R行驶;
所述上位机接收监控终端发布的导航目标点;上位机接收激光雷达传递的障碍物位置信息、下位机传递的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息,按照激光SLAM建图程序来构建二维栅格地图和在已构建的地图上进行路径规划产生全局路径R,并将全局路径R传递给下位机,所述激光SLAM建图程序是指搭载激光雷达、编码器和惯性测量单元传感器,在没有环境先验信息的情况下,在运动的过程中搭建二维栅格地图,同时估计自己的运动;
所述监控终端负责向上位机发布导航目标点;
所述驱动模块包括驱动电路、左轮驱动电机和右轮驱动电机,驱动电路接受下位机发送的驱动指令后,按照驱动指令控制左轮驱动电机和右轮驱动电机,实现AGV的行驶。
优选地,所述上位机为工控机,操作系统为Linux和ROS,包含建图、自动导航及信息传输功能;所述下位机为嵌入式开发板。
优选地,所述监控终端为PC机、笔记本、工控机和平板电脑中的一种或多种,监控终端的操作系统为Linux和ROS,包括在线显示地图和AGV导航目标点指定。
优选地,所述障碍物位置信息中的障碍物包括动态障碍物和静态障碍物,静态障碍物包括墙面、办公设施、仪器设备,公共设施,动态障碍物包括人、动物和移动的物体;所述障碍物位置信息是指障碍物相对于AGV的距离信息和方位信息。
优选地,所述室内AGV自动导航系统中还包括一个供电模块,用于给上位机、下位机、驱动模块、和编码器、惯性测量单元和激光雷达供电。
本发明还提供了一种基于激光SLAM的室内AGV自动导航方法,包括以下步骤:
步骤1,静态二维栅格地图的构建;
步骤1.1,记AGV所在的给定环境为E,E=W×H,其中W为给定环境E的长度,H为给定环境E的宽度,记AGV在给定环境E中的起始位姿为点O,在给定环境E中启动AGV,并在人为指引下AGV从点O开始运动;
步骤1.2,实时信息的获取,包括上位机通过激光雷达获取障碍物位置信息,下位机通过惯性测量单元采集AGV加速度信息和AGV角速度信息、通过编码器采集AGV线速度信息、AGV行驶距离信息和AGV循转角度信息;下位机将获取的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息通过串口传递给上位机;
步骤1.3,根据步骤1.2获取的实时信息,上位机利用激光SLAM算法在给定环境E中构建栅格边长为L的静态二维栅格地图M1;
在静态二维栅格地图M1上以点O为原点建立平面地图坐标系,平面地图坐标系纵轴正方向为AGV车头所指的方向,纵轴正方向顺时针旋转90°为横轴正方向;所述静态二维栅格地图M1是一张由黑色栅格和白色栅格组成的地图,以相应的颜色表示每个栅格的占用状态,白色表示栅格为空闲状态,黑色表示栅格为被占用状态;
步骤1.4,以每个栅格的对角线相交点在平面地图坐标系上的坐标来表示栅格在平面地图坐标系上的坐标,确定步骤1.3获取的静态二维栅格地图M1上每个白色栅格在平面地图坐标系上的坐标,并将二维栅格地图M1上每个黑色栅格在平面地图坐标系上的坐标设置为固定值(W1,H1),其中,W1>W,H1>H:将含有栅格坐标的静态二维栅格地图记为静态二维栅格地图M2;
步骤1.5,上位机保存步骤1.4所获取的静态二维栅格地图M2,并通过无线WIFI将静态二维栅格地图M2传递给监控终端;
步骤2,监控终端向上位机发布导航目标点并将导航目标点记为点S;
步骤3,上位机接收导航目标点S,记AGV当前位置为点G,并以点G为起点、点S为终点在静态二维栅格地图M2上采用A*算法规划出一条安全无碰撞的全局路径R;
设AGV轮廓为正方形,边长为L1,L1≤L,且AGV只能沿着栅格的边界横向移动或者纵向移动;
设静态二维栅格地图M2中的每一个栅格为一个路点,将点G所在栅格设置为起始路点Pinit,将步骤3所述的点S所在栅格设置为目标路点Pgoal;
设从起始路点Pinit到达目标路点Pgoal需要循环的次数为N,并产生N个当前路点,将N次循环中的任意一次循环记为循环i、N个当前路点中的任意一个当前路点记为当前路点Pi,i=1,2...,N,特别的当i=1,取P1=Pinit;
将当前路点Pi周围的四个路点中的任意一个路点记为邻居路点Pin,n=1,2,3,4,i=1,2...,N,所述当前路点Pi周围的四个路点包括:与当前路点Pi在左边相邻的路点、与当前路点Pi在右边相邻的路点、与当前路点Pi在前边相邻的路点、与当前路点Pi在后边相邻的路点;
建立列表1和列表2,列表1用来存储起始路点Pinit和邻居路点Pin,列表2用来存储全局路径R规划过程中得到的当前路点Pi;
具体的,全局路径R的规划步骤如下:
步骤3.1,获取起始路点Pinit和目标路点Pgoal,并将起始路点Pinit放到列表1中;
步骤3.2,进行N次循环得到N个当前路点,并将该N个当前路点均存储在表2中,其中任一次循环i的过程如下:
步骤3.2.1,如果为第一次循环,则直接将起始路点Pinit视为当前路点P1;如果不是第一次循环,则将列表1中代价估计F(i)值最小的路点视为当前路点Pi;
步骤3.2.2,将当前路点Pi移动到列表2中并从表1中删除;
步骤3.2.3,考察当前路点Pi的每个邻居路点Pin,考察情况如下:
情况1,若邻居路点Pin已在列表1中或列表2中,忽略该邻居路点Pin;
情况2,若邻居路点Pin的坐标值为(W1,H1),忽略该邻居路点Pin;
情况3,若邻居路点Pin既不在列表1中也不在列表2中且该邻居路点坐标值不为(W1,H1),则计算该邻居路点的代价估计F(i),并将该邻居路点Pin加入到列表1中;
步骤3.3,全局路径R的形成;
步骤3.3.1对步骤3.2得到的N个当前路点依次计算第i个当前路点Pi和第i+1个当前路点Pi+1的欧氏距离,并将第i个当前路点Pi和第i+1个当前路点Pi+1的欧氏距离记为欧氏距离l(i,i+1),进行如下考察:
若l(i,i+1)>L,则将第i+1个当前路点从列表2中删除;
若l(i,i+1)≤L,则保留第i+1个当前路点;
设经过步骤3.3.1,列表2中保存的当前路点为M个,M≤N;
步骤3.3.2,将起始路点Pinit即当前路点P1从列表2中删除,即经过步骤3.3.2,列表2中保存的当前路点为M-1,并将该M-1个当前路点记为最优路点;
步骤3.3.3,将M-1个最优路点中的任一个记为最优路点Pj,j=1,2...M-1,则以起始路点Pinit为起点、目标路点Pgoal为终点,顺序连接M-1个最优路点构建路径队列P(Pinit,P1,...,Pj,...,PM-1,Pgoal),该路径列队P(Pinit,P1,...,Pj,...,PM-1,Pgoal)构成的路径即为全局路径R;
步骤4,上位机将步骤3得到的全局路径R通过串口发送给下位机;
步骤5,下位机通过串口接收全局路径R并通过IO口向驱动模块发出行驶速度为V的驱动指令,驱动模块控制AGV按照全局路径R行使;
步骤6,AGV按照全局路径R行驶,同时上位机不断获取实时信息;
所述实时信息包括激光雷达采集的障碍物位置信息,惯性测量单元采集的AGV加速度信息和AGV角速度信息,编码器采集的AGV线速度信息、AGV行驶距离信息和AGV循转角度信息;
步骤7,上位机根据步骤6获取的实时信息判断AGV前方L2距离内是否有动态障碍物:
如果有动态障碍物则进入步骤8;
如果没有动态障碍物,AGV继续保持行驶速度V沿着全局路径R行驶并进入步骤9;
步骤8,上位机根据步骤5获取的实时信息进行实时避障;
设动态障碍物在任意时刻占据栅格的个数为K个,K为正整数,将K个栅格中的任意一个栅格在平面地图坐标系上的坐标记为Xk,k=1,2,...,K;
上位机根据步骤5获取的实时信息计算动态障碍物的K个坐标,并判断K个栅格中的任意一个栅格在平面地图坐标系上的坐标Xk与全局路径R中任意一个最优路点Pj的坐标是否相同:
如果有相同的坐标,表明AGV与动态障碍物可能会发生碰撞,下位机向驱动模块发出降低行驶速度的驱动指令,驱动模块控制AGV降低当前行驶速度以回避碰撞,特别的当AGV与动态障碍物的距离小于L时,AGV立即停止运动,返回步骤6;
如果没有相同的坐标,表明AGV与动态障碍物不会发生碰撞,AGV继续保持行驶速度V沿着全局路径R行驶并进入步骤9;
步骤9,判断AGV是否到达导航目标点S:
如果到达导航目标点S,下位机向驱动模块发出停止运行的驱动指令,控制AGV停止运动并进入步骤10;
如果未到达导航目标点S,AGV则返回步骤6;
步骤10,上位机等待监控终端发送的新导航目标点,
如果上位机在30分钟内接收到新导航目标点,则返回步骤3;
如果上位机超过30分钟未接收到新导航目标点,则将整个AGV自动导航系统设置为待机状态。
优选地,给定环境E的长度W=100米,给定环境E的宽度H=100米。
优选地,所述某路点的代价估计F(i)为AGV从起始路点Pinit经由邻居路点Pin到目标路点Pgoal的代价估计,计算式如下:
F(i)=G(i)+H(i)
其中,G(i)为AGV从起始路点Pinit到邻居路点Pin的累积代价值,H(i)为AGV从邻居路点Pinit到目标路点Pgoal的代价估计,计算式分别如下:
G(i)=G(i-1)+G(i-1→i)
其中,G(i-1)为AGV从起始路点Pinit到当前路点Pi的累积代价值,G(i-1→i)为AGV从当前路点Pi到邻居路点Pin的代价值cost,取代价值cost为恒值,大小为L,在计算G(1)的过程中,取G(0)=0;
H(i)=||Pin-Pgoal||
其中,||Pin-Pgoal||表示邻居路点Pin到目标路点Pgoal的欧氏距离。
与现有技术相比,本发明提出的一种基于激光SLAM的室内AGV自动导航系统及导航方法,具有以下有益效果:
1、本发明提供的导航系统不需要环境的先验信息,利用激光SLAM建立未知环境的地图,然后在已建立好的地图上实现AGV的自动导航与避障。
2、导航自主能力强,较少的人为参与,只要通过地面监控计算机向上位机发布导航任务,AGV就可以自动完成导航与避障。
3、本文所提出的导航系统是基于ROS的,由于ROS的分布式框架和大量的开源代码,有效降低了AGV的开发难度、加快了开发进程。
附图说明
图1为本发明中基于激光SLAM的室内AGV自动导航系统结构图。
图2为本发明中基于激光SLAM的室内AGV自动导航方法流程图。
具体实施方式
以下结合附图并通过具体实施案例来进一步说明本发明的技术方案。
图1为本发明中基于激光SLAM的室内AGV自动导航系统结构图。由图1可见,本发明提供的一种基于激光SLAM的室内AGV自动导航系统,包括激光雷达10、惯性测量单元20、编码器30、驱动模块40、下位机50、上位机60和监控终端70。
在本实施例中,上位机60为工控机,操作系统为Linux和ROS,包含建图、自动导航及信息传输功能。所述下位机50为嵌入式开发板,优先推荐使用STM32F407。所述监控终端70为PC机、笔记本、工控机和平板电脑中的一种或多种,监控终端70)操作系统为Linux和ROS,包括在线显示地图和AGV导航目标点指定。
所述激光雷达10与上位机60通过串口单向连接,激光雷达10采集障碍物位置信息,并将障碍物位置信息传递给上位机60。所述障碍物位置信息中的障碍物包括动态障碍物和静态障碍物,静态障碍物包括墙面、办公设施、仪器设备,公共设施,动态障碍物包括人、动物和移动的物体;所述障碍物位置信息是指障碍物相对于AGV的距离信息和方位信息。
所述惯性测量单元20与下位机50通过IIC接口单向连接,惯性测量单元20采集AGV加速度信息和AGV角速度信息,并将AGV加速度信息和AGV角速度信息传递给下位机50。
所述编码器30与下位机50通过GPI0接口单向连接,编码器30采集AGV线速度信息、AGV行驶里程信息和AGV循转角度信息,并将AGV线速度信息、AGV行驶里程信息和AGV循转角度信息传递给下位机50。
所述下位机50与上位机60通过串口双向连接,所述下位机50通过IO线与驱动模块40单向连接,所述上位机60与监控终端70通过无线WIFI实现通讯连接;
所述下位机50将接收到的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息传递给上位机60,并接收上位机60发布的全局路径R,下位机50再将驱动指令发送给驱动模块40,驱动模块40控制AGV按照全局路径R行驶。
所述上位机60接收监控终端70发布的导航目标点。上位机60接收激光雷达10传递的障碍物位置信息、下位机50传递的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息,按照激光SLAM建图程序来构建二维栅格地图和在已构建的地图上进行路径规划产生全局路径R,并将全局路径R传递给下位机50,所述激光SLAM建图程序是指搭载激光雷达、编码器和惯性测量单元传感器,在没有环境先验信息的情况下,在运动的过程中搭建二维栅格地图,同时估计自己的运动。
所述监控终端70负责向上位机60发布导航目标点。
所述驱动模块40包括驱动电路、左轮驱动电机和右轮驱动电机,驱动电路接受下位机50发送的驱动指令后,按照驱动指令控制左轮驱动电机和右轮驱动电机,实现AGV的行驶。
在本实施例中,所述基于激光SLAM的室内AGV自动导航系统中还包括一个供电模块,用于给上位机60、下位机50、驱动模块40、和编码器30、惯性测量单元20和激光雷达10供电。
图2为本发明中基于激光SLAM的室内AGV自动导航方法流程图。由图2可见,本发明还提供了一种基于激光SLAM的室内AGV自动导航方法,包括以下步骤:
步骤1,静态二维栅格地图的构建。
步骤1.1,记AGV所在的给定环境为E,E=W×H,其中W为给定环境E的长度,H为给定环境E的宽度,记AGV在给定环境E中的起始位姿为点O,在给定环境E中启动AGV,并在人为指引下AGV从点O开始运动。在本实施例中,给定环境E的长度W=100米,给定环境E的宽度H=100米。
步骤1.2,实时信息的获取,包括上位机60通过激光雷达10获取障碍物位置信息,下位机50通过惯性测量单元20采集AGV加速度信息和AGV角速度信息、通过编码器30采集AGV线速度信息、AGV行驶距离信息和AGV循转角度信息;下位机50将获取的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息通过串口传递给上位机60。
步骤1.3,根据步骤1.2获取的实时信息,上位机60利用激光SLAM算法在给定环境E中构建栅格边长为L的静态二维栅格地图M1。在本实施例中,L=1~2米。
在静态二维栅格地图M1上以点O为原点建立平面地图坐标系,平面地图坐标系纵轴正方向为AGV车头所指的方向,纵轴正方向顺时针旋转90°为横轴正方向。所述静态二维栅格地图M1是一张由黑色栅格和白色栅格组成的地图,以相应的颜色表示每个栅格的占用状态,白色表示栅格为空闲状态,黑色表示栅格为被占用状态。
步骤1.4,以每个栅格的对角线相交点在平面地图坐标系上的坐标来表示栅格在平面地图坐标系上的坐标,确定步骤1.3获取的静态二维栅格地图M1上每个白色栅格在平面地图坐标系上的坐标,并将二维栅格地图M1上每个黑色栅格在平面地图坐标系上的坐标设置为固定值(W1,H1),其中,W1>W,H1>H:将含有栅格坐标的静态二维栅格地图记为静态二维栅格地图M2。
步骤1.5,上位机60保存步骤1.4所获取的静态二维栅格地图M2,并通过无线WIFI将静态二维栅格地图M2传递给监控终端70。
步骤2,监控终端70向上位机60发布导航目标点并将导航目标点记为点S。
步骤3,上位机60接受导航目标点S,记AGV当前位置为点G,并以点G为起点、点S为终点在静态二维栅格地图M2上采用A*算法规划出一条安全无碰撞的全局路径R。
设AGV轮廓为正方形,边长为L1,L1≤L,且AGV只能沿着栅格的边界横向移动或者纵向移动。在本实施例中,L1=0.8~1.8米。
设静态二维栅格地图M2中的每一个栅格为一个路点,将点G所在栅格设置为起始路点Pinit,将步骤3所述的点S所在栅格设置为目标路点Pgoal。
设从起始路点Pinit到达目标路点Pgoal需要循环的次数为N,并产生N个当前路点,将N次循环中的任意一次循环记为循环i、N个当前路点中的任意一个当前路点记为当前路点Pi,i=1,2...,N,特别的当i=1,取P1=Pinit。
将当前路点Pi周围的四个路点中的任意一个路点记为邻居路点Pin,n=1,2,3,4,i=1,2...,N,所述当前路点Pi周围的四个路点包括:与当前路点Pi在左边相邻的路点、与当前路点Pi在右边相邻的路点、与当前路点Pi在前边相邻的路点、与当前路点Pi在后边相邻的路点。
建立列表1和列表2,列表1用来存储起始路点Pinit和邻居路点Pin,列表2用来存储全局路径R规划过程中得到的当前路点Pi。
具体的,全局路径R的规划步骤如下:
步骤3.1,获取起始路点Pinit和目标路点Pgoal,并将起始路点Pinit放到列表1中。
步骤3.2,进行N次循环得到N个当前路点,并将该N个当前路点均存储在表2中,其中任一次循环i的过程如下:
步骤3.2.1,如果为第一次循环,则直接将起始路点Pinit视为当前路点P1;如果不是第一次循环,则将列表1中代价估计F(i)值最小的路点视为当前路点Pi;
步骤3.2.2,将当前路点Pi移动到列表2中并从表1中删除;
步骤3.2.3,考察当前路点Pi的每个邻居路点Pin,考察情况如下:
情况1,若邻居路点Pin已在列表1中或列表2中,忽略该邻居路点Pin;
情况2,若邻居路点Pin的坐标值为(W1,H1),忽略该邻居路点Pin;
情况3,若邻居路点Pin既不在列表1中也不在列表2中且该邻居路点坐标值不为(W1,H1),则计算该邻居路点的代价估计F(i),并将该邻居路点Pin加入到列表1中。
步骤3.3,全局路径R的形成。
步骤3.3.1对步骤3.2得到的N个当前路点依次计算第i个当前路点Pi和第i+1个当前路点Pi+1的欧氏距离,并将第i个当前路点Pi和第i+1个当前路点Pi+1的欧氏距离记为欧氏距离l(i,i+1),进行如下考察:
若l(i,i+1)>L,则将第i+1个当前路点从列表2中删除;
若l(i,i+1)≤L,则保留第i+1个当前路点;
设经过步骤3.3.1,列表2中保存的当前路点为M个,M≤N;
步骤3.3.2,将起始路点Pinit即当前路点P1从列表2中删除,即经过步骤3.3.2,列表2中保存的当前路点为M-1,并将该M-1个当前路点记为最优路点;
步骤3.3.3,将M-1个最优路点中的任一个记为最优路点Pj,j=1,2...M-1,则以起始路点Pinit为起点、目标路点Pgoal为终点,顺序连接M-1个最优路点构建路径队列P(Pinit,P1,...,Pj,...,PM-1,Pgoal),该路径列队P(Pinit,P1,...,Pj,...,PM-1,Pgoal)构成的路径即为全局路径R。
步骤4,上位机60将步骤3得到的全局路径R通过串口发送给下位机50。
步骤5,下位机50通过串口接收全局路径R并通过IO口向驱动模块40发出行驶速度为V的驱动指令,驱动模块40控制AGV按照全局路径R行使。
步骤6,AGV按照全局路径R行驶,同时上位机60不断获取实时信息。
所述实时信息包括激光雷达10采集的障碍物位置信息,惯性测量单元20采集的AGV加速度信息和AGV角速度信息,编码器30采集的AGV线速度信息、AGV行驶距离信息和AGV循转角度信息。
步骤7,上位机60根据步骤6获取的实时信息判断AGV前方L2距离内是否有动态障碍物:
如果有动态障碍物则进入步骤8;
如果没有动态障碍物,AGV继续保持行驶速度V沿着全局路径R行驶并进入步骤9。
在本实施例中,L2=1米。
步骤8,上位机60根据步骤5获取的实时信息进行实时避障。
设动态障碍物在任意时刻占据栅格的个数为K个,K为正整数,将K个栅格中的任意一个栅格在平面地图坐标系上的坐标记为Xk,k=1,2,...,K;
上位机60根据步骤5获取的实时信息计算动态障碍物的K个坐标,并判断K个栅格中的任意一个栅格在平面地图坐标系上的坐标Xk与全局路径R中任意一个最优路点Pj的坐标是否相同:
如果有相同的坐标,表明AGV与动态障碍物可能会发生碰撞,下位机50向驱动模块40发出降低行驶速度的驱动指令,驱动模块40控制AGV降低当前行驶速度以回避碰撞,特别的当AGV与动态障碍物的距离小于L时,AGV立即停止运动,返回步骤6;
如果没有相同的坐标,表明AGV与动态障碍物不会发生碰撞,AGV继续保持行驶速度V沿着全局路径R行驶并进入步骤9。
在本实施例中,K最大取值为10。
步骤9,判断AGV是否到达导航目标点S:
如果到达导航目标点S,下位机50向驱动模块40发出停止运行的驱动指令,控制AGV停止运动并进入步骤10;
如果未到达导航目标点S,AGV则返回步骤6;
步骤10,上位机60等待监控终端70发送的新导航目标点,
如果上位机60在30分钟内接收到新导航目标点,则返回步骤3;
如果上位机60超过30分钟未接收到新导航目标点,则将整个AGV自动导航系统设置为待机状态。
至此,一次导航结束。
在步骤3.2.1中,所述某路点的代价估计F(i)为AGV从起始路点Pinit经由邻居路点Pin到目标路点Pgoal的代价估计,计算式如下:
F(i)=G(i)+H(i)
其中,G(i)为AGV从起始路点Pinit到邻居路点Pin的累积代价值,H(i)为AGV从邻居路点Pinit到目标路点Pgoal的代价估计,计算式分别如下:
G(i)=G(i-1)+G(i-1→i)
其中,G(i-1)为AGV从起始路点Pinit到当前路点Pi的累积代价值,G(i-1→i)为AGV从当前路点Pi到邻居路点Pin的代价值cost,取代价值cost为恒值,大小为L,在计算G(1)的过程中,取G(0)=0;
H(i)=||Pin-Pgoal||
其中,||Pin-Pgoal||表示邻居路点Pin到目标路点Pgoal的欧氏距离。
Claims (8)
1.一种基于激光SLAM的室内AGV自动导航系统,其特征在于,包括激光雷达(10)、惯性测量单元(20)、编码器(30)、驱动模块(40)、下位机(50)、上位机(60)和监控终端(70);
所述激光雷达(10)与上位机(60)通过串口单向连接,激光雷达(10)采集障碍物位置信息,并将障碍物位置信息传递给上位机(60);
所述惯性测量单元(20)与下位机(50)通过IIC接口单向连接,惯性测量单元(20)采集AGV加速度信息和AGV角速度信息,并将AGV加速度信息和AGV角速度信息传递给下位机(50);
所述编码器(30)与下位机(50)通过GPI0接口单向连接,编码器(30)采集AGV线速度信息、AGV行驶里程信息和AGV循转角度信息,并将AGV线速度信息、AGV行驶里程信息和AGV循转角度信息传递给下位机(50);
所述下位机(50)与上位机(60)通过串口双向连接,所述下位机(50)通过IO线与驱动模块(40)单向连接,所述上位机(60)与监控终端(70)通过无线WIFI实现通讯连接;
所述下位机(50)将接收到的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息传递给上位机(60),并接收上位机(60)发布的全局路径R,下位机(50)再将驱动指令发送给驱动模块(40),驱动模块(40)控制AGV按照全局路径R行驶;
所述上位机(60)接收监控终端(70)发布的导航目标点;上位机(60)接收激光雷达(10)传递的障碍物位置信息、下位机(50)传递的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息,按照激光SLAM建图程序来构建二维栅格地图和在已构建的地图上进行路径规划产生全局路径R,并将全局路径R传递给下位机(50),所述激光SLAM建图程序是指搭载激光雷达、编码器和惯性测量单元传感器,在没有环境先验信息的情况下,在运动的过程中搭建二维栅格地图,同时估计自己的运动;
所述监控终端(70)负责向上位机(60)发布导航目标点;
所述驱动模块(40)包括驱动电路、左轮驱动电机和右轮驱动电机,驱动电路接受下位机(50)发送的驱动指令后,按照驱动指令控制左轮驱动电机和右轮驱动电机,实现AGV的行驶。
2.根据权利要求1所述的一种基于激光SLAM的室内AGV自动导航系统,其特征在于,所述上位机(60)为工控机,操作系统为Linux和ROS,包含建图、自动导航及信息传输功能;所述下位机(50)为嵌入式开发板。
3.根据权利要求1所述的一种基于激光SLAM的室内AGV自动导航系统,其特征在于,所述监控终端(70)为PC机、笔记本、工控机和平板电脑中的一种或多种,监控终端(70)的操作系统为Linux和ROS,包括在线显示地图和AGV导航目标点指定。
4.根据权利要求1所述的一种基于激光SLAM的室内AGV自动导航系统,其特征在于,所述障碍物位置信息中的障碍物包括动态障碍物和静态障碍物,静态障碍物包括墙面、办公设施、仪器设备,公共设施,动态障碍物包括人、动物和移动的物体;所述障碍物位置信息是指障碍物相对于AGV的距离信息和方位信息。
5.根据权利要求1所述的基于激光SLAM的室内AGV自动导航系统,其特征在于,所述室内AGV自动导航系统中还包括一个供电模块,用于给上位机(60)、下位机(50)、驱动模块(40)、和编码器(30)、惯性测量单元(20)和激光雷达(10)供电。
6.根据权利要求1所述的一种基于激光SLAM的室内AGV自动导航方法,其特征在于,包括以下步骤:
步骤1,静态二维栅格地图的构建;
步骤1.1,记AGV所在的给定环境为E,E=W×H,其中W为给定环境E的长度,H为给定环境E的宽度,记AGV在给定环境E中的起始位姿为点O,在给定环境E中启动AGV,并在人为指引下AGV从点O开始运动;
步骤1.2,实时信息的获取,包括上位机(60)通过激光雷达(10)获取障碍物位置信息,下位机(50)通过惯性测量单元(20)采集AGV加速度信息和AGV角速度信息、通过编码器(30)采集AGV线速度信息、AGV行驶距离信息和AGV循转角度信息;下位机(50)将获取的AGV加速度信息、AGV角速度信息、AGV线速度信息、AGV循转角度信息和AGV行驶里程信息通过串口传递给上位机(60);
步骤1.3,根据步骤1.2获取的实时信息,上位机(60)利用激光SLAM算法在给定环境E中构建栅格边长为L的静态二维栅格地图M1;
在静态二维栅格地图M1上以点O为原点建立平面地图坐标系,平面地图坐标系纵轴正方向为AGV车头所指的方向,纵轴正方向顺时针旋转90°为横轴正方向;所述静态二维栅格地图M1是一张由黑色栅格和白色栅格组成的地图,以相应的颜色表示每个栅格的占用状态,白色表示栅格为空闲状态,黑色表示栅格为被占用状态;
步骤1.4,以每个栅格的对角线相交点在平面地图坐标系上的坐标来表示栅格在平面地图坐标系上的坐标,确定步骤1.3获取的静态二维栅格地图M1上每个白色栅格在平面地图坐标系上的坐标,并将二维栅格地图M1上每个黑色栅格在平面地图坐标系上的坐标设置为固定值(W1,H1),其中,W1>W,H1>H:将含有栅格坐标的静态二维栅格地图记为静态二维栅格地图M2;
步骤1.5,上位机(60)保存步骤1.4所获取的静态二维栅格地图M2,并通过无线WIFI将静态二维栅格地图M2传递给监控终端(70);
步骤2,监控终端(70)向上位机(60)发布导航目标点并将导航目标点记为点S;
步骤3,上位机(60)接收导航目标点S,记AGV当前位置为点G,并以点G为起点、点S为终点在静态二维栅格地图M2上采用A*算法规划出一条安全无碰撞的全局路径R;
设AGV轮廓为正方形,边长为L1,L1≤L,且AGV只能沿着栅格的边界横向移动或者纵向移动;
设静态二维栅格地图M2中的每一个栅格为一个路点,将点G所在栅格设置为起始路点Pinit,将步骤3所述的点S所在栅格设置为目标路点Pgoal;
设从起始路点Pinit到达目标路点Pgoal需要循环的次数为N,并产生N个当前路点,将N次循环中的任意一次循环记为循环i、N个当前路点中的任意一个当前路点记为当前路点Pi,i=1,2...,N,特别的当i=1,取P1=Pinit;
将当前路点Pi周围的四个路点中的任意一个路点记为邻居路点Pin,n=1,2,3,4,i=1,2...,N,所述当前路点Pi周围的四个路点包括:与当前路点Pi在左边相邻的路点、与当前路点Pi在右边相邻的路点、与当前路点Pi在前边相邻的路点、与当前路点Pi在后边相邻的路点;
建立列表1和列表2,列表1用来存储起始路点Pinit和邻居路点Pin,列表2用来存储全局路径R规划过程中得到的当前路点Pi;
具体的,全局路径R的规划步骤如下:
步骤3.1,获取起始路点Pinit和目标路点Pgoal,并将起始路点Pinit放到列表1中;
步骤3.2,进行N次循环得到N个当前路点,并将该N个当前路点均存储在表2中,其中任一次循环i的过程如下:
步骤3.2.1,如果为第一次循环,则直接将起始路点Pinit视为当前路点P1;如果不是第一次循环,则将列表1中代价估计F(i)值最小的路点视为当前路点Pi;
步骤3.2.2,将当前路点Pi移动到列表2中并从表1中删除;
步骤3.2.3,考察当前路点Pi的每个邻居路点Pin,考察情况如下:
情况1,若邻居路点Pin已在列表1中或列表2中,忽略该邻居路点Pin;
情况2,若邻居路点Pin的坐标值为(W1,H1),忽略该邻居路点Pin;
情况3,若邻居路点Pin既不在列表1中也不在列表2中且该邻居路点坐标值不为(W1,H1),则计算该邻居路点的代价估计F(i),并将该邻居路点Pin加入到列表1中;
步骤3.3,全局路径R的形成;
步骤3.3.1对步骤3.2得到的N个当前路点依次计算第i个当前路点Pi和第i+1个当前路点Pi+1的欧氏距离,并将第i个当前路点Pi和第i+1个当前路点Pi+1的欧氏距离记为欧氏距离l(i,i+1),进行如下考察:
若l(i,i+1)>L,则将第i+1个当前路点从列表2中删除;
若l(i,i+1)≤L,则保留第i+1个当前路点;
设经过步骤3.3.1,列表2中保存的当前路点为M个,M≤N;
步骤3.3.2,将起始路点Pinit即当前路点P1从列表2中删除,即经过步骤3.3.2,列表2中保存的当前路点为M-1,并将该M-1个当前路点记为最优路点;
步骤3.3.3,将M-1个最优路点中的任一个记为最优路点Pj,j=1,2...M-1,则以起始路点Pinit为起点、目标路点Pgoal为终点,顺序连接M-1个最优路点构建路径队列P(Pinit,P1,...,Pj,...,PM-1,Pgoal),该路径列队P(Pinit,P1,...,Pj,...,PM-1,Pgoal)构成的路径即为全局路径R;
步骤4,上位机(60)将步骤3得到的全局路径R通过串口发送给下位机(50);
步骤5,下位机(50)通过串口接收全局路径R并通过IO口向驱动模块(40)发出行驶速度为V的驱动指令,驱动模块(40)控制AGV按照全局路径R行使;
步骤6,AGV按照全局路径R行驶,同时上位机(60)不断获取实时信息;
所述实时信息包括激光雷达(10)采集的障碍物位置信息,惯性测量单元(20)采集的AGV加速度信息和AGV角速度信息,编码器(30)采集的AGV线速度信息、AGV行驶距离信息和AGV循转角度信息;
步骤7,上位机(60)根据步骤6获取的实时信息判断AGV前方L2距离内是否有动态障碍物:
如果有动态障碍物则进入步骤8;
如果没有动态障碍物,AGV继续保持行驶速度V沿着全局路径R行驶并进入步骤9;
步骤8,上位机(60)根据步骤5获取的实时信息进行实时避障;
设动态障碍物在任意时刻占据栅格的个数为K个,K为正整数,将K个栅格中的任意一个栅格在平面地图坐标系上的坐标记为Xk,k=1,2,...,K;
上位机(60)根据步骤5获取的实时信息计算动态障碍物的K个坐标,并判断K个栅格中的任意一个栅格在平面地图坐标系上的坐标Xk与全局路径R中任意一个最优路点Pj的坐标是否相同:
如果有相同的坐标,表明AGV与动态障碍物可能会发生碰撞,下位机(50)向驱动模块(40)发出降低行驶速度的驱动指令,驱动模块(40)控制AGV降低当前行驶速度以回避碰撞,特别的当AGV与动态障碍物的距离小于L时,AGV立即停止运动,返回步骤6;
如果没有相同的坐标,表明AGV与动态障碍物不会发生碰撞,AGV继续保持行驶速度V沿着全局路径R行驶并进入步骤9;
步骤9,判断AGV是否到达导航目标点S:
如果到达导航目标点S,下位机(50)向驱动模块(40)发出停止运行的驱动指令,控制AGV停止运动并进入步骤10;
如果未到达导航目标点S,AGV则返回步骤6;
步骤10,上位机(60)等待监控终端(70)发送的新导航目标点,
如果上位机(60)在30分钟内接收到新导航目标点,则返回步骤3;
如果上位机(60)超过30分钟未接收到新导航目标点,则将整个AGV自动导航系统设置为待机状态。
7.根据权利要求7所述的一种基于激光SLAM的室内AGV自动导航方法,其特征在于,给定环境E的长度W=100米,给定环境E的宽度H=100米。
8.根据权利要求7所述的一种基于激光SLAM的室内AGV自动导航方法,其特征在于,所述某路点的代价估计F(i)为AGV从起始路点Pinit经由邻居路点Pin到目标路点Pgoal的代价估计,计算式如下:
F(i)=G(i)+H(i)
其中,G(i)为AGV从起始路点Pinit到邻居路点Pin的累积代价值,H(i)为AGV从邻居路点Pinit到目标路点Pgoal的代价估计,计算式分别如下:
G(i)=G(i-1)+G(i-1→i)
其中,G(i-1)为AGV从起始路点Pinit到当前路点Pi的累积代价值,G(i-1→i)为AGV从当前路点Pi到邻居路点Pin的代价值cost,取代价值cost为恒值,大小为L,在计算G(1)的过程中,取G(0)=0;
H(i)=||Pin-Pgoal||
其中,||Pin-Pgoal||表示邻居路点Pin到目标路点Pgoal的欧氏距离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010838354.9A CN112066989B (zh) | 2020-08-19 | 2020-08-19 | 基于激光slam的室内agv自动导航系统及导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010838354.9A CN112066989B (zh) | 2020-08-19 | 2020-08-19 | 基于激光slam的室内agv自动导航系统及导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112066989A true CN112066989A (zh) | 2020-12-11 |
CN112066989B CN112066989B (zh) | 2022-07-29 |
Family
ID=73662250
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010838354.9A Active CN112066989B (zh) | 2020-08-19 | 2020-08-19 | 基于激光slam的室内agv自动导航系统及导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112066989B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112631290A (zh) * | 2020-12-14 | 2021-04-09 | 云南昆船智能装备有限公司 | 自动标定和设置导航标记物的移动机器人及方法 |
CN112698629A (zh) * | 2020-12-23 | 2021-04-23 | 江苏睿科大器机器人有限公司 | 一种适用于医院场景的agv调度方法与系统 |
CN112799404A (zh) * | 2021-01-05 | 2021-05-14 | 佛山科学技术学院 | Agv的全局路径规划方法、装置及计算机可读存储介质 |
CN112859110A (zh) * | 2020-12-28 | 2021-05-28 | 济南大学 | 一种基于三维激光雷达的定位导航方法 |
CN112947475A (zh) * | 2021-03-22 | 2021-06-11 | 山东大学 | 一种激光导航叉车式agv车载系统及方法 |
CN113029143A (zh) * | 2021-02-24 | 2021-06-25 | 同济大学 | 一种适用于pepper机器人的室内导航方法 |
CN113218384A (zh) * | 2021-05-19 | 2021-08-06 | 中国计量大学 | 一种基于激光slam的室内agv自适应定位系统 |
CN113238561A (zh) * | 2021-05-31 | 2021-08-10 | 河北工业大学 | 一种人体洗浴避障方法及系统 |
CN113268062A (zh) * | 2021-05-31 | 2021-08-17 | 河北工业大学 | 一种人体曲面建模方法、建模装置及建模系统 |
CN113439524A (zh) * | 2021-06-15 | 2021-09-28 | 江苏科技大学 | 基于单线激光雷达自动升降装置的家用割草机器人、系统以及建图方法 |
CN113589802A (zh) * | 2021-06-25 | 2021-11-02 | 北京旷视科技有限公司 | 栅格地图处理方法、装置、系统、电子设备和计算机介质 |
CN113687650A (zh) * | 2021-07-06 | 2021-11-23 | 浙江世仓智能仓储设备有限公司 | 一种穿梭车运行定位的方法 |
CN113867290A (zh) * | 2021-09-30 | 2021-12-31 | 上汽通用五菱汽车股份有限公司 | 一种基于激光slam和plc的agv的联合控制方法及系统 |
CN114355921A (zh) * | 2021-12-28 | 2022-04-15 | 北京易航远智科技有限公司 | 车辆循迹轨迹生成方法、装置、电子设备及存储介质 |
CN114879620A (zh) * | 2022-05-26 | 2022-08-09 | 宁波舜宇贝尔自动化有限公司 | 一种基于ros的agv控制系统 |
CN115016510A (zh) * | 2022-08-08 | 2022-09-06 | 武汉工程大学 | 一种机器人导航避障方法、装置以及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090088916A1 (en) * | 2007-09-28 | 2009-04-02 | Honeywell International Inc. | Method and system for automatic path planning and obstacle/collision avoidance of autonomous vehicles |
CN106325275A (zh) * | 2016-09-14 | 2017-01-11 | 广州今甲智能科技有限公司 | 一种机器人导航的系统、方法及装置 |
CN107990903A (zh) * | 2017-12-29 | 2018-05-04 | 东南大学 | 一种基于改进a*算法的室内agv路径规划方法 |
CN109085838A (zh) * | 2018-09-05 | 2018-12-25 | 南京理工大学 | 一种基于激光定位的动态障碍物剔除算法 |
US20190004524A1 (en) * | 2016-08-31 | 2019-01-03 | Faraday&Future Inc. | System and method for planning a vehicle path |
CN110763225A (zh) * | 2019-11-13 | 2020-02-07 | 内蒙古工业大学 | 一种小车路径导航方法及系统、运输车系统 |
CN111240331A (zh) * | 2020-01-17 | 2020-06-05 | 仲恺农业工程学院 | 基于激光雷达和里程计slam的智能小车定位导航方法及系统 |
-
2020
- 2020-08-19 CN CN202010838354.9A patent/CN112066989B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090088916A1 (en) * | 2007-09-28 | 2009-04-02 | Honeywell International Inc. | Method and system for automatic path planning and obstacle/collision avoidance of autonomous vehicles |
US20190004524A1 (en) * | 2016-08-31 | 2019-01-03 | Faraday&Future Inc. | System and method for planning a vehicle path |
CN106325275A (zh) * | 2016-09-14 | 2017-01-11 | 广州今甲智能科技有限公司 | 一种机器人导航的系统、方法及装置 |
CN107990903A (zh) * | 2017-12-29 | 2018-05-04 | 东南大学 | 一种基于改进a*算法的室内agv路径规划方法 |
CN109085838A (zh) * | 2018-09-05 | 2018-12-25 | 南京理工大学 | 一种基于激光定位的动态障碍物剔除算法 |
CN110763225A (zh) * | 2019-11-13 | 2020-02-07 | 内蒙古工业大学 | 一种小车路径导航方法及系统、运输车系统 |
CN111240331A (zh) * | 2020-01-17 | 2020-06-05 | 仲恺农业工程学院 | 基于激光雷达和里程计slam的智能小车定位导航方法及系统 |
Non-Patent Citations (1)
Title |
---|
马静等: ""A*算法在无人车路径规划中的应用"", 《计算机技术与发展》 * |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112631290A (zh) * | 2020-12-14 | 2021-04-09 | 云南昆船智能装备有限公司 | 自动标定和设置导航标记物的移动机器人及方法 |
CN112698629A (zh) * | 2020-12-23 | 2021-04-23 | 江苏睿科大器机器人有限公司 | 一种适用于医院场景的agv调度方法与系统 |
CN112859110A (zh) * | 2020-12-28 | 2021-05-28 | 济南大学 | 一种基于三维激光雷达的定位导航方法 |
CN112859110B (zh) * | 2020-12-28 | 2024-06-07 | 济南大学 | 一种基于三维激光雷达的定位导航方法 |
CN112799404B (zh) * | 2021-01-05 | 2024-01-16 | 佛山科学技术学院 | Agv的全局路径规划方法、装置及计算机可读存储介质 |
CN112799404A (zh) * | 2021-01-05 | 2021-05-14 | 佛山科学技术学院 | Agv的全局路径规划方法、装置及计算机可读存储介质 |
CN113029143A (zh) * | 2021-02-24 | 2021-06-25 | 同济大学 | 一种适用于pepper机器人的室内导航方法 |
CN112947475A (zh) * | 2021-03-22 | 2021-06-11 | 山东大学 | 一种激光导航叉车式agv车载系统及方法 |
CN113218384A (zh) * | 2021-05-19 | 2021-08-06 | 中国计量大学 | 一种基于激光slam的室内agv自适应定位系统 |
CN113238561A (zh) * | 2021-05-31 | 2021-08-10 | 河北工业大学 | 一种人体洗浴避障方法及系统 |
CN113268062A (zh) * | 2021-05-31 | 2021-08-17 | 河北工业大学 | 一种人体曲面建模方法、建模装置及建模系统 |
CN113439524A (zh) * | 2021-06-15 | 2021-09-28 | 江苏科技大学 | 基于单线激光雷达自动升降装置的家用割草机器人、系统以及建图方法 |
CN113589802A (zh) * | 2021-06-25 | 2021-11-02 | 北京旷视科技有限公司 | 栅格地图处理方法、装置、系统、电子设备和计算机介质 |
CN113687650B (zh) * | 2021-07-06 | 2024-06-04 | 浙江世仓智能仓储设备有限公司 | 一种穿梭车运行定位的方法 |
CN113687650A (zh) * | 2021-07-06 | 2021-11-23 | 浙江世仓智能仓储设备有限公司 | 一种穿梭车运行定位的方法 |
CN113867290A (zh) * | 2021-09-30 | 2021-12-31 | 上汽通用五菱汽车股份有限公司 | 一种基于激光slam和plc的agv的联合控制方法及系统 |
CN114355921A (zh) * | 2021-12-28 | 2022-04-15 | 北京易航远智科技有限公司 | 车辆循迹轨迹生成方法、装置、电子设备及存储介质 |
CN114355921B (zh) * | 2021-12-28 | 2022-10-18 | 北京易航远智科技有限公司 | 车辆循迹轨迹生成方法、装置、电子设备及存储介质 |
CN114879620A (zh) * | 2022-05-26 | 2022-08-09 | 宁波舜宇贝尔自动化有限公司 | 一种基于ros的agv控制系统 |
CN115016510A (zh) * | 2022-08-08 | 2022-09-06 | 武汉工程大学 | 一种机器人导航避障方法、装置以及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN112066989B (zh) | 2022-07-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112066989B (zh) | 基于激光slam的室内agv自动导航系统及导航方法 | |
CN112518739B (zh) | 履带式底盘机器人侦察智能化自主导航方法 | |
US7693654B1 (en) | Method for mapping spaces with respect to a universal uniform spatial reference | |
CN108958250A (zh) | 多传感器移动平台及基于已知地图的导航与避障方法 | |
Yoshida et al. | A sensor platform for outdoor navigation using gyro-assisted odometry and roundly-swinging 3D laser scanner | |
Pfaff et al. | Towards mapping of cities | |
US11537140B2 (en) | Mobile body, location estimation device, and computer program | |
CN214520204U (zh) | 一种基于深度相机和激光雷达的港区智能巡检机器人 | |
CN114527763B (zh) | 基于目标检测和slam构图的智能巡检系统及方法 | |
Al-Darraji et al. | A technical framework for selection of autonomous uav navigation technologies and sensors | |
CN113566808A (zh) | 一种导航路径规划方法、装置、设备以及可读存储介质 | |
CN112611374A (zh) | 基于激光雷达和深度相机的路径规划及避障的方法及系统 | |
Romanov et al. | A navigation system for intelligent mobile robots | |
Kayhani et al. | Tag-based indoor localization of UAVs in construction environments: Opportunities and challenges in practice | |
Choi et al. | Cellular Communication-Based Autonomous UAV Navigation with Obstacle Avoidance for Unknown Indoor Environments. | |
Hu et al. | A small and lightweight autonomous laser mapping system without GPS | |
US20240168480A1 (en) | Autonomous mapping by a mobile robot | |
Tsukiyama | World map based on RFID tags for indoor mobile robots | |
de Melo et al. | Mobile robot indoor autonomous navigation with position estimation using rf signal triangulation | |
JP7396618B2 (ja) | 移動体位置推定システム | |
Park et al. | Multilevel localization for mobile sensor network platforms | |
De Melo et al. | Trajectory planning for nonholonomic mobile robot using extended Kalman filter | |
Meedendorp | Path Planning and Path Following for an Autonomous GPR Survey Robot | |
Chang et al. | System Development and Integration of Unmanned Aerial Vehicle Navigation Techniques for Indoor Environments | |
Mohiuddin et al. | An Efficient Lidar Sensing System For Self-Driving Cars |
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 |