diydrones/ardupilot — pull request #1336 by priseborough (2014-08-24 04:07:57+00:00)
Title: AP_NavEKF : Reduce ripple in estimates that can cause audible copter motor 'pulsing'

This patch reduces the level of 5Hz and 10Hz 'pulsing' heard in motors due to GPS, altimeter and magnetometer fusion which can cause a small 5Hz and 10Hz ripple on the state output. Attitude, velocity and position state corrections from GPS, altimeter and magnetometer measurements are applied incrementally in the interval from receiving the measurement to the predicted time of receipt of the next measurement. During periods of rapid rotation, corrections to the quaternion states are applied immediately and not incrementally to avoid attitude error building up during periods of high rotation.

Time stamps are now explicitly initialised to the current IMU time to avoid unwanted activation of timeout logic on filter start and the various calls to the hal.scheduler->millis() object have been consolidated.