ABSTRACT The FCDET is considered as a promising and advanced agricultural machinery due to its convenience and controllability. To enhance the control performance of the FCDET unit dynamic system, understanding the accurate position of the center of gravity (CoG) of the tractor unit in longitudinal motion and the operating environment is essential. In this paper, we proposed a real-time estimation method of CoG position of longitudinal motion for FCDET plowing and transportation conditions. CoG height and longitudinal axis distance distribution coefficients are used as state estimation variables, and the data obtained from displacement and velocity sensors are used as state observation variables, establishing a discrete system state space model and proving the observability. The proposed Derived UKF algorithm introduces the Sage-Husa adaptive noise equation within the Square-Root UKF framework to address the non-positive definite matrix problem. The research shows that the precise CoG longitudinal position effectively reflects changes in operational pavement load. The Derived UKF algorithm exhibits high state estimation accuracy in plowing and transportation conditions, with mean absolute errors of 14.2% and 5.0% of the state amplitude, respectively. This study supports the practical application of real-time state parameter estimation algorithms in controlling advanced agricultural machinery distributed drive systems.
Read full abstract