Sensor measurements are corrupted by biases, noise and drift effects and, in order to provide accurate measurements, these errors need to be estimated and, thus, eliminated. The current model used an Extended Kalman filter for the estimation of rate gyroscope measurement errors. This work improves upon that filter by applying a more robust, more accurate and more reliable Unscented Kalman filter. In addition, an algorithm for estimating the accelerometer measurement errors is developed using control theory. Using the attitude estimate from the Unscented Kalman filter, an error signal is formed between that attitude and the attitude estimates from the accelerometer array(s). This error signal is then reduced by implementation of an innovative method using PID controllers to estimate, and reduce the effects of, accelerometer measurement errors.
展开▼
