磁导航AGV的路径跟踪方法

摘要

本发明公开了一种磁导航AGV的路径跟踪方法。该路径跟踪方法包括：步骤1，判断横向检测传感器中间两个点以及纵向传感器的所有点是否有信号输出；步骤2，基于步骤1，若是直接跳入到步骤7；步骤3，基于步骤2，若否，则判断横向传感器的哪几位有信号输出；步骤4，基于步骤3，同时判断纵向信号输出点是否有第一个点，若是直接跳入到步骤7；步骤5；步骤6，经计算出来的控制量输出给两个控制电机执行纠偏过程，并判断是否进入到接近姿态；步骤7，若满足接近姿态的条件，则车体两个驱动轮的其中一个轮转速保持不变且另一个轮以原来的转速反转。该路径跟踪方法使得AGV的控制精度大大提高。

主权项

一种磁导航AGV的路径跟踪方法，其特征在于，该磁导航AGV采用呈T字形布局的横向检测传感器和纵向传感器，并通过综合横向传感器以及纵向传感器的信号输出位判断该磁导航AGV的姿态，在不同姿态下用不同的控制策略使AGV进入平衡状态；该路径跟踪方法包括以下步骤：步骤1，判断横向检测传感器中间两个点以及纵向传感器的所有点是否有信号输出；步骤2，基于步骤1，若否，则判断是否横向检测传感器的中间两个点以及纵向检测传感器的第一个点有信号输出且纵向检测传感器存在无信号输出的点；若是直接跳入到步骤7；步骤3，基于步骤2，若否，则判断横向传感器的哪几位有信号输出；步骤4，基于步骤3，同时判断纵向信号输出点是否有第一个点，若是直接跳入到步骤7；步骤5，基于步骤4，若结论为否，则计算出此时车体的距离偏差和角度偏差，同时计算出车体的纠偏半径和电机转速增量；步骤6，经计算出来的控制量输出给两个控制电机执行纠偏过程，并判断是否进入到接近姿态；步骤7，若满足接近姿态的条件，则车体两个驱动轮的其中一个轮转速保持不变且另一个轮以原来的转速反转，直到纵向检测传感器所有的点都有信号输出为止，两个驱动轮的转速恢复为设定的车体前进的速度；所述横向检测传感器和纵向传感器检测到的磁导航AGV的状态包括：第一类状态：平衡姿态，是指传感器组的接近圆有信号输出且纵向传感器的其余所有检测单元都有信号输出；第二类状态：极端姿态，是指横向检测传感器的中间两个点无信号输出且纵向检测传感器第一个点无信号输出，在此状态下的纠偏策略是，计算出此时的AGV的距离偏差和角度偏差，再求出纠偏半径和控制量；第三类状态：接近姿态，此时横向检测传感器的中间两个点和纵向检测传感器的第一个点均有信号输出；所述纵向传感器与磁导航AGV的中心线重合，所述磁导航AGV的中心线是指在小车底盘平面内经过两驱动轮轴线的中点且垂直于两驱动轮轴线的线；所述两驱动轮的轴线经过纵向传感器的第一个信号检测点。