Sensor Fusion for Roll and Pitch Estimation Improvement of an Agricultural Sprayer Vehicle

Lav R. Khot,Lie Tang,Brian L. Steward,Shufeng Han
DOI: https://doi.org/10.13031/2013.20644
2006-01-01
Abstract:Sensor fusion technique has been commonly used for improving the navigation ofautonomous agricultural vehicles by means of combining complimentary sensors mounted on suchvehicles for the position and attitude angle measurements. In this research, sensor fusion via anExtended Kalman Filter (EKF) was used to integrate the attitude angle estimates from the DigitalElevation Models (DEMs) and Terrain Compensation Module (TCM) sensor to improve the roll andpitch angle measurements of a self propelled sprayer. The fusion algorithm was also developed toimprove the three-dimensional positioning of the sprayer, in particular the elevation measurements ofa GPS receiver mounted on the sprayer. Vehicle attitude and field elevation were measured at twospeeds, 5.6 km/h and 9.6 km/h, using a set of onboard sensors including a real-time kinematic-differential GPS receiver (RTK-DGPS), a TCM sensor and an Inertial Measurement Unit (IMU). Asecond order auto-regressive (AR) model was developed to model the TCM roll and GPS-basedpitch errors. The derived error states were incorporated into the EKF algorithm and the measurementnoise covariance was estimated from the AR model, which limited the fine tuning of noise covarianceto the process noise covariance only. The EKF estimations were compared with the IMU measurements to validate the performance of thedeveloped fusion algorithm. For the slow speed test data, the mean and standard deviation of theerrors of roll (Mean: -0.2244, Std. Dev.:1.471) and pitch (Mean: 0.0597, Std. Dev.: 0.6621) fromthe EKF estimates were reduced considerably compared to that of the errors of roll (Mean: 0.2157,Std. Dev.: 2.4610) and pitch (Mean: 0.0473, Std. Dev.: 1.3230) from DEM. Medium speed testdata also showed considerable improvement in the attitude angles estimated using the developedEKF algorithm. The fusion algorithm for improving the elevation measurement of the GPS alsoshowed promising results. Thus, the fusion algorithm was effective in improving attitude and thenavigational accuracy of the self-propelled agricultural sprayer, which in turn will also facilitate theautomatic control of the implements that interact with the soil surface on undulated topographicsurfaces.
What problem does this paper attempt to address?