一种地下铲运机多模式自主行驶控制方法

摘要

本发明公开了一种地下铲运机多模式自主行驶控制方法，针对井下巷道环境条件的复杂状况，将地下铲运机目标路径规划、偏差计算及自主行驶控制有机结合起来，克服了地下铲运机目标路径规划难题及行驶轨迹与目标路径偏差求取难题，具有测量系统存储和计算数据量小、控制系统运行速度快、系统稳定性好的优点；另外，通过将地下铲运机偏差计算及自主行驶控制划分为四种计算控制模式，克服了单一模式的局限性，通过在不同的井下巷道环境条件下，运用不同的偏差计算控制模式或将其组合使用，在减少计算量和控制复杂性的同时，较好地适用井下巷道各种环境条件，取得地下铲运机较理想的自主行驶控制效果。