Revert "AP_InertialSensor: Removed average values. Back to the EKF and DCM filters"

This reverts commit ae2ef6be52e08db2b6c7f14f2772e08896083abb.