Implementation of error-state kalman filter for attitude determination with MARG sensors - View it on GitHub