[发明专利]全向移动AGV导航纠偏方法

摘要

本发明涉及一种全向移动AGV导航纠偏方法，属于麦克纳姆轮全向移动AGV的导航定位技术领域。本发明根据前后磁传感器反馈的磁条位置信息，通过一种信息处理算法将得到的复杂的实际情况解析为两种独立且方便处理的简单情况，方便处理。从而针对麦克纳姆轮全向移动AGV的特性进行偏差矫正。从磁传感器反馈的信息将会被实时处理并用于计算偏差程度，依据偏差程度对偏差矫正速度进行赋值。从而实现了麦克纳姆轮全向移动AGV的高精度导航纠偏。该方法依据麦克纳姆轮全向移动AGV的行驶特性实现，充分利用了底盘平台的全向移动特点。

主权项

1.一种全向移动AGV导航纠偏方法，其特征在于，包括以下步骤：如果AGV车体发生第一种偏离情况，即车体中心点在车体下方磁条的磁条路径上，同时车体中轴线与磁条路径有一个不为零的夹角，则根据磁传感器返回的值，分析车体与磁条的偏离程度，并计算出旋转速度ω进行车身姿态调整，实现纠偏；如果车体发生第二种偏离情况，即车体中心点不在磁条路径上，同时车体中轴线与磁条路径平行，则根据磁传感器返回的值，分析车体与磁条的偏离程度，并计算出横移速度x进行车身姿态调整，实现纠偏；如果车体发生的偏移情况为第一种与第二种情况的复合偏离情况，即既有旋转偏移，又有横向偏移的情况，则将得到的复合偏离情况拆解为第一种与第二种情况，再通过其各自对应的计算方式计算出相应的调整速度x与ω，同时进行横移和旋转调整，实现纠偏；所述磁传感器为前、后两个磁传感器，分别安装在车体前端与后端；若车体正常行驶，没有任何偏移，则车体中心点在磁条路径上，同时车体中轴线与磁条路径之间没有夹角；对于第一种情况，设前磁传感器的值为a，后磁传感器的值为b，前后磁传感器之间的距离为L，则计算前后磁传感器之间的数值差的绝对值|a‑b|与和的一半(a+b)/2，并计算出车体中轴线与磁条之间的夹角α的三角函数tanα＝|a‑b|/L，由此计算出夹角α，将夹角α乘以系数得到旋转速度ω，利用旋转速度ω进行车身姿态调整，实现纠偏，其中所述系数根据车体旋转到最偏程度时，按照夹角α越小旋转速度ω相应地越小的理论所进行的试验得到。