关键词:
无人驾驶农机
路径跟踪
视线导引
滑模控制
状态观测器
摘要:
农业是支撑国民经济建设和发展的基础产业,无人农机自动驾驶系统是我国面向精准农业,实现农业现代化,衡量国家综合实力一项重要技术。特别地,稳定精准的路径跟踪控制算法能够提高农机作业效率,缓解人工劳动力,是农机自动驾驶系统的关键所在。本文将田间作业东方红LX1104型四轮驱动式拖拉机作为被控试验平台,对其路径跟踪控制系统进行深入研究;以视线法制导律为基础,设计一种稳定可靠的农机路径跟踪控制策略方案。主要研究内容为以下几个方面:(1)通过对路径跟踪控制系统整体架构的研究,建立农机动力学横向控制模型。首先根据系统中涉及到的车身状态信息获取、前轮转向控制等模块,以车辆动力学理论为基础分别对其进行数学建模,再结合农机路径跟踪控制需求分析和简化系统设计,建立符合农机路径跟踪系统要求的二自由度横向控制模型。(2)结合农机动力学控制模型,完成路径跟踪过程中视线导引系统的设计。首先,为了改善路径跟踪动态响应和稳定性能,在系统中引入并深入研究了视线导引方法,然后在其基础上对制导律中的前视距离和切换视线圆半径两个算法分别进行了改进,进一步提高了系统的灵活性和自适应性。最后将其与横向动力学控制模型相结合,设计一个农机路径跟踪视线导引系统,通过直线和折线导引两种不同工况的仿真,验证了系统的可靠性。(3)在视线导引系统的策略下设计路径跟踪横向滑模控制系统。首先为了增强系统的鲁棒性和准确性,针对车辆质心侧偏角和外界扰动分别设计扩张状态观测器,给控制系统提供精准的反馈补偿量并进行仿真验证其合理性。接着,为了解决系统中滑模控制抖振问题和提高实际应用价值,考虑到系统内部模型不确定性和实际中执行器输入物理受限问题,在传统滑模理论的基础上设计了一种基于模糊逻辑系统和输入饱和补偿的滑模偏航控制器。最后将其与传统滑模控制器进行仿真对比,验证了所设计控制器的优越性能,能够给系统带来稳定准确的控制输入。(4)基于视线导引系统和横向滑模控制系统的设计,对完整的农机路径跟踪系统进行理论和工程应用性验证。首先,利用Carsim/Simulink联合仿真平台,根据以上设计搭建了基于视线导引法和滑模控制的路径跟踪系统并分别在有侧风扰动和无侧风扰动条件下进行仿真对比,全面验证了系统的理论应用可行性;然后,将路径跟踪系统算法通过编程开发应用到东方红LX1104拖拉机无人驾驶系统中,并根据控制需求对其导航定位、航姿系统、角度传感器和电控转向设备进行改装,搭建完整的实车试验平台。最后选择干燥田和泥泞田两种不同工况地面进行田间实验,结果都表明农机在15s左右就能完成跟踪上线过程,线上路径跟踪横向偏差基本都能保持在±5cm以内,说明本课题研究的基于视线导引法路径跟踪系统滑模控制策略能满足农机田间作业路线跟踪精度要求,符合精准农业中无人农机自动驾驶系统标准。