色带导航纠偏方法、存储介质和电子设备技术

本发明专利技术公开了一种色带导航纠偏方法、存储介质和电子设备，方法包括以下步骤：视觉传感器采集AGV中轴方向与色带轨道的角度偏移量Xrole；视觉传感器采集AGV中轴与色带轨道的垂直距离偏移量Ys；根据求值公式X结合所述角度偏移量Xrole和垂直距离偏移量Ys获得偏差值ErrorValue，其中所述求值公式X为预先设定，AGV根据轨道偏差值ErrorValue调整车体位姿。本发明专利技术的存储介质和电子设备用于实现上述方法。相比现有技术仅通过Y轴方向的偏差纠正AGV的位置，其纠正精度更高，有效防止AGV在直线或弯道上偏航、脱轨。脱轨。脱轨。

【技术实现步骤摘要】
色带导航纠偏方法、存储介质和电子设备


[0001]本专利技术涉及工业机器人领域，具体涉及一种色带导航纠偏方法、存储介质和电子设备。

技术介绍

[0002]色带导引是在自动导引车的形式路径上设置光学标志(粘贴色带或涂漆)，通过车载的光学传感器摄像头(视觉传感器)采集图像信号识别来实现导引的方法。光学导引与磁带导引较为类似，主要的优点是路面铺设较为容易，拓展与更改路径相对磁带导引容易，成本低。
[0003]如图2
‑
3所示，由于色带导航也属于有轨导航的一种，一般采取的导航算法，即依据视觉传感器的摄像头返回来的“左右偏差”数据，即Y轴方向的偏差，计算AGV偏离轨道的误差，其公式为ErrorValue＝K*Y，然后调整差速AGV左右电机的速度进行纠偏，其中，ErrorValue为调整量，Y为Y轴偏差距离，K为常量，其是根据实验获得经验数值，范围在1～120内，不同结构、规格的AGV的K数值有所不同。由于摄像头距离地面的高度限制，摄像头采集地面X轴方向、Y轴方向的范围有限，如AGV偏航较多，会导致传感器无法读取色带，在一些拐弯路径，仅通过上述计算偏差的公式会导致AGV即使已在X轴方向偏航，却不能及时发现，导致不能及时的控制AGV进行调整，导致AGV脱轨。
[0004]上述问题假设通过增大K值解决，虽然可使AGV在弯道行驶时不易脱轨，但会导致AGV在直线行驶时过调，形成蛇形走位，由于摄像头的检测范围有限，过调量大还容易导致摄像头难以检测到色带，造成脱轨。

技术实现思路

