CN107102641A - 一种基于激光引导双轮差速agv的原地偏航旋转方法 - Google Patents
一种基于激光引导双轮差速agv的原地偏航旋转方法 Download PDFInfo
- Publication number
- CN107102641A CN107102641A CN201710350910.6A CN201710350910A CN107102641A CN 107102641 A CN107102641 A CN 107102641A CN 201710350910 A CN201710350910 A CN 201710350910A CN 107102641 A CN107102641 A CN 107102641A
- Authority
- CN
- China
- Prior art keywords
- agv
- mrow
- msub
- angle
- original place
- 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
- 238000009987 spinning Methods 0.000 title claims abstract description 19
- 238000000034 method Methods 0.000 claims abstract description 55
- 238000004891 communication Methods 0.000 claims abstract description 19
- 230000005540 biological transmission Effects 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 6
- 230000009467 reduction Effects 0.000 claims description 6
- 239000007943 implant Substances 0.000 claims description 4
- 238000012544 monitoring process Methods 0.000 claims description 4
- 230000009183 running Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000002068 genetic effect Effects 0.000 claims description 3
- 238000011022 operating instruction Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 2
- 238000011065 in-situ storage Methods 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- RTZKZFJDLAIYFH-UHFFFAOYSA-N Diethyl ether Chemical compound CCOCC RTZKZFJDLAIYFH-UHFFFAOYSA-N 0.000 description 2
- 230000005611 electricity Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
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
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于激光引导双轮差速AGV的原地偏航旋转方法,通过激光扫描仪不断获取AGV小车的实时位姿,并通过中间读写程序传递给PLC执行程序,同时上位机将目标点的坐标信息通过无线网络通讯给车载控制系统。当AGV在某一点完成任务后需要向下一目标点行进时,则要通过本发明提供的原地偏航旋转方法结合AGV实时位姿和目标点坐标信息到达期待航向,才可以继续行进。此方法创新地将旋转方向问题进行了‘格式化’,涵盖了各种旋转情况,排除了特殊情况带来的不稳定影响。同时设置了相应的减速点,以确保AGV实际朝向到达期待航向时的精度。此方法适用于一般情况或者空间受限程度较小的情况,实用简洁、切实可行。
Description
技术领域
本发明属于移动机器人自动导航技术领域,尤其涉及一种基于激光引导双轮差速AGV的原地偏航旋转方法。
背景技术
AGV(Automated Guided Vehicle)即“自动导引车”,也称移动机器人,是一种以电能作为动力,通过电磁或光学等非接触式自动导引装置,在无人操控的情况下沿着预定路径行驶到指定的地点,实现自动移载、搬运等功能的运输小车。AGV小车的激光导引方式始于90年代初期,不需要对地面进行任何处理,在AGV小车的行走区域安装位置精确的激光反射板,AGV通过激光扫描仪发射激光并采集由不同角度的反射板反射回来的激光光束,利用其内置定位算法,确定当前小车的位置和方向,并通过连续定位算法实现AGV的导引。激光导引方式的最大优点就是AGV定位精确,柔性好,不需要对地面进行任何处理,路径变换灵活多变,适用于各种现场环境,能够方便快捷的修改运动参数及行驶路径,是当前国际上最先进的导引方式。
我国AGV的应用和研发起步较晚,如今的国内企业中,昆明昆船、北京机科、合肥柯金、怡丰、艾吉威等一批企业近两年都纷纷推出AGV叉车系列,尤其是艾吉威自主研发出无激光反射板的激光引导叉车,开创了AGV行业的新领域。但AGV的核心车载控制系统技术几乎仍由国外公司拥有,激光引导双轮差速AGV的原地偏航旋转方法是其中不可或缺的一个环节。那么如何控制AGV小车的旋转,按照符合实际的方向进行旋转,是实际应用中必须要解决的关键问题。通过查阅论文与专利,在运动规划上常见的路径规划方法有遗传算法、人工势场法、PRM法、Dubins路径规划方法等。
此类规划路径的方法一般都是基于全局的,其侧重点在算法的设计及其鲁棒性的检验上,并不考虑对象的轮廓及其运动特性,无法保证路径的真实可行性。多数工厂的空间受限,若将小车抽象成质点,不能反映出轮廓与环境的信息,因此上述的方法并不合适。
发明内容
为了克服上述现有技术存在的不足,本发明的目的在于提出一种基于激光引导双轮差速AGV的原地偏航旋转方法,该方法适用于一般情况或者空间受限程度较小的情况,结合AGV小车的全方位运动特性,方案实用简洁、切实可行。
为了达到上述目的,本发明所采用的技术方案是:一种基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,所述方法包括如下步骤:
步骤1,AGV车载控制系统通过无线网络与上位机控制系统进行通讯,接收到路径信息;
步骤2,激光引导AGV通过激光扫描仪得到小车的位姿信息(x0,y0,θ0),其中小车当前航向角在0~360°并与车载控制系统进行数据交换;
步骤3,利用AGV位姿信息和目标点得到通过该两点的直线与X轴正方向之间的较小夹角,再通过计算使夹角在0~360°之间;
步骤4,通过AGV小车当前航向角度值与目标点期待航向角度值进行比较,得到理论偏差,同时遵循能量最小原理,运用相应算法,得到使小车往角度较小方向旋转,即小车理应原地偏航旋转到达期待航向的度数;
步骤5,基于双轮差速AGV的原地偏航旋转,设置相应的减速点,当车轮到达减速点时,车速开始降低,停止时,AGV小车到达期待航向,允许小范围的误差。
进一步地,步骤1中,所述上位机控制系统同时使用两种方法通过无线网络发送作业任务指令以及路径运行指令,再由AGV通过主控制器软件中的任务功能模块处理成为车载控制系统的执行指令,同时主控制器反馈模块将AGV运行过程中的实时信息反馈回上位机控制系统,方法具体包括:
AGV的行走路径由上位机控制系统的路径规划软件运用高适应度值遗传算法确定,最优路径确定后,同时使用两种方法传输路径信息,第一种为实时下发路径,上位机通过无线网络实时传输下一段AGV需要行走的路径信息,并实时监控AGV当前位置;第二种方法为一次性下发当前作业所有路径,上位机路径规划软件根据当前作业任务确定该任务所有路径并一次性下发完毕。
进一步地,AGV的主控制器为基于嵌入式操作系统的IPC控制器,在该操作系统下运行符合国际标准IEC 61131-3软PLC,方法在该软PLC中实现。
进一步地,步骤2中,激光引导AGV通过激光扫描仪得到小车的位姿信息,该信息通过以太网传送给车载主控制器中嵌入式操作系统的应用程序,并使用ADS通讯协议实现应用程序与软PLC中数据交换,方法具体包括:
在AGV运行区域内按照要求安装一定数量的激光反射板,并事先将这些反射板的绝对坐标信息保存在激光扫描仪内,将激光扫描仪水平安装在AGV的顶部,与反射板在同一水平面内,并以固定的转速旋转360°并通过脉冲激光器持续向外发射激光束,同时接收不少于三个反射板反射回来的激光束,激光扫描仪就能通过探测到的反射板的数量并与存入的反射板信息进行比较,得出此时AGV在绝对坐标系中的位姿(x0,y0,θ0),其中0≤θ0≤360°;激光扫描仪的位姿信息通过以太网传送给主控制器,使用ADS通信协议完成与软PLC的数据交换,将读写程序的可执行文件植入操作系统中。
进一步地,步骤3中,利用AGV位姿信息和目标点得到通过该两点的直线与X轴正方向之间的较小夹角,再通过计算使夹角在0~360°之间,具体实现方法包括:
步骤3.1,已知AGV小车的绝对坐标A(x0,y0),目标点坐标B(x,y),则可得矢量
步骤3.2,反向延长可得直线AB,其与X轴之间的夹角θ′计算可得:
步骤3.3,将夹角θ′限定在0~360°之间,即X轴正方向逆时针旋转到矢量的期待航向角度θ,
当x>x0,y≥y0时θ=θ′;
当x<x0,y≥y0时θ=θ′+180°;
当x<x0,y<y0时θ=|θ′|+180°;
当x>x0,y<y0时θ=360°-|θ′|。
进一步地,步骤4中,通过AGV小车实际朝向角度值θ0与目标点期待航向角度值θ进行比较,得到理论偏差Δθ,同时遵循能量最小原理,运用相应算法,得到使小车往角度较小方向旋转,即小车理应原地偏航旋转到达期待航向的度数Δθ′,具体实现方法包括:
步骤4.1,得出理论偏差Δθ:
Δθ=θ0-θ;
步骤4.2,遵循能量最小原理,求出AGV小车理应转过的角度Δθ′:
当Δθ<-180°时Δθ′=Δθ+360°;
当Δθ>180°时Δθ′=Δθ-360°;
当-180≤Δθ≤180°时Δθ′=Δθ;
将此换算过程称为“格式化”,即将差值Δθ′以0作为分割点,可快速确定AGV小车原地旋转的方向:当Δθ′≥0时,控制AGV小车原地顺时针旋转;当Δθ′<0时,控制AGV小车原地逆时针旋转。
进一步地,步骤5中,AGV小车在原地偏航旋转,并设置相应的减速点,当车轮到达减速点时,车速开始降低,停止时,AGV小车到达期待航向,具体实现方法包括:
Δθ2=ωt2 (5)
Δθ3=Δθ1+Δθ2 (6)
联立公式(1)~公式(6),可得减速点的位置:
以AGV两个驱动轮连线中点为圆心原地旋转,以上公式中,ω为匀速旋转时的角速度,v为匀速旋转时车轮的速度,D为两个驱动轮连线之间的距离,ωt为减速末角速度,vt为减速末车轮的速度,a为匀减速旋转时的加速度,t1为减速过程所用的时间,t2为系统反应时间,Δθ1为减速转过的角度,Δθ2为系统反应时间内转过的角度,Δθ3为从减速点到减速完成转过的角度。
本发明的出发点即是考虑到空间受限或特定轨迹的实现,体现出了AGV全方位移动的优势。当然,本发明适用于空间受限程度较小的情况,当遇到极其受限时,则需要考虑到周围环境、障碍物等情况,本发明不做阐述。
与现有技术相比,本发明的有益效果是:本发明的方法创新地将旋转方向问题进行了‘格式化’,涵盖了各种旋转情况,排除了特殊情况带来的不稳定影响。同时设置了相应的减速点,以确保AGV实际朝向到达期待航向时的精度。此方法适用于一般情况或者空间受限程度较小的情况,实用简洁、切实可行。本发明具有如下优点:
1、本发明创新地将特殊方向角转化为普通情况下的方向角,涵盖了各种旋转情况,排除了特殊情况带来的不稳定影响。
2、本发明优化了自旋方向选择的算法问题,始终往AGV小车实际航向与期待航向的较小夹角方向运行,节省能耗。
3、本发明设置了相应的减速点,使AGV小车自旋时提前减速,减小超调,提高了停止时方向定位的精度。
4、本发明应用普遍,即可广泛应用于一般工作空间,也适用于相对狭窄的工作空间,极具实用性。
5、本发明AGV的行走路径由上位机控制系统同时使用两种方法下发,第一种为实时下发路径,上位机通过无线网络实时传输下一段AGV需要行走的路径信息,并实时监控AGV当前位置,第二种方法为一次性下发当前作业所有路径,上位机路径规划软件根据当前作业任务确定该任务所有路径并一次性下发完毕,该种方式可以避免无线网络出现通讯问题时无法完成作业任务。第二种方法为第一种方法备份。本发明同时使用这两种方式进行路径信息传输,增加了信息的冗余性,提高了系统的可靠性。
6、本发明AGV所使用的主控制器为基于嵌入式操作系统的IPC控制器,在该操作系统下运行符合国际标准IEC 61131-3软PLC,应用程序和PLC(内核模式驱动)之间的切换发生在固定期限内,保证了PLC任务的实时性,本发明在该软PLC中实现。
附图说明
图1为本发明实施例提供的激光引导双轮差速AGV原理示意图。
图2为本发明实施例提供的激光引导双轮差速AGV车底车轮结构分布示意图。
图3为本发明实施例提供的控制系统结构示意图。
图4为本发明所述算法中各个角度之间的关系。
图5本发明实施案例中设置的相应减速点示意图。
具体实施方式
为了便于本领域普通技术人员理解和实施本发明,下面结合实施例对本发明作进一步的详细描述,应当理解,此处所描述的实施示例仅用于说明和解释本发明,并不用于限定本发明。
如图1所示,本发明提供一种基于激光引导双轮差速AGV的原地偏航旋转方法,通过激光扫描仪不断获取AGV小车的实时位姿,并通过中间读写程序传递给PLC执行程序,同时上位机将目标点的坐标信息通过无线网络通讯给车载控制系统。当AGV在某一点完成任务后需要向下一目标点行进时,则要通过本发明提供的原地偏航旋转方法结合AGV实时位姿和目标点坐标信息到达期待航向,才可以继续行进。
图2为本发明实施例的双轮差速AGV车底车轮结构分布示意图,若要实现车体原地旋转功能,只需使两个驱动轮的转速大小相等、方向相反即可。
图3示出了本发明实施例完成激光引导双轮差速AGV的原地偏航旋转方法的控制系统结构以及各单元之间遵循的通讯协议示意图。该方法包括:
步骤1,AGV车载控制系统通过无线局域网与上位机进行通讯,接收到目标点的坐标信息;
步骤2,激光引导AGV通过激光扫描仪得到小车的位姿信息,其中小车当前航向在0~360°并与车载控制系统进行数据交换;
步骤3,利用AGV位姿信息和目标点得到通过该两点的直线与X轴正方向之间的较小夹角,再通过计算使夹角在0~360°之间;
步骤4,通过AGV小车当前航向角度值与目标点期待航向角度值进行比较,得到理论偏差,同时遵循能量最小原理,运用相应算法,得到使小车往角度较小方向旋转,即小车理应原地偏航旋转到达期待航向的度数;
步骤5,基于双轮差速AGV的原地偏航旋转,设置相应的减速点,当车轮到达减速点时,车速开始降低,停止时,AGV小车到达期待航向,允许小范围的误差。
在步骤1中,上位机控制系统同时使用两种方法通过无线网络发送作业任务指令以及路径运行指令,AGV通过主控制器软件中的任务功能模块处理成为车载控制系统的执行指令,同时主控制器反馈模块将AGV运行过程中的实时信息反馈回上位机控制系统,该方法包括:
本发明AGV的行走路径由上位机路径规划软件运用相关最优算法确定,最优路径确定后,同时使用两种方法传输路径信息,第一种为实时下发路径,上位机通过无线网络实时传输下一段AGV需要行走的路径信息,并实时监控AGV当前位置,第二种方法为一次性下发当前作业所有路径,上位机路径规划软件根据当前作业任务确定该任务所有路径并一次性下发完毕,该种方式可以避免无线网络出现通讯问题时无法完成作业任务。第二种方法为第一种方法备份。本发明同时使用这两种方式进行路径信息传输,增加了信息的冗余性,提高了系统的可靠性。
在本实施例中,所述的主控制器为基于嵌入式操作系统的IPC控制器。
在步骤2中,激光引导AGV通过激光扫描仪得到小车的位姿信息,该信息通过以太网传送给车载主控制器中嵌入式操作系统的应用程序,并使用ADS(自动化设备规范)通讯协议实现应用程序与软PLC中数据交换,该方法包括:
在AGV运行区域内按照要求安装一定数量的激光反射板,并事先将这些反射板的绝对坐标信息保存在激光扫描仪内。将激光扫描仪水平安装在AGV的顶部,与反射板在同一水平面内,并以固定的转速旋转360°并通过脉冲激光器持续向外发射激光束,同时接收不少于三个反射板反射回来的激光束,激光扫描仪就能通过探测到的反射板的数量并与存入的反射板信息进行比较,得出此时AGV在绝对坐标系中的位姿(x0,y0,θ0),其中0≤θ0≤360°。激光扫描仪的位姿信息通过以太网传送给主控制器,使用socket套接字建立通讯连接,但该数据无法直接写入PLC程序,需要编写读写程序使用ADS通信协议完成与软PLC的数据交换,本发明将读写程序的可执行文件植入操作系统中,当程序运行时,通过ADS通讯协议与PLC程序进行数据交换。其中,ADS是一种自动化设备规范,用于控制器设备之间的非周期性通讯,既可用于控制器内部的设备通讯,也可以用于控制器之间的设备通讯。本发明用于控制器内部的设备通讯。ADS通讯是基于TCP/IP之上的应用协议,所以当它用于控制器之间的设备通讯时,需要保证控制器之间的TCP/IP通讯正常,支持有线连接和无线连接。ADS通讯的机制是Server/Client机制。作为ADS Server不需要任何ADS通讯方面的编程。Server能够对协议约定的ADS请求作出响应。所有通讯方面的编程工作都在Client端,且Client必须按照Server约定的规则,才能得到正确的响应。本发明读写程序作为Client端,PLC程序作为Server端。
本发明可将读写应用程序的可执行文件植入操作系统中,上位机通过无线通讯向车载控制系统发送目标点信息(x,y),并由读写程序接收。同时激光头旋转360°不断向四周发射激光束并采集由不同角度的反射板反射回来的激光束,利用其内置定位算法,确定当前小车的位置和方向,即位姿(x0,y0,θ0),且中间程序通过Socket通讯协议不断读取激光扫描仪里的小车位姿信息。与此同时,中间程序与PLC程序通过ADS通讯协议进行数据交换。PLC程序收到所需信息之后通过算法进行向目标点原地偏航旋转,以使达到期待航向。图4示出了各个角度之间的关系。在本发明具体实施案例中,AGV小车按照规定轨迹到达终点后,即将往下一目标点行进,则需先通过以下算法到达期待航向,具体算法步骤如下:
步骤一,得到小车所在位置与目标点连线,与X轴正方向之间的夹角θ′:
步骤二,将夹角θ′限定在0~360°之间,得到期待航向角度θ:
当x>x0,y≥y0时θ=θ′;
当x<x0,y≥y0时θ=θ′+180°;
当x<x0,y<y0时θ=|θ′|+180°;
当x>x0,y<y0时θ=360°-|θ′|。
步骤三,通过AGV小车实际朝向角度值θ0与目标点期待航向角度值θ进行比较,得到理论偏差Δθ,并遵循能量最小原理,求出AGV小车理应转过的角度Δθ′:
Δθ=θ0-θ;
当Δθ<-180°时Δθ′=Δθ+360°;
当Δθ>180°时Δθ′=Δθ-360°;
当-180≤Δθ≤180°时Δθ′=Δθ。
将此换算过程称为“格式化”,即将差值Δθ′以0作为分割点,可快速确定AGV小车原地旋转的方向:当Δθ′≥0时,控制AGV小车原地顺时针旋转;当Δθ′<0时,控制AGV小车原地逆时针旋转。
步骤四,通过步骤三将差值Δθ′以0作为分割点,快速确定AGV小车原地旋转的方向:当Δθ′≥0时,控制AGV小车原地顺时针旋转;当Δθ′<0时,控制AGV小车原地逆时针旋转。嵌入式控制器包含CAN通讯模块,与驱动器通过CAN总线进行通讯,发送驱动报文,当左轮向前运行,右轮向后运行,且大小相等时,可实现顺时针旋转,反之实现逆时针旋转。在本实施案例中,在即将到达期待航向前,需设置减速点,以使车轮停止旋转时刚好到达期待航向,允许小范围误差,图5示出了AGV小车原地旋转时,到达相应减速点的一般情况。
步骤五,设置相应的减速点,当车轮到达减速点时,车速开始降低,停止时,AGV小车到达期待航向,允许小范围的误差:
Δθ2=ωt2 (5)
Δθ3=Δθ1+Δθ2 (6)
联立公式(1)~公式(6)可得减速点的位置:
本发明以AGV两个驱动轮连线中点为圆心原地旋转。以上公式中,ω为匀速旋转时的角速度,v为匀速旋转时车轮的速度,D为两个驱动轮连线之间的距离,ωt为减速末角速度,vt为减速末车轮的速度,a为匀减速旋转时的加速度,t1为减速过程所用的时间,t2为系统反应时间,Δθ1为减速转过的角度,Δθ2为系统反应时间内转过的角度,Δθ3为从减速点到减速完成转过的角度。
至此,整个基于激光引导双轮差速AGV的原地偏航旋转方法已经完成,当AGV小车的实际朝向到达期待航向之后,上位机即通过WLAN向AGV车载控制系统发送向目标点行进的指令。
综上所述,本发明实施例所述的一种基于激光引导双轮差速AGV的原地偏航旋转方法,结合AGV小车的全方位运动特性,此方法适用于一般情况或者空间受限程度较小的情况,方案将一般情况、特殊情况统一融合,实用简洁、切实可行。
应当理解的是,本说明书未详细阐述的部分均属于现有技术。
应当理解的是,上述针对较佳实施例的描述较为详细,并不能因此而认为是对本发明专利保护范围的限制,本领域的普通技术人员在本发明的启示下,在不脱离本发明权利要求所保护的范围情况下,还可以做出替换或变形,均落入本发明的保护范围之内,本发明的请求保护范围应以所附权利要求为准。
Claims (7)
1.一种基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,所述方法包括如下步骤:
步骤1,AGV车载控制系统通过无线网络与上位机控制系统进行通讯,接收到路径信息;
步骤2,激光引导AGV通过激光扫描仪得到小车的位姿信息(x0,y0,θ0),其中小车当前航向角在0~360°并与车载控制系统进行数据交换;
步骤3,利用AGV位姿信息和目标点得到通过该两点的直线与X轴正方向之间的较小夹角,再通过计算使夹角在0~360°之间;
步骤4,通过AGV小车当前航向角度值与目标点期待航向角度值进行比较,得到理论偏差,同时遵循能量最小原理,运用相应算法,得到使小车往角度较小方向旋转,即小车理应原地偏航旋转到达期待航向的度数;
步骤5,基于双轮差速AGV的原地偏航旋转,设置相应的减速点,当车轮到达减速点时,车速开始降低,停止时,AGV小车到达期待航向,允许小范围的误差。
2.如权利要求1所述的基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,步骤1中,所述上位机控制系统同时使用两种方法通过无线网络发送作业任务指令以及路径运行指令,再由AGV通过主控制器软件中的任务功能模块处理成为车载控制系统的执行指令,同时主控制器反馈模块将AGV运行过程中的实时信息反馈回上位机控制系统,方法具体包括:
AGV的行走路径由上位机控制系统的路径规划软件运用高适应度值遗传算法确定,最优路径确定后,同时使用两种方法传输路径信息,第一种为实时下发路径,上位机通过无线网络实时传输下一段AGV需要行走的路径信息,并实时监控AGV当前位置;第二种方法为一次性下发当前作业所有路径,上位机路径规划软件根据当前作业任务确定该任务所有路径并一次性下发完毕。
3.如权利要求1所述的基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,AGV的主控制器为基于嵌入式操作系统的IPC控制器,在该操作系统下运行符合国际标准IEC 61131-3软PLC,方法在该软PLC中实现。
4.如权利要求3所述的基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,步骤2中,激光引导AGV通过激光扫描仪得到小车的位姿信息,该信息通过以太网传送给车载主控制器中嵌入式操作系统的应用程序,并使用ADS通讯协议实现应用程序与软PLC中数据交换,方法具体包括:
在AGV运行区域内按照要求安装一定数量的激光反射板,并事先将这些反射板的绝对坐标信息保存在激光扫描仪内,将激光扫描仪水平安装在AGV的顶部,与反射板在同一水平面内,并以固定的转速旋转360°并通过脉冲激光器持续向外发射激光束,同时接收不少于三个反射板反射回来的激光束,激光扫描仪就能通过探测到的反射板的数量并与存入的反射板信息进行比较,得出此时AGV在绝对坐标系中的位姿(x0,y0,θ0),其中0≤θ0≤360°;激光扫描仪的位姿信息通过以太网传送给主控制器,使用ADS通信协议完成与软PLC的数据交换,将读写程序的可执行文件植入操作系统中。
5.如权利要求1至4任一项所述的基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,步骤3中,利用AGV位姿信息和目标点得到通过该两点的直线与X轴正方向之间的较小夹角,再通过计算使夹角在0~360°之间,具体实现方法包括:
步骤3.1,已知AGV小车的绝对坐标A(x0,y0),目标点坐标B(x,y),则可得矢量
步骤3.2,反向延长可得直线AB,其与X轴之间的夹角θ′计算可得:
步骤3.3,将夹角θ′限定在0~360°之间,即X轴正方向逆时针旋转到矢量的期待航向角度θ,
当x>x0,y≥y0时θ=θ′;
当x<x0,y≥y0时θ=θ′+180°;
当x<x0,y<y0时θ=|θ′|+180°;
当x>x0,y<y0时θ=360°-|θ′|。
6.如权利要求1至5任一项所述的基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,步骤4中,通过AGV小车实际朝向角度值θ0与目标点期待航向角度值θ进行比较,得到理论偏差Δθ,同时遵循能量最小原理,运用相应算法,得到使小车往角度较小方向旋转,即小车理应原地偏航旋转到达期待航向的度数Δθ′,具体实现方法包括:
步骤4.1,得出理论偏差Δθ:
Δθ=θ0-θ;
步骤4.2,遵循能量最小原理,求出AGV小车理应转过的角度Δθ′:
当Δθ<-180°时Δθ′=Δθ+360°;
当Δθ>180°时Δθ′=Δθ-360°;
当-180≤Δθ≤180°时Δθ′=Δθ;
将此换算过程称为“格式化”,即将差值Δθ′以0作为分割点,可快速确定AGV小车原地旋转的方向:当Δθ′≥0时,控制AGV小车原地顺时针旋转;当Δθ′<0时,控制AGV小车原地逆时针旋转。
7.如权利要求1至6任一项所述的基于激光引导双轮差速AGV的原地偏航旋转方法,其特征在于,步骤5中,AGV小车在原地偏航旋转,并设置相应的减速点,当车轮到达减速点时,车速开始降低,停止时,AGV小车到达期待航向,具体实现方法包括:
<mrow>
<mi>&omega;</mi>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>v</mi>
</mrow>
<mi>D</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>v</mi>
<mi>t</mi>
</msub>
</mrow>
<mi>D</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>a</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>&omega;</mi>
</mrow>
<msub>
<mi>t</mi>
<mn>1</mn>
</msub>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&Delta;&theta;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>&omega;t</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<msub>
<mi>at</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
Δθ2=ωt2 (5)
Δθ3=Δθ1+Δθ2 (6)
联立公式(1)~公式(6),可得减速点的位置:
<mrow>
<msub>
<mi>&Delta;&theta;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>t</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mi>&omega;</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
以AGV两个驱动轮连线中点为圆心原地旋转,以上公式中,ω为匀速旋转时的角速度,v为匀速旋转时车轮的速度,D为两个驱动轮连线之间的距离,ωt为减速末角速度,vt为减速末车轮的速度,a为匀减速旋转时的加速度,t1为减速过程所用的时间,t2为系统反应时间,Δθ1为减速转过的角度,Δθ2为系统反应时间内转过的角度,Δθ3为从减速点到减速完成转过的角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710350910.6A CN107102641B (zh) | 2017-05-18 | 2017-05-18 | 一种基于激光引导双轮差速agv的原地偏航旋转方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710350910.6A CN107102641B (zh) | 2017-05-18 | 2017-05-18 | 一种基于激光引导双轮差速agv的原地偏航旋转方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107102641A true CN107102641A (zh) | 2017-08-29 |
CN107102641B CN107102641B (zh) | 2020-08-07 |
Family
ID=59669823
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710350910.6A Expired - Fee Related CN107102641B (zh) | 2017-05-18 | 2017-05-18 | 一种基于激光引导双轮差速agv的原地偏航旋转方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107102641B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107544512A (zh) * | 2017-09-30 | 2018-01-05 | 江西洪都航空工业集团有限责任公司 | 一种用于智能四轮小车的差速转弯控制器 |
CN107817803A (zh) * | 2017-11-14 | 2018-03-20 | 上海诺力智能科技有限公司 | 一种适用于agv的二次精确定位的控制系统及其控制方法 |
CN108152827A (zh) * | 2017-09-28 | 2018-06-12 | 北京卫星制造厂 | 一种基于激光测距的全向智能移动装备定位与导航方法 |
CN108489479A (zh) * | 2017-12-29 | 2018-09-04 | 合肥中导机器人科技有限公司 | 激光导航精确定位方法、机器人导航方法及激光导航系统 |
CN109144078A (zh) * | 2018-11-13 | 2019-01-04 | 楚天智能机器人(长沙)有限公司 | 一种基于二维码导航共线双舵轮agv路线纠偏方法及系统 |
CN109345697A (zh) * | 2018-08-31 | 2019-02-15 | 成都越凡创新科技有限公司 | 售卖机自动回充导航方法 |
CN109901581A (zh) * | 2019-03-15 | 2019-06-18 | 智久(厦门)机器人科技有限公司上海分公司 | 一种agv车自旋角的标定方法及自旋运动控制方法 |
CN110118571A (zh) * | 2019-04-19 | 2019-08-13 | 芜湖智久机器人有限公司 | 一种获取移动设备上的激光传感器的安装角度误差的方法 |
CN110837257A (zh) * | 2019-11-19 | 2020-02-25 | 北京卫星制造厂有限公司 | 一种基于iGPS与视觉的AGV复合定位导航系统 |
CN111596657A (zh) * | 2020-05-09 | 2020-08-28 | 浙江工业大学 | 一种agv及其轨道运动方法 |
CN111722202A (zh) * | 2020-08-05 | 2020-09-29 | 湖北工业大学 | 一种基于回波强度的反光板位置拟合方法及系统 |
WO2022121459A1 (zh) * | 2020-12-07 | 2022-06-16 | 兰剑智能科技股份有限公司 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4772832A (en) * | 1986-07-11 | 1988-09-20 | Tsubakimoto Chain Co. | Guiding method for autonomous traveling vehicle |
CN1546336A (zh) * | 2003-12-03 | 2004-11-17 | 云南昆船设计研究院 | 光学制导式自动导引车导引装置 |
CN104750115A (zh) * | 2015-04-09 | 2015-07-01 | 北京科技大学 | 一种移动设备的激光主动式导航系统及导航方法 |
CN105892459A (zh) * | 2016-04-01 | 2016-08-24 | 清华大学 | 一种非时间参考的差速驱动机器人定点跟踪控制方法 |
CN106444762A (zh) * | 2016-10-18 | 2017-02-22 | 北京京东尚科信息技术有限公司 | 自动引导运输车agv 及运动控制方法和装置 |
CN106647741A (zh) * | 2016-11-16 | 2017-05-10 | 浙江工业大学 | 基于激光导航的全方位运动机构控制系统 |
CN106681317A (zh) * | 2016-11-27 | 2017-05-17 | 北京特种机械研究所 | Agv全向导航行驶方法 |
-
2017
- 2017-05-18 CN CN201710350910.6A patent/CN107102641B/zh not_active Expired - Fee Related
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4772832A (en) * | 1986-07-11 | 1988-09-20 | Tsubakimoto Chain Co. | Guiding method for autonomous traveling vehicle |
CN1546336A (zh) * | 2003-12-03 | 2004-11-17 | 云南昆船设计研究院 | 光学制导式自动导引车导引装置 |
CN104750115A (zh) * | 2015-04-09 | 2015-07-01 | 北京科技大学 | 一种移动设备的激光主动式导航系统及导航方法 |
CN105892459A (zh) * | 2016-04-01 | 2016-08-24 | 清华大学 | 一种非时间参考的差速驱动机器人定点跟踪控制方法 |
CN106444762A (zh) * | 2016-10-18 | 2017-02-22 | 北京京东尚科信息技术有限公司 | 自动引导运输车agv 及运动控制方法和装置 |
CN106647741A (zh) * | 2016-11-16 | 2017-05-10 | 浙江工业大学 | 基于激光导航的全方位运动机构控制系统 |
CN106681317A (zh) * | 2016-11-27 | 2017-05-17 | 北京特种机械研究所 | Agv全向导航行驶方法 |
Non-Patent Citations (1)
Title |
---|
鲍金: "基于PID算法的双轮差动式移动机器人定位和导航研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108152827A (zh) * | 2017-09-28 | 2018-06-12 | 北京卫星制造厂 | 一种基于激光测距的全向智能移动装备定位与导航方法 |
CN107544512A (zh) * | 2017-09-30 | 2018-01-05 | 江西洪都航空工业集团有限责任公司 | 一种用于智能四轮小车的差速转弯控制器 |
CN107817803A (zh) * | 2017-11-14 | 2018-03-20 | 上海诺力智能科技有限公司 | 一种适用于agv的二次精确定位的控制系统及其控制方法 |
CN108489479A (zh) * | 2017-12-29 | 2018-09-04 | 合肥中导机器人科技有限公司 | 激光导航精确定位方法、机器人导航方法及激光导航系统 |
CN109345697A (zh) * | 2018-08-31 | 2019-02-15 | 成都越凡创新科技有限公司 | 售卖机自动回充导航方法 |
CN109144078A (zh) * | 2018-11-13 | 2019-01-04 | 楚天智能机器人(长沙)有限公司 | 一种基于二维码导航共线双舵轮agv路线纠偏方法及系统 |
CN109901581A (zh) * | 2019-03-15 | 2019-06-18 | 智久(厦门)机器人科技有限公司上海分公司 | 一种agv车自旋角的标定方法及自旋运动控制方法 |
CN110118571A (zh) * | 2019-04-19 | 2019-08-13 | 芜湖智久机器人有限公司 | 一种获取移动设备上的激光传感器的安装角度误差的方法 |
CN110837257A (zh) * | 2019-11-19 | 2020-02-25 | 北京卫星制造厂有限公司 | 一种基于iGPS与视觉的AGV复合定位导航系统 |
CN110837257B (zh) * | 2019-11-19 | 2023-12-29 | 北京卫星制造厂有限公司 | 一种基于iGPS与视觉的AGV复合定位导航系统 |
CN111596657A (zh) * | 2020-05-09 | 2020-08-28 | 浙江工业大学 | 一种agv及其轨道运动方法 |
CN111596657B (zh) * | 2020-05-09 | 2023-07-18 | 浙江工业大学 | 一种agv及其轨道运动方法 |
CN111722202A (zh) * | 2020-08-05 | 2020-09-29 | 湖北工业大学 | 一种基于回波强度的反光板位置拟合方法及系统 |
CN111722202B (zh) * | 2020-08-05 | 2021-04-27 | 湖北工业大学 | 一种基于回波强度的反光板位置拟合方法及系统 |
WO2022121459A1 (zh) * | 2020-12-07 | 2022-06-16 | 兰剑智能科技股份有限公司 | 计算agv叉车激光扫描仪安装位置偏差的方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN107102641B (zh) | 2020-08-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107102641A (zh) | 一种基于激光引导双轮差速agv的原地偏航旋转方法 | |
CN110989526B (zh) | 一种双agv协同运载控制系统及方法 | |
CN111766879A (zh) | 一种基于自主协同导航的智能车编队系统 | |
CN107272008A (zh) | 一种带惯性补偿的agv激光导航系统 | |
CN111413976A (zh) | 一种agv控制系统及控制方法 | |
CN113282083B (zh) | 一种基于机器人操作系统的无人车编队实验平台 | |
Pamosoaji et al. | PSO-based minimum-time motion planning for multiple vehicles under acceleration and velocity limitations | |
CN111367285B (zh) | 一种轮式移动小车协同编队与路径规划方法 | |
CN111399509A (zh) | 一种多移动机器人协同转运控制方法及系统 | |
CN214846390U (zh) | 基于自动导引小车的动态环境避障系统 | |
CN105892459B (zh) | 一种非时间参考的差速驱动机器人定点跟踪控制方法 | |
CN113190020A (zh) | 一种移动机器人队列系统及路径规划、跟随方法 | |
CN111679676A (zh) | 一种agv运动轨迹控制方法 | |
Sekhavat et al. | Motion planning and control for Hilare pulling a trailer: experimental issues | |
CN105479460A (zh) | 一种非时间参考的差速驱动机器人路线跟踪控制方法 | |
CN110794834A (zh) | 一种基于后驱前转向的搬运汽车控制系统 | |
CN109572857A (zh) | 一种麦克纳姆轮智能仓储agv及其路径规划方法 | |
CN109213140A (zh) | 一种全向搬运装置及其控制方法 | |
Cai et al. | Multi-maneuver vertical parking path planning and control in a narrow space | |
Nagy et al. | Path planning and control of differential and car-like robots in narrow environments | |
CN115805503A (zh) | 一种智能打磨机器人自动打磨决策规划装置及方法 | |
CN116048095A (zh) | 应用于多种类型agv的协同调度控制方法 | |
Vieira et al. | An autonomous parallel parking algorithm for car-like mobile robots | |
CN111056490A (zh) | 一种无人激光叉车的车载系统 | |
CN216210565U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200807 Termination date: 20210518 |