轮式AGV沿葡萄园垄道行驶避障导航算法与模拟试验

针对轮式AGV沿葡萄园垄道循迹受到障碍物阻碍的问题,应用滚动优化原理提出了基于超声波测距与航向角检测的AGV防碰避障导航算法。采用交叉布置的8路超声波传感器检测垄道边界与障碍物,提出了同一障碍物匹配与类型判据及动态障碍物轨迹预测模型。以AGV横向位置偏差和航向偏角作为模糊控制器输入,获得AGV前轮期望导向角,为AGV绕行障碍物提供参考航向角。基于滚动优化原理提出了调节绕行偏角和调节车速的避障导航策略,设计了AGV绕行静态障碍物、减速或停车避让动态障碍物的导航算法。试验系统的上位机采用Lab VIEW开发的避障导航算法程序,实时将导航数据发送到下位机PLC来控制AGV转向。模拟试验结果表明,该导航算法实现AGV沿垄道预设路径纠偏行驶的同时,可导引AGV避免与垄道上的障碍物发生碰撞,验证了防碰避障导航算法的有效性,可为无人化轮式拖拉机等前轮导向车辆沿垄道循迹的防碰预警与避障技术提供参考。

轮式AGV纯滚动转向系统设计与无侧滑转向控制研究

为了解决前轮导向AGV的车轮侧滑问题,基于Ackermann转向原理设计了一种变长连杆的双曲柄转向系统。通过推导转向动力学模型,建立了考虑转向阻力矩的左、右前轮转向角闭环控制模型,提出了左、右前轮转向角PID同步控制算法,利用Matlab仿真转向控制模型的动态响应,获得了相关控制参数。以松下PLC为核心,构建了由左前轮转向交流伺服电机、推杆伺服电机、驱动器和编码器组成的AGV转向测控系统,设计了前轮转向系统同步闭环控制流程,实现了满足纯滚动转向原理的左、右前轮转角实时同步控制及转角信息采集。草地路面原地转向及硬质路面S型轨迹转向行驶试验表明,前轮导向AGV转向系统的左、右前轮期望转角与实际转角误差小于0.1°,AGV转向系统近似满足车轮纯滚动无侧滑运动条件,验证了轮式AGV纯滚动转向系统设计和转向控制的正确性与有效性。