Wheeled robot state estimation method and autonomous navigation method based on robust rank Kalman filtering
A wheeled robot and Kalman filter technology, applied in navigation, surveying and navigation, navigation calculation tools, etc., can solve problems such as inability to deal with nonlinear uncertain systems, low navigation positioning accuracy, etc., and achieve strong robustness and navigation Positioning accuracy and the effect of improving accuracy
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment
[0064] Embodiment: the wheeled robot autonomous navigation method based on robust rank Kalman filtering-SLAM, comprises the following steps:
[0065] Step 1: Establish a corresponding navigation system model for a wheeled robot:
[0066]
[0067] in, is the position (x and y) and azimuth (θ) of the wheeled robot at time k, u k is the control quantity, z k is the observed quantity, w k-1 and v k are system noise and measurement noise, respectively;
[0068] Step 2: Establish a SLAM probability model In the formula is the map feature point at time k;
[0069] The SLAM probability model is calculated using Bayesian theory.
[0070] First predict, through the motion model of the wheeled robot and the posterior probability distribution at time k-1 to obtain the prior probability distribution at time k:
[0071]
[0072] The second is the observation update, using the observation data z of the sensor k time k Correct the prior probability distribution to obtain ...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 


