资源免费
我们一直在努力

CN105737838A一种agv路径跟踪方法[caired.com-彩红网3D模型下载平面素材专利检索网站源码]

本发明属于AGV控制方法领域,具体为一种AGV路径跟踪方法,包括以下步骤:(a)在AGV的导航装置内建立路径地图,路径地图包括若干路径点,以及由路径点拟合得出的基础路径曲线;(b)AGV的驱动模块驱动AGV沿基础路径曲线行进;(c)AGV内的修正模块提取当前路径点和下一个路径点,根据当前路径点和下一个路径点拟合出实时路径曲线;(d)AGV的定位模块确定AGV的位置,以当前位置确定导航点,以导航点为圆心建立半径为R的跟踪圆,跟踪圆中,沿AGV行进方向±D范围内的圆弧为有效圆弧,所述有效圆弧与实时路径曲线的交点为行进目标点;(e)AGV修正模块导引AGV朝向行进目标点运行。本发明提供的路径跟踪方法,AGV行走路径直接朝向行进目标点,运行线路短。
CN105737838A一种agv路径跟踪方法[caired.com-彩红网3D模型下载平面素材专利检索网站源码]
技术领域

[0001 ]本发明属于AGV控制方法领域,具体为一种AGV路径跟踪方法。

背景技术

[0002] 现有的AGV路径跟踪方法,一般是根据AGV所需运行的轨迹,设定轨迹曲线,然后 AGV的导航装置导引AGV沿轨迹曲线行进。随着AGV不断地行进,AGV行进的误差会不断地积 累,AGV会逐渐偏离预定轨迹。所以技术人员需要为此类AGV导航方式搭配一种误差修正方 法,以确保AGV能准确的按预设的轨迹行进。

[0003] 但现有的修正方法,是通过准确地把AGV准确的带回预设的轨迹曲线上,从而使 AGV能准确地到达目标位置。虽然该种方法能使AGV运行更准确,但每一次修正AGV的运行方 向都朝向预设的轨迹曲线,而目标位置的实际方向与AGV朝向轨迹运行的方向之间存在一 定的夹角。因此,现有的修正方法,不可避免的会降低AGV朝目标点行进的效率。

发明内容

[0004] 本发明的目的在于克服现有技术的不足,提供一种行进效率高,能准确到达目标 位置的AGV路径跟踪方法。

[0005] 为了解决上述技术问题,本发明采用以下技术方案:AGV路径跟踪方法,包括以下 步骤:

[0006] (a)在AGV的导航装置内建立路径地图,所述路径地图包括若干路径点,以及由路 径点拟合得出的基础路径曲线;

[0007] (b) AGV内的驱动模块驱动AGV沿基础路径曲线行进;

[0008] (C)AGV内的修正模块提取当前路径点和下一个路径点,根据当前路径点和下一个 路径点拟合出实时路径曲线;

[0009] (d)AGV的定位模块确定AGV当前的位置,以当前位置确定导航点,以导航点为圆心 建立半径为R的跟踪圆,所述跟踪圆中,沿AGV行进方向±0范围内的圆弧为有效圆弧,所述 有效圆弧与实时路径曲线的交点为行进目标点,De [0°,180° ];

[0010] (e)AGV修正模块导引AGV朝向行进目标点运行。

[0011] 本发明提供的路径跟踪方法,当AGV偏离了基础路径曲线时,利用跟踪圆和实施路 径曲线的结合选取行进目标点,使AGV行走的路径直接朝向行进目标点,运行线路短。因此, 与现有技术相比,本发明具有行进效率高,能准确到达目标位置的优点。

[0012] 优选的,沿AGV行进方向±0范围内的圆弧为有效圆弧,De [0°,90°]。

[0013] 所述步骤(C)提取当前路径点和下一个路径点的方法有以下两种:

[0014] 第一种:路径地图还包括两个相邻的路径点之间的拟合得出的基础路径曲线支 路,所有基础路径曲线支路组合得出的基础路径曲线;

[0015] 当导航装置建立跟踪圆时,基础路径曲线与有效圆弧交点所在的基础路径曲线支 路两端的路径点分别为前路径点和下一个路径点,根据路径地图区分前路径点和下一个路 径点。所述基础路径曲线与跟踪圆的交点多于1个时,选取在基础路径曲线上位置更远的交 点,作为提取路径点的参考点。该种方法与一般定位、提取路径点的方法相比,准确性更高。

[0016] 第二种:将所述路径点排序,AGV的定位模块根据AGV的前进方向,提取出AGV前进 方向的最近路径点和后一个路径点分别为当前路径点和下一个路径点。该种提取路径点的 方法简单,便于执行。

[0017] 优选的,所述步骤(e)修正模块驱动AGV朝向行进目标点运行的方法如下:

[0018] 修正模块建立实时路径地图,在实时路径地图中建立直角坐标系,所述AGV车体与 X轴方向的夹角为车体航向角α,行进目标点和导航点的连线与X轴方向的夹角为偏向角α’, 将σ’和α相减得出舵机转向的偏差角为β,根据偏差角β调整舵机转向,导引AGV朝行进目标 点运行。通过对比α’和α直接得出偏差角β,便于舵机执行动作,使调节更迅速。

[0019] 优选的,得出偏差角β后,对偏差角β进行PID运算得到β’,舵机转动β’,导引AGV朝 行进目标点运行。采用PID运算,使AGV转向更准确。

[0020] 优选的,偏向角α ‘可由以下方式得出:

[0021]根据修正模块建立的直角坐标系,得出导航点的坐标位置(a,b)和行进目标点的 位置坐标(xg,yg),®,=紅c tan ^^^。 xg – a

[0022] 优选的,所述步骤(c)、(d)、(e)为路径修正步骤,所述路径修正步骤执行频率T,T e(IHz,1000Hz)。

[0023] 优选的,AGV的行进速度为V,R和V成正比关系。当速度高时;跟踪圆半径大,当速度 低时跟踪圆半径小。这样能够在高速保证稳定性,低速时保证精度。

[0024] 优选的,所述导航点的位置为AGV两侧后轮之间的中点的实时位置,AGV前进和后 退时都选用该位置作为导航点,使AGV的定位更准确;当AGV为叉车式AGV时,举升臂位于AGV 的前部,后轮之间的中点与举升臂的位置较远,减少举升臂运放物品对定位造成的影响。

附图说明

[0025]图1为本发明提供的AGV路径跟踪方法的流程框图,

赞(0) 打赏
未经允许不得转载:彩红网 » CN105737838A一种agv路径跟踪方法[caired.com-彩红网3D模型下载平面素材专利检索网站源码]
分享到: 更多 (0)

觉得文章有用就打赏一下文章作者

支付宝扫一扫打赏

微信扫一扫打赏