CPC G01S 19/47 (2013.01) [G01C 21/165 (2013.01); G01C 21/20 (2013.01)] | 9 Claims |
1. A positioning method, comprising:
acquiring credibility of each of a plurality of different positioning subsystems in different states and generating a credibility data table for each positioning subsystem;
acquiring real-time credibility from the corresponding credibility data table according to real-time positioning data of each positioning subsystem;
calculating a first information distribution weight coefficient of each positioning subsystem involving a fusion operation of a Federated Kalman filter according to the real-time credibility of each positioning subsystem;
acquiring a second information distribution weight coefficient of each positioning subsystem involving the fusion operation fed back to each sub-filter of the Federated Kalman filter by a main filter of the Federated Kalman filter according to global data; determining a final information distribution weight coefficient of each positioning subsystem involving the fusion operation according to the first information distribution weight coefficient and the second information distribution weight coefficient; and
performing, by the Federated Kalman filter, the fusion operation according to the final information distribution weight coefficient of each of the positioning subsystems and outputting a final positioning result.
|