一种应用于AGV曲线路径导航跟随方法技术

本发明专利技术涉及AGV运输车技术领域，具体为一种应用于AGV曲线路径导航跟随方法，所述方法步骤如下，将AGV运输车的动力牵引端记为控制点(P1)，再将AGV运输车的最前端、最末端记为跟随点；确定曲线路径中的起始点(P0)与结束点(P2)；启动AGV运输车，AGV运输车在动力牵引端的作用下从一条直线驶出，驶出时AGV运输车最前端的跟随点会与直线平行。本发明专利技术可以根据当前位置及采样点目标控制角度，不断的切换当前控制角度，可以让AGV沿着贝塞尔曲线运行，并且可清晰的发现AGV整个车体在出曲线段时，车体已摆直，这时上直线段无需通过多次调节来实现车体摆直，平缓过度，可以友好的保证了AGV上货物平稳。物平稳。物平稳。

【技术实现步骤摘要】
一种应用于AGV曲线路径导航跟随方法


[0001]本专利技术涉及AGV运输车
，具体为一种应用于AGV曲线路径导航跟随方法。

技术介绍

[0002]AGV在路径跟随中，曲线跟随难度是最大的，在以往的控制过程中，我们使用的是标准圆弧线，在跟随的过程中，控制比较简单，给出一定的控制角度，不用频繁的改变控制角度就能实现圆弧控制，这种控制有个致命的缺陷，就是在离开圆弧时车体形态与圆弧始终都是相切，这时若前面的路径时直线段，会出现车体摆动较大且需要经过多次震荡才能平稳下来，控制效果不理想，从而很容易导致AGV运输车载运的货物发生移动或掉落现象。

技术实现思路

