CN112947475A - 一种激光导航叉车式agv车载***及方法 - Google Patents
一种激光导航叉车式agv车载***及方法 Download PDFInfo
- Publication number
- CN112947475A CN112947475A CN202110301652.9A CN202110301652A CN112947475A CN 112947475 A CN112947475 A CN 112947475A CN 202110301652 A CN202110301652 A CN 202110301652A CN 112947475 A CN112947475 A CN 112947475A
- Authority
- CN
- China
- Prior art keywords
- module
- agv
- point
- laser
- vehicle
- 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 28
- 230000033001 locomotion Effects 0.000 claims abstract description 19
- 238000004891 communication Methods 0.000 claims abstract description 13
- 238000007726 management method Methods 0.000 claims abstract description 7
- 230000000007 visual effect Effects 0.000 claims abstract description 4
- 238000010276 construction Methods 0.000 claims abstract 2
- 230000009191 jumping Effects 0.000 claims description 18
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000000295 complement effect Effects 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 230000011218 segmentation Effects 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 description 10
- 238000001514 detection method Methods 0.000 description 6
- 238000013507 mapping Methods 0.000 description 6
- 230000003137 locomotive effect Effects 0.000 description 5
- 230000005622 photoelectricity Effects 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000008034 disappearance Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000002310 reflectometry Methods 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0289—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling with means for avoiding collisions between vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
- G05D1/0293—Convoy travelling
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种激光导航叉车式AGV车载***及控制方法,包括电动叉车本体,在电动叉车本体上设有车载主控制器,所述的车载控制器与定位导航模块、路径规划模块、安全避障模块、声光报警模块、运动执行模块、自动充电模块、无线通讯模块和任务管理调度模块相连;其中所述的定位导航模块,采用激光SLAM方式描述周围环境,并融合I MU、轮式里程计、摄像头传感器信息,完成建图和AGV叉车自身定位。
Description
技术领域
本发明涉及无人激光叉车控制领域,特别涉及一种无人激光叉车的车载***及方法。
背景技术
随着仓储物流自动化的快速发展和国内人口红利的消失,自动导引车(AutomatedGuided Vehicle,AGV)凭借其效率高、灵活性强等优点逐渐成为智慧物流***的重要组成部分。其中,叉车式AGV作为代表,不仅可以实现物料搬运功能,而且可以实现物料堆垛的功能,基本完全替代人力,实现自动化。目前,市场上主流的激光叉车AGV是以电动叉车为主体,将激光雷达等传感器安装在电动叉车主体上,并在周围环境加装反光板等光学辅助装置,协助激光雷达进行定位,进而实现对AGV的控制。但是存在以下问题:
1、现有的激光导航叉车式AGV安装反光板的定位方式对周围环境要求较高,反光板易被污染,周围物体的反射率对激光雷达定位的准确性有一定的影响,由于反光板安装的要求,在室外使用受限,且多采用单一传感器定位,躲避动态障碍物能力较差。
2、现有的AGV路径规划方法多存在路径搜索时间长,冗余节点多等问题,影响AGV的工作效率。且对于多AGV的调度,存在路口拥堵等问题。
3、只是将各类传感器安装在叉车主体上,其车载***主要用于接收信息和发送指令,并没有将激光SLAM模块、路径规划模块、运动控制模块等做集成,可移植性较差。
发明内容
为了解决现有技术中存在的技术问题,本发明提出了一种激光导航叉车式AGV车载***及控制方法,具有集成度高和架构精简等优势。
本发明采用的技术方案如下:
第一方面,本发明的实施例提供了一种激光导航叉车式AGV车载***,包括电动叉车本体,在电动叉车本体上设有车载主控制器、定位导航模块、路径规划模块、安全避障模块、声光报警模块、运动执行模块、自动充电模块、无线通讯模块和任务管理调度模块;
所述的车载主控制器为工控机,定位导航模块、路径规划模块、安全避障模块、声光报警模块、运动执行模块、自动充电模块、无线通讯模块分别与主控制器连接;其中所述的定位导航模块摒弃传统的反光板定位方式,采用激光SLAM方式描述周围环境,并融合IMU、轮式里程计、摄像头等传感器信息,完成建图和AGV叉车自身定位。
路径规划模块可进行碰撞检测,计算AGV叉车和周围障碍物之间的距离,用于为AGV规划一条从起始位置到目标工位的最短无碰撞路径。
安全避障模块采用硬件和软件相结合,接触式防护和非接触式防护配合的二级联合防护措施,包括车头部加装的2台专业性激光避障扫描仪,三区域防护模式,一个保护区两个警告区,车尾货叉尖部安装的避障检测光电,车头加装的保险杠和避障接触开关和货叉尖部加装的接触开关;
声光报警模块用于出现故障时的报警提示。
运动执行模块用AGV的行走、转向和货叉抬升下降,采用电液混合驱动方式,货叉抬升采用液压控制。
自动充电模块用于为车载电池充电,提高AGV工作效率。无线通讯模块用于与远程控制中心之间的数据通讯,起到数据传输,数据中转作用。
任务调度模块用于多台AGV的任务管理调度。整体***基于ROS操作***。
第二方面,基于上述***,本发明实施例还提供了一种方法,其中,定位导航模块的建图方法如下:
步骤1:***通过IMU采集速度和加速度信息,通过姿态解算、互补滤波完成对AGV自身姿态的初步估计;
步骤2:通过轮式里程计采集速度信息完成AGV的航迹推算从而进行AGV自身位置估计,融合姿态估计与位置估计完成位姿估计;
步骤3:多线激光雷达采用点云分割匹配技术,基于点云片段和分类出的目标的方法,建立周围环境的点云描述模型,并与估计的位姿进行扫描匹配得到匹配后的位姿;
步骤4:摄像头进行标志位姿和标志尺寸的识别;
步骤5:与激光雷达匹配位姿动态加权得到高精度位姿;
步骤6:输出位姿到中心控制器调整车轮的转速和转角;
步骤7:判断是否到达目标任务点,若到达则导引完成,若未到达,则开始下一个扫描周期。
进一步的,所述的路径规划模块对路径进行规划的方法如下:
步骤1:首先根据地图精度划分栅格;
步骤2:将起始点加入开放列表;
步骤3:以起始点为中心向8个方向搜索节点;
步骤4:将满足条件的跳点加入开放列表;
步骤5:寻找开放列表中最小值的栅格点记为X点;
步骤6:判断X是否为目标点,若为目标点,则结束路径搜索,若不是目标点,则将X点从开放列表中删除,将X点加入关闭列表;
步骤7:可向直线方向和斜线方向寻找节点,当两个方向都可以扩展时,优先进行直线方向的扩展,先完成直线方向的扩展再进行对角线方向的扩展;搜索直线方向或对角线方向上的第一个跳点N;
步骤8:将N点在关闭列表中删除;
步骤9:判断N点是否在开放列表中,若不在,则将N点加入开放列表,若在,则更新N点在开放列表中的值,再进行下一轮搜索;
步骤10:当搜索完成后,遍历关闭列表中的节点,将所有的节点依次连在一起,便得到最终路径。根据最终生成的路径,运用导航框架,输出速度信息,可实现AGV的运动控制。
上述本发明的实施例的有益效果如下:
本发明提出的激光导航叉车式AGV车载***及控制方法,改进相关算法,具有集成度高和架构精简等优势。摒弃传统的反光板的定位建图方法,采用SLAM算法,并融合IMU、里程计和摄像头等传感器数据,提高激光定位精度,提高环境适应性,扩展了AGV的工作范围。改进相关路径规划算法,减少了路径搜索节点,缩短了路径搜索时间,提高了AGV自主导航效率。提出新的AGV多机调度方法,有效缓解路口拥堵问题,避免冲突的同时减少绕路现象。
附图说明
构成本发明的一部分的说明书附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。
图1是本发明整体***框架结构示意图;
图2是本发明定位建图模块流程图;
图3是本发明路径规划模块流程图;
图4是本发明避障模块流程图;
图5是本发明自动充电模块流程图;
图6是本发明运动控制模块流程图;
图7是本发明管理调度流程图。
具体实施方式
应该指出,以下详细说明都是例示性的,旨在对本发明提供进一步的说明。除非另有指明,本发明使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本发明的示例性实施方式。如在这里所使用的,除非本发明另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合;
正如背景技术所介绍的,现有技术中存在的不足,为了解决如上的技术问题,本发明提出了一种激光导航叉车式AGV车载***及控制方法。
本发明的一种典型的实施方式中,如图1、图2所示,本实施例中公开了一种激光导航叉车式AGV车载***,包含电动叉车本体,在电动叉车车体上设有车载主控制器、定位导航模块、路径规划模块、安全避障模块、声光报警模块、运动执行模块、自动充电模块、无线通讯模块和任务管理调度模块。
其中车载主控制器为工控机,定位导航模块、路径规划模块、安全避障模块、声光报警模块、运动执行模块、自动充电模块、无线通讯模块分别与主控制器连接;其中,定位导航模块摒弃传统的反光板定位方式,采用激光SLAM方式描述周围环境,并融合IMU、轮式里程计、摄像头等传感器信息,完成建图和AGV叉车自身定位。
路径规划模块可进行碰撞检测,计算AGV叉车和周围障碍物之间的距离,用于为AGV规划一条从起始位置到目标工位的最短无碰撞路径。
安全避障模块采用硬件和软件相结合,接触式防护和非接触式防护配合的二级联合防护措施,包括车头部加装的2台专业性激光避障扫描仪,三区域防护模式,一个保护区两个警告区,车尾货叉尖部安装的避障检测光电,车头加装的保险杠和避障接触开关和货叉尖部加装的接触开关。
声光报警模块用于出现故障时的报警提示。
运动执行模块用AGV的行走、转向和货叉抬升下降,采用电液混合驱动方式,货叉抬升采用液压控制。自动充电模块用于为车载电池充电,提高AGV工作效率。
无线通讯模块用于与远程控制中心之间的数据通讯,起到数据传输,数据中转作用。任务调度模块用于多台AGV的任务管理调度。整体***基于ROS操作***。
定位导航模块摒弃传统的反光板定位方式,采用激光SLAM方式描述周围环境,并融合IMU、轮式里程计、摄像头等传感器信息,完成建图和AGV叉车自身定位。路径规划模块可进行碰撞检测,计算AGV叉车和周围障碍物之间的距离,用于为AGV规划一条从起始位置到目标工位的最短无碰撞路径。安全避障模块采用硬件和软件相结合,接触式防护和非接触式防护配合的二级联合防护措施,包括车头部加装的2台专业性激光避障扫描仪,三区域防护模式,一个保护区两个警告区,车尾货叉尖部安装的避障检测光电,车头加装的保险杠和避障接触开关和货叉尖部加装的接触开关。声光报警模块用于出现故障时的报警提示。运动执行模块用AGV的行走、转向和货叉抬升下降,采用电液混合驱动方式,货叉抬升采用液压控制。自动充电模块用于为车载电池充电,提高AGV工作效率。无线通讯模块用于与远程控制中心之间的数据通讯,起到数据传输,数据中转作用。任务调度模块用于多台AGV的任务管理调度。整体***基于ROS操作***。
其中,激光雷达建图定位模块区别于传统的单线激光雷达建图,且摒弃反光板建图的方式,采用多线激光雷达建图方法,具体包括以下步骤:
步骤1:***通过IMU采集速度和加速度信息,通过姿态解算、互补滤波等完成对AGV自身姿态的初步估计,
步骤2:通过轮式里程计采集速度信息完成AGV的航迹推算从而进行AGV自身位置估计,融合姿态估计与位置估计完成位姿估计;
步骤3:多线激光雷达采用点云分割匹配技术,基于点云片段和分类出的目标的方法,建立周围环境的点云描述模型,并与估计的位姿进行扫描匹配得到匹配后的位姿,
步骤4:摄像头进行标志位姿和标志尺寸的识别,
步骤5:与激光雷达匹配位姿动态加权得到高精度位姿,
步骤6:输出位姿到中心控制器调整车轮的转速和转角,
步骤7:判断是否到达目标任务点,若到达则导引完成,若未到达,则开始下一个扫描周期。
从而实现多传感器融合定位建图,实时反馈AGV的运行位姿信息,保证AGV的正常行走,并保持一定的精度。其流程如图2所示。
进一步的,本实施例中路径规划模块用于为AGV规划从起始位置到目标工位的无碰撞路径,为解决现有路径规划方法存在的路径搜索时间长,搜索冗余节点较多等问题,应用一种新的路径规划方法,不再采用传统的逐点判断的方式,以起始点为中心向周围四个方向或八个方向扩张计算,而是选择关键点作为跳跃点,采用跳跃点判断的方式,以起始点为中心根据规则挑选符合条件的跳点,并以原跳点和新跳点的方向为下一次搜索方向搜索跳点,直至到达终点,省去了传统算法中对非关键节点的计算判断环节,提高了算法效率。其流程如图3所示。算法维护了开放列表和关闭列表两个节点列表,开放列表中存放未遍历的节点,关闭列表中存放已经遍历过的节点,具体步骤如下:
步骤1:首先根据地图精度划分栅格;
步骤2:将起始点加入开放列表;
步骤3:以起始点为中心向8个方向搜索节点;
步骤4:将满足条件的跳点加入开放列表;
步骤5:寻找开放列表中最小值的栅格点记为X点;
步骤6:判断X是否为目标点,若为目标点,则结束路径搜索,若不是目标点,则将X点从开放列表中删除,将:X点加入关闭列表;
步骤7:可向直线方向和斜线方向寻找节点,当两个方向都可以扩展时,优先进行直线方向的扩展,先完成直线方向的扩展再进行对角线方向的扩展。搜索直线方向或对角线方向上的第一个跳点N;
步骤8:将N点在关闭列表中删除;
步骤9:判断N点是否在开放列表中,若不在,则将N点加入开放列表,若在,则更新N点在开放列表中的值,再进行下一轮搜索;
步骤10:当搜索完成后,遍历关闭列表中的节点,将所有的节点依次连在一起,便得到最终路径。根据最终生成的路径,运用导航框架,输出速度信息,可实现AGV的运动控制。
进一步的,本实施例中的安全避障模块采用硬件和软件二级联合防护措施,分为接触式和非接触式两类。第一级安全***采用多种非接触式传感器,包括在车头加装两台专业性激光避障扫描仪,激光扫描仪的扫描角度为270度,分别安装在车头两角处,刚好覆盖车身周围区域,没有安全死角。在车尾货叉尖部加装避障检测光电,在货叉根部加装货到位检测光电。第二级采用接触式安全***,包括在车头加装保险杠,并在保险杠后加装拉线开关,在车尾货叉尖部加装接触开关,在门架上端加装限高接触开关等。若警示区检测到障碍物,则减速慢行,若停止区检测到障碍物。则立即停止,若未检测到周围有障碍物,则AGV叉车仍保持工作状态,若防撞胶条触碰到障碍物,立即停止作业,其流程图如图4所示,具体步骤如下:
步骤1:避障***开始工作;
步骤2:激光雷达警示区是否检测到障碍物,若检测到障碍物,则减速慢行,若未检测到障碍物,则继续正常作业;
步骤3:激光雷达停止区是否检测到障碍物,若未检测到障碍物,则继续正常作业,若检测到障碍物,则立即停车;
步骤4:检测障碍物是否移开,若移开,则继续正常工作,若未移开,则保持停在原地;
步骤5:超声波传感器是否检测到障碍物,若未检测到障碍物,则正常作业,若检测到障碍物,则立即停止作业,
步骤6:检测障碍物是否移开,若移开,则继续正常工作,若未移开,则保持停在原地;
步骤7:防撞胶条是否检测到障碍物,若未检测到障碍物,则继续正常工作,若检测到障碍物,则立即停车;
步骤8:检测障碍物是否移开,若移开,则继续正常工作,若未移开,则保持停在原地。
进一步的,本实施例中,自动充电模块,通过检测电池I/O口来检测电池电量控制与充电刷板的接触器,从而控制充电的通断。运行过程中车载充电电刷与电池断开,只有当AGV到达充电站后AGV上的控制器才会闭合接触器,是车载充电电刷与电池接通,侧面电极板与充电桩连在一起。自动充电模块流程如图6所示,步骤如下:
步骤1:检测AGV当前状态;
步骤2:若为空闲状态,检测AGV电量是否低于50%,若低于50%,则到充电桩充电,若高于50%,则在停止区待命;
步骤3:检测是否充电两小时或者电池电量高于95%,若高于95%,则行驶至停止区待命;若未高于95%,则继续充电;
步骤4:若为工作状态,检测AGV电量是否低于30%,若低于30%,则完成一个周期工作后到充电桩充电;若不低于30%,则继续工作,工作结束后到停止区待命;
步骤5:判断是否充电一小时或电量高于95%,若高于95%,则行驶至停止区待命;若不高于95%,则继续充电。
进一步的,本实施例中运动执行模块用于自动控制叉车的动作,主要由驱动单元和执行单元组成,包括直行、转向、货叉升降等运动控制。其运动控制流程如图6所示。
步骤1:AGV进入待命状态;
步骤2:是否有任务呼叫,若无任务呼叫,则在停止区待命,若有任务呼叫,则判断工位方向;
步骤3:若在起始工位,则为出工位方向,若从左侧出,则先后退慢行,再后退左转,再加速后退;若从右侧出,则先后退慢行,再后退右转,再加速后退。
步骤4:进入目标工位时,若从左侧进入,则先减速慢行,再从后退转到前进,再前进左转;若从右侧进入,则先减速慢行,再从后退转到前进,再前进右转;
步骤5:判断是否到达指定工位,若未到达指定工位,则控制器指令调整;若到达指定工位,则先停车,再执行货叉动作;
步骤6:判断货叉动作是否完成,若货叉未到位,则控制器指令调整;若货叉到位,则进行下一个周期工作。
进一步的,本实施例中,AGV充当***的执行者,完成货物的周转搬运,AGV需要工作在任务管理调度模块的监督下,本***采用wifi无线通讯,任务管理模块与AGV之间构成星型网络连接,主要完成AGV任务的合理分配、AGV行走规划、交通管制等功能,同时还具备监督设备运行状态等功能。***动态调度流程图如下图所示。主要思想是:若为同向冲突,则判断两台AGV之间的车距,若AGV车距小于安全距离,则减速后车或加速前车,若是相向冲突,则判断两台AGV谁先进入到冲入区,当已经有一辆AGV进入到冲突区,则让另一辆AGV在冲突区外停车等待,直到已经进入到冲突区的AGV离开冲突区为止。程序循环运行,即可实现对AGV***的动态调度,具体步骤如下:
步骤1:上位机开始AGV状态监听;
步骤2:上位机发布任务指令;
步骤3:判断该任务在任务队列中的优先级;
步骤4:为任务分配合适的AGV;
步骤5:AGV开始工作,判断当前AGV是否处于冲突区前3米范围内,若不在,则AGV继续以正常速度行驶;
步骤6:若当前AGV处于冲突区前3米范围内,则继续判断冲突类型,判断是否为同向冲突,若为同向冲突,则判断冲突区中两车之间的距离是否小于安全距离,若不小于安全距离,则当前AGV以正常速度行驶,若小于安全距离,则继续判断当前AGV是否在另一辆AGV前方,若在前方,则加速当前AGV,若在后方,则减速当前AGV;
步骤7:若不是同向冲突,则判断是否为相向冲突,若不是相向冲突,则当前AGV以正常速度行驶;若为相向冲突,则判断两辆AGV位置,若当前AGV先进入冲突区且另一台AGV在冲突区前2米内,若在两米内,则急停另一辆AGV;若另一台AGV先于当前AGV进入冲突区且当前AGV在冲突区前两米内,则急停当前AGV;若另一台AGV先于当前AGV进入冲突区且已经离开冲突区,则取消当前AGV急停,否则当前AGV以正常速度行驶。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种激光导航叉车式AGV车载***,其特征在于,包括电动叉车本体,在电动叉车本体上设有车载主控制器,所述的车载控制器与定位导航模块、路径规划模块、安全避障模块、声光报警模块、运动执行模块、自动充电模块、无线通讯模块和任务管理调度模块相连;
其中,所述的定位导航模块,采用激光SLAM方式描述周围环境,并融合IMU、轮式里程计、摄像头传感器信息,完成建图和AGV叉车自身定位。
2.如权利要求1所述的激光导航叉车式AGV车载***,其特征在于,所述的路径规划模块选择关键点作为跳跃点,采用跳跃点判断的方式,以起始点为中心根据规则挑选符合条件的跳点,并以原跳点和新跳点的方向为下一次搜索方向搜索跳点,直至到达终点。
3.如权利要求1所述的激光导航叉车式AGV车载***,其特征在于,所述的安全避障模块包括接触式防护模块和非接触式防护模块两个。
4.如权利要求3所述的激光导航叉车式AGV车载***,其特征在于,所述的接触式防护模块包括安装在车头的保险杠、安装在车尾货叉尖部的避障接触开关和安装在门架上端的限高接触开关。
5.如权利要求3所述的激光导航叉车式AGV车载***,其特征在于,所述的非接触式防护模块包括安装在电动叉车本体车头部的激光避障扫描仪。
6.如权利要求5所述的激光导航叉车式AGV车载***,其特征在于,所述的激光避障扫描仪包括两个,安装在车头两角处,且激光扫描仪的扫描角度为270度。
7.如权利要求1所述的激光导航叉车式AGV车载***,其特征在于,所述的运动执行模块用AGV的行走、转向和货叉抬升下降,采用电液混合驱动方式,货叉抬升采用液压控制。
8.基于权利要求1-7任一所述的激光导航叉车式AGV车载***的控制方法,其特征在于,定位导航模块的建图方法如下:
步骤1:***通过IMU采集速度和加速度信息,通过姿态解算、互补滤波完成对AGV自身姿态的初步估计;
步骤2:通过轮式里程计采集速度信息完成AGV的航迹推算从而进行AGV自身位置估计,融合姿态估计与位置估计完成位姿估计;
步骤3:多线激光雷达采用点云分割匹配技术,基于点云片段和分类出的目标的方法,建立周围环境的点云描述模型,并与估计的位姿进行扫描匹配得到匹配后的位姿;
步骤4:摄像头进行标志位姿和标志尺寸的识别;
步骤5:与激光雷达匹配位姿动态加权得到高精度位姿;
步骤6:输出位姿到中心控制器调整车轮的转速和转角;
步骤7:判断是否到达目标任务点,若到达则导引完成,若未到达,则开始下一个扫描周期。
9.如权利要求8所述的激光导航叉车式AGV车载***的控制方法,其特征在于,所述的路径规划模块对路径进行规划的方法如下:
步骤1:首先根据地图精度划分栅格;
步骤2:将起始点加入开放列表;
步骤3:以起始点为中心向8个方向搜索节点;
步骤4:将满足条件的跳点加入开放列表;
步骤5:寻找开放列表中最小值的栅格点记为X点;
步骤6:判断X是否为目标点,若为目标点,则结束路径搜索,若不是目标点,则将X点从开放列表中删除,将X点加入关闭列表;
步骤7:可向直线方向和斜线方向寻找节点,当两个方向都可以扩展时,优先进行直线方向的扩展,先完成直线方向的扩展再进行对角线方向的扩展;搜索直线方向或对角线方向上的第一个跳点N;
步骤8:将N点在关闭列表中删除;
步骤9:判断N点是否在开放列表中,若不在,则将N点加入开放列表,若在,则更新N点在开放列表中的值,再进行下一轮搜索;
步骤10:当搜索完成后,遍历关闭列表中的节点,将所有的节点依次连在一起,便得到最终路径。根据最终生成的路径,运用导航框架,输出速度信息,可实现AGV的运动控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110301652.9A CN112947475A (zh) | 2021-03-22 | 2021-03-22 | 一种激光导航叉车式agv车载***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110301652.9A CN112947475A (zh) | 2021-03-22 | 2021-03-22 | 一种激光导航叉车式agv车载***及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112947475A true CN112947475A (zh) | 2021-06-11 |
Family
ID=76227491
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110301652.9A Pending CN112947475A (zh) | 2021-03-22 | 2021-03-22 | 一种激光导航叉车式agv车载***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947475A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113447950A (zh) * | 2021-06-30 | 2021-09-28 | 湖南牛顺科技有限公司 | Agv定位导航***及方法 |
CN113963562A (zh) * | 2021-12-21 | 2022-01-21 | 北京慧拓无限科技有限公司 | 作业区多车辆的避让方法以及装置 |
CN115129068A (zh) * | 2022-08-26 | 2022-09-30 | 济宁龙纳智能科技有限公司 | 一种基于agv叉车的智能定位导航*** |
CN116757350A (zh) * | 2023-08-11 | 2023-09-15 | 稳石机器人(深圳)有限公司 | 一种无人叉车集群调度处理*** |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607635A (zh) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制***及全向自动导引车 |
CN109115226A (zh) * | 2018-09-01 | 2019-01-01 | 哈尔滨工程大学 | 基于跳点搜索的多机器人冲突避免的路径规划方法 |
CN209161405U (zh) * | 2018-10-23 | 2019-07-26 | 安徽合派电动科技有限公司 | 一种slam导航agv叉车 |
CN110108269A (zh) * | 2019-05-20 | 2019-08-09 | 电子科技大学 | 基于多传感器数据融合的agv定位方法 |
CN110319837A (zh) * | 2019-07-09 | 2019-10-11 | 北方工业大学 | 一种服务机器人室内复杂状况路径规划方法 |
CN111309000A (zh) * | 2019-11-05 | 2020-06-19 | 华中科技大学 | 一种基于双控制板的agv***及路径规划方法 |
CN112066989A (zh) * | 2020-08-19 | 2020-12-11 | 合肥工业大学 | 基于激光slam的室内agv自动导航***及导航方法 |
-
2021
- 2021-03-22 CN CN202110301652.9A patent/CN112947475A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607635A (zh) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制***及全向自动导引车 |
CN109115226A (zh) * | 2018-09-01 | 2019-01-01 | 哈尔滨工程大学 | 基于跳点搜索的多机器人冲突避免的路径规划方法 |
CN209161405U (zh) * | 2018-10-23 | 2019-07-26 | 安徽合派电动科技有限公司 | 一种slam导航agv叉车 |
CN110108269A (zh) * | 2019-05-20 | 2019-08-09 | 电子科技大学 | 基于多传感器数据融合的agv定位方法 |
CN110319837A (zh) * | 2019-07-09 | 2019-10-11 | 北方工业大学 | 一种服务机器人室内复杂状况路径规划方法 |
CN111309000A (zh) * | 2019-11-05 | 2020-06-19 | 华中科技大学 | 一种基于双控制板的agv***及路径规划方法 |
CN112066989A (zh) * | 2020-08-19 | 2020-12-11 | 合肥工业大学 | 基于激光slam的室内agv自动导航***及导航方法 |
Non-Patent Citations (4)
Title |
---|
王晓博: "多AGV路径规划及调度控制策略研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
王璐欢: "《工业互联网与机器人技术应用初级教程》", 30 June 2020 * |
胡杰杰: "面向制造车间柔性物流的AGV群控***研制", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
邱磊: "利用跳点搜索算法加速A*寻路", 《兰州大学学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113447950A (zh) * | 2021-06-30 | 2021-09-28 | 湖南牛顺科技有限公司 | Agv定位导航***及方法 |
CN113963562A (zh) * | 2021-12-21 | 2022-01-21 | 北京慧拓无限科技有限公司 | 作业区多车辆的避让方法以及装置 |
CN115129068A (zh) * | 2022-08-26 | 2022-09-30 | 济宁龙纳智能科技有限公司 | 一种基于agv叉车的智能定位导航*** |
CN115129068B (zh) * | 2022-08-26 | 2022-12-16 | 济宁龙纳智能科技有限公司 | 一种基于agv叉车的智能定位导航*** |
CN116757350A (zh) * | 2023-08-11 | 2023-09-15 | 稳石机器人(深圳)有限公司 | 一种无人叉车集群调度处理*** |
CN116757350B (zh) * | 2023-08-11 | 2024-04-26 | 稳石机器人(深圳)有限公司 | 一种无人叉车集群调度处理*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112947475A (zh) | 一种激光导航叉车式agv车载***及方法 | |
JP7236749B2 (ja) | 環境アクティブセンシングタイプの駐車場自動駐車システム | |
US20200307648A1 (en) | Parking lot management device, parking lot management method, and storage medium | |
JP6898394B2 (ja) | 車両の自動運転制御補助方法、車両の自動運転制御補助装置、機器、コンピュータ読み取り可能な記憶媒体及び車路連携システム | |
CN113485319A (zh) | 基于5g车路协同的自动驾驶*** | |
Chong et al. | Autonomous personal vehicle for the first-and last-mile transportation services | |
CN109403690A (zh) | 自动车辆搬运与转移的方法、***及应用 | |
CN109952603B (zh) | 用于运行商用车的***和方法 | |
CN112875578B (zh) | 一种无人叉车控制*** | |
CN112875577A (zh) | 一种基于amr及agv叉车的智慧仓储管理控制*** | |
EP3798577A1 (en) | Method and apparatus for determining turn-round path of vehicle, device and medium | |
CN111309000B (zh) | 一种基于双控制板的agv***及路径规划方法 | |
CN112429016B (zh) | 一种自动驾驶控制方法及装置 | |
JP2020106525A (ja) | 自律車両ルートプランニング | |
CN112875576A (zh) | 一种自动驾驶叉车*** | |
CN112684791A (zh) | 一种基于5g的无人驾驶物流车 | |
CN112810628A (zh) | 车辆控制*** | |
CN115129050A (zh) | 一种港口牵引车无人运输短倒***及方法 | |
CN113196358A (zh) | 自动驾驶行驶路径所需的信号灯体系分析*** | |
CN215793717U (zh) | 四轮无人驾驶纯电动摆渡车 | |
CN116166029A (zh) | 一种兼容局部避障功能的多agv导航方法及*** | |
CN113022552B (zh) | 基于激光雷达和v2i技术的自动泊车***及控制方法 | |
US11364953B2 (en) | Vehicle control system | |
CN111857132B (zh) | 一种中央控制式自动驾驶方法、***以及中央控制*** | |
CN113485368A (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 |