Revert "AHRS code fixes by Jeroen van de Mortel"

This reverts commit 4b23762e4ddf45d6daf8f038a7a891122e2ed397.

Conflicts:
	autopilot/service/estimators/ahrs.c