[0005]本专利技术的第一个专利技术目的在于克服现有的色带导航纠偏方法不能兼顾AGV在直线、弯道上有效纠偏的问题，提供一种色带导航纠偏方法。
[0006]为实现以上专利技术目的，本专利技术采取以下技术方案：
[0007]色带导航纠偏方法，所述方法包括以下步骤：
[0008]视觉传感器采集AGV中轴方向与色带轨道的角度偏移量Xrole；
[0009]视觉传感器采集AGV中轴与色带轨道的垂直距离偏移量Ys；
[0010]根据求值公式X结合所述角度偏移量Xrole和垂直距离偏移量Ys获得偏差值ErrorValue，其中所述求值公式X为预先设定；
[0011]AGV根据轨道偏差值ErrorValue调整车体位姿。
[0012]本专利技术的方法获取角度偏移量Xrole、垂直距离偏移量Ys；并通过预先设定的公式获得偏差值ErrorValue，从而调整车体位姿。与现有技术相比，其同时兼顾到角度偏移量Xrole、垂直距离偏移量Ys，相比现有技术仅通过Y轴方向的偏差纠正AGV的位置，其纠正精度更高，有效防止AGV在直线或弯道上偏航、脱轨。
[0013]优选的，所述求值公式X为ErrorValue＝K1*Ys+K2*Xrole，所述K1和K2是权重系
数。
[0014]优选的，当所述AGV中轴方向与色带轨道的偏角位于色带轨道的左侧时，所述角度偏移量Xrole为负值，反之为正值；当所述AGV中轴位于所述色带轨道的左侧时，所述垂直距离偏移量Ys为负值，反之为正值。
[0015]当轨道偏差值为正，控制终端控制差速驱动模组的左侧电机减速，右侧电机加速，当轨道偏差值为负，则反之。
[0016]优选的，所述视觉传感器距水平面100mm,Xrole的范围在
‑
45～45度之间，Ys数据范围在
‑
58.5mm～58.5mm之间。
[0017]优选的，所述控制终端通过PID算法计算调整量。即在获得偏差值ErrorValue值后，通过PID算法计算调整量。
[0018]本专利技术的另一个专利技术目的在于提供一种存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现上述方案的色带导航纠偏方法。与现有技术相比，本专利技术的存储介质由于可执行上述方案的色带导航纠偏方法，因此，具有上述方案的所有优点。
[0019]本专利技术的第三个专利技术目的在于提供一种电子设备，包括处理器和存储器，所述处理器和所述存储器之间相互通信，所述存储器用于存放可执行的指令，使所述处理器执行该指令时实现上述的色带导航纠偏方法。
附图说明
[0020]图1是本专利技术的流程简图；
[0021]图2是现有技术的原理图1；
[0022]图3是现有技术的原理图2；
[0023]图4是现有技术的原理图3；
[0024]图5是本专利技术的原理图1；
[0025]图6是本专利技术的原理图2；
[0026]图7是本专利技术的原理图3；
[0027]图8是本专利技术的原理图4。
具体实施方式
[0028]以下根据附图，进一步的说明本专利技术的技术方案：
[0029]实施例一：
[0030]参见图1所示，本实施例公开了一种色带导航纠偏方法，所述方法包括以下步骤：视觉传感器采集AGV中轴方向与色带轨道的角度偏移量Xrole；视觉传感器采集AGV中轴与色带轨道的垂直距离偏移量Ys；根据求值公式X结合所述角度偏移量Xrole和垂直距离偏移量Ys获得偏差值ErrorValue，其中所述求值公式X为预先设定,AGV根据轨道偏差值ErrorValue调整车体位姿。
[0031]上述求值公式X为ErrorValue＝K1*Ys+K2*Xrole，所述K1和K2是权重系数。在本方案中，K1、K2是根据实验获得经验数值，不同结构、规格的AGV的K数值有所不同。
[0032]在一实施例中，当所述AGV中轴方向与色带轨道的偏角位于色带轨道的左侧时，所述角度偏移量Xrole为负值，反之为正值；当所述AGV中轴位于所述色带轨道的左侧时，所述
垂直距离偏移量Ys为负值，反之为正值。
[0033]当轨道偏差值为正，控制终端控制差速驱动模组的左侧电机减速，右侧电机加速，当轨道偏差值为负，则反之。
[0034]在一实施例中，视觉传感器距水平面100mm,Xrole的范围在
‑
45～45度之间，Ys数据范围在
‑
58.5mm～58.5mm之间。
[0035]在一实施例中，所述控制终端通过PID算法计算调整量。
[0036]工作原理：
[0037]如5
‑
6所示，摄像头采集的图形信息包括摄像头与色带之间夹角，以及摄像头与色带之间的距离，由于摄像头的高度固定，拍摄范围有限，而根据实验证明，摄像头的安装高度与水平在相距100mm时拍摄效果最佳，在该高度限制下，摄像头的拍摄范围在摄像头75mm*117mm内，摄像头对色带采集范围为以其中轴为中心线的
‑
45～45度之间，垂直距离值范围为
‑
58.5mm～58.5mm，超过该范围，摄像头无法采集色带信息，因此，上述视觉传感器距水平面100cm,Xrole的范围在
‑
45～45度之间，Ys数据范围在
‑
58.5mm～58.5mm之间。
[00本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.色带导航纠偏方法，其特征在于，所述方法包括以下步骤：视觉传感器采集AGV中轴方向与色带轨道的角度偏移量Xrole；视觉传感器采集AGV中轴与色带轨道的垂直距离偏移量Ys；根据求值公式X结合所述角度偏移量Xrole和垂直距离偏移量Ys获得偏差值ErrorValue，其中所述求值公式X为预先设定；AGV根据轨道偏差值ErrorValue调整车体位姿。2.根据权利要求1所述的色带导航纠偏方法，其特征在于，所述求值公式X为ErrorValue＝K1*Ys+K2*Xrole，所述K1和K2是权重系数。3.根据权利要求2所述的色带导航纠偏方法，其特征在于，当所述AGV中轴方向与色带轨道的偏角位于色带轨道的左侧时，所述角度偏移量Xrole为负值，反之为正值；当所述AGV中轴位于所述色带轨道的左侧时，所述垂直距离偏移量Ys为负值，反之为正值。4.根据权利要求3所述的色带导航纠偏方法，其特征在于，当...

【专利技术属性】
技术研发人员：刘锦安，
申请(专利权)人：广东嘉腾机器人自动化有限公司，
类型：发明
国别省市：