I present you my implementation of Sebastian Madgwick's implementation of Mayhony's DCM filter incorporating Sebastian's magnetic distortion compensation.
The sensors used where the ADXL345, the ITG3200 and the HMC5843.
All the details available at varesano.net -