Implementation of error-state kalman filter for attitude determination with MARG sensors