[0003]本专利技术的目的在于提供一种应用于AGV曲线路径导航跟随方法，以解决上述
技术介绍
中提出控制效果不理想，很容易导致AGV运输车载运的货物发生移动或掉落现象的问题。
[0004]为实现上述目的，本专利技术提供如下技术方案：一种应用于AGV曲线路径导航跟随方法，所述方法步骤如下：
[0005]步骤一、将AGV运输车的动力牵引端记为控制点(P1)，再将AGV运输车的最前端、最末端记为跟随点；
[0006]步骤二、确定曲线路径中的起始点(P0)与结束点(P2)；
[0007]步骤三、启动AGV运输车，AGV运输车在动力牵引端的作用下从一条直线驶出，驶出时AGV运输车最前端的跟随点会与直线平行，随后继续行驶的AGV运输车上的控制点(P1)会与曲线路径中的起始点(P0)对齐；
[0008]步骤四、对齐后，AGV运输车继续行驶，此时控制点(P1)开始控制工作，使AGV运输车以贝塞尔曲线为控制基准的作用下，配合动力牵引端的牵引力进行运动，在曲线控制过程运动中，车体沿着贝塞尔曲线行驶，控制过程中会不断改变控制角度，使车体控制点(P1)始终与贝塞尔曲线相切；
[0009]步骤五、GV运输车中最末端的跟随点在动力牵引端的牵引下离开曲线路径，并很平缓的过度到另一条直线段上。
[0010]优选的，所述贝塞尔曲线为二阶贝塞尔曲线，且贝塞尔曲线点之间的关系式满足DF/DE＝AD/AB＝BE/BC，并且根据DE线段和计算公式找出所有的F点，记住是所有的F点。
[0011]优选的，所述F点需要依次连接起来，第一个连接点是A
‑
F，第二连接点是A
‑
F1，该F1必须满足关系DF1/DE＝AD/AB＝BE/BC，以此类推，直到最后连接上C点，连接完成后即贝塞尔曲线。
[0012]优选的，所述贝塞尔曲线中的P0＝A；P1＝B；P2＝C，其中黑色点代表是F点，P0
‑
P1线段代表是D点，P0
‑
P2线段代表是E点，并且线段上面点的获取，必须要满足等比关系。
[0013]优选的，所述二阶贝塞尔曲线方程式：
[0014]B(t)＝(1
‑
t)2P0+2t(1
‑
t)PC+t2P1其中的P0起始点；PC控制点；P1结束点。
[0015]优选的，所述二阶贝塞尔曲线切线方程式：
[0016]B'(t)＝2t(P0
‑
2Pc+P1)
‑
2(P0
‑
Pc)，其中的P0起始点；PC控制点；P1结束点。
[0017]与现有技术相比，本专利技术的有益效果是：该应用于AGV曲线路径导航跟随方法可以根据当前位置及采样点目标控制角度，不断的切换当前控制角度，可以让AGV沿着贝塞尔曲线运行，并且可清晰的发现AGV整个车体在出曲线段时，车体已摆直，这时上直线段无需通过多次调节来实现车体摆直，平缓过度，可以友好的保证了AGV上货物平稳。
附图说明
[0018]图1为本专利技术的贝塞尔曲线控制示意图；
[0019]图2为本专利技术的贝塞尔曲线各点之间关系图；
[0020]图3为本专利技术的贝塞尔曲线轨迹图；
[0021]图4为本专利技术的标准圆弧控制示意图。
具体实施方式
[0022]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例，此外，术语“第一”、“第二”、“第三”“上、下、左、右”等仅用于描述目的，而不能理解为指示或暗示相对重要性。同时，在本专利技术的描述中，除非另有明确的规定和限定，术语“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电性连接；可以是直接相连，也可以通过中间媒介间接相连，基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0023]本专利技术提供的一种应用于AGV曲线路径导航跟随方法的结构如图1所示，所述方法步骤如下：
[0024]步骤一、将AGV运输车的动力牵引端记为控制点(P1)，再将AGV运输车的最前端、最末端记为跟随点；
[0025]步骤二、确定曲线路径中的起始点(P0)与结束点(P2)；
[0026]步骤三、启动AGV运输车，AGV运输车在动力牵引端的作用下从一条直线驶出，驶出时AGV运输车最前端的跟随点会与直线平行，随后继续行驶的AGV运输车上的控制点(P1)会与曲线路径中的起始点(P0)对齐；
[0027]步骤四、对齐后，AGV运输车继续行驶，此时控制点(P1)开始控制工作，使AGV运输车以贝塞尔曲线为控制基准的作用下，配合动力牵引端的牵引力进行运动，在曲线控制过程运动中，车体沿着贝塞尔曲线行驶，控制过程中会不断改变控制角度，使车体控制点(P1)始终与贝塞尔曲线相切，其中，该二阶贝塞尔曲线切线方程式：
[0028]B
′
(t)＝2t(P0
‑
２Pc+P1)
‑
2(P0
‑
Pc)，进一步的，P0起始点；PC控制点；P1结束点；
[0029]进一步地，如图2以及图3所示，贝塞尔曲线为二阶贝塞尔曲线，且贝塞尔曲线点之间的关系式满足DF/DE＝AD/AB＝BE/BC，并且根据DE线段和计算公式找出所有的F点，记住是所有的F点，F点需要依次连接起来，第一个连接点是A
‑
F，第二连接点是A
‑
F1，该F1必须满
足关系DF1/DE＝AD/AB＝BE/BC，以此类推，直到最后连接上C点，连接完成后即贝塞尔曲线，贝塞尔曲线中的P0＝A；P1＝B；P2＝C，其中黑色点代表是F点，P0
‑
P1线段代表是D点，P0
‑
P2线段代表是E点，并且线段上面点的获取，必须要满足等比关系，二阶贝塞尔曲线方程式：
[0030]B(t)＝(1
‑
t)2P0+2t(1
‑
t)PC+t2P1，其中的P0起始点；PC控制点；P1结束点；
[0031]步骤五、AGV运输车中最末端的跟随点在本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种应用于AGV曲线路径导航跟随方法，其特征在于：所述方法步骤如下：步骤一、将AGV运输车的动力牵引端记为控制点(P1)，再将AGV运输车的最前端、最末端记为跟随点；步骤二、确定曲线路径中的起始点(P0)与结束点(P2)；步骤三、启动AGV运输车，AGV运输车在动力牵引端的作用下从一条直线驶出，驶出时AGV运输车最前端的跟随点会与直线平行，随后继续行驶的AGV运输车上的控制点(P1)会与曲线路径中的起始点(P0)对齐；步骤四、对齐后，AGV运输车继续行驶，此时控制点(P1)开始控制工作，使AGV运输车以贝塞尔曲线为控制基准的作用下，配合动力牵引端的牵引力进行运动，在曲线控制过程运动中，车体沿着贝塞尔曲线行驶，控制过程中会不断改变控制角度，使车体控制点(P1)始终与贝塞尔曲线相切；步骤五、GV运输车中最末端的跟随点在动力牵引端的牵引下离开曲线路径，并很平缓的过度到另一条直线段上。2.根据权利要求1所述的一种应用于AGV曲线路径导航跟随方法，其特征在于：所述贝塞尔曲线为二阶贝塞尔曲线，且贝塞尔曲线点之间的关系式满足DF/DE＝AD/AB＝BE/BC，并且根据DE线段和计算公式找出所有的F点，记住是所有的F点。3.根据权利要求2所述的一种应用于AGV曲线路径导航跟随方法，其特征在于：所述F点...

【专利技术属性】
技术研发人员：李蜜，陈检，
申请(专利权)人：上海同普电力技术有限公司，
类型：发明
国别省市：