王法安,王博洋,张兆国,等. 履带车辆自适应预瞄跟踪模糊控制算法[J]. 农业工程学报,2024,40(10):32-43. DOI: 10.11975/j.issn.1002-6819.202401039
    引用本文: 王法安,王博洋,张兆国,等. 履带车辆自适应预瞄跟踪模糊控制算法[J]. 农业工程学报,2024,40(10):32-43. DOI: 10.11975/j.issn.1002-6819.202401039
    WANG Fa´an, WANG Boyang, ZHANG Zhaoguo, et al. Adaptive preview tracking fuzzy control algorithm for tracked vehicles[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2024, 40(10): 32-43. DOI: 10.11975/j.issn.1002-6819.202401039
    Citation: WANG Fa´an, WANG Boyang, ZHANG Zhaoguo, et al. Adaptive preview tracking fuzzy control algorithm for tracked vehicles[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2024, 40(10): 32-43. DOI: 10.11975/j.issn.1002-6819.202401039

    履带车辆自适应预瞄跟踪模糊控制算法

    Adaptive preview tracking fuzzy control algorithm for tracked vehicles

    • 摘要: 针对现有单边制动履带车辆跟踪控制算法同周期内并行控制难、跟踪精度低、转向控制次数较多等问题,该研究以电控化改装后江苏筑水农机 3B55 型履带运输车为试验平台,开展单边制动履带车辆路径跟踪控制算法研究。通过单边制动履带车辆运动学分析,构建车辆预瞄跟踪模型,提出一种预瞄跟踪模糊控制算法,将横向偏差与航向偏差作为多输入输出模糊控制器输入参数,实现车辆同一控制周期内转向与直线行驶的并行控制。为了优化车辆路径跟踪精度与转向控制次数,提出改进麻雀搜索算法(sparrow search algorithm, SSA)的自适应前视距求解算法,考虑车辆的横向偏差和转向路径角度约束,解析较优前视距离,通过仿真和田间试验对算法进行跟踪精度与转向控制次数综合评价。仿真结果表明:基于自适应预瞄跟踪模糊控制算法跟踪多角度规划路径时,车辆转向控制次数为89次,误差面积为1.74 m2。田间作业路况下,由于试验路面起伏不平,并且随速度增加车辆跟踪精度下降,但跟踪精度及转向控制次数随前视距离的变化规律与仿真结果一致,当车辆分别以0.14、0.47和0.83 m/s跟踪路径时,自适应预瞄跟踪模糊控制算法相对于固定前视距离预瞄跟踪模糊控制算法车辆转向控制次数分别减少13.59%、9.87%和11.25%,误差面积分别减少19.93%、48.48%和54.59%,验证了算法的有效性。研究结果可为单边制动履带车辆的农机自动导航技术提供创新思路与技术支撑。

       

      Abstract: Tracked vehicles have demonstrated superior passability in hilly and mountainous terrains. Among them, the control system of path tracking has been focused mainly on wheeled agricultural equipment rather than tracked vehicles, particularly with single-sided braking tracks. In this study, the fuzzy control of adaptive preview tracking was proposed to improve the parallel control and tracking accuracy with the lower turning count of tracked vehicles. The 3B55 tracked transport vehicle was modified as the experimental platform from Jiangsu Zhushui Agricultural Machinery. A preview tracking model was constructed via the kinematic analysis of single-sided brake-tracked vehicles. Efficient parallel control was achieved in the steering and straight-line travel within the same control cycle. A multiple input/output fuzzy controller was designed with the lateral and heading deviation as the inputs, while the motion distance and turning ratio as the outputs. Furthermore, an adaptive line-of-sight solution was introduced with the improved sparrow search algorithm (SSA) to enhance the accuracy of path tracking with less turning count. The chaotic factor and clustering scavengers were also added to the sparrow population, in order to improve the convergence accuracy and susceptibility to local optima. This adaptive front view distance(Los) solution with the improved SSA was analytically determined as the optimal Los, considering the lateral deviation and steering path angle constraints of the vehicle's current state. Simulation and field experiments were carried out to evaluate the tracking accuracy and turning count. Simulation results demonstrate the convergence speed was significantly improved during the early iterations of the improved Sparrow Search. Moreover, the superiority of the improved SSA was validated to successfully escape the local optima with the optimal fitness value after 37 iterations. The on-line modelling test was implemented with the Los of 0.8, 1.5, 2, and 3 m. The lateral deviation increased in the same control cycle when the vehicle was reduced the heading deviation. A longer time was required for the vehicle to complete the on-line, with the increase of the Los. The accuracy of vehicle tracking decreased gradually, but the number of turning counts was also reduced. An optimal Los was obtained in the fuzzy control of adaptive preview tracking in real time, according to the current position and steering path angle of the tracked vehicle during path tracking. When tracking multi-angle planned paths, the turning count was 89 times, with an error area of 1.74 m2. The field experiments were conducted at the Panax Notoginseng Planting Test Field of the Yunnan University Traditional Chinese Medicinal Materials Mechanization Engineering Research Center. The test field was measured as 40 m in length and 6 m in width. The accuracy of path tracking decreased for the tracked transport vehicle in the field, due to the unevenness of the terrain. However, the trends of tracking accuracy and turning count with the Los were consistent with the simulation. Both the turning count and path tracking accuracy decreased gradually, as the driving speed increased, especially in the tracking fuzzy control with fixed Los. When the vehicle tracked at the speeds of 0.14, 0.47, and 0.83 m/s, respectively, the fuzzy control of adaptive preview tracking reduced turning count by 13.59%, 9.87%, and 11.25%, respectively, and the error areas by 19.93%, 48.48%, and 54.59%, respectively. The field and simulation proved that the adaptive predictive tracking fuzzy control for tracked vehicles can be expected to improve the tracking accuracy of the vehicle and the number of steering control times in the field tracking. The tracking trajectory was closer to the planned path, indicating better performance. This study can provide innovative ideas and technical support to the automatic navigation of agricultural machinery in the single-sided brake-tracked vehicle.

       

    /

    返回文章
    返回