The magnetometer measurement update plays a key role in correcting yaw estimation in fusion algorithms, and hence, the yaw estimation is vulnerable to magnetic disturbances. The purpose of this study is to improve the ability of the fusion algorithm to deal with magnetic disturbances.
In this paper, an adaptive measurement equation based on vehicle status is derived, which can constrain the yaw estimation from drifting when vehicle is running straight. Using this new measurement, a Kalman filter-based fusion algorithm is constructed, and its performance is evaluated experimentally.
The experiments results demonstrate that the new measurement update works as an effective supplement to the magnetometer measurement update in the present of magnetic disturbances, and the proposed fusion algorithm has better yaw estimation accuracy than the conventional algorithm.
The paper proposes a new adaptive measurement equation for yaw estimation based on vehicle status. And, using this measurement, the fusion algorithm can not only reduce the weight of disturbed sensor measurement but also utilize the character of vehicle running to deal with magnetic disturbances. This strategy can also be used in other orientation estimation fields.
