Shit happens - simplifications are not always good.

The original idea described at: http://www.starlino.com/imu_guide.html
shows how the attidue is calculated correctly.
The current implementation/simplification is error prone for acc measurment spikes.