New AHRS driver for FHP_Airspeed

Modified AHRS drivers to work with FHP_Airspeed object. This code is no
longer compatible with the vanilla APM firmware. Code verifies in
Arduino, has not been tested on APM yet.