AP_AHRS_DCM

Reduces size of compilation product and increases speed a little. 
Found not much to optimize.