A Multi-source Joint Localization Method Based on Adaptive Weighted Hybrid Kalman Filter
A Kalman filter, adaptive weighting technology, applied in satellite radio beacon positioning system, radio wave measurement system, navigation through velocity/acceleration measurement, etc. Difficulty, improve positioning accuracy, and improve the effect of computing speed
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0082] Such as Figure 1-3 shown.
[0083] A multi-source joint positioning method based on adaptive weighted hybrid Kalman filter, comprising the following steps:
[0084] 1) The receiver receives the signals of GNSS, RFID, and IMU respectively, and judges whether the GNSS signal is interfered;
[0085] 2) If the GNSS signal is not disturbed, to locate the coordinates of the target is the state vector, with Establish the GNSS system motion model and GNSS observation model for the observation vector, and obtain the optimal estimation of the GNSS state through the extended Kalman filter calculation where r 1 、r 2 、r 3 are the distances from the coordinates of the positioning target measured by GNSS to the three base stations; x k ,y k Respectively, under the WGS-84 coordinates, at time k, the eastward and northward coordinates of the Gaussian projection plane;
[0086] 3) To locate the coordinates of the target is the state vector, with For the RFID observation ...
Embodiment 2
[0093] The multi-source joint positioning method based on adaptive weighted hybrid Kalman filter as described in Embodiment 1, the difference is that the formula of the GNSS system motion model:
[0094]
[0095] in, d k is the displacement of the positioning target from time k-1 to time k, w k-1 is the heading angle of the positioning target measured by the IMU at time k-1; is the noise input function, is the zero-mean systematic white noise sequence, is the variance matrix of the system noise sequence.
Embodiment 3
[0097] The multi-source joint positioning method based on adaptive weighted hybrid Kalman filter as described in Embodiment 1, the difference is that the formula of the GNSS observation model:
[0098]
[0099] in, (x 1 ,y 1 ), (x 2 ,y 2 ), (x 3 ,y 3 ) are the coordinates of the three base stations participating in the positioning; r 1 、r 2 、r 3 are the distances from the coordinates of the positioning target measured by GNSS to the three base stations; is a zero-mean observed white noise sequence, in, is the variance of the observation noise sequence.
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 


