Added AHRS draft
AHRS. Added logging ability