Sideslip angle estimation method and estimator suitable for agricultural machinery linear navigation
A technology for agricultural machinery and angle estimation, which is applied in the field of vehicle navigation and tracking, and can solve the problems of lack of sensors, difficulty in obtaining the sideslip angle, and poor path tracking accuracy.
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0058] Embodiment 1, a side-slip angle estimation method suitable for straight-line navigation of agricultural machinery, specifically includes the following steps:
[0059] Step S1. During the running process of the agricultural machine, collect the front wheel steering angle information of the agricultural machine, as well as the forward speed information, antenna positioning information and current attitude information of the agricultural machine, and perform corresponding analysis and processing;
[0060] Step S2, constructing the dynamic equation of the agricultural machinery and using it as the system state equation, based on the state observer theory to realize the estimation of the sideslip angle during the straight-line navigation path tracking process, specifically:
[0061] (1) According to the antenna positioning information and current attitude information of the agricultural machinery collected in step S1, analyze and obtain the comprehensive error signal ε(j) at ...
Embodiment 2
[0086] Embodiment 2, based on the estimation method proposed in Embodiment 1, this embodiment proposes a sideslip angle estimator suitable for straight-line navigation of agricultural machinery. The automatic navigation system of agricultural machinery is equipped with vehicle front wheel wheel angle sensors 1 and GNSS Locating orienting device 2, such as figure 1 As shown, the front wheel steering angle analog value output by the front wheel angle sensor 1 passes through the A / D converter 3 and the first digital filter 4 and then outputs the digital value δ(j) of the front wheel steering angle at j moment; the first digital The filter 4 realizes the filtering of the A / D converted signal of the wheel angle sensor, which is mean value filtering. Define the number of filtering points of mean filtering as N, the sampling interval of AD conversion as Δt, and the system control period as T s , in order to ensure the normal operation of the system, the number of mean filter points ...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 


