AP_Compass: fixed a bug in the tilt compass calculation

The simplification applied a few months ago was incorrect