CN109375624B - 一种双舵轮agv圆弧路径生成方法、装置及介质 - Google Patents
一种双舵轮agv圆弧路径生成方法、装置及介质 Download PDFInfo
- Publication number
- CN109375624B CN109375624B CN201811339470.5A CN201811339470A CN109375624B CN 109375624 B CN109375624 B CN 109375624B CN 201811339470 A CN201811339470 A CN 201811339470A CN 109375624 B CN109375624 B CN 109375624B
- Authority
- CN
- China
- Prior art keywords
- steering wheel
- agv
- stage
- wheels
- arc path
- 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 45
- 238000004590 computer program Methods 0.000 claims abstract description 4
- 238000006073 displacement reaction Methods 0.000 claims description 8
- 238000004088 simulation Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 description 4
- 238000013178 mathematical model Methods 0.000 description 2
- 230000001427 coherent effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 239000012770 industrial material Substances 0.000 description 1
- 230000009347 mechanical transmission Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004806 packaging method and process Methods 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/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/0227—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area
- G05D1/0229—Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area in combination with fixed guiding means
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种双舵轮AGV圆弧路径生成方法,包括步骤:S01、将AGV的圆弧路径规划为第一阶段、第二阶段和第三阶段,第一阶段为前后舵轮舵角等速反向旋转到角度θ;第二阶段为保持角度θ运行;第三阶段为前后舵轮舵角等速反向从角度θ旋转到0;S02、根据AGV转弯半径预设值R和前后舵轮之间的长度L,根据舵轮的偏转角速度ω转和前舵轮的速度V车,生成各阶段的圆弧路径;S03、将各圆弧路径首尾相接,生成AGV圆弧路径。本发明还公开了一种与方法相对应的装置。另外本发明还公开了一种计算机可读存储介质,其上储存有计算机程序,该程序被处理器执行时实现如上所述的方法。本发明的方法、装置及介质均具有精确性好、完整性好等优点。
Description
技术领域
本发明主要涉及食品、医药包装技术领域,特指一种双舵轮AGV圆弧路径生成方法、装置及介质。
背景技术
目前AGV(Automated Guided Vehicle)系统已经广泛应用于工业物料柔性搬运系统中,AGV的驱动方式一般分为三种:单驱动、差速驱动和双舵轮驱动。各种驱动方式驱动轮分布各不相同。其中导航方式主要包括电磁导航、磁带导航、激光导航、二维码导航,其中前三种方式导航数据为持续连贯的,二维码导航数据是不连续的。
双舵轮AGV的转弯是一个十分复杂的运动学过程,它与数学模型的建立有密切关系。在AGV的圆弧路径计算中,通常忽略了舵轮打角旋转的过程,默认此过程是瞬间完成的,会产生一定的误差,这样导致AGV的圆弧路径走完后,需要立马进行纠偏操作。AGV的速度分量是通过舵轮角度和车身角度叠加计算,当这两个角度和大于90时,计算出来的速度存在符号问题,从而产生误差,并且AGV整车速度是分别计算前舵轮和后舵轮速度后才能得到,有一定计算量。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种精确性高的双舵轮AGV圆弧路径生成方法,并相应提供一种双舵轮AGV圆弧路径生成装置以及计算机可读储存介质。
为解决上述技术问题,本发明提出的技术方案为:
一种双舵轮AGV圆弧路径生成方法,包括以下步骤:
S01、将双舵轮AGV的圆弧路径规划为三个阶段,三个阶段依次为第一阶段、第二阶段和第三阶段,其中第一阶段为前后舵轮舵角等速反向旋转到角度θ;第二阶段为前后舵轮保持角度θ运行;第三阶段为前后舵轮舵角等速反向从角度θ旋转到0;
S03、将步骤S02中的各阶段对应的圆弧路径首尾相接,生成双舵轮AGV圆弧路径。
优选地,步骤S02中第一阶段的圆弧路径生成的具体过程为:
S22、根据前舵轮的速度V车和偏转角β,计算AGV前进方向的速度V前=V车cosβ和垂直方向的速度V转=V车sinβ;
S24、根据V前和α,分别得到世界坐标系中X方向的分量VX=V前sinα和Y方向的分量VY=V前cosα;
优选地,在步骤S02中,第三阶段的圆弧路径生成的具体过程为:
S31、第三阶段持续时间和第一阶段持续时间相等,即TC=TA,舵轮偏转角β=θ-ωt;
S32、执行步骤S22~S25。
优选地,在步骤S02中,第二阶段的圆弧路径生成的具体过程为:
S42、执行步骤S22~S25。
优选地,用MATLAB对步骤S01~S03进行仿真,补偿小车本身所带误差,根据仿真结果对θ进行调整,从而得到最终的圆弧路径。
优选地,对θ进行调整的角度小于1度。
本发明还公开了一种双舵轮AGV圆弧路径生成装置,包括
第一模块,用于将双舵轮AGV的圆弧路径规划为三个阶段,三个阶段依次为第一阶段、第二阶段和第三阶段,其中第一阶段为前后舵轮舵角等速反向旋转到角度θ;第二阶段为前后舵轮保持角度θ运行;第三阶段为前后舵轮舵角等速反向从角度θ旋转到0;
第三模块,用于将步骤S02中的各阶段对应的圆弧路径首尾相接,生成双舵轮AGV圆弧路径。
本发明还进一步公开了一种计算机可读存储介质,其上储存有计算机程序,该程序被处理器执行时实现如上所述的方法。
与现有技术相比,本发明的优点在于:
本发明的双舵轮AGV圆弧路径生成方法,将双舵轮AGV的圆弧路径规划为三个阶段,考虑了舵轮打角的过程,从而提高了生成的圆弧路径的完整性以及精确性,省去了圆弧路径后小车进行再次对准的过程,提高了AGV小车整体运行速度与稳定性;在路径生成过程中,采用前舵轮的速度代替AGV整车的速度,减少了计算量;用二次投影的方式计算AGV舵轮的速度,避免角度问题导致的速度误差;用MATLAB仿真对舵轮的打角进行补偿,进一步提高圆弧路径的精确性。
本发明的双舵轮AGV圆弧路径生成装置以及介质均具有如上方法所述的优点。
附图说明
图1为发明的坐标示意图。
图2为本发明的圆弧路径示意图。
具体实施方式
以下结合说明书附图和具体实施例对本发明作进一步描述。
如图1和图2所示,本实施例的双舵轮AGV圆弧路径生成方法,包括以下步骤:
S01、将双舵轮AGV的圆弧路径规划为三个阶段,三个阶段依次为第一阶段、第二阶段和第三阶段,其中第一阶段为前后舵轮舵角等速反向旋转到角度θ;第二阶段为前后舵轮保持角度θ运行;第三阶段为前后舵轮舵角等速反向从角度θ旋转到0;
S03、将步骤S02中的各阶段对应的圆弧路径首尾相接,生成双舵轮AGV圆弧路径。
本发明的双舵轮AGV圆弧路径生成方法,将双舵轮AGV的圆弧路径规划为三个阶段,考虑了舵轮打角的过程,从而提高了生成的圆弧路径的完整性以及精确性。
通常在AGV的转弯过程中,前后舵轮的速度相等,前后舵轮的转向方式是正反方向打角,AGV预定的偏转角度为90度。在AGV的转弯过程中,由于后舵轮一直处于跟随状态,所以只需对前舵轮的运动过程进行数学模型分析。
如附图1所示,前舵轮的速度为V车,前舵轮打角为β,前舵轮预定的调整角度为θ,舵轮的偏转角速度ω转,AGV车体的旋转角速度ω车,V车在车身前进方向上的投影分量为V前,V车在垂直车身方向上的投影分量为V转,AGV车身的偏转角度为α,在世界坐标系中,V前在X轴方向上的投影分量为VX,V前在Y轴方向上的投影分量为VY。整个圆弧转弯过程包括三个阶段,如图2中A、B、C所示:
A.前后舵轮舵角等速反向旋转到调整角度θ;
B.前后舵轮保持θ舵角运行;
C.前后舵轮舵角等速反向从调整角度θ旋转到0。
本实施例中,步骤S02中第一阶段的圆弧路径生成的具体过程为:
S22、根据前舵轮的速度V车和偏转角β,计算AGV前进方向的速度V前=V车cosβ和垂直方向的速度V转=V车sinβ;如图1中的图框1所示;
S24、根据V前和α,分别得到世界坐标系中X方向的分量VX=V前sinα和Y方向的分量VY=V前cosα;如图1中的图框2所示;
本实施例中,在步骤S02中,第三阶段的圆弧路径生成的具体过程为:
S31、第三阶段持续时间和第一阶段持续时间相等,即TC=TA,舵轮偏转角β=θ-ωt;
S32、执行步骤S22~S25。
本实施例中,在步骤S02中,第二阶段的圆弧路径生成的具体过程为:
S42、执行步骤S22~S25。
本实施例中,由于θ的计算只是对舵轮预定调整角度的初始化估计,需要对θ进行补偿。因此,用MATLAB对整个计算过程进行仿真,补偿小车本身所带误差(机械传动、运动摩擦等),根据仿真结果对θ进行调整,调整角度小于1度,从而得到最终的精确结果。
本发明的双舵轮AGV圆弧路径生成方法,用二次投影的方式计算AGV舵轮的速度,避免角度问题导致的速度误差;用前舵轮的速度代替AGV整车的速度,减少了计算量;优化计算结果,用MATLAB仿真对舵轮的打角进行补偿,得到精确的圆弧路径。
本发明还相应公开了一种一种双舵轮AGV圆弧路径生成装置,包括
第一模块,用于将双舵轮AGV的圆弧路径规划为三个阶段,三个阶段依次为第一阶段、第二阶段和第三阶段,其中第一阶段为前后舵轮舵角等速反向旋转到角度θ;第二阶段为前后舵轮保持角度θ运行;第三阶段为前后舵轮舵角等速反向从角度θ旋转到0;
第三模块,用于将步骤S02中的各阶段对应的圆弧路径首尾相接,生成双舵轮AGV圆弧路径。
本发明还进一步公开了一种计算机可读存储介质,其上储存有计算机程序,其特征在于,该程序被处理器执行时实现如上所述的方法。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (7)
1.一种双舵轮AGV圆弧路径生成方法,其特征在于,包括以下步骤:
S01、将双舵轮AGV的圆弧路径规划为三个阶段,三个阶段依次为第一阶段、第二阶段和第三阶段,其中第一阶段为前后舵轮等速反向旋转到角度θ;第二阶段为前后舵轮保持角度θ运行;第三阶段为前后舵轮等速反向从角度θ旋转到0;
S03、将步骤S02中的各阶段对应的圆弧路径首尾相接,生成双舵轮AGV圆弧路径;
步骤S02中第一阶段的圆弧路径生成的具体过程为:
S22、根据前舵轮的速度V车和舵轮偏转角β,计算AGV前进方向的速度V前=V车cosβ和垂直方向的速度V转=V车sinβ;
S24、根据V前和α,分别得到世界坐标系中X方向的分量VX=V前sinα和Y方向的分量VY=V前cosα;
2.根据权利要求1所述的双舵轮AGV圆弧路径生成方法,其特征在于,在步骤S02中,第三阶段的圆弧路径生成的具体过程为:
S31、第三阶段持续时间和第一阶段持续时间相等,即TC=TA,舵轮偏转角β=θ-ωt;
S32、执行步骤S22~S25。
4.根据权利要求1至3中任意一项所述的双舵轮AGV圆弧路径生成方法,其特征在于,用MATLAB对步骤S01~S03进行仿真,补偿小车本身所带误差,根据仿真结果对θ进行调整,从而得到最终的圆弧路径。
5.根据权利要求4所述的双舵轮AGV圆弧路径生成方法,其特征在于,对θ进行调整的角度小于1度。
6.一种双舵轮AGV圆弧路径生成装置,其特征在于,包括
第一模块,用于将双舵轮AGV的圆弧路径规划为三个阶段,三个阶段依次为第一阶段、第二阶段和第三阶段,其中第一阶段为前后舵轮等速反向旋转到角度θ;第二阶段为前后舵轮保持角度θ运行;第三阶段为前后舵轮等速反向从角度θ旋转到0;
第二模块,用于根据AGV圆弧转弯半径预设值R和AGV前后舵轮之间的长度L,计算舵轮预定角度并根据前后舵轮的偏转角速度ω转和前舵轮的速度V车,生成各阶段对应的圆弧路径;其中第一阶段的圆弧路径生成的具体过程为:
根据前舵轮的速度V车和舵轮偏转角β,计算AGV前进方向的速度V前=V车cosβ和垂直方向的速度V转=V车sinβ;
根据V前和α,分别得到世界坐标系中X方向的分量VX=V前sinα和Y方向的分量VY=V前cosα;
第三模块,用于将第二模块中的各阶段对应的圆弧路径首尾相接,生成双舵轮AGV圆弧路径。
7.一种计算机可读存储介质,其上储存有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1~5中任意一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811339470.5A CN109375624B (zh) | 2018-11-12 | 2018-11-12 | 一种双舵轮agv圆弧路径生成方法、装置及介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811339470.5A CN109375624B (zh) | 2018-11-12 | 2018-11-12 | 一种双舵轮agv圆弧路径生成方法、装置及介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109375624A CN109375624A (zh) | 2019-02-22 |
CN109375624B true CN109375624B (zh) | 2022-02-15 |
Family
ID=65384057
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811339470.5A Active CN109375624B (zh) | 2018-11-12 | 2018-11-12 | 一种双舵轮agv圆弧路径生成方法、装置及介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109375624B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109928129B (zh) * | 2019-04-01 | 2021-03-23 | 上海快仓智能科技有限公司 | 自动引导车的控制方法、自动引导车及货物搬运系统 |
CN110320906B (zh) * | 2019-05-09 | 2022-02-01 | 重庆大学 | 一种基于麦克纳姆轮的四驱agv小车差速直线行驶姿态调整方法 |
CN110647153B (zh) * | 2019-10-21 | 2021-05-25 | 兰剑智能科技股份有限公司 | 基于舵轮偏距的无人搬运车仿真方法、装置及计算机设备 |
CN111273551B (zh) * | 2020-03-12 | 2021-03-16 | 山东大学 | 双舵轮自动导引车轨迹追踪控制方法及系统 |
CN111880538B (zh) * | 2020-07-28 | 2024-01-26 | 湖南驰众机器人有限公司 | 一种agv激光导航线路标定中弯道调整方法 |
CN114265413A (zh) * | 2021-12-30 | 2022-04-01 | 深圳创维数字技术有限公司 | 车辆控制方法、设备及计算机可读存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647770A (zh) * | 2017-01-22 | 2017-05-10 | 无锡卡尔曼导航技术有限公司 | 用于农机无人驾驶的田间掉头路径规划及其控制方法 |
CN106767808A (zh) * | 2016-11-22 | 2017-05-31 | 上海振华重工电气有限公司 | 基于模板的自动化集装箱码头自动引导车辆路径规划方法 |
CN108413977A (zh) * | 2018-02-11 | 2018-08-17 | 西安智加科技有限公司 | 一种智能农机自动作业交互方法和交互系统 |
CN108594815A (zh) * | 2018-04-20 | 2018-09-28 | 武汉大学 | 一种分阶段的轮式机器人移动路径规划方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2627841B2 (ja) * | 1991-12-16 | 1997-07-09 | トヨタ自動車株式会社 | 前後輪操舵車の後輪転舵装置 |
-
2018
- 2018-11-12 CN CN201811339470.5A patent/CN109375624B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106767808A (zh) * | 2016-11-22 | 2017-05-31 | 上海振华重工电气有限公司 | 基于模板的自动化集装箱码头自动引导车辆路径规划方法 |
CN106647770A (zh) * | 2017-01-22 | 2017-05-10 | 无锡卡尔曼导航技术有限公司 | 用于农机无人驾驶的田间掉头路径规划及其控制方法 |
CN108413977A (zh) * | 2018-02-11 | 2018-08-17 | 西安智加科技有限公司 | 一种智能农机自动作业交互方法和交互系统 |
CN108594815A (zh) * | 2018-04-20 | 2018-09-28 | 武汉大学 | 一种分阶段的轮式机器人移动路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109375624A (zh) | 2019-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109375624B (zh) | 一种双舵轮agv圆弧路径生成方法、装置及介质 | |
CN105867377B (zh) | 一种农业机械自动导航控制方法 | |
CN107943020B (zh) | 一种轮胎吊大车自动纠偏方法 | |
CN109144078B (zh) | 一种基于二维码导航共线双舵轮agv路线纠偏方法及系统 | |
CN107092266B (zh) | 一种移动车轨迹跟踪控制方法 | |
CN109960150B (zh) | 巡检机器人轨迹跟踪控制方法 | |
JPH0324605A (ja) | 移動ロボットの走行制御方法 | |
CN110320917B (zh) | 无人车弯道循迹控制方法 | |
BR112017022955B1 (pt) | Sistema, método e meio não transitório legível por computador para calcular um plano de trajetória dirigível para um veículo autônomo e sistema, método e meio não transitório legível por computador para controlar um veículo autônomo | |
CN114148320B (zh) | 一种路径跟踪控制方法及设备 | |
CN111580520A (zh) | 基于二维码导航的四轮转向agv轨迹纠偏方法 | |
CN109739094A (zh) | 一种基于自适应滑模控制的移动机器人轨迹跟踪新方法 | |
CN111587199B (zh) | 驾驶辅助装置、驾驶辅助方法及驾驶辅助系统 | |
CN112537297A (zh) | 车道保持方法、系统及车辆 | |
CN111487976A (zh) | 一种倒车轨迹跟踪方法 | |
CN111538339A (zh) | 船舶航迹控制方法及装置 | |
CN112596521A (zh) | 一种双舵轮磁导航agv纠偏方法及装置 | |
CN114715167A (zh) | 一种基于全向移动车辆多行驶模式的自动驾驶轨迹跟踪控制方法 | |
CN111240362A (zh) | 一种智能引导飞行器转弯的控制方法及装置 | |
KR20130099672A (ko) | 퍼지 추론 시스템 및 그 방법 | |
CN110362088B (zh) | 一种适用于无人驾驶跨运车的循迹控制系统和方法 | |
CN114291117B (zh) | 一种四轮转向无人车辆轨迹跟踪控制方法 | |
Feng et al. | Implementation of dynamic obstacle avoidance on the CMU NavLab | |
JP2008213682A (ja) | 船舶用自動操舵装置 | |
CN113696967B (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 | ||
EE01 | Entry into force of recordation of patent licensing contract | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20190222 Assignee: TRUKING TECHNOLOGY Ltd. Assignor: TRUKING INTELLIGENT ROBOT (CHANGSHA) Co.,Ltd. Contract record no.: X2023980047829 Denomination of invention: A method, device, and medium for generating circular arc paths of dual rudder AGVs Granted publication date: 20220215 License type: Common License Record date: 20231122 |