基于虚拟探照灯的离合制动履带底盘寻径跟踪  

Path finding and tracking of clutch brake track chassis based on virtual searchlight

作　　者：陈子文 熊扬凡 胡宗锐 李聪 庞有伦[3] 杨明金[1] CHEN Ziwen;XIONG Yangfan;HU Zongrui;LI Cong;PANG Youlun;YANG Mingjin(College of Engineering and Technology,Southwest University,Chongqing 400715,China;Faculty of Mechanical Engineering and Automation,Chongqing Industry Polytechnic College,Chongqing 401120,China;Institute of Agricultural Machinery,Chongqing Academy of Agricultural Sciences,Chongqing 401329,China)

机构地区：[1]西南大学工程技术学院,重庆400715 [2]重庆工业职业技术学院机械工程与自动化学院,重庆401120 [3]重庆市农业科学院农业机械化研究所,重庆401329

出　　处：《农业工程学报》2023年第12期10-19,共10页Transactions of the Chinese Society of Agricultural Engineering

基　　金：国家重点研发计划项目(2018YFD0700603-1);重庆市技术创新与应用发展专项重点项目(cstc2021jscx-gksbX0013)。

摘　　要：油动履带底盘由于具有成本低、技术成熟、动力充足、续航能力强、维修便捷等特点而被广泛应用于农业生产,但其操控精度低、振动严重等问题对其应用造成挑战。该研究以农用油动履带底盘为对象,根据共性传动结构提出离合制动式履带底盘,并以STM32F303作为主控器搭建基于实时动态差分全球导航卫星系统(real-time kinematic global navigation satellite system,RTK-GNSS)的自动导航系统,建立其运动学模型,提出一种改进模糊式预瞄控制算法—虚拟探照灯寻径跟踪(virtual searchlight pathfinding tracking,VSPT)算法。针对横向偏差和速度变化引起的跟踪振荡问题,提出基于横向偏差指数的视域角动态调整方法和基于行驶速度的虚拟目标点判断方法,并通过仿真和试验验证算法的有效性。仿真结果表明,在底盘前进速度0.4 m/s时,横向偏差指数λ、视域增益k1和目标增益k2取值分别为1/4,0.005 rad·m和6 s^(-1)时可获得较好的导航效果。现场试验结果表明,在水泥路面,不同初始位姿下,直线导航平均上线距离为1.64 m,平均横向偏差和航向偏差为0.44 cm和1.57°;行驶速度提高会导致导航精度降低,适当修正k1、k2可维持较好的导航效果,3种行驶速度下获得的平均横向和航向偏差分别为0.75 cm和1.05°,平均纠偏次数为4.7次;田间路况下,由于土路附着系数增加,转向相对平稳,纠偏次数降低至2.7次,相同参数时2种路况下的导航效果接近。研究表明,VSPT算法针对离合制动式履带底盘具有良好的跟踪效果和路况适应性,该研究可为离合制动履带平台提供一种高效、稳定的导航控制方案。Chassis assembly is one of the core components in mobile agricultural power machinery.A universal chassis can carry the functional tools to realize the various activities in agricultural production.Among them,the oil-operated track chassis are widely used in recent years,due to their low cost,mature technology,sufficient power,high range,and easy maintenance.But their low handling accuracy and severe vibration have posed great challenges to the application of automatic navigation.In this study,the concept of clutch-braked track chassis was proposed as a low-cost agricultural oil-operated track chassis platform.Stronger traction was achieved during steering,compared with differential track chassis vehicles.The RTK-GNSS-based automatic navigation system was built with the STM32F303 as the main controller.The working path of agricultural machines generally consisted of a straight line in the actual operation.The process of tracking was divided into the desired path of the track chassis platform online and the straight line tracking,according to the online point(the online point referred to the sampling point with a lateral deviation less than 3.0 cm,heading deviation less than 2.0°,and the closest distance to the starting position).The kinematics model was established using the transmission and motion of the platform vehicle.A virtual search light pathfinding tracking(VSPT)was proposed to represent the pseudo-code of the VSPT.The fuzzy pre-scanning control was enhanced to search for the target points within the searchlight's field of view in real time.The steering of the track vehicle was controlled to expose the target points within the field of view at all times.In addition,the field of view angle was dynamically adjusted for the tracking oscillation caused by the lateral deviation and speed change.The lateral deviation index and a virtual target point judgment were utilized with a positive proportional relationship of speed.The logical process was designed for the data flow diagram.Direct memory access(DMA)data

关 键 词：精准农业 车辆 导航 RTK-GNSS 履带底盘 控制算法 

分 类 号：S224.9[农业科学—农业机械化工程]