Started to implement an AHRS function on the spatial