Compensating magnetic disturbances on MARG units by means of a low complexity data fusion algorithm