基于二维码导航的四轮转向AGV轨迹纠偏方法

摘要

本发明公开了一种基于二维码导航的四轮转向AGV轨迹纠偏方法，包括：获取二维码中的AGV姿态偏差数据；计算AGV控制转向电机进行偏角矫正时的第一角度偏移和位移矫正时的第一位移偏移；判断AGV姿态偏差数据和第一角度偏移判断是否保持转盘最大角度预设时间后转回，生成偏角纠正电机速度控制曲线；根据AGV姿态偏差数据和第一位移偏移判断是否保持转盘最大角度预设时间后转回，生成偏移纠正电机速度控制曲线；利用转向电机和驱动电机的速度曲线和偏移纠正电机速度控制曲线对电机进行速度控制。该方法能够根据初始偏移和AGV的固有参数规划一条合适的纠偏路径，并得到四个驱动电机和四个驱动电机的速度曲线，完成运动纠偏。