Initial correction of Z acceleration

Added pos.EstAcc[3] that will be used for position tracking with the
Sonar and the PX4flow.