Plots of Heading, Angles and Sensors Vals after changing AHRS Update function.