CN107844105B - 一种基于时间窗的避障控制方法 - Google Patents
一种基于时间窗的避障控制方法 Download PDFInfo
- Publication number
- CN107844105B CN107844105B CN201710984930.9A CN201710984930A CN107844105B CN 107844105 B CN107844105 B CN 107844105B CN 201710984930 A CN201710984930 A CN 201710984930A CN 107844105 B CN107844105 B CN 107844105B
- Authority
- CN
- China
- Prior art keywords
- obstacle avoidance
- time window
- objects
- agv
- target
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000002452 interceptive effect Effects 0.000 claims abstract description 10
- 238000004364 calculation method Methods 0.000 claims abstract description 7
- 238000010835 comparative analysis Methods 0.000 claims abstract description 5
- 230000033001 locomotion Effects 0.000 claims description 7
- 230000009467 reduction Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000003993 interaction Effects 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 5
- 239000003795 chemical substances by application Substances 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000000354 decomposition reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 239000012754 barrier agent Substances 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
- G05B19/4189—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the transport system
- G05B19/41895—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the transport system using automatic guided vehicles [AGV]
-
- 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/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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Toys (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种基于时间窗的避障控制方法,步骤S1、为每个避障物设置一时间窗;步骤S2、通过协调控制代理获取所有避障物的时间窗参数;步骤S3、然后进行比较分析:对所有的避障物两两间执行交互计算,若目标避障物与其他避障物的时间窗存在交互情况,则先判断优先级:若目标避障物优先级高,则保持原始速度继续行驶;若目标避障物优先级比其他避障物优先级低,则降低目标避障物的行驶速度;步骤S4、将计算的结果作用于所服务的避障物执行器,以控制避障物行驶速度,避免避障物发生碰撞,从而达到避障的目的。本发明对目标避障物与其他避障物的时间窗参数进行比较,得出交互情况,来控制各自的运行速度,从而避免碰撞的可能。
Description
技术领域
本发明涉及工业控制技术领域,特别涉及一种避障控制方法,可应用于AGV小车的控制领域。
背景技术
科学技术的发展日新月异,AGVs在现代货物搬运中得到了越来越广泛的使用。其自动化程度高,能够满足柔性制造系统和立体仓库的要求。其中AGVs是指自动导引车系统,由管理计算机、数据传递子系统、若干辆沿导引路径行驶的自动导引小车(即AGV小车)、地面子系统组等组成,用于及时有效的分派自动导引小车到某位置完成指定动作,而且具有监控管理的系统。AGVs在现代科技中具有无可比拟的优势,合理和有效解决系统中的路径冲突问题是高效利用AGVs的关键。但是在AGVs中,由于多个AGV小车的共同运行,很可能导致碰撞冲突,所以合理解决此问题显得尤为关键。
本发明方法就是基于现有AGVs的不足,提出了一种基于时间窗的避障方法,相比于只包含车辆载重约束的基本车辆路径问题,带时间窗的车辆路径问题更好地反应实际应用情况,然而由于车辆路径问题本身就是一大难题,而带时间窗问题是在此基础上又增加了时间窗约束,从而使问题的求解更加困难,因此对时间窗问题的模型和求解算法研究一直是车辆路径规划研究的重点和难点。
发明内容
本发明要解决的技术问题,在于提供一种基于时间窗的避障控制方法,通过将目标避障物与其他避障物的时间窗参数进行比较计算,得出目标避障物与其他避障物之间的交互情况,来控制目标避障物或其他避障物的运行速度,避免目标避障物与其他避障物发生碰撞的可能。
本发明是这样实现的:一种基于时间窗的避障控制方法,包括:
步骤S1、为每个避障物设置一时间窗,所述时间窗的尺寸参数如下:
长X=Sy+1/2L+1/2(L*Sinθ+A*Cosθ),
宽Y=Sx+1/2L+1/2(L*Cosθ+A*Sinθ),
其中Sx:避障物沿X轴方向匀减速运动的位移;Sy:避障物沿Y轴方向匀减速运动的位移;L:避障物本身长度;A:避障物宽度;θ:避障物轴线与水平方向的夹角;
而避障物匀减速运动的位移S的计算式为:S=V2/2a;
其中,V表示避障物的实时速度,α表示避障物的额定加速度;
步骤S2、通过协调控制代理获取所有避障物的时间窗参数;
步骤S3、然后进行比较分析:对所有的避障物两两间执行交互计算,若目标避障物与其他避障物的时间窗存在交互情况,则先判断优先级:
若目标避障物优先级高,则保持原始速度继续行驶;
若目标避障物优先级比其他避障物优先级低,则降低目标避障物的行驶速度;
步骤S4、将计算的结果作用于所服务的避障物执行器,以控制避障物行驶速度,避免避障物发生碰撞,从而达到避障的目的。
其中,该方法应用于AGV小车的避障,则所述避障物为AGV小车。
本发明具有如下优点:本发明方法通过将目标避障物与其他避障物的时间窗参数进行比较计算,得出目标避障物与其他避障物之间的交互情况,来控制目标避障物或其他避障物的运行速度,避免目标避障物与其他避障物发生碰撞的可能,特别适用于AGV小车的避障,可以有效解决系统中存在的路径冲突问题,提高AGV的利用效率,改善AGVs的性能。
附图说明
下面参照附图结合实施例对本发明作进一步的说明。
图1为本发明方法的执行流程示意图。
图2为本发明时间窗的结构示意图。
图3为本发明目标避障物为水平运动时的时间窗的结构示意图。
图4为本发明目标避障物为垂直运动时的时间窗的结构示意图。
图5为本发明目标避障物为转弯运动时的时间窗的结构示意图。
图6为本发明方法用于AGV避障的执行流程示意图。
具体实施方式
请参阅图1所示,本发明的基于时间窗的避障控制方法,包括:
步骤S1、为每个避障物设置一时间窗,所述时间窗的尺寸参数如下:
长X=Sy+1/2L+1/2(L*Sinθ+A*Cosθ),
宽Y=Sx+1/2L+1/2(L*Cosθ+A*Sinθ),
其中Sx:避障物沿X轴方向匀减速运动的位移;Sy:避障物沿Y轴方向匀减速运动的位移;L:避障物本身长度;A:避障物宽度;θ:避障物轴线与水平方向的夹角;
步骤S2、通过协调控制代理获取所有避障物的时间窗参数;
步骤S3、然后进行比较分析:对所有的避障物两两间执行交互计算,若目标避障物与其他避障物的时间窗存在交互情况,则先判断优先级:
若目标避障物优先级高,则保持原始速度继续行驶;
若目标避障物优先级比其他避障物优先级低,则降低目标避障物的行驶速度;
步骤S4、将计算的结果作用于所服务的避障物执行器,以控制避障物行驶速度,避免避障物发生碰撞,从而达到避障的目的。
现以AGV小车的避障为例,对本发明作详细的阐述:
1、首先,详细阐述AGV时间窗的原理:AGV时间窗的形成基于运动学的原理,时间窗区域的大小由AGV小车实时速度和AGV小车车长共同决定,其中时间窗区域动态组成部分如公式(1)所示,即AGV小车以当前速度做匀减速运动产生的位移即为时间窗区域动态组成的部分。时间窗区域的AGV小车车长为静态组成部分,作为两辆车需要保持的最小安全距离,不论AGV小车处于运动状态还是静止状态,都能保持与其他AGV小车至少一个车长的距离。
S=V2/2a(1)
注:S表示时间窗区域动态组成部分的长度,V表示AGV小车的实时速度,α表示AGV小车的额定加速度。
2、其次,详细阐述AGV避障控制理论:每个AGV小车均配置一个避障控制代理,避障控制代理的输入为各AGV的时间窗参数(AGV的时间窗区域是一个矩形,矩形的两个对角点坐标即可确定刚矩形的大小。如图2所示,输入A和C点的坐标参数或者B和D点的坐标参数其中的一组的坐标参数即可确定AGV时间窗大小),以要保护的AGV小车为主体对象,通过与其他AGV小车的时间窗参数进行比较计算,得出保护AGV小车与其他AGV小车的交互情况。若保护AGV小车与其他AGV小车出现冲突情况,避障代理将控制保护AGV小车的运行速度,避免与其他AGV小车发生碰撞的可能。
3、最后,详细阐述本发明的AGV避障控制方法的实现步骤:
AGV时间窗的形成主要取决于AGV小车的实时速度。其中AGV小车的实时速度为矢量,包含速度大小和速度方向两个因素,共同决定AGV时间窗区域的大小,可将AGV小车的实时速度延X轴方向和Y轴方向分解,在这两个方向上计算AGV时间窗大小。
以图3、图4、图5所示的三个情况为例。
图3为AGV小车水平运动的情况,AGV小车实时速度延X轴方向和Y轴方向分解后只有X轴方向有速度大小,此时AGV时间窗的大小由X轴方向速度大小和AGV小车车长共同决定,时间窗长X=Sx+L,宽Y=A。
图4为AGV小车垂直运动的情况,AGV小车实时速度延X轴方向和Y轴方向分解后只有Y轴方向有速度大小,此时AGV时间窗的大小由Y轴方向速度大小和AGV小车车长共同决定,时间窗长X=A,宽Y=Sy+L。
图5为AGV小车转弯运动时任一时刻的位置情况,AGV小车实时速度为转弯运动时任一时刻的切线速度,将该速度延X轴方向和Y轴方向进行分解,此时时间窗的参数为:
长X=Sy+1/2L+1/2(L*Sinθ+A*Cosθ),
宽Y=Sx+1/2L+1/2(L*Cosθ+A*Sinθ)。
其中Sx:X轴方向匀减速位移;Sy:Y轴方向匀减速位移;L:AGV小车车长;A:AGV小车车宽;θ:AGV小车车身与水平方向夹角。
结合图6所示,AGV小车避障流程:
1、AGV协调控制代理通过AGV导航中心获取所有AGV小车的时间窗参数;
2、然后进行比较分析:对所有的AGV小车两两间执行交互计算,若目标AGV小车与其他AGV小车的时间窗存在交互情况,则先判断优先级。优先级判断方法:若目标AGV小车优先级高,则保持原始速度继续行驶,若目标AGV小车优先级比其他AGV小车优先级低,则降低目标AGV小车的行驶速度。
3、将计算的结果作用于所服务的AGV执行器,可以起到控制AGV小车行驶速度,避免AGV小车发生碰撞的作用。
虽然以上描述了本发明的具体实施方式,但是熟悉本技术领域的技术人员应当理解,我们所描述的具体的实施例只是说明性的,而不是用于对本发明的范围的限定,熟悉本领域的技术人员在依照本发明的精神所作的等效的修饰以及变化,都应当涵盖在本发明的权利要求所保护的范围内。
Claims (2)
1.一种基于时间窗的避障控制方法,其特征在于:包括:
步骤S1、为每个避障物设置一时间窗,所述时间窗的尺寸参数如下:
长X=Sy+1/2L+1/2(L*Sinθ+A*Cosθ),
宽Y=Sx+1/2L+1/2(L*Cosθ+A*Sinθ),
其中Sx:避障物沿X轴方向匀减速运动的位移;Sy:避障物沿Y轴方向匀减速运动的位移;L:避障物本身长度;A:避障物宽度;θ:避障物轴线与水平方向的夹角;
而避障物匀减速运动的位移S的计算式为:S=V2/2a;
其中,V表示避障物的实时速度,α表示避障物的额定加速度;
步骤S2、通过协调控制代理获取所有避障物的时间窗参数;
步骤S3、然后进行比较分析:对所有的避障物两两间执行交互计算,若目标避障物与其他避障物的时间窗存在交互情况,则先判断优先级:
若目标避障物优先级高,则保持原始速度继续行驶;
若目标避障物优先级比其他避障物优先级低,则降低目标避障物的行驶速度;
步骤S4、将计算的结果作用于所服务的避障物执行器,以控制避障物行驶速度,避免避障物发生碰撞,从而达到避障的目的。
2.根据权利要求1所述的一种基于时间窗的避障控制方法,其特征在于:该方法应用于AGV小车的避障,所述避障物为AGV小车。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710984930.9A CN107844105B (zh) | 2017-10-20 | 2017-10-20 | 一种基于时间窗的避障控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710984930.9A CN107844105B (zh) | 2017-10-20 | 2017-10-20 | 一种基于时间窗的避障控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107844105A CN107844105A (zh) | 2018-03-27 |
CN107844105B true CN107844105B (zh) | 2019-12-06 |
Family
ID=61661600
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710984930.9A Active CN107844105B (zh) | 2017-10-20 | 2017-10-20 | 一种基于时间窗的避障控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107844105B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001273032A (ja) * | 2000-03-28 | 2001-10-05 | Denso Corp | 無人移動車における障害物対処システムおよび装置 |
CN104951918A (zh) * | 2015-06-11 | 2015-09-30 | 上海德马物流技术有限公司 | 一种时间窗路径规划方法 |
CN107179078A (zh) * | 2017-05-24 | 2017-09-19 | 合肥工业大学(马鞍山)高新技术研究院 | 一种基于时间窗优化的agv路径规划方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101738195B (zh) * | 2009-12-24 | 2012-01-11 | 厦门大学 | 基于环境建模与自适应窗口的移动机器人路径规划方法 |
-
2017
- 2017-10-20 CN CN201710984930.9A patent/CN107844105B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001273032A (ja) * | 2000-03-28 | 2001-10-05 | Denso Corp | 無人移動車における障害物対処システムおよび装置 |
CN104951918A (zh) * | 2015-06-11 | 2015-09-30 | 上海德马物流技术有限公司 | 一种时间窗路径规划方法 |
CN107179078A (zh) * | 2017-05-24 | 2017-09-19 | 合肥工业大学(马鞍山)高新技术研究院 | 一种基于时间窗优化的agv路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107844105A (zh) | 2018-03-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107610494B (zh) | 基于信息物理融合系统的agv车辆系统及交通控制方法 | |
CN110209485B (zh) | 一种协同作业时多机器人的动态避让方法 | |
Chang et al. | Fuzzy projection control law and its application to the overhead crane | |
CN111638717B (zh) | 一种分布式自主机器人交通协调机制的设计方法 | |
KR102006401B1 (ko) | 충돌 가능성이 있는 무인운반차들의 경로 및 속도 재설정 | |
KR20160070467A (ko) | 장애물 회피를 위한 멀티로봇 시스템 및 장애물 회피를 위한 스위칭 대형 전략을 이용하는 방법 | |
US11795036B2 (en) | Method for generating a trajectory for a hoisting appliance | |
CN110817220A (zh) | 一种rgv避让方法、rgv及rgv避让系统 | |
CN110727275A (zh) | 基于plc的rgv动态避碰控制系统及方法 | |
CN107678279A (zh) | 一种考虑规避约束的agv轨迹规划方法 | |
CN107844105B (zh) | 一种基于时间窗的避障控制方法 | |
Van Koevering et al. | Provable probabilistic safety and feasibility-assured control for autonomous vehicles using exponential control barrier functions | |
CN115826589B (zh) | 一种小车防碰撞控制方法 | |
Tai et al. | A time-efficient approach to solve conflicts and deadlocks for scheduling AGVs in warehousing applications | |
CN112731920A (zh) | 搬运设备的控制方法、装置、搬运设备及存储介质 | |
Tubaileh | Layout of flexible manufacturing systems based on kinematic constraints of the autonomous material handling system | |
Keppler et al. | Prioritized multi-robot velocity planning for trajectory coordination of arbitrarily complex vehicle structures | |
CN116360420A (zh) | 一种clf-cbf优化的无人车辆运动规划控制方法 | |
Guo et al. | Optimal trajectory generation for nonholonomic robots in dynamic environments | |
Li et al. | Adaptive fuzzy control for mobile robot obstacle avoidance based on virtual line path tracking | |
US11708091B2 (en) | Vehicle traveling control system and vehicle control system | |
CN113835431A (zh) | 一种用于多台四向穿梭同区域作业的调度方法和系统 | |
Muhammad et al. | Adaptive warning fields for warehouse AGVs | |
Keppler et al. | SAFESTOP: Disturbance handling in prioritized multi-robot trajectory planning | |
CN109360447A (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 |