基于非奇异快速终端滑模的移栽机取送苗机构运动控制

    Motion control of transplanter seedling pickup and delivery mechanism using non-singular fast terminal sliding mode

    • 摘要: 针对番茄移栽机取送苗机构高速往复运动中产生的定位误差增大和稳定性下降的问题,该研究采用基于干扰观测器的非奇异快速终端滑模控制策略,实现取送苗机构的定位控制。分析取送苗机构受约束情况,建立取送苗机构动力学模型;设计非奇异快速终端滑模控制器,并采用改进型分数阶自适应律(fractional-order adaptive law,fal)函数趋近律,保证取送苗机构位置控制的快速性和准确性。为防止控制器中非线性函数和摩擦振动导致的抖振,引入非线性干扰观测器,实现抖振有效抑制和系统跟踪的稳定性。在Matlab/Simulink软件中进行干扰下移栽机取送苗机构轨迹跟踪仿真试验,结果表明:非奇异快速终端滑模控制器保证系统跟踪误差在有效时间内收敛;引入干扰观测器的非奇异快速终端滑模控制,改善系统控制抖振导致的收敛振荡,提高系统稳定性。最后搭建试验平台,通过高速摄影对取送苗运动轨迹和误差累积情况进行验证,结果表明:取送苗速率试验中位姿最大误差是2.63°,累计试验位姿误差在3°内,满足取送苗实际工作要求。该研究可为移栽机取送苗自动化提供参考。

       

      Abstract: Xinjiang is the largest agricultural production base in China; however, due to the region's unique climate, early sowing is not possible. The use of seedling transplanting technology has been adapted to extreme climatic conditions, and this technology has improved the survival rate of tomato seedlings. As tomato production continues to expand and agricultural modernisation advances, the efficiency of transplanting machinery is becoming an essential development requirement. The present study proposes a non-singular fast terminal sliding mode control method based on the interference observer, with the aim of enhancing the system's seedling picking up and delivery mechanism. This method addresses the challenges posed by interference and modelling errors, which have been identified as contributing factors to the system's suboptimal performance, characterised by low position control accuracy, slow response speed and stability. 1)The paper analyses the constraints on the seedling pickup and delivery mechanism, and establishes a reduced order model of seedling pickup and delivery manipulator dynamics based on the Lagrange dynamics modelling method. 2)The non-singular fast terminal sliding mode controller is designed, and the improved fal function convergence law is adopted to ensure the fast and accurate position control of the seedling pickup and delivery mechanism. 3)Due to the jitter vibration caused by the nonlinear function and friction vibration in the controller, it is proposed to introduce a nonlinear disturbance observer to achieve effective suppression of the jitter vibration and stability of the system tracking. 4)In Matlab/Simulink, the trajectory tracking simulation experiment of transplanting machine seedling pickup and delivery mechanism under interference is carried out. The results demonstrate that the position tracking of the seedling pickup and delivery mechanism linkage 1 and linkage 2 converge at 0.7 and 0.8s, respectively, when employing a non-singular fast terminal sliding mode controller. The maximum position tracking error is 0.32 and 0.45rad, which verifies that the sliding mode controller effectively improves the convergence speed and control accuracy of the seedling pickup and delivery mechanism. After the introduction of the interference observer, the mean squared error of position tracking of connecting rod 1 and connecting rod 2 of the seedling pickup and delivery robot is 0.00772 and 0.00824rad, which is a decrease of 45.7% and 52.8% in the tracking error mean squared error, and it verifies that the interference observer effectively improves the stability of the control. Concurrently, the convergence time is reduced by 42.9% and 25%, and the maximum position tracking error is decreased by 25% and 11%, signifying that the interference observer enhances convergence speed and control accuracy. Finally, a test platform has been constructed in order to verify the rate of seedling pickup and delivery and error accumulation through the use of high-speed photography. The results of this study demonstrate that the maximum attitude error in the rate test of seedling pickup and delivery is 2.63°, and that the error accumulation test is within 3°, which meets the actual working requirements of seedling pickup and delivery. This study provides a reference for the automation of pickup and delivery of tomato hole tray seedling transplanter.

       

    /

    返回文章
    返回